ABSTRACT
We develop optimal control strategies for Autonomous Vehicles (AVs) that are required to meet complex specifications imposed by traffic laws and cultural expectations of reasonable driving behavior. We formulate these specifications as rules, and specify their priorities by constructing a priority structure, called <u>T</u>otal <u>OR</u>der over e<u>Q</u>uivalence classes (TORQ). We propose a recursive framework, in which the satisfaction of the rules in the priority structure are iteratively relaxed based on their priorities. Central to this framework is an optimal control problem, where convergence to desired states is achieved using Control Lyapunov Functions (CLFs), and safety is enforced through Control Barrier Functions (CBFs). We also show how the proposed framework can be used for after-the-fact, pass/fail evaluation of trajectories - a given trajectory is rejected if we can find a controller producing a trajectory that leads to less violation of the rule priority structure. We present case studies with multiple driving scenarios to demonstrate the effectiveness of the proposed framework.
- A. D. Ames, K. Galloway, and J. W. Grizzle. 2012. Control Lyapunov Functions and Hybrid Zero Dynamics. In Proc. of 51rd IEEE Conference on Decision and Control. 6837--6842.Google Scholar
- A. D. Ames, X. Xu, J. W. Grizzle, and P. Tabuada. 2017. Control Barrier Function Based Quadratic Programs for Safety Critical Systems. IEEE Trans. Automat. Control 62, 8 (2017), 3861--3876.Google ScholarCross Ref
- Z. Artstein. 1983. Stabilization with relaxed controls. Nonlinear Analysis: Theory, Methods & Applications 7, 11 (1983), 1163--1173.Google ScholarCross Ref
- A. Censi, K. Slutsky, T. Wongpiromsarn, D. Yershov, S. Pendleton, J. Fu, and E. Frazzoli. 2019. Liability, Ethics, and Culture-Aware Behavior Specification using Rulebooks. In 2019 International Conference on Robotics and Automation. 8536--8542.Google Scholar
- A. Collin, A. Bilka, S. Pendleton, and R. D. Tebbens. 2020. Safety of the Intended Driving Behavior Using Rulebooks. In IV Workshop on Ensuring and Validating Safety for Automated Vehicles. 1--7.Google Scholar
- R. Dimitrova, M. Ghasemi, and U. Topcu. 2018. Maximum realizability for linear temporal logic specifications. In International Symposium on Automated Technology for Verification and Analysis. 458--475.Google Scholar
- A. Donzé and O. Maler. 2010. Robust satisfaction of temporal logic over real-valued signals. In International Conference on Formal Modeling and Analysis of Timed Systems. 92--106.Google Scholar
- R. A. Freeman and P. V. Kokotovic. 1996. Robust Nonlinear Control Design. Birkhauser.Google Scholar
- P. Glotfelter, J. Cortes, and M. Egerstedt. 2017. Nonsmooth barrier functions with applications to multi-robot systems. IEEE control systems letters 1, 2 (2017), 310--315.Google Scholar
- ISO. 2019. PAS 21448-Road Vehicles-Safety of the Intended Functionality. International Organization for Standardization (2019).Google Scholar
- H. K. Khalil. 2002. Nonlinear Systems. Prentice Hall, third edition.Google Scholar
- L. Lindemann and D. V. Dimarogonas. 2019. Control barrier functions for signal temporal logic tasks. IEEE Control Systems Letters 3, 1 (2019), 96--101.Google ScholarCross Ref
- O. Maler and D. Nickovic. 2004. Monitoring temporal properties of continuous signals. In Proc. of International Conference on FORMATS-FTRTFT. Grenoble, France, 152--166.Google Scholar
- N. Mehdipour, C. Vasile, and C. Belta. 2019. Arithmetic-geometric mean robustness for control from signal temporal logic specifications. In American Control Conference. 1690--1695.Google Scholar
- N. Mehdipour, C. I. Vasile, and C. Belta. 2020. Specifying User Preferences using Weighted Signal Temporal Logic. IEEE Control Systems Letters (2020). Google ScholarCross Ref
- Q. Nguyen and K. Sreenath. 2016. Exponential Control Barrier Functions for Enforcing High Relative-Degree Safety-Critical Constraints. In Proc. of the American Control Conference. 322--328.Google Scholar
- M. Nolte, G. Bagschik, I. Jatzkowski, T. Stolte, A. Reschka, and M. Maurer. 2017. Towards a skill-and ability-based development process for self-aware automated road vehicles. In 2017 IEEE 20th International Conference on Intelligent Transportation Systems. 1--6.Google Scholar
- M. Parseh, F. Asplund, M. Nybacka, L. Svensson, and M. Törngren. 2019. Pre-Crash Vehicle Control and Manoeuvre Planning: A Step Towards Minimizing Collision Severity for Highly Automated Vehicles. In 2019 IEEE International Conference of Vehicular Electronics and Safety (ICVES). 1--6.Google Scholar
- X. Qian, J. Gregoire, F. Moutarde, and A. D. L. Fortelle. 2014. Priority-based coordination of autonomous and legacy vehicles at intersection. In IEEE conference on intelligent transportation systems. 1166--1171.Google ScholarCross Ref
- A. Rucco, G. Notarstefano, and J. Hauser. 2015. An Efficient Minimum-Time Trajectory Generation Strategy for Two-Track Car Vehicles. IEEE Transactions on Control Systems Technology 23, 4 (2015), 1505--1519.Google ScholarCross Ref
- S. Shalev-Shwartz, S. Shammah, and A. Shashua. 2017. On a formal model of safe and scalable self-driving cars. preprint in arXiv:1708.06374 (2017).Google Scholar
- K. P. Tee, S. S. Ge, and E. H. Tay. 2009. Barrier lyapunov functions for the control of output-constrained nonlinear systems. Automatica 45, 4 (2009), 918--927.Google ScholarDigital Library
- J. Tmová, L. I R. Castro, S. Karaman, E. Frazzoli, and D. Rus. 2013. Minimum-violation LTL planning with conflicting specifications. In 2013 American Control Conference. 200--205.Google Scholar
- S. Ulbrich and M. Maurer. 2013. Probabilistic online POMDP decision making for lane changes in fully automated driving. In IEEE Conference on Intelligent Transportation Systems. 2063--2067.Google Scholar
- L. Wang, A. D. Ames, and M. Egerstedt. 2017. Safety barrier certificates for collisions-free multirobot systems. IEEE Transactions on Robotics 33, 3 (2017), 661--674.Google ScholarDigital Library
- R. Wisniewski and C. Sloth. 2013. Converse barrier certificate theorem. In Proc. of 52nd IEEE Conference on Decision and Control. Florence, Italy, 4713--4718.Google Scholar
- W. Xiao and C. Belta. 2019. Control Barrier Functions for Systems with High Relative Degree. In Proc. of 58th IEEE Conference on Decision and Control. Nice, France, 474--479.Google Scholar
- W. Xiao, C. Belta, and C. G. Cassandras. 2020. Feasibility Guided Learning for Constrained Optimal Control problems. In Proc. of 59th IEEE Conference on Decision and Control. 1896--1901.Google Scholar
- W. Xiao, C. Belta, and C. G. Cassandras. 2021. Adaptive Control Barrier Functions. In provisonally accepted in Transactions on Automatic Control, preprint in arXiv:2002.04577.Google Scholar
Index Terms
- Rule-based optimal control for autonomous driving
Recommendations
Numerical Analysis of Tractor Accidents using Driving Simulator for Autonomous Driving Tractor
ICMRE'19: Proceedings of the 5th International Conference on Mechatronics and Robotics EngineeringAutonomous driving of automobiles is a hot research topic in recent years. The autonomous driving tractor also has been studied in the agricultural field as well as an autonomous driving automobile. On the other hand, tractor accidents frequently occur ...
Autonomous Driving: Investigating the Feasibility of Bimodal Take-Over Requests
Autonomous vehicles will need de-escalation strategies to compensate when reaching system limitations. Car-driver handovers can be considered one possible method to deal with system boundaries. The authors suggest a bimodal auditory and visual handover ...
Autonomous Highway Car Following System Based on Fuzzy Control
HPCCT '18: Proceedings of the 2018 2nd High Performance Computing and Cluster Technologies ConferenceThe ability of controlling real-time vehicle status is extremely important for car-following systems. The status of the traffic stream on highways has impact on the vehicle control while in a high driving speed. In this paper, a feedback car-following ...
Comments