Nine-axis inertial fusion method based on dynamic magnetic field calibration

Hao-yuan CAI; Sheng-lin ZHAO; Song-ye CUI; Wen-kuan LI; Chun-xiu LIU

doi:10.37188/OPE.20202809.2007

您当前的位置：

首页 >

文章列表页 >

Nine-axis inertial fusion method based on dynamic magnetic field calibration

Micro/Nano Technology and Fine Mechanics | 更新时间：2020-09-28

- Nine-axis inertial fusion method based on dynamic magnetic field calibration
- Optics and Precision Engineering Vol. 28, Issue 9, Pages: 2007-2016(2020)
- 作者机构：
  
  1.中国科学院空天信息创新研究院传感技术国家重点实验室, 北京 100190
  2.中国科学院大学, 北京 100049
  3.深圳前海维晟智能技术有限公司, 广东深圳 518101
- 作者简介：
- 基金信息：
- DOI：10.37188/OPE.20202809.2007
  CLC： U666.1
- Received：02 January 2020，
  
  Revised：09 February 2020，
  
  Accepted：09 February 2020，
  
  Published：25 September 2020
- 稿件说明：
移动端阅览
Hao-yuan CAI, Sheng-lin ZHAO, Song-ye CUI, et al. Nine-axis inertial fusion method based on dynamic magnetic field calibration[J]. Optics and precision engineering, 2020, 28(9): 2007-2016.
DOI：

Hao-yuan CAI, Sheng-lin ZHAO, Song-ye CUI, et al. Nine-axis inertial fusion method based on dynamic magnetic field calibration[J]. Optics and precision engineering, 2020, 28(9): 2007-2016. DOI： 10.37188/OPE.20202809.2007.

摘要

针对低成本MEMS惯性传感器航向角的累积漂移误差和传统磁场校准方法使用不便等问题，提出一种基于动态磁场校准的九轴惯性融合方法。首先，通过旋转矩阵建立陀螺仪与磁力计的关系，利用扩展卡尔曼滤波对陀螺仪数据和磁力计数据进行融合，实现对磁力计的动态实时校准；然后利用互补滤波思想，着重考虑了自由加速度和磁场环境突变的情况，定义了各自的信赖函数，对PI控制器做出了改进；最终获得高稳定性的惯性传感器的姿态角。在传感器采样率为100 Hz，运行时长约为11 min，旋转圈数为117圈时，航向角的漂移为0.42°，与商用的惯导模块算法相比减小了14.9°，实现了数量级的改进。实验结果表明，通过陀螺仪动态校准磁场能有效改善传统椭球拟合算法对校准数据要求高的缺点，提出方法基本可以做到实时，用户无需做特定的绕“8”字动作，即可完成磁场校准；对互补滤波算法进行了改进，基本消除自由加速度对姿态角解算的影响。提出方法在控制减小航向角漂移上有很大优势，同时满足校准便捷、适用场景多样等要求，在低成本MEMS惯导领域有广阔的应用前景。

Abstract

To address the issue of the accumulated heading angle drift of low-cost MEMS inertial sensors and the inconvenience of using traditional magnetic field calibration methods

a nine-axis inertial fusion algorithm based on dynamic magnetic field calibration was proposed. First

the relationship between the gyroscope and magnetometer was established by a rotation matrix

and the magnetometer was dynamically calibrated by the extended Kalman filter. Second

trust functions were defined considering the free acceleration and the sudden change in the magnetic field environment of the complementary filter

which improved the PI controller. Finally

the attitude angle of the inertial sensor with high stability was obtained. The experimental results show that

the dynamic calibration of the magnetic field by a gyroscope can effectively address the shortcomings of the traditional ellipsoid fitting algorithm

which requires high calibration data. This method can essentially be used in real time

and users can complete magnetic field calibration without a specific "8" winding action. The complementary filtering algorithm is improved to eliminate the influence of free acceleration on attitude angle calculation. When the sampling rate of the sensor is 100 Hz

the running time is approximately 11 min

the number of rotations is 117

and the drift of the heading angle is 0.42°

which is 14.9° less than that of the commercial IMU module

indicating an improvement on the order of a magnitude. This algorithm has considerable advantages in controlling and reducing the heading drift and meets the requirements of convenient calibration and various applicable scenarios. It has a broad application prospects in the field of low-cost MEMS inertial navigation.

关键词

Keywords

references

VALENTI R G, DRYANOVSKI I, XIAO J Z. Keeping a good attitude: a quaternion-based orientation filter for IMUs and MARGs[C]. Sensors , 2015, 15: 19302-19330.

刘公绪 , 史凌峰 . 室内导航与定位技术发展综述 . 导航定位学报 , 2018 . 6 ( 2 ): 7 - 14 . http://www.cnki.com.cn/Article/CJFDTotal-CHWZ201802002.htm http://www.cnki.com.cn/Article/CJFDTotal-CHWZ201802002.htm .

G X LIU , L F SHI . An overview about development of indoor navigation and positioning technology . Journal of Navigation and Positioning , 2018 . 6 ( 2 ): 7 - 14 . http://www.cnki.com.cn/Article/CJFDTotal-CHWZ201802002.htm http://www.cnki.com.cn/Article/CJFDTotal-CHWZ201802002.htm .

潘献飞 , 穆华 , 胡小平 . 单兵自主导航技术发展综述 . 导航定位与授时 , 2018 . 5 ( 1 ): 1 - 11 . http://www.cqvip.com/QK/71906X/20181/674490354.html http://www.cqvip.com/QK/71906X/20181/674490354.html .

X F PAN , H MU , X P HU . A survey of autonomous navigation technology for individual solder . Navigation Positioning and Timing , 2018 . 5 ( 1 ): 1 - 11 . http://www.cqvip.com/QK/71906X/20181/674490354.html http://www.cqvip.com/QK/71906X/20181/674490354.html .

裴凌 , 刘东辉 , 钱久超 . 室内定位技术与应用综述 . 导航定位与授时 , 2017 . 4 ( 3 ): 1 - 10 . http://d.wanfangdata.com.cn/Periodical/dhdwyss201703001 http://d.wanfangdata.com.cn/Periodical/dhdwyss201703001 .

L PEI , D H LIU , J CH QIAN . A survey of indoor positioning technology and application . Navigation Positioning and Timing , 2017 . 4 ( 3 ): 1 - 10 . http://d.wanfangdata.com.cn/Periodical/dhdwyss201703001 http://d.wanfangdata.com.cn/Periodical/dhdwyss201703001 .

王勇军 , 李智 , 李翔 . 采用组合滤波算法的无人机航向测量系统研究 . 测控技术与仪器仪表 , 2018 . 44 ( 2 ): 39 - 43 . http://www.zhangqiaokeyan.com/academic-journal-cn_application-electronic-technique_thesis/0201234904284.html http://www.zhangqiaokeyan.com/academic-journal-cn_application-electronic-technique_thesis/0201234904284.html .

Y J WANG , ZH LI , X LI . Research of heading measurement for UAV based on combined filter . Application of Electronic Technique , 2018 . 44 ( 2 ): 39 - 43 . http://www.zhangqiaokeyan.com/academic-journal-cn_application-electronic-technique_thesis/0201234904284.html http://www.zhangqiaokeyan.com/academic-journal-cn_application-electronic-technique_thesis/0201234904284.html .

Y X WU , D P ZOU , P L LIU , 等 . Dynamic magnetometer calibration and alignment to inertial sensors by kalman filtering . IEEE Transactions on Control Systems Technology , 2018 . 26 ( 2 ): 716 - 723 . http://ieeexplore.ieee.org/document/7866868/ http://ieeexplore.ieee.org/document/7866868/ .

朱建良 , 王兴全 , 吴盘龙 , 等 . 基于椭球曲面拟合的三维磁罗盘误差补偿算法 . 中国惯性技术学报 , 2012 . 20 ( 5 ): 562 - 566 . http://d.wanfangdata.com.cn/Periodical/zggxjsxb201205012 http://d.wanfangdata.com.cn/Periodical/zggxjsxb201205012 .

J L ZHU , X Q WANG , P L WU , 等 . Three-dimensional magnetic compass error compensation algorithm based on ellipsoid surface fitting . Journal of Chinese Inertial Technology , 2012 . 20 ( 5 ): 562 - 566 . http://d.wanfangdata.com.cn/Periodical/zggxjsxb201205012 http://d.wanfangdata.com.cn/Periodical/zggxjsxb201205012 .

杨宾峰 , 樊博宇 , 胥俊敏 , 等 . 基于最小二乘的地磁场测量误差补偿技术 . 空军工程大学学报(自然科学版) , 2017 . 18 ( 6 ): 34 - 39 . http://d.old.wanfangdata.com.cn/Periodical_kjgcdxxb201706006.aspx http://d.old.wanfangdata.com.cn/Periodical_kjgcdxxb201706006.aspx .

B F YANG , B Y FAN , J M XU , 等 . Research on error compensation in geomagnetic field measurement based on least squares . Journal of Air Force Engineering University (Natural Science Edition) , 2017 . 18 ( 6 ): 34 - 39 . http://d.old.wanfangdata.com.cn/Periodical_kjgcdxxb201706006.aspx http://d.old.wanfangdata.com.cn/Periodical_kjgcdxxb201706006.aspx .

秦赓 , 管雪元 , 李文胜 . 基于椭球补偿的三维载体磁场误差补偿方法 . 电子测量技术 , 2018 . 41 ( 2 ): 34 - 39 . http://www.cnki.com.cn/Article/CJFDTotal-DZCL201802009.htm http://www.cnki.com.cn/Article/CJFDTotal-DZCL201802009.htm .

G QIN , X Y GUNA , W SH LI . Compensation method of magnetic field error of three-dimensional vector based on ellipsoid compensation . Electronic Measurement Technology , 2018 . 41 ( 2 ): 34 - 39 . http://www.cnki.com.cn/Article/CJFDTotal-DZCL201802009.htm http://www.cnki.com.cn/Article/CJFDTotal-DZCL201802009.htm .

M KOK , T B SCHON . Magnetometer calibration using inertial sensors . IEEE Sensors Journal , 2016 . 16 ( 14 ): 5679 - 5689 . DOI: 10.1109/JSEN.2016.2569160 http://doi.org/10.1109/JSEN.2016.2569160 .

K HAN , H Z HAN , Z F WANG . Extended kalman filter-based gyroscope-aided magnetometer calibration for consumer electronic devices . IEEE Sensors Journal , 2017 . 17 ( 1 ): 63 - 71 . http://ieeexplore.ieee.org/document/7733159/ http://ieeexplore.ieee.org/document/7733159/ .

何康辉, 董朝阳, 王青.一种考虑GPS信号中断的导航滤波算法[J/OL].北京航空航天大学学报. http://doi.org/10.13700/j.bh.1001-5965.2018.0786 http://doi.org/10.13700/j.bh.1001-5965.2018.0786 .

HE K H, DONG CH Y, WANG Q. A navigation filtering algorithm considering GPS signal interruption[J/OL]. Journal of Beijing University of Aeronautics and Astronautics . http://doi.org/10.13700/j.bh.1001-5965.2018.0786 http://doi.org/10.13700/j.bh.1001-5965.2018.0786 (in Chinese)

M R ZHU , Y WU , W YU , 等 . An Efficient method for gyroscope-aided full magnetometer calibration . IEEE Sensors Journal , 2019 . 19 ( 15 ): 6355 - 6361 . DOI: 10.1109/JSEN.2019.2910091 http://doi.org/10.1109/JSEN.2019.2910091 .

陈亮 , 杨柳庆 , 肖前贵 . 基于梯度下降法和互补滤波的航向姿态参考系统 . 电子设计工程 , 2016 . 24 ( 24 ): 38 - 45 . http://www.cqvip.com/QK/98233A/201624/670876627.html http://www.cqvip.com/QK/98233A/201624/670876627.html .

L CHEN , L Q YANG , Q G XIAO . Attitude and Heading reference system based on gradient descent method and complementary filtering . Electronic Design Engineering , 2016 . 24 ( 24 ): 38 - 45 . http://www.cqvip.com/QK/98233A/201624/670876627.html http://www.cqvip.com/QK/98233A/201624/670876627.html .

R MAHONY , T HAMEL , J M PFLIMLIN . Nonlinear complementary filters on the special orthogonal group . IEEE Trans. Autom. Control , 2008 . 53 1203 - 1218 . DOI: 10.1109/TAC.2008.923738 http://doi.org/10.1109/TAC.2008.923738 .

EUSTON M, COOTE P, MAHONEY R, et al .. A complementary filter for attitude estimation of a fixed-wing UAV[C]. In Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems , 2008: 340-345.

MADGWICK S O H, HARRISON A J L, VAIDYANATHAN R. Estimation of IMU and MARG orientation using a gradient descent algorithm[C]. In Proceedings of the IEEE International Conference on Rehabilitation Robotics, 2011, 29(1): 1-7.

H HYTTI , A VISALA . A DCM based attitude estimation algorithm for Low-Cost MEMS IMUs . International Journal of Navigation and Observation , 2015 . ( 4 ): 1 - 18 . http://www.researchgate.net/publication/285392548_A_DCM_Based_Attitude_Estimation_Algorithm_for_Low-Cost_MEMS_IMUs http://www.researchgate.net/publication/285392548_A_DCM_Based_Attitude_Estimation_Algorithm_for_Low-Cost_MEMS_IMUs .

蔡浩原 , 李文宽 , 赵晟霖 , 等 . 陀螺仪补偿的实时EKF磁场校准 . 光学精密工程 , 2019 . 27 ( 12 ): 2650 - 2658 . http://ope.lightpublishing.cn/thesisDetails?columnId=2141048&Fpath=&index=-1&l=zh http://ope.lightpublishing.cn/thesisDetails?columnId=2141048&Fpath=&index=-1&l=zh .

H Y CAI , W K LI , SH L ZHAO , 等 . . Gyro-compensated real-time EKF magnetic field calibration method . Opt. Precision Eng. , 2019 . 27 ( 12 ): 2650 - 2658 . http://ope.lightpublishing.cn/thesisDetails?columnId=2141048&Fpath=&index=-1&l=zh http://ope.lightpublishing.cn/thesisDetails?columnId=2141048&Fpath=&index=-1&l=zh .

Views

1036

下载量

CSCD

Alert me when the article has been cited

提交

Tools

Publicity Resources

A visual SLAM algorithm based on adaptive inertial navigation assistant feature matching

Gyro-compensated real-time EKF magnetic field calibration method

Camera tracking in industrial augmented reality

The Research of Gyro Decoupling Problem on Photo-electric Platform

Related Author

JIA Xiaoxue

ZHAO Dongqing

ZHANG Letian

XIAO Guorui

XU Qing

Hao-yuan CAI

Wen-kuan LI

Sheng-lin ZHAO

Related Institution

Geography Space Information Institute， Information Engineering University

State Key Laboratory of Transducer Technology, Institute of Electrics Chinese Academy of Sciences

College of Civil Aviation, Nanjing University of Aeronautics and Astronautic

深圳白山机电一体化有限公司

AI问答

Address：No.3888 Dong Nanhu Road, Changchun, Jilin, China Postal code：130033
Tel：0431-86176855 Email：gxjmgc@ciomp.ac.cn
Technical support is provided by Beijing Founder electronics co., LTD 吉ICP备11002662号-17 京公网安备11010802024621
It is recommended to read the content of this site in Chrome&IE9+. Please switch to extreme mode in browser 360.
Cookies We use cookies to help provide and enhance our service and tailor content. By continuing, you agree to the use of cookies.

⁰