A Novel Localization Approach for Autonomous Vehicles Based on Map Matchingwith Curvature Features
SU Kuifeng1,2, DENG Zhidong1, HUANG Zhen1
1. State Key Laboratory of Intelligent Technology and Systems, Tsinghua National Laboratory for Information Science and Technology, Department of Computer Science, Tsinghua University, Beijing 100084, China;
2. Academy of Armored Force Engineering, Beijing 100072, China
Using the curvature features, a novel map-matching based localization approach for autonomous vehicles is proposed. By computing the scale-invariant curvature integral and its correlation of autonomous vehicle's historical and reference trajectories for matching, the proposed approach can effectively eliminate the mismatch problem caused by odometer calibration parameters bias and azimuth estimation errors in dead-reckoning (DR). Firstly, we integrate the inertial measurement unit output, steering angles, and wheel speed measurements from four ABS (anti-lock braking system) sensors by using the extended Kalman filter in order to estimate the autonomous vehicle's position and orientation, which are then used to select the candidate matching segments from digital maps. Then, a map matching algorithm based on spatial curvature features is proposed to accomplish segment matching, and matching points are determined according to the changes in curvature and yaw. Finally, these matching points are further utilized as the measurements of the unscented Kalman filter to update the filter and achieve high-precision estimation of pose. The experimental results in the real road condition show that the proposed approach is able to realize map matching effectively, reduce the accumulative error of autonomous vehicles in DR, and estimate the pose of autonomous vehicles accurately for long-range navigation even if the GPS (global positioning system) signal occasionally fails.
[1] Greenfeld J S. GPS matching observations to locations on a digital map[C/CD]//81st Annual Meeting of the Transportation Research Board. Washington, WS, USA: s.n., 2002: 164-173.
[2] Zhao Y. Vehicle location and navigation system[M]. Massachusetts, USA: Artech House, 1997: 120-145.
[3] 张其善,吴今培,杨东凯.智能车辆定位导航系统及应用[M].北京:科学出版社,2002:21-28. Zhang Q S, Wu J P, Yang D K. Intelligent vehicle positioning navigation system and its application[M]. Beijing: Science Press, 2002: 21-28.
[4] 苏洁,周东方,岳春生.GPS车辆导航中的实时地图匹配算法[J].测绘学报,2001,30(3):252-256. Su J, Zhou D F, Yue C S. Real-time map-matching algorithm in GPS navigation system for vehicles[J]. Acta Geodaetica et Cartographic Sinica, 2001, 30(3): 252-256.
[5] Kim J S, Le J H, Kang T H, et al. Node based map-matching algorithm for car navigation system[C]//Proceedings of the 29th ISATA Symposium. Florence, Italy: Automotive Automation Ltd, 1996: 121-126.
[6] El Najjar M E, Bonnifait P. A road-matching method for precise vehicle localization using belief theory and Kalman filtering[J]. Autonomous Robots, 2005, 19(2): 173-191.
[7] White C E, Bernstein D, Kornhauser A L. Some map matching algorithms for personal navigation assistants[J]. Transportation Research, Part C: Emerging Technologies, 2000, 8(1-6): 91-108.
[8] Joshi R R. A new approach to map-matching for in-vehicle navigation systems: The rotational variation metric[C]//IEEE International Conference on Intelligent Transportation Systems. Piscataway, NJ, USA: IEEE, 2001: 33-38.
[9] Quddus M A, Ochieng W Y, Zhao L, et al. A general map matching algorithm for transport telematics applications[J]. GPS Solutions, 2003, 7(3): 157-167.
[10] Li Z H, Chen W. A new approach to map-matching and parameter correcting for vehicle navigation system in the area of shadow of GPS signal[C]//IEEE International Conference on Intelligent Transportation Systems. Piscataway, NJ, USA: IEEE, 2005: 425-430.
[11] Quddus M A, Noland R B, Ochieng W Y. Validation of map matching algorithms using high precision positioning with GPS[J]. Journal of Navigation, 2005, 58(2): 257-271.
[12] Pyo J S, Shin D H, Sung T K. Development of a map matching method using the multiple hypothesis technique[C]//IEEE International Conference on Intelligent Transportation Systems. Piscataway, NJ, USA: IEEE, 2001: 23-27.
[13] Yang D, Cai B, Yuan Y. An improved map-matching algorithm used in vehicle navigation system[C]//IEEE \columnbreak International Conference on Intelligent Transportation Systems. Piscataway, NJ, USA: IEEE, 2003: 1246-1250.
[14] Quddus M A, Noland R B, Ochieng W Y. A high accuracy fuzzy logic based map matching algorithm for road transport[J]. Journal of Intelligent Transportation Systems, 2006, 10(3): 103-115.
[15] Phuyal B. Method and use of aggregated dead reckoning sensor and GPS data for map-matching[C]//Proceedings of the Institute of Navigation (ION) Annual Conference. USA: ION, 2002: 20-27.
[16] Yin H, Wolfson O. A weight-based map matching method in moving objects databases[C]//Proceedings of the International Working Conference on Scientific and Statistical Database Management. Piscataway, NJ, USA: IEEE, 2004: 437-438.
[17] Ochieng W Y, Quddus M A, Noland R B. Map-matching in complex urban road networks[J]. Brazilian Journal of Cartography, 2009, 55(2): 1-18.
[18] Kim W, Jee G I, Lee J G. Efficient use of digital road map in various positioning for ITS[C]//IEEE Position Location and Navigation Symposium. Piscataway, NJ, USA: IEEE, 2000: 170-176.
[19] Gustafsson F, Gunnarsson F, Bergman N, et al. Particle filters for positioning, navigation, and tracking[J]. IEEE Transactions on Signal Processing, 2002, 50(2): 425-437.
[20] Syed S, Cannon M E. Fuzzy logic-based map-matching algorithm for vehicle navigation system in urban canyons[C/CD] ule{0pt}{0pt}//Proceedings of the Institute of Navigation (ION) National Technical Meeting. USA: ION, 2004: 26-28.
[21] Fu M Y, Li J, Wang M L. A hybrid map matching algorithm based on fuzzy comprehensive judgment[C]//IEEE International Conference on Intelligent Transportation Systems. Piscataway, NJ, USA: IEEE, 2004: 613-617.
[22] Cui M, Femiani J, Hu J, et al. Curve matching for open 2D curves[J]. Pattern Recognition Letters, 2009, 30(1): 1-10.
[23] 邓志东,孙增圻.自学习自适应INS/Doppler组合导航系统[J].宇航学报,1994,15(3):55-63. Deng Z D, Sun Z Q. INS/Doppler integrated navigation system based on self-learning adaptive Kalman filtering[J]. Journal of Astronautics, 1994, 15(3): 55-63.
[24] 邓志东,孙增圻.一种对成片连续野值不敏感的鲁棒Kalman滤波[J].清华大学学报:自然科学版,1994,34(1):55-61. Deng Z D, Sun Z Q. Robust Kalman filtering insensitive to continuous outlier[J]. Journal of Tsinghua University: Science and Technology, 1994, 34(1): 55-61.