Please wait a minute...
J4  2014, Vol. 48 Issue (3): 541-547    DOI: 10.3785/j.issn.1008-973X.2014.03.024
航空、航天     
三轴磁强计与MEMS陀螺的在轨实时标定方法
向甜1,王昊2,蒙涛2,金仲和2
1. 浙江大学 信息与电子工程学系,浙江 杭州 310027;2. 浙江大学 航空航天学院,浙江 杭州 310027
Real-time on-orbit calibration method for three-axis magnetometer and MEMS gyroscope
XIANG Tian1, WANG Hao2, MENG Tao2, JIN Zhong-he2
1. Department of Information and Electronics Engineering, Zhejiang University, Hangzhou 310027, China;
2.School of Aeronautics and Astronautics, Zhejiang University, Hangzhou 310027, China
 全文: PDF(1450 KB)   HTML
摘要:

为了提高基于磁强计和微电子机械(MEMS)陀螺的微小卫星定姿系统的精度,提出在无姿态信息时仅依靠三轴磁强计以及MEMS陀螺的测量信息来实时标定磁强计以及MEMS陀螺的算法.该策略采用无迹卡尔曼滤波(UKF)算法,将磁强计的偏置、刻度因子与非正交误差矩阵以及MEMS陀螺漂移作为状态向量,通过建立基于三轴磁强计及其惯性坐标系磁场矢量的观测方程,以及相应的微分测量方程,实现三轴磁强计与MEMS陀螺的在轨标定.仿真结果表明:通过标定后,磁强计的三轴偏置估计误差均优于0.02 mG,刻度因子与非正交误差矩阵的六要素估计误差均优于1×10-4,而MEMS陀螺三轴漂移估计误差分别为1.5°/h、0.45°/h和0.94°/h,从而验证了本策略的可行性.

Abstract:

In order to improve the accuracy of the attitude determination system (ADS) for micro-satellites based on  three-axis magnetometer (TAM) and micro electro mechanical systems (MEMS) gyroscopes, a real-time calibration algorithm for the magnetometer and MEMS gyro was introduced by using only the TAM and MEMS gyro measurements. The unscented Kalman filter (UKF) was applied as the estimation algorithm, in which the TAM bias, the matrix of its scale factors and non-orthogonality corrections, and the gyro drift were used as the state vectors. Then the TAM and geomagnetic vectors in its inertial coordinate based observation model, together with their corresponding derivative measurement model, were  established to realize the on-orbit calibration. The simulation  indicated that the estimation errors of the TAM bias were smaller than 0.02 mG after calibration, while those of the six elements in the matrix of the scale factors and non-orthogonality corrections were all smaller than 1×10-4, and the estimation errors of the gyro bias were 1.5°/h, 0.45°/h and 0.94°/h respectively for each axis, which verified the feasibility of the proposed strategy.

出版日期: 2018-06-10
:  V 448.22  
基金资助:

 国家自然科学基金资助项目(60904090).

通讯作者: 王昊,男,副教授.     E-mail: roger@zju.edu.cn
作者简介: 向甜(1986-),女,博士生,从事微小卫星姿态测量与控制系统设计的研究.E-mail:txiang@zju.edu.cn
服务  
把本文推荐给朋友
加入引用管理器
E-mail Alert
RSS
作者相关文章  

引用本文:

向甜,王昊,蒙涛,金仲和. 三轴磁强计与MEMS陀螺的在轨实时标定方法[J]. J4, 2014, 48(3): 541-547.

XIANG Tian, WANG Hao, MENG Tao, JIN Zhong-he. Real-time on-orbit calibration method for three-axis magnetometer and MEMS gyroscope. J4, 2014, 48(3): 541-547.

链接本文:

http://www.zjujournals.com/eng/CN/10.3785/j.issn.1008-973X.2014.03.024        http://www.zjujournals.com/eng/CN/Y2014/V48/I3/541

[1] 段方,刘建业,李荣冰. 小卫星多传感器融合滤波定姿算法[J]. 宇航学报,2006,27(2): 297-300.
DUAN Fang, LIU Jian-ye, LI Rong-bing. A multi-sensors fusion filtering algorithm for small satellite attitude determination [J]. Journal of Astronautics, 2006, 27(2): 297-300.
[2] CRASSIDIS J L, LAI Kok-Lam, HARMAN R R. Real-time attitude-independent three-axis magnetometer calibration [J]. Journal of Guidance, Control and Dynamics, 2005, 28(1):115-120.
[3] 段方,刘建业,李丹.微小卫星太阳敏感器/磁强计实时标定算法研究[J]. 航空学报,2007,28(1):173-176.
DUAN Fang, LIU Jian-ye, LI Dan. Real-time Sun-sensor/Magnetometer calibration algorithm for micro-satellite[J]. Acta Aeronautica ET Astronautica Sinica,2007,28(1):173-176.
[4] 黄琳, 荆武兴. 卫星姿态确定与三轴磁强计校正[J]. 宇航学报, 2008,29(3):854-859.
HUANG Lin, JING Wu-xing. Spacecraft attitude determination and three-axis magnetometer calibration[J]. Journal of Astronautics, 2008,29(3):854-859.
[5] 段方,刘建业,李荣冰. 基于平淡卡尔曼滤波器的微小卫星姿态确定算法[J]. 上海交通大学学报, 2005, 39(11): 1899-1903.
DUAN Fang, LIU Jian-ye, LI Rong-bing. A micro-satellite attitude determination algorithm based on unscented kalman filter [J]. Journal of Shanghai Jiaotong University, 2005, 39(11): 1899-1903.
[6] ZHAO Lin, HUANG Chen, WANG Xin-zhe, et al. Study on satellite attitude determination based on hybrid extended kalman[C]∥Proceedings of the 8th World Congress on Intelligent Control and Automation. Jinan,China:[s.n.], 2010:1110-1114.
[7] LAI Kok-Lam, CRASSIDIS J L, HARMAN R R. Real-time attitude-independent gyro calibration from three-axis magnetometer measurements[C]∥ AIAA/AAS Astrodyna-mics Specialist Conference and Exhibit.Providence. Rhode Island:[s.n.], 2004:1-11.
[8] 秦伟,苑伟政,常洪龙,等.基于自适应UKF 算法的MEMS 陀螺空中在线标定技术[J].中国惯性技术学报,2011,19(2): 170-174.
QIN Wei, YUAN Wei-zheng, CHANG Hong-long, et al. In-flight on-line calibration method for MEMS gyroscope based on adaptive unscented Kalman filter algorithm[J]. Journal of Chinese Inertial Technology, 2011, 19(2):170-174.
[9] CRASSIDIS JL. Sigma-Point Kalman Filtering for integrated GPS and inertial navigation[C]∥AIAA Guidance, Navigation, and Control Conference and Exhibit.San Francisco, California :AIAA,2005:750-756.
[10] SIMON J, JEFFREY U, HUGH F D W. A new method for the nonlinear transformation of means and covariances in filters and estimators[J]. IEEE Transaction on Automatic Control, 2000, 45(3):477-482.
[11] CRASSIDIS J L, MARKLEY F L. Unscented filtering for spacecraft attitude estimation [J]. Journal of Guidance, Control and Dynamics, 2003, 26(4):536-542.
[12] 张锐,朱振才,张静,等. 基于磁强计的微小卫星姿态确定 [J]. 宇航学报,2006, 27(4): 578-581.
ZHANG Rui, ZHU Zhen-cai, ZHANG Jing, et al. Micro-satellite attitude determination based on magnetometer [J]. Journal of Astronautics, 2006, 27(4): 578-581.

[1] 向甜,王昊,蒙涛,韩柯,金仲和. 基于纯磁控的皮卫星姿态恢复[J]. J4, 2013, 47(5): 843-852.
[2] 韩柯, 王昊, 朱小丰, 向甜, 金仲和. 皮卫星偏置动量轮在轨备份切换策略[J]. J4, 2011, 45(10): 1771-1776.