Dynamic path planning for autonomous driving on various roads with avoidance of static and moving obstacles

Abstract This paper presents a real-time dynamic path planning method for autonomous driving that avoids both static and moving obstacles. The proposed path planning method determines not only an optimal path, but also the appropriate acceleration and speed for a vehicle. In this method, we first construct a center line from a set of predefined waypoints, which are usually obtained from a lane-level map. A series of path candidates are generated by the arc length and offset to the center line in the s - ρ coordinate system. Then, all of these candidates are converted into Cartesian coordinates. The optimal path is selected considering the total cost of static safety, comfortability, and dynamic safety; meanwhile, the appropriate acceleration and speed for the optimal path are also identified. Various types of roads, including single-lane roads and multi-lane roads with static and moving obstacles, are designed to test the proposed method. The simulation results demonstrate the effectiveness of the proposed method, and indicate its wide practical application to autonomous driving.

[1]  Jonathan P. How,et al.  Real-Time Motion Planning With Applications to Autonomous Urban Driving , 2009, IEEE Transactions on Control Systems Technology.

[2]  John W. Polak,et al.  Autonomous cars: The tension between occupant experience and intersection capacity , 2015 .

[3]  Jun Ni,et al.  Dynamics control of autonomous vehicle at driving limits and experiment on an autonomous formula racing car , 2017 .

[4]  Dean Pomerleau,et al.  ALVINN, an autonomous land vehicle in a neural network , 2015 .

[5]  Didier Devaurs,et al.  Optimal Path Planning in Complex Cost Spaces With Sampling-Based Algorithms , 2016, IEEE Transactions on Automation Science and Engineering.

[6]  Jean-Claude Latombe,et al.  Numerical potential field techniques for robot path planning , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[7]  S. LaValle.  Rapidly-exploring random trees : a new tool for path planning , 1998 .

[8]  Keith Redmill,et al.  Systems for Safety and Autonomous Behavior in Cars: The DARPA Grand Challenge Experience , 2007, Proceedings of the IEEE.

[9]  Howie Choset,et al.  Principles of Robot Motion: Theory, Algorithms, and Implementation ERRATA!!!! 1 , 2007 .

[10]  Konghui Guo,et al.  Distributed formation control of nonholonomic autonomous vehicle via RBF neural network , 2017 .

[11]  Hui Zhang,et al.  Active Steering Actuator Fault Detection for an Automatically-Steered Electric Ground Vehicle , 2017, IEEE Transactions on Vehicular Technology.

[12]  Xin Xu,et al.  A hierarchical path planning approach based on A⁎ and least-squares policy iteration for mobile robots , 2015, Neurocomputing.

[13]  Myoungho Sunwoo,et al.  Local Path Planning for Off-Road Autonomous Driving With Avoidance of Static Obstacles , 2012, IEEE Transactions on Intelligent Transportation Systems.

[14]  John M. Dolan,et al.  Motion planning under uncertainty for on-road autonomous driving , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[15]  K. A. Semendyayev,et al.  Handbook of mathematics , 1985 .

[16]  G. Oriolo,et al.  Robotics: Modelling, Planning and Control , 2008 .

[17]  Christopher M. Clark,et al.  Motion planning for formations of mobile robots , 2004, Robotics Auton. Syst..

[18]  Sanjiv Singh,et al.  The DARPA Urban Challenge: Autonomous Vehicles in City Traffic, George Air Force Base, Victorville, California, USA , 2009, The DARPA Urban Challenge.

[19]  Roberto Sepúlveda,et al.  Path planning for mobile robots using Bacterial Potential Field for avoiding static and dynamic obstacles , 2015, Expert Syst. Appl..

[20]  S. Darbha,et al.  Sampling-Based Path Planning for a Visual Reconnaissance Unmanned Air Vehicle , 2012 .

[21]  Guangming Xiong,et al.  A model predictive speed tracking control approach for autonomous ground vehicles , 2017 .

[22]  Joost van de Weijer,et al.  Fast Anisotropic Gauss Filtering , 2002, ECCV.

[23]  Christos Katrakazas,et al.  Real-time motion planning methods for autonomous on-road driving: State-of-the-art and future research directions , 2015 .

[24]  Amir Khajepour,et al.  Direction-dependent optimal path planning for autonomous vehicles , 2015, Robotics Auton. Syst..

[25]  Hongling Wang,et al.  Arc-Length Parameterized Spline Curves for Real-Time Simulation , 2003 .

[26]  Weisheng Yan,et al.  Mutual Information-Based Multi-AUV Path Planning for Scalar Field Sampling Using Multidimensional RRT* , 2016, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[27]  Sisi Zlatanova,et al.  Path Planning for First Responders in the Presence of Moving Obstacles With Uncertain Boundaries , 2017, IEEE Transactions on Intelligent Transportation Systems.

[28]  Junmin Wang,et al.  $\mathcal{H}_{\infty}$ Observer Design for LPV Systems With Uncertain Measurements on Scheduling Variables: Application to an Electric Ground Vehicle , 2016, IEEE/ASME Transactions on Mechatronics.

[29]  Dirk Haehnel,et al.  Junior: The Stanford entry in the Urban Challenge , 2008 .

[30]  Yanjun Huang,et al.  Path Planning and Tracking for Vehicle Collision Avoidance Based on Model Predictive Control With Multiconstraints , 2017, IEEE Transactions on Vehicular Technology.

[31]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[32]  Rongrong Wang,et al.  Robust H∞ output-feedback control for path following of autonomous ground vehicles , 2016 .

[33]  Jianxiong Xiao,et al.  DeepDriving: Learning Affordance for Direct Perception in Autonomous Driving , 2015, 2015 IEEE International Conference on Computer Vision (ICCV).

[34]  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.

[35]  D.M. Bevly,et al.  Harmonic potential field path planning for high speed vehicles , 2008, 2008 American Control Conference.

[36]  Dongpu Cao,et al.  Development of a new integrated local trajectory planning and tracking control framework for autonomous ground vehicles , 2017 .

[37]  Ross A. Knepper,et al.  Differentially constrained mobile robot motion planning in state lattices , 2009 .

[38]  Tran Hiep Dinh,et al.  Enhanced discrete particle swarm optimization path planning for UAV vision-based surface inspection , 2017, ArXiv.

[39]  Weiwen Deng,et al.  Dynamic Trajectory Planning for Vehicle Autonomous Driving , 2013, 2013 IEEE International Conference on Systems, Man, and Cybernetics.

[40]  Richard M. Murray,et al.  Vehicle motion planning using stream functions , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).