国防科技大学学报2013,Vol.35Issue(1):1-6,6.
基于磁强计和光纤陀螺的小卫星姿态确定非线性滤波算法
Nonlinear filter algorithm for micro satellite attitude determination via magnetometer and fiber optic gyroscope
摘要
Abstract
A new nonlinear filter algorithm for micro satellite attitude determination was proposed, which adopted three-axis magnetometer (TAM) and fiber optic gyroscope ( FOG) as attitude sensors. In the design of the nonlinear filter, square-root sigma point Kalman filter was modified. Firstly, an augmented state vector was derived by combining the vector part of attitude quaternion, the bias and noises of FOG. Secondly, vector rotational model, optimization model and error quaternion multiplication model were established to guarantee the quaternion normalization constraint in the process of nonlinear filter. The simulation results indicate that attitude determination performance is improved effectively by the presented algorithm. In comparison with EKF, the accuracy and stability of the proposed algorithm is much better, and the convergent speed is faster. In comparison with UKF, the convergence is equivalent, the accuracy is slight better, while the stability and computing efficiency are both higher.关键词
非线性滤波/增广状态向量/向量旋转/最优化/误差四元数/姿态确定/小卫星Key words
nonlinear filter/ augmented state vector/ vector rotation/ optimization/ error quaternion/ attitude determination/ micre satellite分类
航空航天引用本文复制引用
吴锦杰,刘昆,石实,张斌斌..基于磁强计和光纤陀螺的小卫星姿态确定非线性滤波算法[J].国防科技大学学报,2013,35(1):1-6,6.基金项目
国家863计划资助项目 ()