Safe Motion Planning for Autonomous Driving using an Adversarial Road Model

This paper presents a game-theoretic path-following formulation where the opponent is an adversary road model. This formulation allows us to compute safe sets using tools from viability theory, that can be used as terminal constraints in an optimization-based motion planner. Based on the adversary road model, we first derive an analytical discriminating domain, which even allows guaranteeing safety in the case when steering rate constraints are considered. Second, we compute the discriminating kernel and show that the output of the gridding based algorithm can be accurately approximated by a fully connected neural network, which can again be used as a terminal constraint. Finally, we show that by using our proposed safe sets, an optimization-based motion planner can successfully drive on city and country roads with prediction horizons too short for other baselines to complete the task.

[1]  Sanjiv Singh,et al.  The DARPA Urban Challenge: Autonomous Vehicles in City Traffic, George Air Force Base, Victorville, California, USA , 2009, The DARPA Urban Challenge.

[2]  E D Dickmanns,et al.  AUTONOMOUS HIGH SPEED ROAD VEHICLE GUIDANCE BY COMPUTER VISION , 1987 .

[3]  Stefano Di Cairano,et al.  Driver-assist steering by active front steering and differential braking: Design, implementation and experimental evaluation of a switched model predictive control approach , 2010, 49th IEEE Conference on Decision and Control (CDC).

[4]  Sanjiv Singh,et al.  The 2005 DARPA Grand Challenge: The Great Robot Race , 2007 .

[5]  Majid Zamani,et al.  Approximate abstractions of control systems with an application to aggregation , 2018, Autom..

[6]  Murat Arcak,et al.  Continuous Abstraction of Nonlinear Systems using Sum-of-Squares Programming , 2019, 2019 IEEE 58th Conference on Decision and Control (CDC).

[7]  WächterAndreas,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006 .

[8]  Mo Chen,et al.  FaSTrack: A modular framework for fast and guaranteed safe motion planning , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).

[9]  Matthias Althoff,et al.  CommonRoad: Composable benchmarks for motion planning on roads , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[10]  Amnon Shashua,et al.  On a Formal Model of Safe and Scalable Self-driving Cars , 2017, ArXiv.

[11]  Jean-Pierre Aubin,et al.  Viability theory , 1991 .

[12]  Francesco Borrelli,et al.  Autonomous racing using learning Model Predictive Control , 2016, 2017 American Control Conference (ACC).

[13]  Alessandro Rucco,et al.  An Efficient Minimum-Time Trajectory Generation Strategy for Two-Track Car Vehicles , 2015, IEEE Transactions on Control Systems Technology.

[14]  P. Saint-Pierre,et al.  Set-Valued Numerical Analysis for Optimal Control and Differential Games , 1999 .

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

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

[17]  Russ Tedrake,et al.  Funnel libraries for real-time robust feedback motion planning , 2016, Int. J. Robotics Res..

[18]  Alexander Liniger,et al.  Learning-Based Model Predictive Control for Autonomous Racing , 2019, IEEE Robotics and Automation Letters.

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

[20]  J. Maciejowski,et al.  Invariant sets for constrained nonlinear discrete-time systems with application to feasibility in model predictive control , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[21]  Jonas Fredriksson,et al.  Verification of Collision Avoidance Systems using Reachability Analysis , 2014 .

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

[23]  J. How,et al.  Receding horizon path planning with implicit safety guarantees , 2004, Proceedings of the 2004 American Control Conference.

[24]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[25]  Moritz Diehl,et al.  Recent Advances in Quadratic Programming Algorithms for Nonlinear Model Predictive Control , 2018, Vietnam Journal of Mathematics.

[26]  Matthias Althoff,et al.  Model-Based Probabilistic Collision Detection in Autonomous Driving , 2009, IEEE Transactions on Intelligent Transportation Systems.

[27]  Marco Pavone,et al.  Robust online motion planning via contraction theory and convex optimization , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[28]  Francesco Borrelli,et al.  Predictive Control of Autonomous Ground Vehicles With Obstacle Avoidance on Slippery Roads , 2010 .

[29]  Renaud Dubé,et al.  AMZ Driverless: The full autonomous racing system , 2019, J. Field Robotics.

[30]  Iain Dunning,et al.  JuMP: A Modeling Language for Mathematical Optimization , 2015, SIAM Rev..

[31]  John Lygeros,et al.  Real-Time Control for Autonomous Racing Based on Viability Theory , 2017, IEEE Transactions on Control Systems Technology.

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

[33]  Nolan Wagener,et al.  Information theoretic MPC for model-based reinforcement learning , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[34]  Manfred Morari,et al.  Optimization‐based autonomous racing of 1:43 scale RC cars , 2015, ArXiv.

[35]  John Lygeros,et al.  Hybrid Modelling and Reachability on Autonomous RC-Cars , 2012, ADHS.

[36]  Karl Berntorp,et al.  Automated driving: Safe motion planning using positively invariant sets , 2017, 2017 IEEE 20th International Conference on Intelligent Transportation Systems (ITSC).