Cooperative Multiple Vehicle Trajectory Planning using MIQP

This paper considers the problem of cooperative trajectory planning for multiple, communicating, automated vehicles in general non-hazardous on-road scenarios. Cooperative behavior is introduced by optimizing a collective cost function for all automated vehicles. A novel approach based a Mixed-Integer Quadratic Programming is presented that guarantees to yield the globally optimal solution. Numerical experiments are provided to demonstrate the feasibility of our approach and the benefits compared to priority-based approaches and non-cooperative individual motion planning.

[1]  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).

[2]  Maria Kihl,et al.  Inter-vehicle communication systems: a survey , 2008, IEEE Communications Surveys & Tutorials.

[3]  Mikhail Gordon,et al.  Lane Change and Merge Maneuvers for Connected and Automated Vehicles: A Survey , 2016, IEEE Transactions on Intelligent Vehicles.

[4]  Ömer Sahin Tas,et al.  Rating cooperative driving: A scheme for behavior assessment , 2017, 2017 IEEE 20th International Conference on Intelligent Transportation Systems (ITSC).

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

[6]  Domitilla Del Vecchio,et al.  Least Restrictive Supervisors for Intersection Collision Avoidance: A Scheduling Approach , 2015, IEEE Transactions on Automatic Control.

[7]  David González,et al.  A Review of Motion Planning Techniques for Automated Vehicles , 2016, IEEE Transactions on Intelligent Transportation Systems.

[8]  Alberto Bemporad,et al.  Multi-automated vehicle coordination using decoupled prioritized path planning for multi-lane one- and bi-directional traffic flow control , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[9]  Florent Altché,et al.  Analysis of optimal solutions to robot coordination problems to improve autonomous intersection management policies , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[10]  Jonas Fredriksson,et al.  Longitudinal and Lateral Control for Automated Yielding Maneuvers , 2016, IEEE Transactions on Intelligent Transportation Systems.

[11]  Jonas Sjöberg,et al.  Strategic decision making for automated driving on two-lane, one way roads using model predictive control , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

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

[13]  Jean Gregoire,et al.  Priority-based intersection management with kinodynamic constraints , 2013, 2014 European Control Conference (ECC).

[14]  Domitilla Del Vecchio,et al.  Cooperative Collision Avoidance at Intersections: Algorithms and Experiments , 2013, IEEE Transactions on Intelligent Transportation Systems.

[15]  Julius Ziegler,et al.  The combinatorial aspect of motion planning: Maneuver variants in structured environments , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

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

[17]  Jürgen Beyerer,et al.  A comparison of motion planning algorithms for cooperative collision avoidance of multiple cognitive automobiles , 2011, 2011 IEEE Intelligent Vehicles Symposium (IV).

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

[19]  Hermann Winner,et al.  Three Decades of Driver Assistance Systems: Review and Future Perspectives , 2014, IEEE Intelligent Transportation Systems Magazine.

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

[21]  Karsten Lemmer,et al.  Cooperative Maneuver Planning for Cooperative Driving , 2016, IEEE Intelligent Transportation Systems Magazine.

[22]  Lei Chen,et al.  Cooperative Intersection Management: A Survey , 2016, IEEE Transactions on Intelligent Transportation Systems.

[23]  Joan García-Haro,et al.  This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination. IEEE TRANSACTIONS ON INTELLIGENT TRANSPORTATION SYSTEMS 1 Vehicular Trajectory Optimization for Cooperative Co , 2012 .

[24]  Stephen J. Wright,et al.  Numerical Optimization (Springer Series in Operations Research and Financial Engineering) , 2000 .