改进粒子滤波器的室内地磁匹配精度研究Indoor geomagnetic matching accuracy analysis based on improved particle filter algorithm
李维,黄鹤,罗德安
摘要(Abstract):
针对粒子滤波算法在室内地磁分布的连续性变化中会发生滤波发散,加之算法中重采样步骤使该现象恶化,直接导致室内定位过程中目标丢失的问题。该文受Hausdorff距离度量法中点集匹配思想的启发,提出了一种利用初定位误差作为最大粒子匹配距离的约束思想,通过缩小匹配空间的区域范围的方法来解决传统算法的发散问题。最后实验表明,此方法解决了粒子滤波器在地磁匹配中出现的滤波发散现象,同时使得定位结果更加快速收敛。
关键词(KeyWords): 室内定位;粒子滤波;定位误差;Hausdorff距离;地磁匹配;定位误差约束
基金项目(Foundation): 国家重点研发计划项目(2017YFB0503702);; 现代城市测绘国家地理信息局重点实验室开放基金项目(20131201NZ)
作者(Author): 李维,黄鹤,罗德安
DOI: 10.16251/j.cnki.1009-2307.2018.07.017
参考文献(References):
- [1]KIM S E,YONG K,YOON J,et al.Indoor positioning system using geomagnetic anomalies for smartphones[C]∥International Conference on Indoor Positioning and Indoor Navigation.[S.l.]:IEEE,2012:1-5.
- [2]王向磊,苏牡丹,李博,等.地磁匹配导航算法研究[J].测绘科学,2011,36(4):12-15.(WANG Xianglei,SU Mudan,LI Bo,et al.Research of geomagnetic matching navigation algorithm[J].Science of Surveying and Mapping,2011,36(4):12-15.)
- [3]刘颖,吴美平,胡小平,等.基于等值线约束的地磁匹配方法[J].空间科学学报,2007,27(6):505-511.(LIU Ying,WU Meiping,HU Xiaoping,et al.Contour constraint based geomagnetic matching method[J].Chinese Journal of Space Science,2007,27(6):505-511.)
- [4]乔玉坤,王仕成,张金生,等.基于相关分析的飞行器地磁匹配算法仿真研究[J].地球物理学进展,2009,24(2):721-727.(QIAO Yukun,WANG Shicheng,ZHANG Jinsheng,et al.Simulation of geomagnetic matching algorithm based on correlation analysis for flying objects[J].Progress in Geophysics,2009,24(2):721-727.)
- [5]刘飞,周贤高,杨晔,等.相关地磁匹配定位技术[J].中国惯性技术学报,2007,15(1):59-61.(LIU Fei,ZHOU Xiangao,YANG Ye,et al.Geomagnetic matching location using correlative method[J].Journal of Chinese Inertial Technology,2007,15(1):59-61.)
- [6]孔亚男,鲁浩,徐剑芸.基于Hausdorff距离的地磁匹配导航算法[J].航空兵器,2011(4):26-29.(KONG Yanan,LU Hao,XU Jianyun.Study on geomagnetic matching algorithm based on hausdorff distance[J].Aero Weaponry,2011(4):26-29.)
- [7]ZHAO Jianhu,WANG Shengping,WANG Aixue.Study on underwater navigation system based on geomagnetic match technique[C]∥2009 9th International Conference on Electronic Measurement&Instruments.Beijing:[s.n.],2009:255-259.
- [8]郑德华.ICP算法及其在建筑物扫描点云数据配准中的应用[J].测绘科学,2007,32(2):31-32,177.(ZHENG Dehua.ICP algorithm and application in the data registration of building scanning point doud[J].Science of Surveying and Mapping,2007,32(2):31-32,177)
- [9]EJAZ M.Robust geomagnetic aided inertial navigation of underwater vehicles using the ICP algorithm[C]∥Computational Intelligence and Industrial Applications.[S.l.]:PACIIA,2009:257-262.
- [10]LIU Ying,WU Meiping,HU Xiaoping,et al.Geomagnetism aided inertial navigation system[C]∥2008 2nd International Symposium on Systems and Control in Aerospace and Astronautics.Shenzhen:[s.n.],2008:1-5.
- [11]CORDN O,DAMAS S.Image registration with iterated local search[J].Journal of Heuristics,2006,12(1):3-94.
- [12]王胜平.水下地磁匹配导航定位关键技术研究[J].测绘学报,2013,42(1):153.(WANG Shengping.Research on the key technical of marine geomagnetic matching navigation and positioning[J].Acta Geodaetica et Cartographica Sinica,2013,42(1):153.)
- [13]WANG Kedong,YAN Lei,DENG Wei,et al.Research on iterative closest contour point for underwater terrain-aided navigation[J].Lecture Notes in Computer Science,2006,27(5):252-260.
- [14]郭庆,魏瑞轩,胡明朗,等.地磁匹配双等值线算法仿真研究[J].系统仿真学报,2010,22(7):1576-1579.(GUO Qing,WEI Ruixuan,HU Minglang,et al.Research on dual iterative closet contour point algorithm for geomagnetic matching[J].Journal of System Simulation,2010,22(7):1576-1579.)
- [15]LUO Shitu,WANG Yanling,LIU Yin,et al.Research on geomagnetic-matching technology based on improved ICP algorithm[C]∥2008International Conference on Information and Automation.Changsha:[S.l.],2008:815-819.
- [16]赵建虎,王胜平,王爱学.一种改进型TERCOM水下地磁匹配导航算法[J].武汉大学学报(信息科学版),2009,34(11):1320-1323.(ZHAO Jianhu,WANG Shengping,WANG Aixue.An improved TERCOM algorithm for underwater geomagnetic matching navigation[J].Geomatics and Information Science of Wuhan University,2009,34(11):1320-1323.)
- [17]LIU Yuxia,ZHOU Jun.Geomagnetic matching algorithm based on hidden Markov model[J].Journal of Chinese Inertial Technology,2011,19(2):224-228.
- [18]GUO Zhengdong,LUAN Luyu,ZHU Hai,et al.Geomagnetic filtering navigation algorithm based on single spot matching precorrection[C]∥2012Fifth International Symposium on Computational Intelligence and Design.Hangzhou:[s.n.],2012:543-546.
- [19]WANG Xianglei.Autonomous navigation based Geomagnetic research[J].Chinese Journal of Geophysics,2010,53(11):2724-2731.
- [20]杨功流,李士心,姜朝宇.地磁辅助惯性导航系统的数据融合算法[J].中国惯性技术学报,2007,15(1):47-50.(YANG Gongliu,LI Shixin,JIANG Zhaoyu.Data fusing algorithm in geomagnetic aided INS[J].Journal of Chinese Inertial Technology,2007,15(1):47-50.)
- [21]LARRY C B,KENNETH J L.True navigation and magnetic maps in spiny lobsters[J].Nature,2003,421:60-63.
- [22]STORMS W,SHOCKLEY J,RAQUET J.Magnetic field navigation in an indoor environment[C]∥2010Ubiquitous Positioning Indoor Navigation and Location Based Service.Kirkkonummi:[s.n.],2010:1-10.
- [23]LI B,GALLAGHER T,DEMPSTER A G,et al.How feasible is the use of magnetic field alone for indoor positioning?[C]∥2012International Conference on Indoor Positioning and Indoor Navigation(IPIN),Sydney.NSW:[s.n.],2012:1-9.
- [24]GRAND E L,THRUN S.3-Axis magnetic field mapping and fusion for indoor localization[C]∥2012IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems(MFI).Hamburg:[s.n.],2012:358-364.
- [25]HAVERINEN J,KEMPPAINEN A.Global indoor self-localization based on the ambient magnetic field[J].Robotics&Autonomous Systems,2009,57(10):1028-1035.
- [26]FRASSL M,ANGERMANN M,LICHTENSTERN M,et al.Magnetic maps of indoor environments for precise localization of legged and non-legged locomotion[C]∥2013IEEE/RSJ International Conference on Intelligent Robots and Systems.Tokyo:[s.n.],2013:913-920.
- [27]ARULAMPALAM M S,MASKELL S,GORDON N,et al.A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian tracking[J].IEEE Transactions on Signal Processing,2002,50(2):174-188.
- [28]胡士强.粒子滤波原理及其应用[M].北京:科学出版社,2010:21-25.(HU Shiqiang.The principle and application of particle filter[M].Beijing:Science Press,2010:21-25.)