Resilient Estimator-based Control Barrier Functions for Dynamical Systems with Disturbances and Noise

Chuyuan Tao,Wenbin Wan,Junjie Gao,Bihao Mo,Hunmin Kim,Naira Hovakimyan
2024-06-29
Abstract:Control Barrier Function (CBF) is an emerging method that guarantees safety in path planning problems by generating a control command to ensure the forward invariance of a safety set. Most of the developments up to date assume availability of correct state measurements and absence of disturbances on the system. However, if the system incurs disturbances and is subject to noise, the CBF cannot guarantee safety due to the distorted state estimate. To improve the resilience and adaptability of the CBF, we propose a resilient estimator-based control barrier function (RE-CBF), which is based on a novel stochastic CBF optimization and resilient estimator, to guarantee the safety of systems with disturbances and noise in the path planning problems. The proposed algorithm uses the resilient estimation algorithm to estimate disturbances and counteract their effect using novel stochastic CBF optimization, providing safe control inputs for dynamical systems with disturbances and noise. To demonstrate the effectiveness of our algorithm in handling both noise and disturbances in dynamics and measurement, we design a quadrotor testing pipeline to simulate the proposed algorithm and then implement the algorithm on a real drone in our flying arena. Both simulations and real-world experiments show that the proposed method can guarantee safety for systems with disturbances and noise.
Systems and Control,Robotics
What problem does this paper attempt to address?
The problem that this paper attempts to solve is how to ensure the safety of dynamic systems in the presence of interference and noise. Specifically, the paper mentions that existing Control Barrier Function (CBF) methods usually assume that the system state can be accurately measured and there are no external interferences. However, in practical applications, these assumptions are often not valid because the system may be affected by process noise and measurement noise, resulting in distorted state estimates and further affecting the safety - ensuring ability of CBF. To overcome this challenge, the author proposes a Resilient Estimator - based Control Barrier Function (RE - CBF) method. By combining the new stochastic CBF optimization and resilient estimation techniques, RE - CBF can provide more accurate state estimates in the presence of interference and noise and generate safe control inputs, thereby ensuring the safety of the system. The main contributions of the paper include: 1. Developing a new stochastic CBF optimization method to ensure safety in path - planning problems in uncertain systems. 2. Introducing the RE - CBF algorithm, which can provide interference estimates for stochastic CBF optimization. 3. Designing a quad - rotor UAV test pipeline to implement the RE - CBF method on real - time robots and verify its effectiveness in dealing with uncertainties in system dynamics and measurement. Through numerical simulations and actual flight experiments, the research has proven that the proposed RE - CBF method can effectively ensure the safety of the system in the presence of interference and noise.