Model predictive control for autonomous and cooperative driving. (Commande prédictive pour conduite autonome et coopérative)

Autonomous driving has been gaining more and more attention in the last decades, thanks to its positive social-economic impacts including the enhancement of traffic efficiency and the reduction of road accidents. A number of research institutes and companies have tested autonomous vehicles in traffic, accumulating tens of millions of kilometers traveled in autonomous driving. With the vision of massive deployment of autonomous vehicles, researchers have also started to envision cooperative strategies among autonomous vehicles. This thesis deals with the control architecture design of individual autonomous vehicles and cooperative autonomous vehicles. Model Predictive Control (MPC), thanks to its efficiency and versatility, is chosen as the building block for various control architectures proposed in this thesis. In more detail, this thesis first presents a classical hierarchical control architecture for individual vehicle control that decomposes the controller into a motion planner and a tracking controller, both using nonlinear MPC. In a second step, we analyze the inability of the proposed planner in handling logical constraints raised from traffic rules and multiple maneuver variants, and propose a hybrid MPC based motion planner that solves this issue. We then consider the convoy control problem of autonomous vehicles in which multiple vehicles maintain a formation during autonomous driving. A hierarchical formation control architecture is proposed composing of a convoy supervisor and local MPC based vehicle controllers. Finally, we consider the problem of coordinating a group of autonomous vehicles at an intersection without traffic lights. A hierarchical architecture composed of an intersection controller and multiple local vehicle controllers is proposed to allow vehicles to cross the intersection smoothly and safely.

[1]  Edwin Olson,et al.  Toward integrated motion planning and control using potential fields and torque-based steering actuation for autonomous driving , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[2]  Amir Rahmani,et al.  Road-following formation control of autonomous ground vehicles , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[3]  Nanning Zheng,et al.  Efficient Sampling-Based Motion Planning for On-Road Autonomous Driving , 2015, IEEE Transactions on Intelligent Transportation Systems.

[4]  Qi Zhu,et al.  A practical trajectory planning framework for autonomous ground vehicles driving in urban environments , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

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

[6]  Olivier Michel,et al.  Cyberbotics Ltd. Webots™: Professional Mobile Robot Simulation , 2004, ArXiv.

[7]  Francesco Borrelli,et al.  Manoeuvre generation and control for automated highway driving , 2014 .

[8]  Anis Laouiti,et al.  Cybercar Cooperation for Safe Intersections , 2006, 2006 IEEE Intelligent Transportation Systems Conference.

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

[10]  David Q. Mayne,et al.  Constrained model predictive control: Stability and optimality , 2000, Autom..

[11]  Jin-Woo Lee,et al.  Motion planning for autonomous driving with a conformal spatiotemporal lattice , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

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

[14]  Jonathan P. How,et al.  Receding horizon control of autonomous aerial vehicles , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[15]  Andreas Kugi,et al.  A new flatness-based control of lateral vehicle dynamics , 2008 .

[16]  M. Fliess,et al.  Flatness and defect of non-linear systems: introductory theory and examples , 1995 .

[17]  Vadim I. Utkin,et al.  Linear and nonlinear controller design for robust automatic steering , 1995, IEEE Trans. Control. Syst. Technol..

[18]  Wolfram Burgard,et al.  Kinodynamic motion planning for mobile robots using splines , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Francesco Borrelli,et al.  A collision avoidance system at intersections using Robust Model Predictive Control , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[20]  Julius Ziegler,et al.  Making Bertha Drive—An Autonomous Journey on a Historic Route , 2014, IEEE Intelligent Transportation Systems Magazine.

[21]  J. Richalet,et al.  Model predictive heuristic control: Applications to industrial processes , 1978, Autom..

[22]  西崎 一郎,et al.  数理計画法入門 = Introduction to mathematical programming , 2014 .

[23]  E. Feron,et al.  Safe receding horizon path planning for autonomous vehicles , 2002 .

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

[25]  Ali Marjovi,et al.  Distributed graph-based convoy control for networked intelligent vehicles , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[26]  L. Magni,et al.  Stability margins of nonlinear receding-horizon control via inverse optimality , 1997 .

[27]  Yizhou Wang,et al.  Autonomous lane-change controller via mixed logical dynamical , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[28]  Ali Marjovi,et al.  Network of automated vehicles: The AutoNet2030 vision , 2014 .

[29]  B. J. Harker PROMOTE-CHAUFFEUR II & 5.8 GHz vehicle to vehicle communications system , 2001 .

[30]  John M. Dolan,et al.  Motion planning under uncertainty for on-road autonomous driving , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[31]  Panganamala Ramana Kumar,et al.  An MPC-Based Approach to Provable System-Wide Safety and Liveness of Autonomous Ground Traffic , 2014, IEEE Transactions on Automatic Control.

[32]  Francesco Borrelli,et al.  Hybrid Decentralized Control of Large Scale Systems , 2005, HSCC.

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

[34]  Sebastian Engell,et al.  Multi-stage nonlinear model predictive control applied to a semi-batch polymerization reactor under uncertainty , 2013 .

[35]  David González,et al.  Continuous curvature planning with obstacle avoidance capabilities in urban scenarios , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[36]  Domenico Prattichizzo,et al.  Discussion of paper by , 2003 .

[37]  Jean Gregoire,et al.  Priority-based coordination of robots , 2013, ArXiv.

[38]  Omer Sahin Tas Integrating Combinatorial Reasoning and Continuous Methods for Optimal Motion Planning of Autonomous Vehicles , 2014 .

[39]  Rajesh Rajamani,et al.  Vehicle dynamics and control , 2005 .

[40]  R. Beard,et al.  VIRTUAL STRUCTURE BASED SPACECRAFT FORMATION CONTROL WITH FORMATION FEEDBACK , 2002 .

[41]  Hesham A. Rakha,et al.  Intersection management for autonomous vehicles using iCACC , 2012, 2012 15th International IEEE Conference on Intelligent Transportation Systems.

[42]  Fabien Moutarde,et al.  Priority-based coordination of autonomous and legacy vehicles at intersection , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[43]  Nick McKeown,et al.  Automated vehicle control developments in the PATH program , 1991 .

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

[45]  Karl Iagnemma,et al.  Homotopy-Based Divide-and-Conquer Strategy for Optimal Trajectory Planning via Mixed-Integer Programming , 2015, IEEE Transactions on Robotics.

[46]  Peter Stone,et al.  A Multiagent Approach to Autonomous Intersection Management , 2008, J. Artif. Intell. Res..

[47]  Christoph Stiller,et al.  Real time integrated vehicle dynamics control and trajectory planning with MPC for critical maneuvers , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[48]  Brigitte d'Andréa-Novel,et al.  A new model-free design for vehicle control and its validation through an advanced simulation platform , 2015, 2015 European Control Conference (ECC).

[49]  H. Eric Tseng,et al.  A tube-based robust nonlinear predictive control approach to semiautonomous ground vehicles , 2014 .

[50]  Kiyohito Tokuda,et al.  Vehicle control algorithms for cooperative driving with automated vehicles and intervehicle communications , 2002, IEEE Trans. Intell. Transp. Syst..

[51]  Tucker R. Balch,et al.  Behavior-based formation control for multirobot teams , 1998, IEEE Trans. Robotics Autom..

[52]  Jonathan P. How,et al.  Real-Time Motion Planning With Applications to Autonomous Urban Driving , 2009, IEEE Transactions on Control Systems Technology.

[53]  Gerhard Fettweis,et al.  Vehicular communication performance in convoys of automated vehicles , 2016, 2016 IEEE International Conference on Communications (ICC).

[54]  Yiqi Gao,et al.  Model Predictive Control for Autonomous and Semiautonomous Vehicles , 2014 .

[55]  Robert E. Tarjan,et al.  Data structures and network algorithms , 1983, CBMS-NSF regional conference series in applied mathematics.

[56]  Francesco Borrelli,et al.  Kinematic and dynamic vehicle models for autonomous driving control design , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[57]  Uwe Kiencke,et al.  Automotive Control Systems , 2005 .

[58]  András Kovács,et al.  Enhancements of V2X communication in support of cooperative autonomous driving , 2015, IEEE Communications Magazine.

[59]  Babak Tavassoli,et al.  On Model Predictive Control of Hybrid Systems , 2018, ArXiv.

[60]  Randal W. Beard,et al.  Decentralized Scheme for Spacecraft Formation Flying via the Virtual Structure Approach , 2004 .

[61]  A. Kelly,et al.  TRAJECTORY GENERATION FOR CAR-LIKE ROBOTS USING CUBIC CURVATURE POLYNOMIALS , 2001 .

[62]  David Angeli,et al.  Monotone control systems , 2003, IEEE Trans. Autom. Control..

[63]  Jianda Han,et al.  Quartic Bézier curve based trajectory generation for autonomous vehicles with curvature and velocity constraints , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[64]  D. Mayne,et al.  Min-max feedback model predictive control for constrained linear systems , 1998, IEEE Trans. Autom. Control..

[65]  Byungkyu Brian Park,et al.  Development and Evaluation of a Cooperative Vehicle Intersection Control Algorithm Under the Connected Vehicles Environment , 2012, IEEE Transactions on Intelligent Transportation Systems.

[66]  K. Schittkowski,et al.  NONLINEAR PROGRAMMING , 2022 .

[67]  Thomas Weiskircher,et al.  Predictive ADAS: A predictive trajectory guidance scheme for advanced driver assistance in public traffic , 2015, 2015 European Control Conference (ECC).

[68]  Denis Gillet,et al.  Speed profile optimization for vehicles crossing an intersection under a safety constraint , 2014, 2014 European Control Conference (ECC).

[69]  S. Zucker,et al.  Toward Efficient Trajectory Planning: The Path-Velocity Decomposition , 1986 .

[70]  Mirko Fiacchini,et al.  Invariant Approximations of the Maximal Invariant Set or "Encircling the Square" , 2008 .

[71]  A. de La Fortelle Analysis of reservation algorithms for cooperative planning at intersections , 2010, 13th International IEEE Conference on Intelligent Transportation Systems.

[72]  John M. Dolan,et al.  Toward human-like motion planning in urban environments , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[73]  Qian Wang,et al.  Hierarchical Hybrid Predictive Control of an Autonomous Road Vehicle , 2015 .

[74]  Henk Wymeersch,et al.  Cooperative receding horizon conflict resolution at traffic intersections , 2014, 53rd IEEE Conference on Decision and Control.

[75]  Marina Fruehauf,et al.  Nonlinear Programming Analysis And Methods , 2016 .

[76]  David Q. Mayne,et al.  Robust model predictive control using tubes , 2004, Autom..

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

[78]  Moritz Diehl,et al.  ACADO toolkit—An open‐source framework for automatic control and dynamic optimization , 2011 .

[79]  Christodoulos A. Floudas,et al.  Mixed Integer Nonlinear Programming , 2009, Encyclopedia of Optimization.

[80]  Julius Ziegler,et al.  Trajectory planning for Bertha — A local, continuous method , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[81]  Gerhard Fettweis,et al.  Greedy algorithms for information dissemination within groups of autonomous vehicles , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[82]  Chebly Alia,et al.  Local trajectory planning and tracking of autonomous vehicles, using clothoid tentacles method , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[83]  William Whittaker,et al.  Autonomous driving in urban environments: Boss and the Urban Challenge , 2008, J. Field Robotics.

[84]  Denis Gillet,et al.  Model predictive coordination of autonomous vehicles crossing intersections , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[85]  Vicente Milanés,et al.  Path and speed planning for smooth autonomous navigation , 2012 .

[86]  Andrew Jacob Gray An Integrated Framework for Planning and Control of Semi-Autonomous Vehicles , 2013 .

[87]  Arthur G. Richards,et al.  Robust stable model predictive control with constraint tightening , 2006, 2006 American Control Conference.

[88]  Petr Krejci,et al.  Cooperative Control of SARTRE Automated Platoon Vehicles , 2012 .

[89]  Guangming Xie,et al.  Leader-following formation control of multiple mobile vehicles , 2007 .