Computationally Efficient Autonomous Overtaking on Highways

This paper studies the problem of optimal overtaking of a slow-moving leading vehicle in the presence of oncoming and/or adjacent vehicles with varying but known longitudinal speeds. A computationally efficient modeling approach is introduced, in which the overtaking problem is formulated by sampling in relative distance to the leading vehicle, replacing velocity state with its inverse and utilizing a nonlinear change of control variables. These three steps achieve a computationally efficient nonlinear control problem that can be solved using the sequential quadratic programming. Measures have been taken to ensure the feasibility of the nonlinear problem, even when the sequential quadratic programming iterates are stopped prematurely. A case study is presented, where this new formulation is compared with the previously published formulations in terms of solution quality and computation time.

[1]  Paul T. Boggs,et al.  Sequential Quadratic Programming , 1995, Acta Numerica.

[2]  A. Tits,et al.  Nonlinear Equality Constraints in Feasible Sequential Quadratic Programming , 1996 .

[3]  Gerardus Sierksma,et al.  Linear and integer programming - theory and practice , 1999, Pure and applied mathematics.

[4]  Craig T. Lawrence,et al.  A Computationally Efficient Feasible Sequential Quadratic Programming Algorithm , 2000, SIAM J. Optim..

[5]  D. Casanova,et al.  On minimum time vehicle manoeuvring: the theoretical optimal lap , 2000 .

[6]  Moritz Diehl,et al.  Real-Time Optimization for Large Scale Nonlinear Processes , 2001 .

[7]  Tzila Shamir,et al.  How should an autonomous vehicle overtake a slower moving vehicle: design and analysis of an optimal trajectory , 2004, IEEE Transactions on Automatic Control.

[8]  J. Lofberg,et al.  YALMIP : a toolbox for modeling and optimization in MATLAB , 2004, 2004 IEEE International Conference on Robotics and Automation (IEEE Cat. No.04CH37508).

[9]  Francesco Borrelli,et al.  MPC-Based Approach to Active Steering for Autonomous Vehicle Systems , 2005 .

[10]  Masao Fukushima,et al.  An SQP-type algorithm for nonlinear second-order cone programs , 2007, Optim. Lett..

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

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

[13]  Faraz Kunwar,et al.  Autonomous vehicle overtaking- an online solution , 2009, 2009 IEEE International Conference on Automation and Logistics.

[14]  Magnus Egerstedt,et al.  Autonomous driving in urban environments: approaches, lessons and challenges , 2010, Philosophical Transactions of the Royal Society A: Mathematical, Physical and Engineering Sciences.

[15]  Jonas Sjöberg,et al.  Predictive manoeuvre generation for automated driving , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[16]  Stephen P. Boyd,et al.  ECOS: An SOCP solver for embedded systems , 2013, 2013 European Control Conference (ECC).

[17]  Daniel J. Fagnant,et al.  Preparing a Nation for Autonomous Vehicles: Opportunities, Barriers and Policy Recommendations , 2015 .

[18]  Kazuma Sekiguchi,et al.  Real-time model predictive obstacle avoidance control for vehicles with reduced computational effort using constraints of prohibited region , 2015 .

[19]  Jonas Sjöberg,et al.  Convex modeling of conflict resolution at traffic intersections , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[20]  Jonas Sjöberg,et al.  Predictive cruise control with autonomous overtaking , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[21]  Johan Karlsson,et al.  Temporal vs. spatial formulation of autonomous overtaking algorithms , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

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

[23]  Nikolaos V. Sahinidis,et al.  Domain reduction techniques for global NLP and MINLP optimization , 2017, Constraints.

[24]  Luigi del Re,et al.  Efficient mixed integer programming for autonomous overtaking , 2017, 2017 American Control Conference (ACC).

[25]  Trent Victor,et al.  When Autonomous Vehicles Are Introduced on a Larger Scale in the Road Transport System: The Drive Me Project , 2017 .

[26]  Henk Wymeersch,et al.  Traffic Coordination at Road Intersections: Autonomous Decision-Making Algorithms Using Model-Based Heuristics , 2017, IEEE Intelligent Transportation Systems Magazine.

[27]  Johan Karlsson,et al.  Comparison between mixed-integer and second order cone programming for autonomous overtaking , 2018, 2018 European Control Conference (ECC).