简化磁力计非线性误差模型的快速校正算法Research on rapid calibration algorithm for simplified nonlinear error model of magnetometer
宁一鹏,毕京学,姚国标,桑文刚,郭秋英
摘要(Abstract):
针对传统的磁力计校正算法中存在的误差模型复杂、计算时间长、需要保持水平姿态和已知航向信息等弊端,该文从磁力计误差特性入手,推导并建立了简化的磁力计非线性等效误差模型。基于动态调整策略对传统的LM算法进行改进,并利用改进的LM算法求解误差模型,减少计算过程中的迭代次数,实现了磁力计误差的快速估计。实验表明,该方法在有效保证磁力计校正精度的前提下,迭代次数减少25%,计算速度提高了65.59%。
关键词(KeyWords): 磁力计;磁干扰;非线性;LM算法;迭代次数
基金项目(Foundation): 山东省高等学校青创人才引育计划项目
作者(Author): 宁一鹏,毕京学,姚国标,桑文刚,郭秋英
DOI: 10.16251/j.cnki.1009-2307.2021.01.005
参考文献(References):
- [1]ROH M S,KANG B S.Dynamic accuracy improvement of a MEMS AHRS for small UAVs[J].International Journal of Precision Engineering and Manufacturing,2018,19(10):1457-1466.
- [2]郭才发,胡正东,张士峰,等.地磁导航综述[J].宇航学报,2009,30(4):1314-1319.(GUO Caifa,HU Zhengdong,ZHANG Shifeng,et al.A survey of geomagnetic navigation[J].Journal of Astronautics,2009,30(4):1314-1319.)
- [3]殷红,郭杭,邓晓华.基于foot-mounted的IMU室内行人航位推算研究[J].测绘科学,2014,39(1):20-23,44.(YIN Hong,GUO Hang,DENG Xiaohua.Aresearch of IMU indoor pedestrian dead reckoning based on foot-mounted[J].Science of Surveying and Mapping,2014,39(1):20-23,44.)
- [4]张晓明.地磁导航理论与实践[M].北京:国防工业出版社,2016.(ZHANG Xiaoming.Geomagnetic navigation theory and practice[M].Beijing:National Defense Industry Press,2016.)
- [5]GROVES P D.GNSS与惯性及多传感器组合导航系统原理[M].北京:国防工业出版社,2011.(GROVESP D.GNSS and principles of integrated inertial and multi-sensor navigation systems[M].Beijing:National Defense Industry Press,2011.
- [6]庞鸿锋,潘孟春,王伟,等.基于高斯牛顿迭代算法的三轴磁强计校正[J].仪器仪表学报,2013,34(7):67-72.(PANG Hongfeng,PAN Mengchun,WANG Wei,et al.Error calibration of three axis magnetometer based on Gauss-Newton iteration algorithm[J].Chinese Journal of Scientific Instrument,2013,34(7):67-72.)
- [7]LI X,LI Z.A new calibration method for tri-axial field sensors in strap-down navigation systems[J].Measurement Science&Technology,2012,23(10):2852-2855.
- [8]ALONSO R,SHUSTER M D.TWOSTEP:A fast robust algorithm for attitude-independent magnetometer-bias determination[J].Journal of the Astronautical Sciences,2002,50(4):433-451.
- [9]ALONSO R,SHUSTER M D,et al.Complete linear attitude-independent magnetometer calibration[J].Journal of the Astronautical Sciences,2002,50(4):477-490.
- [10]GEBRE-EGZIABHER D.Calibration of strapdown magnetometers in magnetic field domain[J].Journal of Aerospace Engineering,2006,19(2):87-102.
- [11]VASCONCELOS J F,ELKAIM G,SILVESTRE C,et al.A geometric approach to strapdown magnetometer calibration in sensor frame*[J].IFAC Proceedings Volumes,2008,41(1):172-177.
- [12]WU Y,SHI W.On calibration of three-axis magnetometer[J].IEEE Sensors Journal,2015,15(11):6424-6431.
- [13]钟浩,章卫国,刘小雄.基于模值估计的三轴磁力计标定方法研究[J].传感技术学报,2017,30(10):1512-1517.(ZHONG Hao,ZHAGN Weiguo,LIU Xiaoxiong.Research on calibration methods of three-axis magnetometer based on vector norm estimation[J].Chinese Journal of Sensors and Actuators,2017,30(10):1512-1517.)
- [14]贾文抖,林春生,林朋飞,等.基于正弦拟合的三轴磁力仪标定方法[J].武汉大学学报(信息科学版),2019,44(9):1328-1333,1406.(JIA Wendou,LIN Chunsheng,LIN Pengfei,et al.Calibration method of three-axis magnetometer based on sine fitting[J].Geomatics and Information Science of Wuhan University,204,44(9):1328-1333,1406.)
- [15]吴德会,黄松岭,赵伟.基于FLANN的三轴磁强计误差校正研究[J].仪器仪表学报,2009,30(3):449-453.(WU Dehui,HUANG Songling,ZHAO Wei.Research on correction of tri-axial magnetometer based on FLANN[J].Chinese Journal of Scientific Instrument,2009,30(3):449-453.)
- [16]WU Z,WU Y,HU X,et al.Calibration of three-axis strapdown magnetometers using particle swarm optimiazation algorithm[C]∥IEEE International Symposium on Robotic and Sensors Environments.Montreal,Canada:IEEE,2011:160-165.
- [17]VASCONCELOS J F,ELKAIM G,SILVESTRE C,et al.Ageometric approach to strapdown magnetometer calibration in sensor frame[J].IEEE Transactions on Aerospace and Electronic Systems,2011,47(2):1293-1306.
- [18]聂琳娟,邱耀东,申文斌,等.IGRF12和WMM2015模型在中国区域的精度评估及其适用性分析[J].武汉大学学报(信息科学版),2017,42(9):1229-1235.)(NIELinjuan,QIU Yaodong,SHEN Wenbin,et al.Accuracy evaluation and applicability of IGRF12and WMM2015model in Chinese mainland[J].Geomatics and Information Science of Wuhan University,2017,42(9):1229-1235.)
- [19]马昌凤.最优化方法及其Matlab程序设计[M].北京:科学出版社,2010.(MA Changfeng.Optimization method and Matlab program design[M].Beijing:Science Press,2010.)
- [20]FAN J Y.A modified Levenberg-Marquardt algorithm for singular system of nonlinear equations[J].Journal of Computational Mathematics,2003,21(5):625-636.