Optimization-Based Maneuver Automata for Cooperative Trajectory Planning of Autonomous Vehicles

In this paper, a major challenge in the field of trajectory planning for autonomous on-road vehicles is addressed: to calculate trajectories efficiently and reliably. The proposed method is based on a cooperative maneuver automaton, in which each maneuver is formulated as a discrete-time hybrid automaton that defines constraints on the behavior of a group of autonomous vehicles. For trajectory planning, these constraints enter an optimal control problem, which is formulated as a Mixed-Integer Quadratic Program (MIQP). Despite good practical performance, these programs have adverse worst-case run-time properties, which, however, are improved by the proposed approach. Also, calculation of controllable sets for the hybrid automata allows to determine both the feasibility of an optimal control problem for a given initial state and the required time to complete the maneuver in advance- without solving the optimization problem. The efficacy of the proposed method is demonstrated in an example scenario.

[1]  B. Moor,et al.  Mixed integer programming for multi-vehicle path planning , 2001, 2001 European Control Conference (ECC).

[2]  Florent Altché,et al.  Optimal trajectory planning for autonomous driving integrating logical constraints: An MIQP perspective , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

[3]  Emilio Frazzoli,et al.  A hybrid control architecture for aggressive maneuvering of autonomous helicopters , 1999, Proceedings of the 38th IEEE Conference on Decision and Control (Cat. No.99CH36304).

[4]  Alberto Bemporad,et al.  Predictive Control for Linear and Hybrid Systems , 2017 .

[5]  Matthias Althoff,et al.  Driving strategy selection for cooperative vehicles using maneuver templates , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[6]  Alexandre M. Bayen,et al.  Aircraft Autolander Safety Analysis Through Optimal Control-Based Reach Set Computation , 2007 .

[7]  Claire J. Tomlin,et al.  Design of guaranteed safe maneuvers using reachable sets: Autonomous quadrotor aerobatics in theory and practice , 2010, 2010 IEEE International Conference on Robotics and Automation.

[8]  S. Shankar Sastry,et al.  Reachability calculations for automated aerial refueling , 2008, 2008 47th IEEE Conference on Decision and Control.

[9]  Munther A. Dahleh,et al.  Maneuver-based motion planning for nonlinear systems with symmetries , 2005, IEEE Transactions on Robotics.

[10]  S.S. Sastry,et al.  Deciding to land a UAV safely in real time , 2005, Proceedings of the 2005, American Control Conference, 2005..

[11]  Olaf Stursberg,et al.  Cooperative driving using a hierarchy of mixed-integer programming and tracking control , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[12]  Olaf Stursberg,et al.  Efficient Representation and Computation of Reachable Sets for Hybrid Systems , 2003, HSCC.

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

[14]  Thi Xuan Thao Dang.  Verification and Synthesis of Hybrid Systems , 2000 .

[15]  Matthias Althoff,et al.  Formal verification of maneuver automata for parameterized motion primitives , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Matthias Althoff,et al.  Convex Interpolation Control with Formal Guarantees for Disturbed and Constrained Nonlinear Systems , 2017, HSCC.

[17]  Manfred Morari,et al.  Multi-Parametric Toolbox 3.0 , 2013, 2013 European Control Conference (ECC).