动态磁场校准的九轴惯性融合

蔡浩原; 赵晟霖; 崔松叶; 李文宽; 刘春秀

doi:10.37188/OPE.20202809.2007

您当前的位置：

首页 >

文章列表页 >

动态磁场校准的九轴惯性融合

微纳技术与精密机械 | 更新时间：2020-09-28

- 动态磁场校准的九轴惯性融合
- Nine-axis inertial fusion method based on dynamic magnetic field calibration
- 光学精密工程 2020年28卷第9期页码：2007-2016
- 作者机构：
  
  1.中国科学院空天信息创新研究院传感技术国家重点实验室, 北京 100190
  2.中国科学院大学, 北京 100049
  3.深圳前海维晟智能技术有限公司, 广东深圳 518101
- 作者简介：
  
  [ "蔡浩原(1970-), 男, 广西人, 博士, 副研究员, 1998年于清华大学获得学士学位, 2003年于中国科学院电子学研究所获得博士学位, 主要从事MEMS传感器及其微系统, 无线工业物联网传感器, 移动机器人室内导航的研究。E-mail:hycai@mail.ie.ac.cn" ]
  [ "赵晟霖(1997-), 男, 河北沧州人, 硕士研究生, 2019年于北京科技大学获得学士学位, 主要从事室内导航定位和同步定位与制图的研究。E-mail:zhaoshenglin19@mails.ucas.ac.cn" ]
- 基金信息：
  
  国家自然科学基金资助项目(61774157);国家自然科学基金资助项目(81771388);北京自然科学基金资助项目(4182075)
- DOI：10.37188/OPE.20202809.2007
  中图分类号： U666.1
- 收稿日期：2020-01-02，
  
  修回日期：2020-02-09，
  
  录用日期：2020-2-9，
  
  纸质出版日期：2020-09-25
- 稿件说明：
移动端阅览
蔡浩原, 赵晟霖, 崔松叶, 等. 动态磁场校准的九轴惯性融合[J]. 光学精密工程, 2020,28(9):2007-2016.

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.
蔡浩原, 赵晟霖, 崔松叶, 等. 动态磁场校准的九轴惯性融合[J]. 光学精密工程, 2020,28(9):2007-2016. DOI： 10.37188/OPE.20202809.2007.

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 .

浏览量

1036

下载量

CSCD

文章被引用时，请邮件提醒。

提交

工具集

关联资源

基于自适应惯导辅助特征匹配的视觉SLAM算法

陀螺仪补偿的实时EKF磁场校准

工业增强现实中的相机跟踪

光电平台中陀螺解耦问题的研究