Optimal trajectories for time-critical street scenarios using discretized terminal manifolds

This paper deals with the trajectory generation problem faced by an autonomous vehicle in moving traffic. Being given the predicted motion of the traffic flow, the proposed semi-reactive planning strategy realizes all required long-term maneuver tasks (lane-changing, merging, distance-keeping, velocity-keeping, precise stopping, etc.) while providing short-term collision avoidance. The key to comfortable, human-like as well as physically feasible trajectories is the combined optimization of the lateral and longitudinal movements in street-relative coordinates with carefully chosen cost functionals and terminal state sets (manifolds). The performance of the approach is demonstrated in simulated traffic scenarios.

[1]  R. Bellman.  The theory of dynamic programming , 1954 .

[2]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[3]  Wook Hyun Kwon,et al.  On stability of constrained receding horizon control with finite terminal weighting matrix , 1997, 1997 European Control Conference (ECC).

[4]  K. Murphy,et al.  Path planning for autonomous vehicles driving over rough terrain , 1998, Proceedings of the 1998 IEEE International Symposium on Intelligent Control (ISIC) held jointly with IEEE International Symposium on Computational Intelligence in Robotics and Automation (CIRA) Intell.

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

[6]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[7]  Alonzo Kelly,et al.  Reactive Nonholonomic Trajectory Generation via Parametric Optimal Control , 2003, Int. J. Robotics Res..

[8]  Adolf Hermann Glattfelder,et al.  A path from antiwindup to override control , 2004 .

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

[10]  Efstathios Velenis.  Analysis and Control of High-Speed Wheeled Vehicles , 2006 .

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

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

[13]  Tobias Gindele,et al.  Team AnnieWAY's autonomous system for the 2007 DARPA Urban Challenge , 2008 .

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

[15]  Luke Fletcher,et al.  The MIT–Cornell collision and why it happened , 2008 .

[16]  Thierry Fraichard,et al.  Collision avoidance in dynamic environments: An ICS-based solution and its comparative evaluation , 2009, 2009 IEEE International Conference on Robotics and Automation.

[17]  Oliver Brock,et al.  Planning Long Dynamically-Feasible Maneuvers for Autonomous Vehicles , 2009 .

[18]  Julius Ziegler,et al.  Team AnnieWAY's Autonomous System for the DARPA Urban Challenge 2007 , 2009, The DARPA Urban Challenge.

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

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

[21]  Julius Ziegler,et al.  Fast collision checking for intelligent vehicle motion planning , 2010, 2010 IEEE Intelligent Vehicles Symposium.

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

[23]  Georg Bretthauer,et al.  Invariant Trajectory Tracking With a Full-Size Autonomous Road Vehicle , 2010, IEEE Transactions on Robotics.

[24]  Matthias Althoff,et al.  Comparison of Markov Chain Abstraction and Monte Carlo Simulation for the Safety Assessment of Autonomous Cars , 2011, IEEE Transactions on Intelligent Transportation Systems.