Trajectory Planning for Autonomous High-Speed Overtaking using MPC with Terminal Set Constraints

With self-driving vehicles being pushed towards the main-stream, there is an increasing motivation towards development of systems that autonomously perform manoeuvres involving combined lateral-longitudinal motion (e.g., lane-change, merge, overtake, etc.). This paper presents a situational awareness and trajectory planning framework for performing autonomous overtaking manoeuvres. A combination of a potential field-like function and reachability sets of a vehicle are used to identify safe zones on a road that the vehicle can navigate towards. These safe zones are provided to a model predictive controller as reference to generate feasible trajectories for a vehicle. The strengths of the proposed framework are: (i) it is free from non-convex collision avoidance constraints, (ii) it ensures feasibility of trajectory, and (iii) it is real-time implementable. A proof of concept simulation is shown to demonstrate the ability to plan trajectories for high-speed overtaking manoeuvres.

[1]  Francesco Borrelli,et al.  Predictive control for agile semi-autonomous ground vehicles using motion primitives , 2012, 2012 American Control Conference (ACC).

[2]  Eduardo F. Camacho,et al.  MPC for tracking piecewise constant references for constrained linear systems , 2008, Autom..

[3]  Shohei Kitazawa,et al.  Control target algorithm for direction control of autonomous vehicles in consideration of mutual accordance in mixed traffic conditions , 2016 .

[4]  Rajesh Rajamani.  Lateral Vehicle Dynamics , 2012 .

[5]  S. Seethalakshmi.  Highly Automated Driving on Highways Based on Legal Safety , 2015 .

[6]  Christos Katrakazas,et al.  Real-time motion planning methods for autonomous on-road driving: State-of-the-art and future research directions , 2015 .

[7]  Mehrdad Dianati,et al.  Trajectory planning and tracking for autonomous overtaking: State-of-the-art and future prospects , 2018, Annu. Rev. Control..

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

[9]  Jeroen Ploeg,et al.  Cooperative adaptive cruise control: An artificial potential field approach , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[10]  Manfred Morari,et al.  Autonomous vehicle steering using explicit LPV-MPC , 2009, 2009 European Control Conference (ECC).

[11]  Beno Benhabib,et al.  GUIDANCE-BASED ON-LINE MOTION PLANNING FOR AUTONOMOUS HIGHWAY OVERTAKING , 2008 .

[12]  Walter Lucia,et al.  A Receding Horizon Control Strategy for Autonomous Vehicles in Dynamic Environments , 2016, IEEE Transactions on Control Systems Technology.

[13]  Eleni I. Vlahogianni,et al.  Modeling duration of overtaking in two lane highways , 2013 .

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

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

[16]  Michel Parent,et al.  Cooperative autonomous driving: intelligent vehicles sharing city roads , 2005, IEEE Robotics & Automation Magazine.

[17]  Jonas Sjöberg,et al.  Receding horizon maneuver generation for automated highway driving , 2015 .

[18]  Karel Brookhuis,et al.  Opportunities of advanced driver assistance systems towards overtaking , 2005 .

[19]  Jan M. Maciejowski,et al.  Predictive control : with constraints , 2002 .

[20]  Joel W. Burdick,et al.  Artificial potential functions for highway driving with collision avoidance , 2008, 2008 IEEE International Conference on Robotics and Automation.

[21]  Pradeep K. Khosla,et al.  Manipulator control with superquadric artificial potential functions: theory and experiments , 1990, IEEE Trans. Syst. Man Cybern..

[22]  Nanning Zheng,et al.  A fast RRT algorithm for motion planning of autonomous road vehicles , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).