一种基于NGA-QPF的航天器姿态估计方法

针对航天器姿态确定中的非线性非高斯的滤波问题,提出一种基于遗传算法的粒子滤波的航天器姿态估计方法。该方法将姿态四元数作为采样粒子进行粒子滤波,并将小生境遗传算法（NGA）引入粒子滤波算法中,以改善粒子滤波的性能;用遗传算法单独进行陀螺偏差估计,以减少粒子滤波的状态维数。该姿态估计方法保持了四元数的归一化性质,通过引入小生境遗传算法解决了重采样阶段的粒子退化问题,并且由于单独估计陀螺偏差避免了粒子滤波状态的扩展。该方法能够在较少粒子的情况下实现高效率高精度的定姿,仿真结果说明了方法的有效性。     

IDENTIFICATION OF GYRO DRIFTS UNDER THREE AXIS ATTITUDE COUPLING

ＩＤＥＮＴＩＦＩＣＡＴＩＯＮＯＦＧＹＲＯＤＲＩＦＴＳＵＮＤＥＲＴＨＲＥＥＡＸＩＳＡＴＴＩＴＵＤＥＣＯＵＰＬＩＮＧＪＩＮＧＷｕｘｉｎｇ（荆武兴），ＷＡＮＧＸｕｅｘｉａｏ（王学孝），ＷＵＹａｏｈｕａ（吴瑶华）（ＨａｒｂｉｎＩｎｓｔｉｔｕｔｅｏｆＴｅｃｈｎ...     

改进联邦滤波器在小卫星姿态确定中的应用

采用微小卫星姿态运动学、动力学方程,以磁强计／太阳敏感器为姿态敏感器进行姿态确定,研究了一种基于融合反馈的改进联邦滤波算法,提出了一种基于观测新息修改的信息分配原则。给出了由四元数描述卫星姿态的误差状态方程,并对观测矢量进行推导,获得了基于角速度的观测方程,丰富了观测模型。仿真结果表明：基于角速度观测方程的引入,增强了观测信息的利用率,进而提高了姿态确定的精度,降低了计算量,保证了可靠性。     

Attitude control system design and on-orbit performance analysis of nano-satellite––‘‘Tian Tuo 1’’

‘‘Tian Tuo 1'(TT-1) nano-satellite is the first single-board nano-satellite that was successfully launched in China. The main objective of TT-1 is technology demonstration and scientific measurements. The satellite carries out the significant exploration of single-board architecture feasibility validation, and it is tailored to the low-cost philosophy by adopting numerous commercialoff-the-shelf(COTS) components. The satellite is featured with three-axis stabilization control capability. A pitch bias momentum wheel and three magnetic coils are adopted as control actuators.The sun sensors, magnetometers and a three-axis gyro are employed as the measurement sensors.The quaternion estimator(QUEST) and unscented Kalman filter(UKF) method are adopted for the nano-satellite attitude determination. On-orbit data received by ground station is conducted to analysis the performance of attitude determination and control system(ADCS). The results show that the design of ADCS for TT-1 is suitable, robust and feasible.     

三轴稳定卫星无陀螺姿态确定算法研究

针对三轴稳定卫星进行了正常飞行模式下无陀螺姿态确定算法研究，采用磁强计、地球敏感器和太阳敏感器组合获得姿态数据，利用四元数法和高斯－马尔可夫过程建立了姿态确定估计器算法模型。通过数学仿真证明，此姿态确定算法能够对星体姿态进行较精确的估计或校正，满足卫星控制精度要求。     

Adaptive robust cubature Kalman filtering for satellite attitude estimation

This paper is concerned with the adaptive robust cubature Kalman filtering problem for the case that the dynamics model error and the measurement model error exist simultaneously in the satellite attitude estimation system. By using Hubel-based robust filtering methodology to correct the measurement covariance formulation of cubature Kalman filter, the proposed filtering algorithm could effectively suppress the measurement model error. To further enhance this effect and reduce the impact of the dynamics model error, two different adaptively robust filtering algorithms, one with the optimal adaptive factor based on the estimated covariance matrix of the predicted residuals and the other with multiple fading factors based on strong tracking algorithm, are developed and applied for the satellite attitude estimation. The quaternion is employed to represent the global attitude parameter, and three-dimensional generalized Rodrigues parameters are introduced to define the local attitude error. A multiplicative quaternion error is derived from the local attitude error to maintain quaternion normalization constraint in the filter. Simulation results indicate that the proposed novel algorithm could exhibit higher accuracy and faster convergence compared with the multiplicative extended Kalman filter, the unscented quaternion estimator, and the adaptive robust unscented Kalman filter.     

仅用星敏感器的卫星姿态估计UKF算法研究

针对无陀螺或陀螺失效等情况下的卫星姿态确定问题,应用基于Unscented变换的Unscented滤波理论,提出了仅利用星敏感器矢量观测信息来确定无陀螺卫星姿态的Unscented卡尔曼滤波算法,并进行了数学仿真,仿真结果表明了所提出的UKF算法在无陀螺情况下对卫星姿态估计的有效性和可靠性。     

An improved quaternion Gauss–Newton algorithm for attitude determination using magnetometer and accelerometer

For the vector attitude determination, the traditional optimal algorithms which are based on quaternion estimator(QUEST) measurement noise model are complicated for just two observations. In our application, the magnetometer and accelerometer are not two comparable kinds of sensors and both are not small field-of-view sensors as well. So in this paper a new unit measurement model is derived. According to the Wahba problem, the optimal weights for each measurement are obtained by the error variance researches. Then an improved quaternion Gauss–Newton method is presented and adopted to acquire attitude. Eventually, simulation results and experimental validation employed to test the proposed method demonstrate the usefulness of the improved algorithm.     

基于Rodrigues参数的姿态估计算法

 以Rodrigues参数作为姿态描述参数提出一种快速的全姿态估计算法。Rodrigues参数具有简洁高效的特点,但它具有奇异性,不适用于大角度情况。首先将序贯旋转方法和Rodrigues参数相结合,提出了一种简洁、无奇异的姿态描述方法。然后应用该姿态描述方法,针对“矢量观测+陀螺”这种典型的姿态测量方案,讨论飞行器的姿态估计问题。在姿态估计算法设计中,给出了陀螺模型和观测矢量模型,推导了状态和状态误差协方差阵的预测方程和量测更新方程,并提出了预测方程的一种高效积分方法。仿真结果表明在估计精度等同的条件下,该姿态估计算法比四元数算法效率大约提高10%。     

Low-frequency Periodic Error Identification and Compensation for Star Tracker Attitude Measurement

The low-frequency periodic error of star tracker is one of the most critical problems for high-accuracy satellite attitude determination.In this paper an approach is proposed to identify and compensate the low-frequency periodic error for star tracker in attitude measurement.The analytical expression between the estimated gyro drift and the low-frequency periodic error of star tracker is derived firstly.And then the low-frequency periodic error,which can be expressed by Fourier series,is identified by the frequency spectrum of the estimated gyro drift according to the solution of the first step.Furthermore,the compensated model of the low-frequency periodic error is established based on the identified parameters to improve the attitude determination accuracy.Finally,promising simulated experimental results demonstrate the validity and effectiveness of the proposed method.The periodic error for attitude determination is eliminated basically and the estimation precision is improved greatly.     

一种星敏感器-陀螺组合定姿的实时在轨标定方法

研究了一种星敏感器一陀螺组合定姿方式中的姿态敏感器误差的实时在轨标定方法。首先,选择直观的欧拉角作为姿态描述参数,根据星敏感器和陀螺的测量原理建立星敏感器一陀螺在轨标定的测量方程和状态方程,并以此建立数学模型。其次,采用简单高效的EKF（ExtendedKalmanFilter,扩展卡尔曼滤波）作为估值算法,进行了在轨标定数值仿真。对于航天器姿态定向中出现的姿态角和星敏感器安装角之间的耦合问题,通过在特定姿态通道上施加简单姿态机动实现了解耦。数值结果表明,该实时在轨标定方法,尤其是所提出的姿态角和星敏感器安装角解耦策略,可以实现对航天器姿态的实时精确估计以及对星敏感器安装误差、陀螺常值漂移和相关漂移等误差的实时在轨标定。该方法可用于航天器姿态测量设备的实时在轨标定和航天器姿态的高精度实时确定。     

纬度未知条件下罗经系统行进中启动方法研究

介绍了一种适用于罗经系统在无法获得纬度情况下的航行中启动方法。基于惯性坐标系下的两个不同时间段内的重力加速度积分值实现纬度估计,根据估计的纬度值,完成初始对准。在动基座条件下,通过引入辅助速度信息补偿掉由于载体机动产生的误差,从而实现行进中启动。启动后采用组合导航或纯惯性导航的方式,可以实现方位的保持。通过分析发现,纬度估计精度主要受等效北向陀螺漂移的影响,方位对准精度主要受等效东向陀螺漂移的影响;试验结果表明,在300s时间内,方位角对准精度可以达到0.1°(RMS)。     

基于无味卡尔曼滤波的飞机防滑刹车模糊神经网络控制

根据对飞机刹车过程动力学分析与建模,本文提出了一种基于无味卡尔曼滤波(UKF)的模糊神经网络控制律。本控制律结合了无味卡尔曼滤波对机体速度的良好估计效果和模糊神经网络控制器对不同系统参数的适应能力,能够很好完成对最佳滑移率的追踪任务。Matlab仿真试验结果显示,基于无味卡尔曼滤波的模糊神经网络控制器可以准确的估计飞机滑跑时的速度,改善飞机防滑刹车系统性能,提高刹车效率。     

一个用于目标跟踪的改进粒子滤波算法

简化UT（unscented transformation）转化参数，修改UKF（unscented Kalmanfilter）提议分布，提出了改进的粒子滤波算法。调节因子的增加使得能在线自适应估计，滤波性能提高，并形成一个自适应的算法。仅有角测量的目标跟踪仿真试验证实了改进的粒子滤波算法要优于其它滤波方式。     

Comparison of strapdown inertial navigation algorithm based on rotation vector and dual quaternion

 For the navigation algorithm of the strapdown inertial navigation system, by comparing to the equations of the dual quaternion and quaternion, the superiority of the attitude algorithm based on dual quaternion over the ones based on rotation vector in accuracy is analyzed in the case of the rotation of navigation frame. By comparing the update algorithm of the gravitational velocity in dual quaternion solution with the compensation algorithm of the harmful acceleration in traditional velocity solution, the accuracy advantage of the gravitational velocity based on dual quaternion is addressed. In view of the idea of the attitude and velocity algorithm based on dual quaternion, an improved navigation algorithm is proposed, which is as much as the rotation vector algorithm in computational complexity. According to this method, the attitude quaternion does not require compensating as the navigation frame rotates. In order to verify the correctness of the theoretical analysis, simulations are carried out utilizing the software, and the simulation results show that the accuracy of the improved algorithm is approximately equal to the dual quaternion algorithm.     

改进的格网惯导系统无阻尼综合校正方法

综合校正技术可作为抑制格网惯导系统（INS）导航误差的有效手段。加速度计零偏所造成的水平姿态误差是导致综合校正中陀螺漂移估计精度受限的重要因素。针对这一问题，提出了一种改进的无阻尼综合校正方法。首先，推导了格网坐标系框架下估计加速度计零偏和姿态的目标函数；其次，介绍了无阻尼条件下综合校正的两个核心方程；最后设计了无阻尼两点校策略。综合校正前，在多普勒计程仪（DVL）提供的速度辅助下完成加速度计零偏的估计和补偿，以此消除加速度计零偏所造成的水平姿态误差对综合校正中陀螺漂移估计精度的影响。在两次间断的外部位置和航向辅助下通过所设计的综合校正策略完成对陀螺漂移的估计。校正策略中所涉及的水平姿态误差在DVL辅助下由参数估计方法估计得到。仿真及实验结果表明：与现有的研究相比，所设计的综合校正方案进一步减少了DVL的辅助时间，同时由于准确地估计和补偿了加速度计零偏，陀螺漂移的估计精度显著提高，该方案在抑制导航误差方面具备更明显的优势。     

Wavelet de-noising for IMU alignment

Inertial navigation system (INS) is presently used in several applications related to aerospace systems and land vehicle navigation. An INS determines the position, velocity, and attitude of a moving platform by processing the accelerations and angular velocity measurements of an inertial measurement unit (IMU). Accurate estimation of the initial attitude angles of an IMU is essential to ensure precise determination of the position and attitude of the moving platform. These initial attitude angles are usually estimated using alignment techniques. Due to the relatively low signal-to-noise ratio of the sensor measurement (especially for the gyroscopes), the initial attitude angles may not be computed accurately enough. In addition, the estimated initial attitude angles may have relatively large uncertainties that may affect the accuracy of other navigation parameters. This article suggests processing the gyro and accelerometer measurements with multiple levels of wavelet decomposition to remove the high frequency noise components. The proposed wavelet de-noising method was applied on a navigational grade inertial measurement unit (LTN90-100). The results showed that accurate alignment procedure and fast convergence of the estimation algorithm, in addition to reducing the estimation covariance of the three attitude angles, could be obtained.     

基于卫星和星敏感器的冗余激光惯组在轨标定

采用高精度卫星导航速度、位置信息以及星敏感器提供的姿态信息设计十表冗余捷联惯组的标定模型,包含陀螺和加速度计的零次项和标度因数,对卫星和星敏感器辅助的冗余激光陀螺捷联惯组进行实时在轨标定.利用标准Kalman滤波和Sage-Husa自适应滤波作为估计算法,对十表冗余捷联惯组参数进行在线估计.数值仿真结果表明:参数标定精度均在7％以内,是一种实时的在轨标定方法,满足误差补偿要求.冗余惯组在轨标定方法为航天器高精度定姿和定轨提供了一种理论参考.     

基于EKF的小型涵道式无人机航姿系统算法研究

针对小型涵道式无人机,设计了一种基于扩展Kalman滤波的航姿估计算法。采用四元数作为状态变量,利用陀螺仪的输出构成状态方程,通过加速度计与磁阻传感器构造观测方程来进行扩展Kalman滤波解算。相对于通常的航姿估计算法,这种算法减少了运算量,更适合于基于嵌入式微处理器的航姿估计。实验结果表明这种算法有效的抑制了航姿系统的各种噪声与干扰,同时保证了姿态输出的精度与实时性,可以为小型无人机提供准确的航姿信息。     

基于UKF的GPS/SINS组合导航直接式滤波算法

基于无迹卡尔曼滤波(UKF)方法,使用姿态、速度、位置等9个导航参数组成状态向量,以GPS系统输出的速度、位置组成6维观测向量,构建直接式结构的UKF滤波器。该滤波器能够直接反映系统导航参数的动态过程,准确显示运动状态演变。针对GPS/SINS组合导航系统的特点,构建了GPS/SINS组合导航直接式卡尔曼滤波仿真验证系统,仿真结果验证了基于UKF的GPS/SINS组合导航直接式滤波算法的有效性,该直接式非线性滤波算法可使惯性组合导航系统的导航精度得到提高。