|
|
论文: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-),西北工业大学硕士研究生,主要从事水下航行器导航与控制研究。
|
|
相关功能 |
|
|
|
作者相关文章 |
|
王录 在本刊中的所有文章 |
刘明雍 在本刊中的所有文章 |
王梦凡 在本刊中的所有文章 |
郭娇娇 在本刊中的所有文章 |
雷罡 在本刊中的所有文章 |
张小件 在本刊中的所有文章 |
|
|
|
|
|
|
|
|
参考文献: |
|
|
[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) |
|
|
|
|
|
|
|