Attitude Determination Algorithm for Micro-satellite Based on High-order UKF Using Information Fusion
-
摘要: 为提高微小卫星微型低成本姿态敏感器的姿态确定精度,基于磁强计/太阳敏感器/陀螺仪的姿态敏感器配置以及无迹卡尔曼滤波方法(Unscented Kalman Filter,UKF),设计了一种基于高阶UKF算法并且融合磁强计与太阳敏感器观测信息的微小卫星姿态确定算法.为提高系统状态方程非线性函数的一步预测精度,采用基于五阶UT变换的高阶UKF算法,增加了Sigma采样点数量,提高了系统状态预测精度.单一观测向量滤波算法不能同时满足多个不同量纲观测数据,本文提出一种同时利用两个观测向量的信息融合式滤波算法,根据磁强计和太阳敏感器的观测信息,通过卡尔曼滤波原理中的增益计算,分别得出地磁矢量和太阳矢量对应的卡尔曼增益信息.采用高斯概率密度准则进行信息融合,进而完成预测值的修正,得到同时满足磁强计以及太阳敏感器观测需求的四元数估计值,降低了观测误差的影响.仿真分析验证了算法的优越性.Abstract: To improve the attitude determination accuracy of miniature low-cost attitude sensors, a micro-satellite attitude determination algorithm that combines magnetometer and solar sensor observations was designed, based on high-order Unscented Kalman Filter (UKF) and the attitude sensor configuration of magnetometer/solar sensor/gyroscope. Firstly, in order to improve the one-step prediction accuracy of the nonlinear system state equation, the high-order UKF algorithm with fifth-order UT transformation was used to increase the number of Sigma sampling points and improve the system state prediction accuracy. Secondly, owing to the shortcoming of the single observation vector filtering algorithm that couldn't coordinate multiple observation data with different dimension simultaneously, an information fusion filtering algorithm using two observation vectors was proposed, which was based on the observations of the magnetometer and the solar sensor. The Kalman gain was obtained by the information corresponding to the geomagnetic vector and the solar vector through the gain calculation of the UKF algorithm. Consequently, the Gaussian probability density criterion was used to fuse the Kalman gain information, and the fused information was used to correct the value of the one-step prediction. Therefore, this algorithm reduced the observation errors of the attitude quaternions. Finally, the simulation results proved the availability of the proposed method.
-
[1] ZHANG Chen. Research on Spacecraft Attitude Determination Method Based on Star Tracker[D]. Wuhan: Huazhong University of Science and Technology, 2005:10-11(张晨. 基于星跟踪器的航天器姿态确定方法研究[D]. 武汉: 华中科技大学, 2005:10-11) [2] XING Yanjun, WANG Yongfu, LU Yadong. Robust adaptive filter for small satellite attitude estimation[J]. Chin. Space Sci. Technol., 2015, 35(1):27-35(邢艳军, 王永富, 陆亚东. 微小卫星鲁棒自适应姿态确定算法[J]. 中国空间科学技术, 2015, 35(1):27-35) [3] WANG Xinguo, LI Aihua, XU Hualong. Application of SUKF in missile attitude estimation[J]. J. Syst. Eng. Electron., 2009, 31(1):170-173(王新国, 李爱华, 许化龙. SUKF在导弹姿态估计中的应用[J]. 系统工程与电子技术, 2009, 31(1):170-173) [4] WAHBA G. A least squares estimate of satellite attitude[J]. SIAM Rev., 1965, 7(3):409 [5] SHUSTER M D, OH S D. Three-axis attitude determination from vector observations[J]. J. Guid. Control Dyn., 1981, 4(1):70-77 [6] CHOUKROUN D, BARITZHACK I Y, OSHMAN Y. Optimal-request algorithm for attitude determination[J]. J. Guid. Control Dyn., 2004, 27(3):418-425 [7] MARKLEY F L. Attitude determination using vector observations and the singular value decomposition[J]. J. Astronaut. Sci., 1987, 38(3):245-258 [8] MARKLEY F L. Attitude determination using vector observations: a fast optimal matrix algorithm[J]. J. Astronaut. Sci., 1993, 41(2):261-280 [9] MORTARI, DANIELE. Euler-q algorithm for attitude determination from vector observations[J]. J. Guid. Control Dyn., 1998, 21(2):328-334 [10] XIE Xianghua. Study on Micro-Satellite Attitude Control System[D]. Nanjing: Nanjing University of Aeronautics and Astronautic, 2007(谢祥华. 微小卫星姿态控制系统研究[D]. 南京: 南京航空航天大学, 2007) [11] LI Peng, TANG Jian, DUAN Guangren, et al. Satellite attitude determination based on the adaptive federated Kalman Filter[J]. Chin. Space Sci. Technol., 2013, 33(2):67-71(李鹏, 唐健, 段广仁, 等. 基于自适应联邦滤波的卫星姿态确定[J]. 中国空间科学技术, 2013, 33(2):67-71) [12] DING Guoqiang. Modeling and Filtering of Nonlinear Systems[M]. Beijing: Beihang University Press, 2017(丁国强. 非线性系统建模与滤波方法[M]. 北京: 北京航空航天大学出版社, 2017) [13] ZHANG Yonggang, HUANG Yulong, WU Zhemin, et al. A high order unscented kalman filtering method[J]. J. Auto. Sin., 2014, 40(5):838-848(张勇刚, 黄玉龙, 武哲民, 等. 一种高阶无迹卡尔曼滤波方法[J]. 自动化学报, 2014, 40(5):838-848) [14] SHANNON C E. A mathematical theory of communication[J]. Bell. Syst. Tech. J., 1948, 27:379-423 [15] SHANNON C E, WEAVER W. The Mathematical Theory of Communication[M]. Urbana: The University of Illinois Press, 1949 [16] SVARTVEIT K. Attitude Determination of the NCUBE Satellite[D]. Trondheim: Norwegian University of Science and Technology, 2003 [17] KANG Guohua, FAN Kai, ZHOU Qiongfeng, et al. Attitude determination algorithm for micro-satellite based on Gauss-Newton and UKF[J]. Chin. Space Sci. Technol., 2018, 38(2):16-23(康国华, 范凯, 周琼峰, 等. 基于Gauss-Newton和UKF结合的微小卫星姿态确定算法[J]. 中国空间科学技术, 2018, 38(2):16-23) [18] WANG Guanghui, JIANG Sirong, CUI Guang, et al. Research on attitude control of Micro-Satellite based on only magnetic control[J]. Comput. Simulat., 2018, 35(02):33-38(王光辉, 江思荣, 崔光, 等. 纯磁控微小卫星姿态控制方法研究[J]. 计算机仿真, 2018, 35(02):33-38) -
-
计量
- 文章访问数: 882
- HTML全文浏览量: 131
- PDF下载量: 49
-
被引次数:
0(来源:Crossref)
0(来源:其他)