Efficient Computation of Invariably Safe States for Motion Planning of Self-Driving Vehicles

Safe motion planning requires that a vehicle reaches a set of safe states at the end of the planning horizon. However, safe states of vehicles have not yet been systematically defined in the literature, nor does a computationally efficient way to obtain them for online motion planning exist. To tackle the aforementioned issues, we introduce invariably safe sets. These are regions that allow vehicles to remain safe for an infinite time horizon. We show how invariably safe sets can be computed and propose a tight under-approximation which can be obtained efficiently in linear time with respect to the number of traffic participants. We use invariably safe sets to lift safety verification from finite to infinite time horizons. In addition, our sets can be used to determine the existence of feasible evasive maneuvers and the criticality of scenarios by computing the time-to-react metric.

[1]  Thao Dang,et al.  A flexible method for criticality assessment in driver assistance systems , 2011, 2011 IEEE Intelligent Vehicles Symposium (IV).

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

[3]  Hajime Asama,et al.  Inevitable collision states — a step towards safer robots? , 2004, Adv. Robotics.

[4]  Kristian Kroschel,et al.  A Multilevel Collision Mitigation Approach—Its Situation Assessment, Decision Making, and Performance Tradeoffs , 2006, IEEE Transactions on Intelligent Transportation Systems.

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

[6]  Rolf Isermann,et al.  Fault-tolerant drive-by-wire systems , 2002 .

[7]  E. Velenis,et al.  Optimal Velocity Profile Generation for Given Acceleration Limits; The Half-Car Model Case , 2005, Proceedings of the IEEE International Symposium on Industrial Electronics, 2005. ISIE 2005..

[8]  J. Schroder,et al.  Navigating car-like robots in unstructured environments using an obstacle sensitive cost function , 2008, 2008 IEEE Intelligent Vehicles Symposium.

[9]  Martin Buss,et al.  Determining states of inevitable collision using reachability analysis , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Matthias Althoff,et al.  Enhancing motion safety by identifying safety-critical passageways , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).

[11]  Martin Buss,et al.  On-line Trajectory Generation for Safe and Optimal Vehicle Motion Planning , 2012, AMS.

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

[13]  Matthias Althoff,et al.  Online safety verification of trajectories for unmanned flight with offline computed robust invariant sets , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[14]  Thao Dang,et al.  A novel approach for the probabilistic computation of Time-To-Collision , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[15]  Thierry Fraichard,et al.  An efficient and generic 2D Inevitable Collision State-checker , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Matthias Althoff,et al.  Adaptive Cruise Control with Safety Guarantees for Autonomous Vehicles , 2017 .

[17]  Christian Schmidt,et al.  Research on trajectory planning in emergency situations with multiple objects , 2006, 2006 IEEE Intelligent Transportation Systems Conference.

[18]  Soo Jeon,et al.  Guaranteeing persistent feasibility of model predictive motion planning for autonomous vehicles , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[19]  Julius Ziegler,et al.  Fast collision checking for intelligent vehicle motion planning , 2010, 2010 IEEE Intelligent Vehicles Symposium.

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

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

[22]  Uwe Kiencke,et al.  Redundancy Management for Drive-by-Wire Computer Systems , 2003, SAFECOMP.

[23]  Julius Ziegler,et al.  Optimal trajectory generation for dynamic street scenarios in a Frenét Frame , 2010, 2010 IEEE International Conference on Robotics and Automation.

[24]  Matthias Althoff,et al.  A Formally Verified Checker of the Safe Distance Traffic Rules for Autonomous Vehicles , 2016, NFM.

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

[26]  Matthias Althoff,et al.  Determining the Nonexistence of Evasive Trajectories for Collision Avoidance Systems , 2015, 2015 IEEE 18th International Conference on Intelligent Transportation Systems.

[27]  Malte Lochau,et al.  Compositionality, Decompositionality and Refinement in Input/Output Conformance Testing , 2016, FACS.

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

[29]  Jonas Sjöberg,et al.  Predictive Threat Assessment via Reachability Analysis and Set Invariance Theory , 2011, IEEE Transactions on Intelligent Transportation Systems.

[30]  Hermann Winner,et al.  The worst-time-to-collision metric for situation identification , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[31]  Hermann Winner,et al.  Autonomous Driving: Technical, Legal and Social Aspects , 2016 .

[32]  Ian M. Mitchell Comparing Forward and Backward Reachability as Tools for Safety Analysis , 2007, HSCC.

[33]  Matthias Althoff,et al.  Online Verification of Automated Road Vehicles Using Reachability Analysis , 2014, IEEE Transactions on Robotics.

[34]  Matthias Althoff,et al.  Verifying the safety of lane change maneuvers of self-driving vehicles based on formalized traffic rules , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[35]  Matthias Althoff,et al.  SPOT: A tool for set-based prediction of traffic participants , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[36]  Dirk Wollherr,et al.  Grid-Based Environment Estimation Using Evidential Mapping and Particle Tracking , 2018, IEEE Transactions on Intelligent Vehicles.