Safe Navigation under State Uncertainty: Online Adaptation for Robust Control Barrier Functions

Ersin Daş, Rahal Nanayakkara, Xiao Tan, Ryan M. Bena, Joel W. Burdick, Paulo Tabuada, Aaron D. Ames · 2025

Read Safe Navigation under State Uncertainty: Online Adaptation for Robust Control Barrier Functions by Ersin Daş, Rahal Nanayakkara, Xiao Tan, Ryan M. Bena, Joel W. Burdick, Paulo Tabuada, Aaron D. Ames (2025) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2508-19159.txt.

Introduction

Das and six co-authors adapt robust safety barriers online for a tracked vehicle navigating under state uncertainty, in a paper from twenty twenty-five. Safety guarantees rely on accurate state estimates, which practice rarely supplies. Prior robust barrier methods impose strict input limits that can be infeasible or costly. Their method tunes barrier parameters online through optimization.

Multiple safety constraints merge into one numerical barrier via Poisson's equation. That merger keeps parameter tuning tractable in real time. A dual relative degree issue in vehicle tracking is also addressed. Trials among multiple obstacles show clear gains over prior formulations. Control effort falls while safety holds under estimation error.

Catalog record

CREATORErsin Daş, Rahal Nanayakkara, Xiao Tan, Ryan M. Bena, Joel W. Burdick, Paulo Tabuada, Aaron D. Ames
YEAR2025
COLLECTIONPAPERS
FORMATTXT
FILE SIZE49 KB
VERSION1.0
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2508-19159

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

Safe Navigation under State Uncertainty: Online Adaptation for Robust Control Barrier Functions Ersin Daş, Rahal Nanayakkara, Xiao Tan, Ryan M. Bena, Joel W. Burdick, Paulo Tabuada, Aaron D. Ames Abstract Measurements and state estimates are often imperfect in control practice, posing challenges for safety-critical applications, where safety guarantees rely on accurate state information. In the presence of estimation errors, several prior robust control barrier function (R-CBF) formulations have imposed strict conditions on the input. These methods can be overly conservative and can introduce issues such as infeasibility, high control effort, etc. This work proposes a systematic method to improve R-CBFs, and demonstrates its advantages on a tracked vehicle that navigates among multiple obstacles. A primary contribution is a new optimization-based online parameter adaptation scheme that reduces the conservativeness of existing R-CBFs. In order to reduce the complexity of the parameter optimization, we merge several safety constraints into one unified numerical CBF via Poisson’s equation. We further address the dual relative degree issue that typically causes difficulty in vehicle tracking. Experimental trials demonstrate the overall performance improvement of our approach over existing formulations. I Introduction The increasing use of autonomous robots in complex environments emphasizes the need for safety-critical control [ 1 ] . Control barrier functions (CBFs) [ 2 ] provide conditions, by leveraging system dynamics, that render a prescribed safe set forward invariant and, in practice, lead to safety filters that minimally modify the nominal input only when necessary to maintain safety. However, model uncertainties, including external disturbances, time delays, and state estimation errors, can lead to safety violations in real-world control applications [ 3 ] . For instance, modern mobile robots and uncrewed aerial vehicles often rely upon visual-inertial odometry (VIO) for localization and navigation. Under VIO, the uncertainty in the vehicle’s location estimate grows between global positioning updates, and is an ever-present source of state estimation error that can render safety guarantees meaningless unless they are robustified against these persistent errors. Fig. 1: The proposed robust CBF (R-CBF) method in an outdoor safety-critical navigation scenario with a tracked mobile robot. Our R-CBF-QP-based safety filter maintains safety under state estimation uncertainty. Early robust CBF methods addressed unmodeled dynamics through input - to - state safety margin [ 4 ] . Later formulations ensure safety by introducing adaptive robustness margins to reduce conservatism [ 5 , 3 ] . One recent approach [ 6 ] learns a predictive robustness term that is updated online to tighten the CBF inequality whenever the full-order robot dynamics model deviates from its reduced-order model. To enhance robustness in safety constraints, [ 7 ] presents a learning-based framework that enables online adaptation of class- \mathcal{K}_{\infty} functions for systems under input constraints. Beyond model uncertainty, achieving robustness against measurement errors is a notoriously challenging problem because the CBF condition is evaluated on the estimated state. This problem has been approached by using more conservative conditions [ 8 , 9 ] , by considering specific types of state estimators [ 10 , 11 ] , or by adopting stochastic approaches [ 12 ] . Although effective in specific control problems, each of these methods imposes specific requirements on the state estimator or uncertainty bounds, which may not be applicable for some real-world applications. To overcome these limitations, a concept for robust CBFs (R-CBFs) is introduced in [ 13 ] to ensure safety in the presence of state uncertainty, without requiring prior knowledge of the uncertainty magnitude. Unlike the approach proposed in [ 11 , 10 ] , R-CBFs do not depend on specific classes of state observers. Nevertheless, R-CBFs account for estimation errors through conditions with constant robustness parameters, which may lead to overcompensation for uncertainty, ultimately reducing system performance in an undesirable manner. In this paper, we present a safety-critical control framework that is robust to state estimation uncertainty, with a focus on practical implementation. We build upon the R-CBF formulation in [ 13 ] and propose an optimization-based procedure for the online tuning of the robustifying parameters in the R-CBF condition. This strategy enables the controller to adaptively guarantee robustness to state uncertainty by optimizing the R-CBF parameters using perturbations sampled locally about the current state estimate. In order to account for multiple safety specifications—which commonly arise in real-world autonomy problems [ 14 , 15 , 16 , 17 ] —and reduce the computational complexity of the online parameter optimization, we consolidate them into a single CBF using Poisson safety functions [ 18 ] , [ 19 ] . This also facilitates the generation of safe sets from perception data. Rather than composing safety constraints with approximations, the Poisson safety function provides a smooth scalar field by solving Poisson’s equation with Dirichlet boundary conditions defined by the unsafe and safe set boundaries. We demonstrate the effectiveness of our approach through hardware experiments on a tracked mobile robot, where state estimation is provided by VIO. We model the robot as a unicycle system. Our objective is to provide collision safety even under the time-varying uncertainty introduced by the VIO system. The linear and angular velocity inputs to this vehicle affect the safety function at two different orders of differentiation, resulting in dual relative degree behavior. Inspired by [ 20 ] , we first design a CBF for the single integrator sub-system, then we leverage a Lyapunov function to synthesize a CBF that has a relative degree of one with respect to both inputs for the nonlinear unicycle system. The synthesized CBF explicitly incorporates the effect of angular velocity into the safety condition, overcoming a limitation of conventional CBFs for the unicycle system, where angular velocity does not contribute to the satisfaction of the safety specifications. We organize this paper as follows. Section II introduces preliminaries. Section III presents an online adaptation method for the robustifying parameters of R-CBFs, aimed at reducing conservativeness. Section IV presents simulations and experiments, while Section V concludes the paper. II Preliminaries II-A Control Barrier Functions We consider a nonlinear control-affine system: \displaystyle\dot{\mathbf{x}}=\mathbf{f}(\mathbf{x})+\mathbf{g}(\mathbf{x})\mathbf{u},\ \mathbf{x}\in\mathcal{X}\subseteq\mathbb{R}^{n},\ \mathbf{u}\in\mathcal{U}\subseteq\mathbb{R}^{m}, (1) where the drift dynamics {\mathbf{f}\!:\!\mathcal{X}\!\to\!\mathbb{R}^{n}} and the actuation matrix {\mathbf{g}\!:\!\mathcal{X}\!\to\!\mathbb{R}^{n\times m}} are locally Lipschitz continuous functions. We assume the set of admissible control inputs \mathcal{U} is an m -dimensional convex polytope. For a given time-varying feedback controller {\mathbf{k}\!:\!\mathbb{R}_{\geq 0}\!\times\!\mathcal{X}\!\to\!\mathcal{U}} , which is piecewise continuous in t and locally Lipschitz continuous in \mathbf{x} , the closed-loop system, {\mathbf{f}_{\rm cl}\!:\!\mathbb{R}_{\geq 0}\!\times\!\mathcal{X}\!\to\!\mathbb{R}^{n}} : \dot{\mathbf{x}}=\mathbf{f}(\mathbf{x})+\mathbf{g}(\mathbf{x})\mathbf{k}(t,\mathbf{x})\triangleq\mathbf{f}_{\rm cl}(t,\mathbf{x}), (2) has a unique solution: {\mathbf{x}(t)\!=\!\mathbf{x}_{0}\!+\!\int^{t}_{t_{0}}\mathbf{f}_{\rm cl}(\tau,\mathbf{x}(\tau))d\tau,~t\!>\!t_{0}.} for any initial condition {\mathbf{x}(t_{0})\!=\!\mathbf{x}_{0}\!\in\!\mathcal{X}} . In this paper, we assume that the system is forward complete. We characterize safety through the notion of forward invariance. Let the time-varying safe set {\mathcal{C}(t)} be the 0-superlevel set of a continuously differentiable function {h\!:\!\mathbb{R}_{\geq 0}\!\times\!\mathcal{X}\!\to\!\mathbb{R}} : \mathcal{C}(t)\!\triangleq\!\left\{\mathbf{x}\!\in\!\mathcal{X}\!\subseteq\!\mathbb{R}^{n}\!:\!h(t,\mathbf{x})\!\geq\!0\right\}. This set is said to be forward invariant if, for any initial condition {\mathbf{x}(t_{0})\!\in\!\mathcal{C}(t_{0})} , the solution \mathbf{x}(t) stays in {\mathcal{C}(t),~\forall t\geq\!t_{0}} . The closed-loop system ( 2 ) is safe with respect to the safe set \mathcal{C}(t) if \mathcal{C}(t) is forward invariant. To design controllers that guarantee such forward invariance properties, CBFs [ 2 ] provide a systematic framework. Definition 1 (Control Barrier Function, [ 2 ] ) . Let {\mathcal{C}(t)\!\subseteq\!\mathcal{X}} be the 0-superlevel set of a continuously differentiable function {h\!:\!\mathbb{R}_{\geq 0}\!\times\!\mathcal{X}\!\to\!\mathbb{R}} with 0 as a regular value. The function

Read the complete text