Please wait a minute...
浙江大学学报(工学版)
JOURNAL OF ZHEJIANG UNIVERSITY (ENGINEERING SCIENCE)
    
Attitude compensation algorithm based on error feedback of geomagnetic vector
ZHAO Wen-jie1, FANG Zhou2, LI Ping1,2
1.Department of Control Science and Engineering, Zhejiang University, Hangzhou 310027, China; 2.School of Aeronautics and Astronautics, Zhejiang University, Hangzhou 310027, China
Download:   PDF(750KB) HTML
Export: BibTeX | EndNote (RIS)      

Abstract  

A new closed-loop attitude compensation algorithm for mini aerial robots was proposed to solve the attitude estimation problem during global positioning system (GPS) outages. When GPS is available, the classical integrated navigation system is used to estimate attitude and geomagnetic vector. Once the integrated system cannot work effectively, the concept of feedback control is introduced in the attitude estimation process. The latent attitude information existed in the geomagnetic measurement and its estimation is made the best use, and the feedback of geomagnetic vector deviation is used to correct the angular rate measurement, so that the divergency of inertial navigation system (INS) errors can be limited. The new algorithm was tested on a mini aerial robot, and compared with a reference system. Experimental results show that in contrast to the INS/GPS integrated navigation system that works in open-loop mode, the new closed-loop attitude compensation algorithm achieves smaller errors for attitude estimate and effectively restrains the accumulation of INS attitude errors during GPS outages.

Published: 01 September 2014
CLC:  V 249.328  
Service
E-mail this article
Add to my bookshelf
Add to citation manager
E-mail Alert
RSS
Articles by authors
Cite this article:

ZHAO Wen-jie, FANG Zhou, LI Ping. Attitude compensation algorithm based on error feedback of geomagnetic vector. JOURNAL OF ZHEJIANG UNIVERSITY (ENGINEERING SCIENCE), 2014, 48(9): 1704-1709.

URL:

http://www.zjujournals.com/eng/10.3785/j.issn.1008-973X.2014.09.023     OR     http://www.zjujournals.com/eng/Y2014/V48/I9/1704


基于地磁场矢量误差反馈的姿态补偿算法

针对小型空中机器人在全球定位系统（GPS）失锁情况下的姿态估计问题,提出一种新的闭环姿态补偿算法.有GPS辅助的情况下,采用组合导航算法对姿态角和地磁场矢量做出估计；当组合系统无法有效工作时,将反馈控制的思想引入姿态估计过程,充分利用地磁场测量值与估计值之间隐含的姿态信息,通过地磁场矢量误差反馈对姿态角速率测量值进行修正,进而抑制惯性导航系统误差的发散.在小型空中机器人上对算法进行实物验证,并与参考系统对比.结果显示:在GPS失锁的情况下,与开环工作模式下的INS/GPS组合导航系统相比,新的闭环姿态补偿算法的姿态估计误差更小,使惯性导航系统的姿态误差积累得到了有效的抑制．

［1］GEORGY J, KARAMAT T, IQBAL U, NOURELDIN A. Enhanced MEMS-IMU/odometer/GPS integration using mixture particle filter ［J］. GPS Solutions, 2011, 15(3): 239-252．
［2］YU M J. INS/GPS integration system using adaptive filter for estimating measurement noise variance ［J］. IEEE Transactions on Aerospace and Electronic Systems, 2012, 48(2): 1786-1792.
［3］CHIANG K W, DUONG T T, LIAO J K, et al. On-line smoothing for an integrated navigation system with low-cost MEMS inertial sensors ［J］. Sensors, 2012, 12(12): 17372-7389．
［4］CHIANG K W, NOURELDIN A, EL-SHEIMY N. Developing a low cost MEMS IMU/GPS integration scheme using constructive neural networks ［J］. IEEE Transactions on Aerospace and Electronic Systems, 2008, 44(2): 582-594．
［5］PANG Chen-peng, LID Zao-zhen. Bridging GPS outages of tightly coupled GPS/SINS based on the adaptive track fusion using RBF neural network ［C］∥ IEEE International Symposium on Industrial Electronics. Seoul, Korea:IEEE,2009: 971-976．
［6］ HASAN A M, SAMSUDIN K, RAMLI A R. Optimizing of ANFIS for estimating INS error during GPS outages ［J］. Journal of the Chinese Institute of Engineers, 2011, 34(7): 967-982．
［7］ LEE J K, GREJNER-BRZEZINSKA D A, TOTH C. Network-based collaborative navigation in GPS-denied environment ［J］. Journal of Navigation, 2012, 65(3): 445-457．
［8］WEISS S, SCARAMUZZA D, SIEGWART R. Monocular-SLAM-based navigation for autonomous micro helicopters in GPS-denied environments ［J］. Journal of Field Robotics, 2011, 28(6): 854-874．
［9］CHOWDHARY G, JOHNSON E N, MAGREE D, et al. GPS-denied indoor and outdoor monocular vision aided navigation and control of unmanned aircraft ［J］. Journal of Field Robotics, 2013, 30(3): 415-438．
［10］EL-DIASTY M, PAGIATAKIS S. A frequency-domain INS/GPS dynamic response method for bridging GPS outages ［J］. Journal of Navigation, 2010, 63(4): 627-643．
［11］秦永元.惯性导航［M］. 北京:科学出版社, 2006:287-360．
［12］ TITTERTON D H, WESTON J L. Strapdown inertial navigation technology ［M］. 2nd ed. The IEE, 2004:335-416．
［13］付梦印,邓志红,张继伟.Kalman滤波理论及其在导航系统中的应用［M］.北京:科学出版社,2003:385.
［14］徐玉.微小型无人直升机飞控平台与姿态融合算法研究［D］.杭州：浙江大学,2008:83-87．
XU Yu. Study of flight control platform and attitude fusion algorithms for mini autonomous helicopter ［D］. Hangzhou:Zhejiang University, 2008:83-87．
［15］ HAMEL T, MAHONY R. Attitude estimation on SO ［3］ based on direct inertial measurements［C］∥Proceedings 2006 IEEE International Conference on Robotics and Automation(ICRA).［S.l.］:IEEE, 2006: 2170-2175．
[1] ZHAO Wen-jie, FANG Zhou, LI Ping. Attitude compensation algorithm based on error feedback of geomagnetic vector[J]. JOURNAL OF ZHEJIANG UNIVERSITY (ENGINEERING SCIENCE), 2014, 48(4): 0-00.