Single camera vehicle localization using SURF scale and dynamic time warping

Vehicle ego-localization is an essential process for many driver assistance and autonomous driving systems. The traditional solution of GPS localization is often unreliable in urban environments where tall buildings can cause shadowing of the satellite signal and multipath propagation. Typical visual feature based localization methods rely on calculation of the fundamental matrix which can be unstable when the baseline is small. In this paper we propose a novel method which uses the scale of matched SURF image features and Dynamic Time Warping to perform stable localization. By comparing SURF feature scales between input images and a pre-constructed database, stable localization is achieved without the need to calculate the fundamental matrix. In addition, 3D information is added to the database feature points in order to perform lateral localization, and therefore lane recognition. From experimental data captured from real traffic environments, we show how the proposed system can provide high localization accuracy relative to an image database, and can also perform lateral localization to recognize the vehicle's current lane.

[1]  Hiroshi Murase,et al.  Change detection in streetscapes from GPS coordinated omni-directional image sequences , 2006, 18th International Conference on Pattern Recognition (ICPR'06).

[2]  Hiroshi Murase,et al.  On-road Obstacle Detection by Comparing Present and Past In-vehicle Camera Images , 2011, MVA.

[3]  Leopoldo Armesto,et al.  Robust and Efficient Mobile Robot Self-localization using Laser Scanner and Geometrical Maps , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Manolis I. A. Lourakis,et al.  SBA: A software package for generic sparse bundle adjustment , 2009, TOMS.

[5]  Steven Mills,et al.  Bag‐of‐words‐driven, single‐camera simultaneous localization and mapping , 2011, J. Field Robotics.

[6]  Olivier Stasse,et al.  MonoSLAM: Real-Time Single Camera SLAM , 2007, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[7]  Julius Ziegler,et al.  Urban localization with camera and inertial measurement unit , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[8]  Michael Milford Visual Route Recognition with a Handful of Bits , 2012, Robotics: Science and Systems.

[9]  Sergiu Nedevschi,et al.  Accurate Ego-Vehicle Global Localization at Intersections Through Alignment of Visual Data With Digital Map , 2013, IEEE Transactions on Intelligent Transportation Systems.

[10]  Ju-Jang Lee,et al.  Mobile robot localization in indoor environment using RFID and sonar fusion system , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Takeo Kanade,et al.  Real-time topometric localization , 2012, 2012 IEEE International Conference on Robotics and Automation.

[12]  Jennifer A. Scott,et al.  Algorithm 891: A Fortran virtual memory system , 2009, TOMS.

[13]  Sergiu Nedevschi,et al.  Reliable Localization and Map Building based on Visual Odometry and Ego Motion Model in Dynamic Environment , 2010, VISAPP.

[14]  Michel Dhome,et al.  Monocular Vision Based SLAM for Mobile Robots , 2006, 18th International Conference on Pattern Recognition (ICPR'06).

[15]  Luc Van Gool,et al.  Speeded-Up Robust Features (SURF) , 2008, Comput. Vis. Image Underst..

[16]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

[17]  Fredrik Kahl,et al.  Robust Optimal Pose Estimation , 2008, ECCV.

[18]  Dominique Gruyer,et al.  A Robust Hybrid Multisource Data Fusion Approach for Vehicle Localization , 2013 .