Please wait a minute...
J4  2014, Vol. 48 Issue (3): 541-547    DOI: 10.3785/j.issn.1008-973X.2014.03.024
    
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
Download:   PDF(1450KB) HTML
Export: BibTeX | EndNote (RIS)      

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.



Published: 10 June 2018
CLC:  V 448.22  
Cite this article:

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.

URL:

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


三轴磁强计与MEMS陀螺的在轨实时标定方法

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

[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] XIANG Tian, WANG Hao, MENG Tao, HAN Ke, JIN Zhong-he. Attitude recovery of pico-satellites based on fully magnetic coils control algorithm[J]. J4, 2013, 47(5): 843-852.
[2] HAN Ke, WANG Hao, ZHU Xiao-feng, XIANG Tian, JIN Zhong-he. In-orbit backup and switch method for pico-satellite’s
bias momentum wheel
[J]. J4, 2011, 45(10): 1771-1776.