Ground Feature Point Matching Based Global Localization for Driverless Vehicles
FANG Hui1, YANG Ming2, YANG Ruqing 1
1. Research Institute of Robotics, Shanghai Jiao Tong University, Shanghai 200240, China; 2. Department of Automation, Shanghai Jiao Tong University, Shanghai 200240, China
方辉, 杨明, 杨汝清. 基于地面特征点匹配的无人驾驶车全局定位[J]. 机器人, 2010, 32(1): 55-60..
FANG Hui, YANG Ming, YANG Ruqing . Ground Feature Point Matching Based Global Localization for Driverless Vehicles. ROBOT, 2010, 32(1): 55-60..
Abstract:Vehicle localization is achieved by a ground feature points based map matching approach,in which a camera is fixed downward on the bottom of the vehicle according to the outdoor environmental conditions.The proposed approach includes two steps:(1) a vehicle is manually controlled to move in an environment,recording sensor data from RTK(real-time kinematic)-GPS,odometry and camera to produce a ground feature point map automatically in an off-line manner.A special map organization is used to increase the efficiency of map search and matching.(2) vehicle localization is realized by map matching method,in which a M-estimator weighted ICP(iterative closest point) algorithm is utilized to match feature points and compute matching parameters.Furthermore,map matching result is fused with dead-reckoning by UKF(unscented Kalman filter) to achieve higher robustness.Experimental results demonstrate the effectiveness of the proposed approach.
[1] Panzieri S,Pascucci F,Ulivi G.An outdoor navigation system using GPS and inertial platform[J].IEEE/ASME Transactions on Mechatronics,2002,7(2):134-142.
[2] Lee D,Chung W,Kim M.A reliable position estimation method of the service robot by map matching[C]//IEEE International Conference on Robotics and Automation.Piscataway,N J,USA:IEEE,2003:2830-2835.
[3] Se S,Lowe D,Little J.Mobile robot localization and mapping with uncertainty using scale-invariant visual landmarks[J].International Journal of Robotics Research,2002,21(8):735-758.
[4] Gresetti G,Tipaldi G D,Stachniss C,et al.Fast and accurate SLAM with Rao-Blackwellized panicle filters[J].Robotics and Autonomous Systems,2007,55(1):30-38.
[5] Van der Merwe R,Wan E A.The square-root unscented Kalman filter for state and parameter-estimation[C]//IEEE International Conference on Acoustics,Speech and Signal Processing.Piscataway,NJ,USA:IEEE,2001:3461-3464.
[6] Besl P J,McKay N D.A method for registration of 3-D shapes[J].IEEE Transactions on Pattern Analysis and Machine Intelligence,1992,14(2):239-256.