Stochastic Modeling and Optimal Control for Automated Overtaking

This paper proposes a solution to the overtaking problem where an automated vehicle tries to overtake a human-driven vehicle, which may not be moving at a constant velocity. Using reachability theory, we first provide a robust time-optimal control algorithm to guarantee that there is no collision throughout the overtaking process. Following the robust formulation, we provide a stochastic reachability formulation that allows a trade-off between the conservative overtaking time and the allowance of a small collision probability. To capture the stochasticity of a human driver’s behavior, we propose a new martingale-based model where we classify the human driver as aggressive or nonaggressive. We show that if the human driver is nonaggressive, our stochastic time-optimal control algorithm can provide a shorter overtaking time than our robust algorithm, whereas if the human driver is aggressive, the stochastic algorithm will act on a collision probability of zero, which will match the robust algorithm. Finally, we detail a simulated example that illustrates the effectiveness of the proposed algorithms.

[1]  Lotta Jakobsson,et al.  Collision Warning with Auto Brake - A Real-Life Safety Perspective , 2007 .

[2]  Vicente Milanés Montero,et al.  Intelligent automatic overtaking system using vision for vehicle detection , 2012, Expert Syst. Appl..

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

[4]  D. Bertsekas,et al.  On the minimax reachability of target sets and target tubes , 1971 .

[5]  John S. Baras,et al.  Stochastic Control Formulation of The Car Overtake Problem , 2018 .

[6]  Fan Chung Graham,et al.  Concentration Inequalities and Martingale Inequalities: A Survey , 2006, Internet Math..

[7]  Anca D. Dragan,et al.  Planning for cars that coordinate with people: leveraging effects on human actions for planning and active information gathering over human internal state , 2018, Autonomous Robots.

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

[9]  Ruzena Bajcsy,et al.  Robust, Informative Human-in-the-Loop Predictions via Empirical Reachable Sets , 2017, IEEE Transactions on Intelligent Vehicles.

[10]  David Williams,et al.  Probability with Martingales , 1991, Cambridge mathematical textbooks.

[11]  Pieter Abbeel,et al.  Apprenticeship learning via inverse reinforcement learning , 2004, ICML.

[12]  Mark H. A. Davis Martingale methods in stochastic control , 1979 .

[13]  D. Duffie Dynamic Asset Pricing Theory , 1992 .

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

[15]  Philip Koopman,et al.  Autonomous Vehicle Safety: An Interdisciplinary Challenge , 2017, IEEE Intelligent Transportation Systems Magazine.

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

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

[18]  John Lygeros,et al.  Probabilistic reachability and safety for controlled discrete time stochastic hybrid systems , 2008, Autom..

[19]  Mehrdad Dianati,et al.  Trajectory Planning for Autonomous High-Speed Overtaking using MPC with Terminal Set Constraints , 2018, 2018 21st International Conference on Intelligent Transportation Systems (ITSC).