Safe Stop Trajectory Planning for Highly Automated Vehicles: An Optimal Control Problem Formulation

Highly automated road vehicles need the capability of stopping safely in a situation that disrupts continued normal operation, e.g. due to internal system faults. Motion planning for safe stop differs from nominal motion planning, since there is not a specific goal location. Rather, the desired behavior is that the vehicle should reach a stopped state, preferably outside of active lanes. Also, the functionality to stop safely needs to be of high integrity. The first contribution of this paper is to formulate the safe stop problem as a benchmark optimal control problem, which can be solved by dynamic programming. However, this solution method cannot be used in real-time. The second contribution is to develop a real-time safe stop trajectory planning algorithm, based on selection from a precomputed set of trajectories. By exploiting the particular properties of the safe stop problem, the cardinality of the set is decreased, making the algorithm computationally efficient. Furthermore, a monitoring based architecture concept is proposed, that ensures dependability of the safe stop function. Finally, a proof of concept simulation using the proposed architecture and the safe stop trajectory planner is presented.

[1]  Urs A. Muller,et al.  Learning maneuver dictionaries for ground robot planning , 2008 .

[2]  Olle Sundström,et al.  A generic dynamic programming Matlab function , 2009, 2009 IEEE Control Applications, (CCA) & Intelligent Control, (ISIC).

[3]  Julius Ziegler,et al.  Optimal trajectories for time-critical street scenarios using discretized terminal manifolds , 2012, Int. J. Robotics Res..

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

[5]  Shuhei Yamashita,et al.  Introduction of ISO 26262 'Road vehicles-Functional safety' , 2012 .

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

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

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

[9]  Matthieu Roy,et al.  SMOF: A Safety Monitoring Framework for Autonomous Systems , 2018, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[10]  Sebastian Scherer,et al.  Emergency maneuver library - ensuring safe navigation in partially known environments , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[11]  Carl E. Landwehr,et al.  Basic concepts and taxonomy of dependable and secure computing , 2004, IEEE Transactions on Dependable and Secure Computing.

[12]  Gonçalo Collares Pereira,et al.  Lateral Model Predictive Control for Over-Actuated Autonomous Vehicle , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[13]  Andrew G. Alleyne,et al.  Autonomous Vehicle Control: A Nonconvex Approach for Obstacle Avoidance , 2017, IEEE Transactions on Control Systems Technology.

[14]  Christopher G. Atkeson,et al.  Standing balance control using a trajectory library , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[16]  Daniel Hess,et al.  Contingency planning for automated vehicles , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[17]  Oskar Wallmark,et al.  Design and Implementation of an Experimental Research and Concept Demonstration Vehicle , 2014, 2014 IEEE Vehicle Power and Propulsion Conference (VPPC).

[18]  Yoram Koren,et al.  The vector field histogram-fast obstacle avoidance for mobile robots , 1991, IEEE Trans. Robotics Autom..

[19]  Taxonomy and definitions for terms related to driving automation systems for on-road motor vehicles , 2022 .

[20]  Félix Ingrand,et al.  Dependable execution control for autonomous robots , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).