A Scalable Safety Critical Control Framework for Nonlinear Systems

There are two main approaches to safety-critical control. The first one relies on computation of control invariant sets and is presented in the first part of this work. The second approach draws from the topic of optimal control and relies on the ability to realize Model-Predictive-Controllers online to guarantee the safety of a system. In the second approach, safety is ensured at a planning stage by solving the control problem subject for some explicitly defined constraints on the state and control input. Both approaches have distinct advantages but also major drawbacks that hinder their practical effectiveness, namely scalability for the first one and computational complexity for the second. We therefore present an approach that draws from the advantages of both approaches to deliver efficient and scalable methods of ensuring safety for nonlinear dynamical systems. In particular, we show that identifying a backup control law that stabilizes the system is in fact sufficient to exploit some of the set-invariance conditions presented in the first part of this work. Indeed, one only needs to be able to numerically integrate the closed-loop dynamics of the system over a finite horizon under this backup law to compute all the information necessary for evaluating the regulation map and enforcing safety. The effect of relaxing the stabilization requirements of the backup law is also studied, and weaker but more practical safety guarantees are brought forward. We then explore the relationship between the optimality of the backup law and how conservative the resulting safety filter is. Finally, methods of selecting a safe input with varying levels of trade-off between conservatism and computational complexity are proposed and illustrated on multiple robotic systems, namely: a two-wheeled inverted pendulum (Segway), an industrial manipulator, a quadrotor, and a lower body exoskeleton.

[1]  Roy Featherstone,et al.  A Divide-and-Conquer Articulated-Body Algorithm for Parallel O(log(n)) Calculation of Rigid-Body Dynamics. Part 1: Basic Algorithm , 1999, Int. J. Robotics Res..

[2]  Aaron D. Ames,et al.  Human-Inspired Control of Bipedal Walking Robots , 2014, IEEE Transactions on Automatic Control.

[3]  Anil V. Rao,et al.  GPOPS-II , 2014, ACM Trans. Math. Softw..

[4]  Domitilla Del Vecchio,et al.  Control for Safety Specifications of Systems With Imperfect Information on a Partial Order , 2014, IEEE Transactions on Automatic Control.

[5]  Vijay Kumar,et al.  Planning Dynamically Feasible Trajectories for Quadrotors Using Safe Flight Corridors in 3-D Complex Environments , 2017, IEEE Robotics and Automation Letters.

[6]  Laurent Ciarletta,et al.  Towards a generic and modular geofencing strategy for civilian UAVs , 2016, 2016 International Conference on Unmanned Aircraft Systems (ICUAS).

[7]  J. Burdick,et al.  Implications of Assist-As-Needed Robotic Step Training after a Complete Spinal Cord Injury on Intrinsic Strategies of Motor Learning , 2006, The Journal of Neuroscience.

[8]  Ian M. Mitchell A Summary of Recent Progress on Efficient Parametric Approximations of Viability and Discriminating Kernels , 2015, SNR@CAV.

[9]  Robert Riener,et al.  Control strategies for active lower extremity prosthetics and orthotics: a review , 2015, Journal of NeuroEngineering and Rehabilitation.

[10]  Koushil Sreenath,et al.  Feedback Control of an Exoskeleton for Paraplegics: Toward Robustly Stable, Hands-Free Dynamic Walking , 2018, IEEE Control Systems.

[11]  David Angeli,et al.  Monotone control systems , 2003, IEEE Trans. Autom. Control..

[12]  Aaron D. Ames,et al.  Towards Variable Assistance for Lower Body Exoskeletons , 2020, IEEE Robotics and Automation Letters.

[13]  Aaron D. Ames,et al.  3D dynamic walking with underactuated humanoid robots: A direct collocation framework for optimizing hybrid zero dynamics , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[14]  Petter Nilsson,et al.  Online Active Safety for Robotic Manipulators , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[15]  César Muñoz,et al.  A TCAS-II Resolution Advisory Detection Algorithm , 2013 .

[16]  Khairul Anam,et al.  Active Exoskeleton Control Systems: State of the Art , 2012 .

[17]  Jonathan P. How,et al.  Aggressive 3-D collision avoidance for high-speed navigation , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[18]  Li Wang,et al.  Control Barrier Certificates for Safe Swarm Behavior , 2015, ADHS.

[19]  Aaron D. Ames,et al.  An Online Approach to Active Set Invariance , 2018, 2018 IEEE Conference on Decision and Control (CDC).

[20]  Lui Sha,et al.  The System-Level Simplex Architecture for Improved Real-Time Embedded System Safety , 2009, 2009 15th IEEE Real-Time and Embedded Technology and Applications Symposium.

[21]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[22]  Li Wang,et al.  Safe Learning of Quadrotor Dynamics Using Barrier Certificates , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[23]  Paulo Tabuada,et al.  Correctness Guarantees for the Composition of Lane Keeping and Adaptive Cruise Control , 2016, IEEE Transactions on Automation Science and Engineering.

[24]  Aaron D. Ames,et al.  Towards Restoring Locomotion for Paraplegics: Realizing Dynamically Stable Walking on Exoskeletons , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[25]  Ayush Agrawal,et al.  First Steps Towards Translating HZD Control of Bipedal Robots to Decentralized Control of Exoskeletons , 2017, IEEE Access.

[26]  Eric N. Johnson,et al.  Towards a New Paradigm of UAV Safety , 2018, ArXiv.

[27]  Aaron D. Ames,et al.  Towards a Framework for Realizable Safety Critical Control through Active Set Invariance , 2018, 2018 ACM/IEEE 9th International Conference on Cyber-Physical Systems (ICCPS).

[28]  Franco Blanchini,et al.  Set-theoretic methods in control , 2007 .

[29]  Bohua Zhan,et al.  Smooth Manifolds , 2021, Arch. Formal Proofs.

[30]  Franco Blanchini,et al.  Set invariance in control , 1999, Autom..

[31]  Jie Yu,et al.  Unconstrained receding-horizon control of nonlinear systems , 2001, IEEE Trans. Autom. Control..

[32]  R Jiménez-Fabián,et al.  Review of control algorithms for robotic ankle systems in lower-limb orthoses, prostheses, and exoskeletons. , 2012, Medical engineering & physics.

[33]  Hanan Samet,et al.  Neighbor finding in images represented by octrees , 1989, Comput. Vis. Graph. Image Process..

[34]  D. Robertson Body Segment Parameters , 2014 .

[35]  Claire J. Tomlin,et al.  Sampling-based approximation of the viability kernel for high-dimensional linear sampled-data systems , 2014, HSCC.

[36]  Jonathan P. How,et al.  Aircraft trajectory planning with collision avoidance using mixed integer linear programming , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[37]  Olivier Stasse,et al.  The Pinocchio C++ library : A fast and flexible implementation of rigid body dynamics algorithms and their analytical derivatives , 2019, 2019 IEEE/SICE International Symposium on System Integration (SII).

[38]  Tom Schouwenaars,et al.  Safe Trajectory Planning of Autonomous Vehicles , 2006 .

[39]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Autonomous Robot Vehicles.

[40]  Srikanth Saripalli,et al.  Sampling-Based Path Planning for UAV Collision Avoidance , 2017, IEEE Transactions on Intelligent Transportation Systems.

[41]  Joseph B. Lyons,et al.  A Longitudinal Field Study of Auto-GCAS Acceptance and Trust: First-Year Results and Implications , 2017 .

[42]  Wisama Khalil,et al.  Dynamic Modeling of Robots using Recursive Newton-Euler Techniques , 2010, ICINCO.

[43]  Paulo Tabuada,et al.  Control Barrier Function Based Quadratic Programs for Safety Critical Systems , 2016, IEEE Transactions on Automatic Control.

[44]  Stephen P. Boyd,et al.  OSQP: an operator splitting solver for quadratic programs , 2017, 2018 UKACC 12th International Conference on Control (CONTROL).

[45]  Ian A. Hiskens,et al.  Trajectory Sensitivity Analysis of Hybrid Systems , 2000 .

[46]  E. Westervelt,et al.  Feedback Control of Dynamic Bipedal Robot Locomotion , 2007 .

[47]  Alexandre M. Bayen,et al.  A time-dependent Hamilton-Jacobi formulation of reachable sets for continuous dynamic games , 2005, IEEE Transactions on Automatic Control.

[48]  Stefan Hrabar,et al.  3D path planning and stereo-based obstacle avoidance for rotorcraft UAVs , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.