Positioning Correction Algorithm of Vector Road Aided Inertial Navigation Based on the Rough/Fine Matching Method

doi:10.11947/j.AGCS.2017.20160469

Abstract

Abstract: In the passive environment, accumulated positioning errors of the inertial navigation system (INS) could not be corrected by satellite navigation and positioning, a rough/fine matching method based on high-precision road data was proposed to adjust the vehicle trajectory data acquired by INS. Firstly, by analyzing the feature label point and its minimum bounding rectangle in inertial trajectory, the obvious error matching road and redundant road could be eliminated and the candidate matching road sets could be captured. Then, with the advantages of high precision and stable matching result, the ICCP algorithm was built to compensate and correct the positioning errors caused by INS. Finally, the matching variance and history matching results could be used to judge whether the matching results were correct. Simulation results illustrated that this method could improve the correction accuracy and reduce the false matching results in the complex road intersections.

Key words: rough/fine matching, vector road, trajectory feature, the feature label point, ICCP algorithm

CLC Number:

P208

LI Xiang, HUA Yixin, ZHANG Hong, ZHANG Jiangshui. Positioning Correction Algorithm of Vector Road Aided Inertial Navigation Based on the Rough/Fine Matching Method[J]. Acta Geodaetica et Cartographica Sinica, 2017, 46(8): 1034-1046.

References

[1] 宋磊. 基于熵和ICCP的多级地磁辅助惯性导航算法研究[J]. 华北科技学院学报, 2014, 11(10):70-74. SONG Lei. Research on the Multi-level Geomagnetic Match Algorithm Aided Inertial Navigation Based on Entropy/ICCP Algorithm[J]. Journal of North China Institute of Science and Technology,2014,11(10):70-74.
[2] 寇义民. 地磁导航关键技术研究[D]. 哈尔滨:哈尔滨工业大学, 2010. KOU Yimin.Research of Key Technologies in Geomagnetic Navigation[D]. Harbin:Harbin Institute of Technology, 2010.
[3] 李清泉, 黄练. 基于GPS轨迹数据的地图匹配算法[J]. 测绘学报, 2010, 39(2):207-212. LI Qingquan, HUANG Lian. A Map Matching Algorithm for GPS Tracking Data[J]. Acta Geodaetica et Cartographica Sinica, 2010, 39(2):207-212.
[4] 王美玲, 程林. 浮动车地图匹配算法研究[J]. 测绘学报, 2012, 41(1):133-138. WANG Meiling, CHENG Lin. Study on Map-matching Algorithm for Floating Car[J]. Acta Geodaetica et Cartographica Sinica, 2012, 41(1):133-138.
[5] 孙永荣, 黄斌, 王丽娜, 等. 抗尺度变换的矢量地图匹配导航方法[J]. 中国惯性技术学报, 2013, 21(1):89-92, 111. SUN Yongrong, HUANG Bin, WANG Lina, et al. Vector Map Matching Navigation Method with Anti-scale Transformation[J]. Journal of Chinese Inertial Technology, 2013, 21(1):89-92, 111.
[6] 黄斌. 惯性/地磁/地图组合导航系统研究[D]. 南京:南京航空航天大学, 2013. HUANG Bin. Research on INS/Geomagnetic/Map Integrated Navigation System[D]. Nanjing:Nanjing University of Aeronautics and Astronautics, 2013.
[7] 郭黎, 李宏伟, 张泽建, 等. 道路网信息投影匹配方法研究[J]. 武汉大学学报(信息科学版), 2013, 38(9):1113-1117. GUO Li, LI Hongwei, ZHANG Zejian, et al. Geometry Matching Method for Transportation Road Network Data Based on Projection[J]. Geomatics and Information Science of Wuhan University, 2013, 38(9):1113-1117.
[8] CHAWATHE S S. Segment-based Map Matching[C]//Proceedings of 2007 IEEE Symposium on Intelligent Vehicles. Istanbul:IEEE, 2007:1190-1197.
[9] 李洋, 张晓冬, 鲍远律. 多权值概率论实时地图匹配[J]. 电子测量与仪器学报, 2012, 26(2):166-170. LI Yang, ZHANG Xiaodong, BAO Yuanlv. Algorithm on Real-time Map-matching of Multi-weight Probability[J]. Journal of Electronic Measurement and Instrument, 2012, 26(2):166-170.
[10] 彭飞, 柳重堪, 张其善. 基于代价函数的组合导航系统地图匹配算法[J]. 北京航空航天大学学报, 2002, 28(3):261-264. PENG Fei,LIU Zhongkan,ZHANG Qishan.Cost Function Based Map Matching Algorithm for GPS/DR Integrated Navigation Systems[J]. Journal of Beijing University of Aeronautics and Astronautics, 2002, 28(3):261-264.
[11] BERNOULLI T, KRAMMER M, WALDER U, et al. Improvement of Inertial Sensor Based Indoor Navigation by Video Content Analysis[C]//Proceedings of 2011 International Conference on Indoor Positioning and Indoor Navigation. Guimaraes:IEEE, 2011:1-9.
[12] 李翔. 基于路网特征的惯性导航辅助定位算法的研究与实现[D]. 郑州:信息工程大学, 2013. LI Xiang. Research and Implementation on Aided Inertial Navigation Positioning Algorithm Based on Road Networks Feature[D]. Zhengzhou:Information Engineering University, 2013.
[13] 王志刚, 边少锋. 基于ICCP算法的重力辅助惯性导航[J]. 测绘学报, 2008, 37(2):147-151, 157. WANG Zhigang, BIAN Shaofeng. ICCP Algorithm for Gravity Aided Inertial Navigation[J]. Acta Geodaetica et Cartographica Sinica, 2008, 37(2):147-151, 157.
[14] 刘锐, 张江水, 李翔. 基于路网惯导载体路径匹配的ICCP算法改进[J]. 测绘科学技术学报, 2016, 33(1):82-87. LIU Rui, ZHANG Jiangshui, LI Xiang. The Research on the Improvement of ICCP Algorithm for the Route-matching of Initial Navigation Vehicles in Road Network[J]. Journal of Geomatics Science and Technology, 2016, 33(1):82-87.
[15] 赵建虎, 张红梅, 王爱学, 等. 利用ICCP的水下地磁匹配导航算法[J]. 武汉大学学报(信息科学版), 2010, 35(3):261-264. ZHAO Jianhu, ZHANG Hongmei, WANG Aixue, et al. Underwater Geomagnetic Navigation Based on ICCP[J]. Geomatics and Information Science of Wuhan University, 2010, 35(3):261-264.
[16] 谌剑, 张静远, 查峰. 一种改进ICCP水下地形匹配算法[J]. 华中科技大学学报(自然科学版), 2012, 40(10):63-67. SHEN Jian, ZHANG Jingyuan, ZHA Feng. Improved ICCP Algorithm for Underwater Terrain Matching Method[J]. Journal of Huazhong University of Science & Technology (Natural Science Edition), 2012, 40(10):63-67.
[17] OCHIENG W Y, QUDDUS M, NOLAND R B. Map-matching in Complex Urban Road Networks[J]. Brazilian Journal of Cartography, 2003, 55(2):1-14.
[18] 许建国, 张志利, 周召发. 交互式地图匹配算法在组合导航中的应用[J]. 上海交通大学学报, 2013, 47(8):1323-1328. XU Jianguo, ZHANG Zhili, ZHOU Zhaofa. Application of Interactive Map Matching Algorithm in SINS/Odometer Integrated Navigation[J]. Journal of Shanghai Jiao Tong University, 2013, 47(8):1323-1328.
[19] 崔留争. MEMS-SINS/GPS组合导航关键技术研究[D]. 长春:中国科学院大学(长春光学精密机械与物理研究所), 2014. CUI Liuzheng. Research on the Key Technologies of MEMS-SINS/GPS Integration Navigation System[D]. Changchun:Changchun Institute of Optics, Fine Mehcanics and Physics, Chinese Academy of Sciences, 2014.
[20] 李翔, 张江水, 马健, 等. 顾及轨迹趋势变化的特征提取算法[J]. 计算机辅助设计与图形学学报, 2016, 28(8):1341-1349. LI Xiang, ZHANG Jiangshui, MA Jian, et al. Feature Extraction Algorithm in Consideration of the Trend Changing of Track[J]. Journal of Computer-Aided Design & Computer Graphics, 2016, 28(8):1341-1349.
[21] 马小龙, 李成名, 赵占杰. 道路交叉口自动检测与基于OpenSceneGraph的三维自动建模方法[J]. 测绘学报, 2014, 43(10):1083-1091. DOI:10.13485/j.cnki.11-2089.2014.0158. MA Xiaolong, LI Chengming, ZHAO Zhanjie. Three-dimensional Road Intersection Automatic Inspection and Robotization Modeling Based on OpenSceneGraph[J]. Acta Geodaetica et Cartographica Sinica, 2014, 43(10):1083-1091. DOI:10.13485/j.cnki.11-2089.2014.0158.
[22] 胡云岗, 陈军, 赵仁亮, 等. 地图数据缩编更新中道路数据匹配方法[J]. 武汉大学学报(信息科学版), 2010, 35(4):451-456. HU Yungang, CHEN Jun, ZHAO Renliang, et al. Matching of Roads under Different Scales for Updating Map Data[J]. Geomatics and Information Science of Wuhan University, 2010, 35(4):451-456.
[23] VELAGA N R, QUDDUS M A, BRISTOW A L. Developing an Enhanced Weight-based Topological Map-matching Algorithm for Intelligent Transport Systems[J]. Transportation Research Part C, 2009, 17(6):672-683.
[24] 盛骤, 谢式千, 潘承毅. 概率论与数理统计[M]. 4版. 北京:高等教育出版社, 2008:161-163. SHENG Zou, XIE Shiqian, PAN Chengyi. Probability Theory and Mathematical Statistics[M]. 4th ed. Beijing:Higher Education Press, 2008:161-163.
[25] 王志刚, 边少锋. 基于ICCP算法的重力辅助惯性导航[J]. 测绘学报, 2008, 37(2):147-151, 157. WANG Zhigang, BIAN Shaofeng. ICCP Algorithm for Gravity Aided Inertial Navigation[J]. Acta Geodaetica et Cartographica Sinica, 2008, 37(2):147-151, 157.
[26] 黄晓颖, 童余德, 边少锋. 基于Matcom混合编程的ICCP算法仿真实现[J]. 测绘科学技术学报, 2011, 28(3):186-189. HUANG Xiaoying, TONG Yude, BIAN Shaofeng. Implementation for Simulation of ICCP Based on Matcom[J]. Journal of Geomatics Science and Technology, 2011, 28(3):186-189.
[27] 李世飞, 王平, 沈振康. 迭代最近点算法研究进展[J]. 信号处理, 2009, 25(10):1582-1588. LI Shifei, WANG Ping, SHEN Zhenkang. A Survey of Iterative Closest Point Algorithm[J]. Signal Processing, 2009, 25(10):1582-1588.
[28] BERNARDINI F,MITTLEMAN J,RUSHMEIER H, et al. The Ball-pivoting Algorithm for Surface Reconstruction[J]. IEEE Transactions on Visualization and Computer Graphics, 1999, 5(4):349-359.
[29] 张悦. 水下机器人地磁组合导航中ICCP算法的改进[D]. 哈尔滨:哈尔滨工程大学, 2011. ZHANG Yue. Improvement of ICCP Algorithm in Geomagnetic Integrated Navigation for Underwater Robot[D]. Harbin:Harbin Engineering University, 2011.
[30] 闫利, 崔晨风, 谢洪. ICCP算法在重力匹配中的应用[J]. 遥感信息, 2009(1):16-19. YAN Li, CUI Chenfeng, XIE Hong. The Application of ICCP Algorithm to Gravity Matching[J]. Remote Sensing Information, 2009(1):16-19.
[31] 张红梅, 赵建虎, 王爱学, 等. 预平移简化ICCP匹配算法研究[J]. 武汉大学学报(信息科学版), 2010, 35(12):1432-1435. ZHANG Hongmei, ZHAO Jianhu, WANG Aixue, et al. Pre-translation Simplified ICCP Algorithm[J]. Geomatics and Information Science of Wuhan University, 2010, 35(12):1432-1435.
[32] 徐克虎, 沈春林. 地形特征匹配辅助导航方法研究[J]. 东南大学学报(自然科学版), 2000, 30(3):113-117. XU Kehu, SHEN Chunlin. Study of Terrain Feature Matching Aided Navigation Method[J]. Journal of Southeast University (Natural Science Edition), 2000, 30(3):113-117.
[33] 刘承香. 水下潜器的地形匹配辅助定位技术研究[D]. 哈尔滨:哈尔滨工程大学, 2003. LIU Chengxiang. A Study on Terrain Matching Assistant Positioning Technology for Underwater Vehicle[D]. Harbin:Harbin Engineering University, 2003.
[34] 李强, 曹鹏, 缪立新. 针对探测车历史数据的离线地图匹配算法[J]. 武汉大学学报(信息科学版), 2013, 38(2):244-247. LI Qiang, CAO Peng, MIAO Lixin. Offline Map-matching for Archived Probe Vehicle Data[J]. Geomatics and Information Science of Wuhan University, 2013, 38(2):244-247.
[35] 李翔, 张江水, 杨柏欣, 等. 基于航向角变化的趋势集合轨迹特征划分算法[J]. 地球信息科学学报, 2015, 17(10):1172-1178. LI Xiang, ZHANG Jiangshui, YANG Baixin, et al. An Extraction Algorithm of Track Features Based on Trend Set of Heading Angle Variable[J]. Journal of Geo-information Science, 2015, 17(10):1172-1178.
[36] 百度地图API[EB/OL].[2017-02-05] http://developer.baidu.com/map/index.html.