A path planning algorithm based on fusing lane and obstacle map

This paper proposes a path planning algorithm for autonomous driving in urban environments. The processing of video and Velodyne pointcloud provides information about the positions of lane markers and obstacles in the local map, which are then converted to a lane costmap and obstacle costmap. The referenced GIS follow line is used for generating a series of offset curves, and the best follow line is selected according to a combination of lane, obstacle and background cost. Additional handling of planning path and maximum speed is provided. Our planning algorithm can handle various road types such as U-turn, intersections, and different driving behaviors including passing over or following front vehicles, etc. The proposed navigation framework is implemented on an autonomous vehicle, which exhibits good performance on Future Challenge 2013, Changshu, China.

[1]  Jean Ponce,et al.  Vanishing point detection for road detection , 2009, CVPR.

[2]  Christopher Hunt,et al.  Notes on the OpenSURF Library , 2009 .

[3]  G LoweDavid,et al.  Distinctive Image Features from Scale-Invariant Keypoints , 2004 .

[4]  Mohamed Aly,et al.  Real time detection of lane markers in urban streets , 2008, 2008 IEEE Intelligent Vehicles Symposium.

[5]  Paul Newman,et al.  FAB-MAP: Probabilistic Localization and Mapping in the Space of Appearance , 2008, Int. J. Robotics Res..

[6]  Luke Fletcher,et al.  A perception‐driven autonomous urban vehicle , 2008, J. Field Robotics.

[7]  Mengyin Fu,et al.  Multi-lanes detection based on panoramic camera , 2014, 11th IEEE International Conference on Control & Automation (ICCA).

[8]  Sebastian Thrun,et al.  Junior: The Stanford entry in the Urban Challenge , 2008, J. Field Robotics.

[9]  Julius Ziegler,et al.  Optimal trajectory generation for dynamic street scenarios in a Frenét Frame , 2010, 2010 IEEE International Conference on Robotics and Automation.

[10]  Klaus C. J. Dietmayer,et al.  Generic grid mapping for road course estimation , 2011, 2011 IEEE Intelligent Vehicles Symposium (IV).

[11]  Luke Fletcher,et al.  A perception‐driven autonomous urban vehicle , 2008, J. Field Robotics.

[12]  Klaus C. J. Dietmayer,et al.  Localization in digital maps for road course estimation using grid maps , 2012, 2012 IEEE Intelligent Vehicles Symposium.