A Review of Motion Planning Techniques for Automated Vehicles

Intelligent vehicles have increased their capabilities for highly and, even fully, automated driving under controlled environments. Scene information is received using onboard sensors and communication network systems, i.e., infrastructure and other vehicles. Considering the available information, different motion planning and control techniques have been implemented to autonomously driving on complex environments. The main goal is focused on executing strategies to improve safety, comfort, and energy optimization. However, research challenges such as navigation in urban dynamic environments with obstacle avoidance capabilities, i.e., vulnerable road users (VRU) and vehicles, and cooperative maneuvers among automated and semi-automated vehicles still need further efforts for a real environment implementation. This paper presents a review of motion planning techniques implemented in the intelligent vehicles literature. A description of the technique used by research teams, their contributions in motion planning, and a comparison among these techniques is also presented. Relevant works in the overtaking and obstacle avoidance maneuvers are presented, allowing the understanding of the gaps and challenges to be addressed in the next years. Finally, an overview of future research direction and applications is given.

[1]  Jonathan P. How,et al.  Motion planning for urban driving using RRT , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Martin Lauer,et al.  Team AnnieWAY's Entry to the 2011 Grand Cooperative Driving Challenge , 2012, IEEE Transactions on Intelligent Transportation Systems.

[3]  Ariel Felner,et al.  Theta*: Any-Angle Path Planning on Grids , 2007, AAAI.

[4]  David González,et al.  Continuous curvature planning with obstacle avoidance capabilities in urban scenarios , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

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

[6]  Luke Fletcher,et al.  The MIT - Cornell Collision and Why It Happened , 2009, The DARPA Urban Challenge.

[7]  Ellen van Nunen,et al.  Cooperative Competition for Future Mobility , 2012, IEEE Transactions on Intelligent Transportation Systems.

[8]  Joshué Pérez,et al.  Trajectory generator for autonomous vehicles in urban environments , 2013, 2013 IEEE International Conference on Robotics and Automation.

[9]  Alberto Broggi,et al.  Moving from analog to digital driving , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

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

[11]  Jishun Li,et al.  Automatic parking path optimization based on Bezier curve fitting , 2012, 2012 IEEE International Conference on Automation and Logistics.

[12]  Venkataraman Sundareswaran,et al.  TerraMax™: Team Oshkosh urban robot , 2008 .

[13]  Nick McKeown,et al.  Automated vehicle control developments in the PATH program , 1991 .

[14]  Kevin Warwick,et al.  Planning of multiple autonomous vehicles using RRT , 2011, 2011 IEEE 10th International Conference on Cybernetic Intelligent Systems (CIS).

[15]  Rui Rodrigues,et al.  Smooth trajectory planning for fully automated passengers vehicles - spline and clothoid based methods and its simulation , 2006, ICINCO-RA.

[16]  Ragunathan Rajkumar,et al.  Towards a viable autonomous driving research platform , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[17]  Lakhmi C. Jain,et al.  Path Planning and Obstacle Avoidance for Autonomous Mobile Robots: A Review , 2006, KES.

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

[19]  L. Shepp,et al.  OPTIMAL PATHS FOR A CAR THAT GOES BOTH FORWARDS AND BACKWARDS , 1990 .

[20]  N. Montés,et al.  Trajectory Generation based on Rational Bezier Curves as Clothoids , 2007, 2007 IEEE Intelligent Vehicles Symposium.

[21]  Sebastian Thrun,et al.  Path Planning for Autonomous Vehicles in Unknown Semi-structured Environments , 2010, Int. J. Robotics Res..

[22]  J. M. Chacón,et al.  Polynomial approximation to clothoids via s-power series , 2003, Comput. Aided Des..

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

[24]  Cris Koutsougeras,et al.  KAT-5: Robust systems for autonomous vehicle navigation in challenging and unknown terrain , 2006, J. Field Robotics.

[25]  Alonzo Kelly,et al.  State space sampling of feasible motions for high‐performance mobile robot navigation in complex environments , 2008, J. Field Robotics.

[26]  Alberto Broggi,et al.  PROUD-Public road urban driverless test: Architecture and results , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[27]  Roland Siegwart,et al.  Toward automated driving in cities using close-to-market sensors: An overview of the V-Charge Project , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[28]  Remo Pillat,et al.  A practical approach to robotic design for the DARPA Urban Challenge , 2008, J. Field Robotics.

[29]  Georgios C. Anagnostopoulos,et al.  Knowledge-Based Intelligent Information and Engineering Systems , 2003, Lecture Notes in Computer Science.

[30]  Nidhi Kalra,et al.  Autonomous Vehicle Technology: A Guide for Policymakers , 2014 .

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

[32]  Byungkyu Brian Park,et al.  Development and Evaluation of a Cooperative Vehicle Intersection Control Algorithm Under the Connected Vehicles Environment , 2012, IEEE Transactions on Intelligent Transportation Systems.

[33]  Karl Murphy,et al.  Driving autonomously off-road up to 35 km/h , 2000, Proceedings of the IEEE Intelligent Vehicles Symposium 2000 (Cat. No.00TH8511).

[34]  Eric Krotkov,et al.  The DARPA PerceptOR evaluation experiments , 2007, Auton. Robots.

[35]  Ephrahim Garcia,et al.  Team Cornell's Skynet: Robust perception and planning in an urban environment , 2008, J. Field Robotics.

[36]  Kyu Ho Park,et al.  A fast path planning by path graph optimization , 2003, IEEE Trans. Syst. Man Cybern. Part A.

[37]  Alberto Broggi,et al.  Extensive Tests of Autonomous Driving Technologies , 2013, IEEE Transactions on Intelligent Transportation Systems.

[38]  Jan Becker,et al.  Vehicle guidance for an autonomous vehicle , 1999, Proceedings 199 IEEE/IEEJ/JSAI International Conference on Intelligent Transportation Systems (Cat. No.99TH8383).

[39]  Ivan Petrovic,et al.  Real-time Approximation of Clothoids With Bounded Error for Path Planning Applications , 2014, IEEE Transactions on Robotics.

[40]  Leopoldo Armesto,et al.  Real-time clothoid approximation by Rational Bezier curves , 2008, 2008 IEEE International Conference on Robotics and Automation.

[41]  AhujaNarendra,et al.  Gross motion planninga survey , 1992 .

[42]  Alonzo Kelly,et al.  Toward Reliable Off Road Autonomous Vehicles Operating in Challenging Environments , 2006, Int. J. Robotics Res..

[43]  Jin-Woo Lee,et al.  Motion planning for autonomous driving with a conformal spatiotemporal lattice , 2011, 2011 IEEE International Conference on Robotics and Automation.

[44]  Aurelio Piazzi,et al.  THE ARGO AUTONOMOUS VEHICLE'S VISION AND CONTROL SYSTEMS , 1999 .

[45]  Sebastian Thrun,et al.  Towards fully autonomous driving: Systems and algorithms , 2011, 2011 IEEE Intelligent Vehicles Symposium (IV).

[46]  Zvi Shiller,et al.  Dynamic motion planning of autonomous vehicles , 1991, IEEE Trans. Robotics Autom..

[47]  Sebastian Thrun,et al.  Anytime search in dynamic graphs , 2008, Artif. Intell..

[48]  U. Ozguner,et al.  A parking algorithm for an autonomous vehicle , 2008, 2008 IEEE Intelligent Vehicles Symposium.

[49]  Christian Laugier,et al.  Probabilistic motion planning among moving obstacles following typical motion patterns , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[50]  Venkataraman Sundareswaran,et al.  TerraMax: Team Oshkosh Urban Robot , 2009, The DARPA Urban Challenge.

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

[52]  Alonzo Kelly,et al.  Efficient Constrained Path Planning via Search in State Lattices , 2005 .

[53]  Narendra Ahuja,et al.  Gross motion planning—a survey , 1992, CSUR.

[54]  Mark E. Campbell,et al.  Contingency Planning Over Probabilistic Obstacle Predictions for Autonomous Road Vehicles , 2013, IEEE Transactions on Robotics.

[55]  Jing Ren,et al.  Modified Newton's method applied to potential field-based navigation for mobile robots , 2006, IEEE Transactions on Robotics.

[56]  Wolfram Burgard,et al.  Autonomous driving in a multi-level parking structure , 2009, 2009 IEEE International Conference on Robotics and Automation.

[57]  Qingquan Li,et al.  Hierarchical route planning based on taxi GPS-trajectories , 2009, 2009 17th International Conference on Geoinformatics.

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

[59]  Luca Gatti,et al.  VIAC: An out of ordinary experiment , 2011, 2011 IEEE Intelligent Vehicles Symposium (IV).

[60]  T. Gindele,et al.  A robust algorithm for handling moving traffic in urban scenarios , 2008, 2008 IEEE Intelligent Vehicles Symposium.

[61]  Jang-Myung Lee,et al.  A precise curved motion planning for a differential driving mobile robot , 2008 .

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

[63]  Dereck S. Meek,et al.  Planar G 2 transition curves composed of cubic Bézier spiral segments , 2003 .

[64]  Julius Ziegler,et al.  Spatiotemporal state lattices for fast trajectory planning in dynamic on-road driving scenarios , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[65]  William Whittaker,et al.  A robust approach to high‐speed navigation for unrehearsed desert terrain , 2006, J. Field Robotics.

[66]  Alberto Broggi,et al.  Autonomous vehicles control in the VisLab Intercontinental Autonomous Challenge , 2012, Annu. Rev. Control..

[67]  Dirk Langer,et al.  Up to the limits: Autonomous Audi TTS , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[68]  Anthony J. Barbera,et al.  Trajectory Generation for an On-Road Autonomous Vehicle , 2006 .

[69]  Jung-Shan Lin,et al.  Nonlinear control design of anti-lock braking systems with assistance of active suspension , 2007 .

[70]  Joshué Pérez,et al.  Dynamic trajectory generation using continuous-curvature algorithms for door to door assistance vehicles , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[71]  K.M. Malone,et al.  Cybernetic transport systems: lessons to be learned from user needs analysis and field experience , 2002, Intelligent Vehicle Symposium, 2002. IEEE.

[72]  Sterling J. Anderson,et al.  Constraint-based planning and control for safe, semi-autonomous operation of vehicles , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[73]  Alberto Broggi,et al.  Development of the control system for the Vislab Intercontinental Autonomous Challenge , 2010, 13th International IEEE Conference on Intelligent Transportation Systems.

[74]  Reinhold Behringer,et al.  Autonomous road vehicle guidance from autobahnen to narrow curves , 1998, IEEE Trans. Robotics Autom..

[75]  R. Murray,et al.  Optimization-Based Navigation for the DARPA Grand Challenge , 2006 .

[76]  Maxim Likhachev,et al.  Time-bounded lattice for efficient planning in dynamic environments , 2009, 2009 IEEE International Conference on Robotics and Automation.

[77]  Sebastian Thrun,et al.  PAO for planning with hidden state , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[78]  Jin-Woo Lee,et al.  A unified framework of the automated lane centering/changing control for motion smoothness adaptation , 2012, 2012 15th International IEEE Conference on Intelligent Transportation Systems.

[79]  Dereck S. Meek,et al.  A controlled clothoid spline , 2005, Comput. Graph..

[80]  John M. Dolan,et al.  Toward human-like motion planning in urban environments , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[81]  Jan P van Dijke,et al.  CityMobil, Advanced Transport for the Urban Environment , 2009 .

[82]  Salah Sukkarieh,et al.  An Analytical Continuous-Curvature Path-Smoothing Algorithm , 2010, IEEE Transactions on Robotics.

[83]  Rida T. Farouki,et al.  Pythagorean-Hodograph Curves , 2002, Handbook of Computer Aided Geometric Design.

[84]  Lucia Romani,et al.  The conversion matrix between uniform B-spline and Be'zier representations , 2004, Comput. Aided Geom. Des..

[85]  Thierry Fraichard,et al.  From Reeds and Shepp's to continuous-curvature paths , 1999, IEEE Transactions on Robotics.

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

[87]  Alberto Broggi,et al.  The TerraMax autonomous vehicle , 2006, J. Field Robotics.

[88]  Sebastian Thrun,et al.  Stanley: The robot that won the DARPA Grand Challenge , 2006, J. Field Robotics.

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

[90]  Julius Ziegler,et al.  Optimal trajectories for time-critical street scenarios using discretized terminal manifolds , 2012, Int. J. Robotics Res..

[91]  Christian Laugier,et al.  Probabilistic navigation in dynamic environment using Rapidly-exploring Random Trees and Gaussian processes , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[92]  Kenjiro T. Miura,et al.  An approximation approach of the clothoid curve defined in the interval [0, /2] and its offset by free-form curves , 2001, Comput. Aided Des..

[93]  Jee-Hwan Ryu,et al.  Development and Experiences of an Autonomous Vehicle for High-Speed Navigation and Obstacle Avoidance , 2013, Frontiers of Intelligent Autonomous Systems.

[94]  Myoungho Sunwoo,et al.  Development of Autonomous Car—Part II: A Case Study on the Implementation of an Autonomous Driving System Based on Distributed Architecture , 2015, IEEE Transactions on Industrial Electronics.

[95]  Joel W. Burdick,et al.  Alice: An information‐rich autonomous vehicle for high‐speed desert navigation , 2006, J. Field Robotics.

[96]  Julius Ziegler,et al.  Team AnnieWAY's autonomous system for the 2007 DARPA Urban Challenge , 2008, J. Field Robotics.

[97]  Steven E Shladover THE GM-PATH PLATOON SCENARIO , 1997 .

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

[99]  Emilio Frazzoli,et al.  Optimal kinodynamic motion planning using incremental sampling-based methods , 2010, 49th IEEE Conference on Decision and Control (CDC).

[100]  Plamen Petrov,et al.  Modeling and Nonlinear Adaptive Control for Autonomous Vehicle Overtaking , 2014, IEEE Transactions on Intelligent Transportation Systems.

[101]  Hongbin Zha,et al.  A real-time motion planner with trajectory optimization for autonomous vehicles , 2012, 2012 IEEE International Conference on Robotics and Automation.

[102]  Dariu Gavrila,et al.  Active Pedestrian Safety by Automatic Braking and Evasive Steering , 2011, IEEE Transactions on Intelligent Transportation Systems.

[103]  Benoit Vanholme,et al.  Maneuver-Based Trajectory Planning for Highly Autonomous Vehicles on Real Road With Traffic and Driver Interaction , 2010, IEEE Transactions on Intelligent Transportation Systems.

[104]  Michel Parent Advanced Urban Transport: Automation Is on the Way , 2007, IEEE Intelligent Systems.

[105]  Tatsuya Suzuki,et al.  Trajectory planning for automated parking using multi-resolution state roadmap considering non-holonomic constraints , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[106]  Milan Simic,et al.  Sampling-Based Robot Motion Planning: A Review , 2014, IEEE Access.

[107]  Steven M. LaValle,et al.  Optimal motion planning for multiple robots having independent goals , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[108]  Steven E. Shladover,et al.  PATH at 20—History and Major Milestones , 2007, IEEE Transactions on Intelligent Transportation Systems.

[109]  John M. Dolan,et al.  On-Road Motion Planning for Autonomous Vehicles , 2012, ICIRA.

[110]  Vicente Milanés Montero,et al.  Cooperative Adaptive Cruise Control in Real Traffic Situations , 2014, IEEE Transactions on Intelligent Transportation Systems.

[111]  David González,et al.  Control architecture for Cybernetic Transportation Systems in urban environments , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

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

[113]  Andreas Eidehall,et al.  On path planning methods for automotive collision avoidance , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[114]  Mark E. Campbell,et al.  Discrete and Continuous, Probabilistic Anticipation for Autonomous Robots in Urban Environments , 2010, IEEE Transactions on Robotics.

[115]  Julius Ziegler,et al.  Trajectory planning for Bertha — A local, continuous method , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[116]  R. Curry,et al.  Path Planning Based on Bézier Curve for Autonomous Ground Vehicles , 2008, Advances in Electrical and Electronics Engineering - IAENG Special Edition of the World Congress on Engineering and Computer Science 2008.

[117]  Anthony Stentz,et al.  Using interpolation to improve path planning: The Field D* algorithm , 2006, J. Field Robotics.

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

[119]  John M. Dolan,et al.  Focused Trajectory Planning for autonomous on-road driving , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[120]  Charles E. Thorpe,et al.  AUTOMATED HIGHWAYS AND THE FREE AGENT DEMONSTRATION , 1998 .

[121]  Seiichi Mita,et al.  Bézier curve based path planning for autonomous vehicle in urban environment , 2010, 2010 IEEE Intelligent Vehicles Symposium.

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

[123]  Myoungho Sunwoo,et al.  Development of Autonomous Car—Part I: Distributed System Architecture and Development Process , 2014, IEEE Transactions on Industrial Electronics.

[124]  Saïd Mammar,et al.  Automatic parallel parking with geometric continuous-curvature path planning , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[125]  Roland Siegwart,et al.  On the Application of the D* Search Algorithm to Time-Based Planning on Lattice Graphs , 2009, ECMR.

[126]  Daniel D. Lee,et al.  Little Ben: The Ben Franklin Racing Team's entry in the 2007 DARPA Urban Challenge , 2008, J. Field Robotics.

[127]  Jonathan P. How,et al.  Threat-aware path planning in uncertain urban environments , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[128]  Maxim Likhachev,et al.  Motion planning in urban environments , 2008, J. Field Robotics.

[129]  Maxim Likhachev,et al.  Planning Long Dynamically Feasible Maneuvers for Autonomous Vehicles , 2008, Int. J. Robotics Res..

[130]  Jing-Fu Liu,et al.  Development of an automatic parking system for vehicle , 2008, 2008 IEEE Vehicle Power and Propulsion Conference.

[131]  Julius Ziegler,et al.  Making Bertha Drive—An Autonomous Journey on a Historic Route , 2014, IEEE Intelligent Transportation Systems Magazine.

[132]  J. Christian Gerdes,et al.  Autonomous Vehicle Control at the Limits of Handling , 2012 .

[133]  Fawzi Nashashibi,et al.  Adaptive steering control for autonomous lane change maneuver , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[134]  J. Schroder,et al.  Navigating car-like robots in unstructured environments using an obstacle sensitive cost function , 2008, 2008 IEEE Intelligent Vehicles Symposium.

[135]  Fawzi Nashashibi,et al.  An on-demand personal automated transport system: The CityMobil demonstration in La Rochelle , 2011, 2011 IEEE Intelligent Vehicles Symposium (IV).

[136]  Alonzo Kelly,et al.  Optimal Rough Terrain Trajectory Generation for Wheeled Mobile Robots , 2007, Int. J. Robotics Res..

[137]  Håkan Jonsson,et al.  Planning Smooth and Obstacle-Avoiding B-Spline Paths for Autonomous Mining Vehicles , 2010, IEEE Transactions on Automation Science and Engineering.

[138]  Saïd Mammar,et al.  Geometric continuous-curvature path planning for automatic parallel parking , 2013, 2013 10th IEEE INTERNATIONAL CONFERENCE ON NETWORKING, SENSING AND CONTROL (ICNSC).

[139]  Aurelio Piazzi,et al.  Quintic G2-splines for the iterative steering ofvision-based autonomous vehicles , 2002, IEEE Trans. Intell. Transp. Syst..

[140]  Fabio M. Marchese,et al.  Multiple Mobile Robots Path-Planning with MCA , 2006, International Conference on Autonomic and Autonomous Systems (ICAS'06).

[141]  Tarak Gandhi,et al.  Pedestrian Protection Systems: Issues, Survey, and Challenges , 2007, IEEE Transactions on Intelligent Transportation Systems.

[142]  Werner Huber,et al.  Experience, Results and Lessons Learned from Automated Driving on Germany's Highways , 2015, IEEE Intelligent Transportation Systems Magazine.

[143]  Edward Jones,et al.  Vision-based detection and tracking of vehicles to the rear with perspective correction in low-light conditions , 2011 .

[144]  Rahul Kala,et al.  Multi-Level Planning for Semi-autonomous Vehicles in Traffic Scenarios Based on Separation Maximization , 2013, J. Intell. Robotic Syst..

[145]  Sebastian Thrun,et al.  Autonomous driving in semi-structured environments: Mapping and planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[146]  Myoungho Sunwoo,et al.  Overall Reviews of Autonomous Vehicle A1 - System Architecture and Algorithms , 2013 .