Path planning and integrated collision avoidance for autonomous vehicles

This paper discusses some of the current state-of-the-art and remaining challenges in research on path planning and vehicle control of autonomous vehicles. Reliable path planning is fundamental for the proper operation of an autonomous vehicle. Typically, the path planner relies on an incomplete model of the surroundings to generate a reference trajectory, used as input to a vehicle controller that tracks this reference trajectory. Depending on how much complexity is put into the path-planning block, the path planning and vehicle-control blocks can be viewed as independent of each other, connected to each other, or merged into one block. There are several types of path-planning techniques developed over the last decades, each with its own set of benefits and drawbacks. We review different techniques for path planning and trajectory tracking, and give examples of its use in relation to autonomous vehicles. We report on our own recent findings and give an outlook on potential research directions.

[1]  Francesco Borrelli,et al.  Automated driving: The role of forecasts and uncertainty - A control perspective , 2015, Eur. J. Control.

[2]  Jonathan P. How,et al.  Motion Planning in Complex Environments using Closed-loop Prediction , 2008 .

[3]  Kazuhide Okamoto,et al.  Similarity-based vehicle-motion prediction , 2017, 2017 American Control Conference (ACC).

[4]  Karl Berntorp,et al.  Hierarchical predictive control for ground-vehicle maneuvering , 2015, 2015 American Control Conference (ACC).

[5]  Jonas Sjöberg,et al.  Receding horizon maneuver generation for automated highway driving , 2015 .

[6]  Manfred Morari,et al.  Model predictive control: Theory and practice - A survey , 1989, Autom..

[7]  Anthony Stentz,et al.  The Focussed D* Algorithm for Real-Time Replanning , 1995, IJCAI.

[8]  Emilio Frazzoli,et al.  RRTX: Real-Time Motion Planning/Replanning for Environments with Unpredictable Obstacles , 2014, WAFR.

[9]  Lino Guzzella,et al.  Optimal emergency maneuvers on highways for passenger vehicles with two- and four-wheel active steering , 2010, Proceedings of the 2010 American Control Conference.

[10]  Stefano Di Cairano,et al.  Reference Tracking With Guaranteed Error Bound for Constrained Linear Systems , 2016, IEEE Transactions on Automatic Control.

[11]  Rajesh Rajamani,et al.  Vehicle dynamics and control , 2005 .

[12]  Stefano Di Cairano,et al.  Joint Decision Making and Motion Planning for Road Vehicles Using Particle Filtering , 2016 .

[13]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[14]  Stephen M. Erlien,et al.  Collision Avoidance and Stabilization for Autonomous Vehicles in Emergency Scenarios , 2017, IEEE Transactions on Control Systems Technology.

[15]  Leslie Pack Kaelbling,et al.  LQR-RRT*: Optimal sampling-based motion planning with automatically derived extension heuristics , 2012, 2012 IEEE International Conference on Robotics and Automation.

[16]  William Whittaker,et al.  Autonomous driving in urban environments: Boss and the Urban Challenge , 2008, J. Field Robotics.

[17]  Sterling J. Anderson,et al.  An optimal-control-based framework for trajectory planning, threat assessment, and semi-autonomous control of passenger vehicles in hazard avoidance scenarios , 2010 .

[18]  Lydia E. Kavraki,et al.  Randomized preprocessing of configuration for fast path planning , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[19]  Karl Berntorp,et al.  Vehicle tracking control on piecewise-clothoidal trajectories by MPC with guaranteed error bounds , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[20]  E. Feron,et al.  Real-time motion planning for agile autonomous vehicles , 2000, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[21]  Emilio Frazzoli,et al.  Optimal motion planning with the half-car dynamical model for autonomous high-speed driving , 2013, 2013 American Control Conference.

[22]  Panagiotis Tsiotras,et al.  Dynamic programming guided exploration for sampling-based motion planning algorithms , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[23]  Stefano Di Cairano,et al.  The development of Model Predictive Control in automotive industry: A survey , 2012, 2012 IEEE International Conference on Control Applications.

[24]  Sven Koenig,et al.  Fast replanning for navigation in unknown terrain , 2005, IEEE Transactions on Robotics.

[25]  Luigi Glielmo,et al.  Robust vehicle lateral stabilisation via set-based methods for uncertain piecewise affine systems , 2012 .

[26]  Nils J. Nilsson,et al.  Principles of Artificial Intelligence , 1980, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[27]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[28]  Lars Petersson,et al.  Statistical Threat Assessment for General Road Scenes Using Monte Carlo Sampling , 2008, IEEE Transactions on Intelligent Transportation Systems.

[29]  Lars Nielsen,et al.  Models and methodology for optimal trajectory generation in safety-critical road–vehicle manoeuvres , 2014 .

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

[31]  Peter King,et al.  Odin: Team VictorTango's entry in the DARPA Urban Challenge , 2008, J. Field Robotics.

[32]  Ian R. Manchester,et al.  LQR-trees: Feedback Motion Planning via Sums-of-Squares Verification , 2010, Int. J. Robotics Res..

[33]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[34]  Karl Berntorp,et al.  Particle filtering for online motion planning with task specifications , 2016, 2016 American Control Conference (ACC).

[35]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[36]  D. Dolgov.  Practical Search Techniques in Path Planning for Autonomous Driving , 2008 .

[37]  John F. Canny,et al.  Planning smooth paths for mobile robots , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[38]  Ahmad A. Masoud,et al.  Kinodynamic Motion Planning , 2010, IEEE Robotics & Automation Magazine.

[39]  Dizan Vasquez,et al.  A survey on motion prediction and risk assessment for intelligent vehicles , 2014, ROBOMECH Journal.

[40]  Francesco Borrelli,et al.  Predictive Control of Autonomous Ground Vehicles With Obstacle Avoidance on Slippery Roads , 2010 .

[41]  T. Kanade,et al.  Monte Carlo road safety reasoning , 2005, IEEE Proceedings. Intelligent Vehicles Symposium, 2005..

[42]  P. Falcone,et al.  A hierarchical Model Predictive Control framework for autonomous ground vehicles , 2008, 2008 American Control Conference.

[43]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

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

[45]  Karl Berntorp,et al.  Sampling-based algorithms for optimal motion planning using closed-loop prediction , 2016, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[46]  Jur P. van den Berg,et al.  Kinodynamic RRT*: Asymptotically optimal motion planning for robots with linear dynamics , 2013, 2013 IEEE International Conference on Robotics and Automation.

[47]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .

[48]  Edsger W. Dijkstra,et al.  A note on two problems in connexion with graphs , 1959, Numerische Mathematik.

[49]  Emilio Frazzoli,et al.  Anytime Motion Planning using the RRT* , 2011, 2011 IEEE International Conference on Robotics and Automation.

[50]  Matthias Althoff,et al.  Model-Based Probabilistic Collision Detection in Autonomous Driving , 2009, IEEE Transactions on Intelligent Transportation Systems.

[51]  Panagiotis Tsiotras,et al.  Use of relaxation methods in sampling-based algorithms for optimal motion planning , 2013, 2013 IEEE International Conference on Robotics and Automation.

[52]  Kostas E. Bekris,et al.  Sparse Methods for Efficient Asymptotically Optimal Kinodynamic Planning , 2014, WAFR.

[53]  H. Eric Tseng,et al.  A tube-based robust nonlinear predictive control approach to semiautonomous ground vehicles , 2014 .

[54]  H. E. Tseng,et al.  Linear model predictive control for lane keeping and obstacle avoidance on low curvature roads , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[55]  Karl Berntorp,et al.  Path planning using positive invariant sets , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

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

[57]  Francesco Borrelli,et al.  Predictive Active Steering Control for Autonomous Vehicle Systems , 2007, IEEE Transactions on Control Systems Technology.

[58]  John H. Reif,et al.  Complexity of the mover's problem and generalizations , 1979, 20th Annual Symposium on Foundations of Computer Science (sfcs 1979).