论文:2019,Vol:37,Issue(2):225-231
引用本文:
王录, 刘明雍, 王梦凡, 郭娇娇, 雷罡, 张小件. 基于地磁场自适应修正的航姿系统姿态解算研究[J]. 西北工业大学学报
WANG Lu, LIU Mingyong, WANG Mengfan, GUO Jiaojiao, LEI Gang, ZHANG Xiaojian. Attitude Calculation of AHRS Based on Geomagnetic Field Adaptive Correction[J]. Northwestern polytechnical university

基于地磁场自适应修正的航姿系统姿态解算研究
王录, 刘明雍, 王梦凡, 郭娇娇, 雷罡, 张小件
西北工业大学 航海学院, 陕西 西安 710072
摘要:
针对航姿参考系统(attitude and heading reference system,AHRS)中,MEMS陀螺仪输出噪声过大、零点漂移无法完全消除、角速率输出易受干扰等导致的姿态四元数精度低、累积误差较大等问题,提出了一种自适应扩展卡尔曼滤波算法,利用地球物理场(地球重力场、地磁场)信息不断自适应修正MEMS陀螺仪在姿态解算过程中的累积误差。在ROS机器人平台上进行了实验,实验结果表明该算法能有效解决在求解姿态四元数过程中累积误差较大的问题,同时可以提高姿态解算精度,进而验证了该算法的有效性。
关键词:    AHRS    地磁场    地球重力场    自适应扩展卡尔曼滤波算法    数据融合   
Attitude Calculation of AHRS Based on Geomagnetic Field Adaptive Correction
WANG Lu, LIU Mingyong, WANG Mengfan, GUO Jiaojiao, LEI Gang, ZHANG Xiaojian
School of Marine Science and Technology, Northwestern Polytechnical University, Xi'an 710072, China
Abstract:
In the attitude and heading reference system (AHRS), the output noise of MEMS gyroscope is too large, zero drift can not be eliminated completely, and the output of angular rate is easy to be interfered, which leads to low accuracy and large accumulated error of attitude quaternion and so on. In this paper, an adaptive extended Kalman filter algorithm is proposed based on the information of geophysical field (earth gravity field and geomagnetic field) to continuously and adaptively correct the accumulated error of MEMS gyroscope in attitude calculation. The experimental results via ROS robot platform show that the proposed algorithm can effectively solve the problem of large accumulated error in the process of attitude quaternion solution, and improve the accuracy of attitude calculation, thus the effectiveness of the proposed algorithm is verified.
Key words:    AHRS    geomagnetic field    earth gravity field    adaptive extended kalman filtering algorithm    data fusion   
收稿日期: 2018-03-05     修回日期:
DOI: 10.1051/jnwpu/20193720225
基金项目: 水下信息与控制重点实验室开放研究项目(6142218051806)与国家自然科学基金(51679201)资助
通讯作者:     Email:
作者简介: 王录(1991-),西北工业大学硕士研究生,主要从事水下航行器导航与控制研究。
相关功能
PDF(1831KB) Free
打印本文
把本文推荐给朋友
作者相关文章
王录  在本刊中的所有文章
刘明雍  在本刊中的所有文章
王梦凡  在本刊中的所有文章
郭娇娇  在本刊中的所有文章
雷罡  在本刊中的所有文章
张小件  在本刊中的所有文章

参考文献:
[1] ZHU R, SUN D, ZHOU Z, et al. A Linear Fusion Algorithm for Attitude Determination Using Low Cost Mems-Based Sensors[J]. Measurement, 2007, 40(3):322-328
[2] SASIADEK J Z, HARTANA P. Sensor Data Fusion Using Kalman Filter[C]//International Conference on Information Fusion, 2000:WED5/19-WED5/25
[3] VALENTI R G, DRYANOVSKI I, XIAO J. Keeping a Good Attitude:a Quaternion-Based Orientation Filter for IMUs and MARGs[J]. Sensors, 2015, 15(8):19302-19330
[4] CHOUKROUN D, BAR-ITZHACK I Y, OSHMAN Y. Novel Quaternion Kalman Filter[J]. IEEE Transactions on Aerospace & Electronic Systems, 2006, 42(1):174-190
[5] CHOUKROUN D, BARITZHACK I Y, OSHMAN Y. A Novel Quaternion Kalman Filter[C]//AIAA Guidance, Navigation, and Control Conference and Exhibit, 2002
[6] SABATINI A M. Quaternion-Based Extended Kalman Filter for Determining Orientation by Inertial and Magnetic Sensing[J]. IEEE Transactions on Biomedical Engineering, 2006, 53(7):1346-56
[7] MARINS J L, YUN X, BACHMANN E R, et al. An Extended Kalman Filter for Quaternion-Based Orientation Estimation Using Marg Sensors[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems, 2001
[8] 盛汉霖, 张天宏, 刘冬冬. 基于扩展卡尔曼滤波器的低成本航姿系统设计[J]. 系统工程与电子技术, 2013, 35(10):2158-2164 SHENG Hanlin, ZHANG Tianhong, LIU Dongdong. Low-Cost AHRS Oesign Based on Extending Katmah Filter[J]. Systems Engineering and Electronics, 2013, 35(10):2158-2164(in Chinese)
[9] MAKNI A, FOURATI H, KIBANGOU A Y. Adaptive Kalman Filter for MEMS-IMU Based Attitude Estimation under External Acceleration and Parsimonious USE of Gyroscopes[C]//Proceedings of the European Control Conferencelecc, Strasbowy France, 2014:1379-1384
[10] EUSTON M, COOTE P, MAHONY R, et al. A Complementary Filter for Attitude Estimation of a Fixed-Wing UAV[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems, 2008
[11] 秦永元. 惯性导航.[M]2版. 北京:科学出版社, 2014 QIN Yongyuan. Inertial Navigtion[M]2nd Edition. Beijing, Science Press, 2014(in Chinese)
[12] 秦永元, 张洪钺, 汪叔华. 卡尔曼滤波与组合导航原理[M]. 西安:西北工业大学出版社, 2012 QIN Yongyuan, ZHANG Hongyue, WANG Shuhua. Kalman Filter and the Theory of Instegrated Navigation[M]. Xi'an, Northwestern Polythwestern University Press, 2012(in Chinese)