Geometry-Aware Predictive Safety Filters on Humanoids: From Poisson Safety Functions to CBF Constrained MPC

Ryan M. Bena, Gilbert Bahati, Blake Werner, Ryan K. Cosner, Lizhi Yang, Aaron D. Ames · 2025

Read Geometry-Aware Predictive Safety Filters on Humanoids: From Poisson Safety Functions to CBF Constrained MPC by Ryan M. Bena, Gilbert Bahati, Blake Werner, Ryan K. Cosner, Lizhi Yang, 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-11129.txt.

Introduction

Ryan Bena and co-authors build a safety filter that lets legged robots roam without collisions. Their 2025 paper notes that humanoids and quadrupeds have lopsided shapes, which planners must respect. Their filter runs a predictive controller that steers online while honoring safety rules drawn from barrier functions. Those rules are built straight from sensor data through Poisson safety functions.

They extend the math so the safe zone can shift as the world moves. Shape-aware set tools then fold the robot's own geometry into the map. The filter ran in real time on a humanoid and a quadruped in risky scenes. The authors say the method shows how flexible these safety functions can be.

Catalog record

CREATORRyan M. Bena, Gilbert Bahati, Blake Werner, Ryan K. Cosner, Lizhi Yang, Aaron D. Ames
YEAR2025
COLLECTIONPAPERS
FORMATTXT
FILE SIZE42 KB
VERSION1.0
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

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

Browse the full library · About the Tower of Babel

Full text

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

Geometry-Aware Predictive Safety Filters on Humanoids: From Poisson Safety Functions to CBF Constrained MPC Ryan M. Bena, Gilbert Bahati, Blake Werner, Ryan K. Cosner, Lizhi Yang, Aaron D. Ames Abstract Autonomous navigation through unstructured and dynamically-changing environments is a complex task that continues to present many challenges for modern roboticists. In particular, legged robots typically possess manipulable asymmetric geometries which must be considered during safety-critical trajectory planning. This work proposes a predictive safety filter : a nonlinear model predictive control (MPC) algorithm for online trajectory generation with geometry-aware safety constraints based on control barrier functions (CBFs). Critically, our method leverages Poisson safety functions to numerically synthesize CBF constraints directly from perception data. We extend the theoretical framework for Poisson safety functions to incorporate temporal changes in the domain by reformulating the static Dirichlet problem for Poisson’s equation as a parameterized moving boundary value problem. Furthermore, we employ Minkowski set operations to lift the domain into a configuration space that accounts for robot geometry. Finally, we implement our real-time predictive safety filter on humanoid and quadruped robots in various safety-critical scenarios. The results highlight the versatility of Poisson safety functions, as well as the benefit of CBF constrained model predictive safety-critical controllers. I INTRODUCTION Robotic technology is evolving at an exciting rate; with this rapid evolution comes the increasing need for safe robotic autonomy. Whether one considers a quadrupedal robot performing an industrial inspection, an autonomous vehicle transporting passengers, or the Ingenuity helicopter flying above the Martian surface, collisions with the environment can often be irreversible and catastrophic. Humanoid robots in particular are designed to operate in complex and dynamically-changing human-occupied environments. Thus, it is critical to ensure that autonomous robots interact with their environments in a safe, predictable, and robust manner. The field of safety-critical control aims to tackle this challenge. Over the past several decades, various approaches have been proposed to address the notion of safe autonomy for dynamical systems. A few popular examples include Hamilton-Jacobi (HJ) reachability methods [ 1 ] , artificial potential fields (APFs) [ 2 ] , state-constrained model predictive control (MPC) [ 3 ] , and control barrier function (CBF) methods [ 4 ] . Of particular interest in this work are MPC and CBFs. MPC has demonstrated repeated success in robotics, with results ranging from legged locomotion [ 5 ] to autonomous car racing [ 6 ] . Meanwhile, CBFs continue to gain traction as an intuitive and efficient means of enforcing dynamic safety constraints on a broad class of systems [ 7 , 8 , 9 ] . Furthermore, the merger of MPC and CBFs, denoted MPC+CBF, has recently been highlighted as a powerful safety-critical control architecture [ 10 , 11 , 12 ] . MPC+CBF methods leverage the finite-horizon optimality of the traditional MPC problem with the dynamic safety guarantees of CBF constraints. Specifically, when CBF constraints are used along the MPC horizon, the resultant closed-loop autonomous system has provable robustness and recursive feasibility benefits [ 13 ] . Fig. 1: Predictive Safety Filtering with Poisson Safety Functions. From environmental perception data, we formulate a Dirichlet problem for Poisson’s equation with temporal and configurational dependencies. The resultant Poisson safety function informs the safety constraints within our CBF+MPC predictive safety filter . This safety filter generates a reference trajectory for an RL locomotion controller, which produces joint-level torque commands for a legged robot, resulting in safe autonomous behavior. Experimental footage is available at https://youtu.be/i8uMyW4iSQw . MPC+CBF methods seek to perform some nominal autonomous task while keeping the state of the robotic system within a safe region. This is often formalized as enforcing forward invariance of a safe set with respect to the closed-loop dynamics. As the first step in achieving forward invariance, the safe set is frequently characterized by a continuous safety function , the zero superlevel set of which precisely defines the safe set. In most published work, the safety function is specified via two methods: 1) an ad hoc analytical expression — this is the case in most CBF research, where “obstacles” in the environment are described by implicit geometric shapes, e.g., circles, ellipses, and rectangles [ 14 , 15 ] , or 2) a signed distance function (SDF) — this approach characterizes safety via a numerical function that represents the distance to the nearest safe set boundary (i.e. obstacle surface) [ 16 , 17 ] . We explore a more recent result: the Poisson safety function [ 18 ] , a numerical method which uses partial differential equations (PDEs) to characterize safe sets by solving Poisson’s equation in the spatial domain. Poisson safety functions have demonstrated benefits over ad hoc and SDF methods. In this work, we present a geometry-aware predictive safety filter for robotic systems, based on nonlinear MPC+CBF, that utilizes Poisson safety functions in higher-dimensional configuration space to enforce safe set forward invariance via translational and rotational degrees-of-freedom (DOFs). The main contributions of this paper are as follows: • Recasting the static Dirichlet problem in [ 18 ] as a moving boundary problem, we generate a time-varying safety function that extrapolates the evolution of the safe set over a finite future time interval. • Using Minkowski set operations based on robot occupancy, we lift the domain for Poisson’s equation into higher-dimensional configuration space, thus producing a Poisson safety function that has additional DOFs. • Employing our extended Poisson safety function as a CBF for a single-integrator, we formulate a novel MPC+CBF predictive safety filter, which enables safe geometry-aware trajectory generation in real-time. • We experimentally demonstrate the advantages of our online predictive safety filtering method on quadruped and humanoid robots in multiple challenging safety-critical scenarios. II PRELIMINARIES II-A Safety-Critical Control: Control Barrier Functions In this work, we discuss safety for control affine dynamical systems, i.e., systems whose state \boldsymbol{x}\in\mathbb{R}^{n} evolves according to the continuous-time dynamics: \dot{\boldsymbol{x}}=\boldsymbol{f}(\boldsymbol{x})+\boldsymbol{g}(\boldsymbol{x})\boldsymbol{u}, (1) where \boldsymbol{f}:\mathbb{R}^{n}\rightarrow\mathbb{R}^{n} and \boldsymbol{g}:\mathbb{R}^{n}\rightarrow\mathbb{R}^{n\times m} , assumed to be Lipschitz continuous, characterize the autonomous and non-autonomous behavior of the system, respectively, and \boldsymbol{u}\in\mathbb{R}^{m} is the control input. Given some Lipschitz continuous feedback law \boldsymbol{u}=\boldsymbol{k}(\boldsymbol{x}) , the closed-loop dynamics are: \dot{\boldsymbol{x}}=\boldsymbol{f}(\boldsymbol{x})+\boldsymbol{g}(\boldsymbol{x})\boldsymbol{k}(\boldsymbol{x}). (2) We characterize the safety of the system ( 1 ) with respect to a set \mathcal{S} : \displaystyle\mathcal{S}\coloneqq\left\{\boldsymbol{x}\in\mathbb{R}^{n}\,\big|\,h(\boldsymbol{x})\geq 0\right\}, (3) \displaystyle\partial\mathcal{S}\coloneqq\left\{\boldsymbol{x}\in\mathbb{R}^{n}\,\big|\,h(\boldsymbol{x})=0\right\}, (4) \displaystyle\mathrm{int}\left(\mathcal{S}\right)\coloneqq\left\{\boldsymbol{x}\in\mathbb{R}^{n}\,\big|\,h(\boldsymbol{x})>0\right\}, (5) where the zero superlevel set of the function h:\mathbb{R}^{n}\rightarrow\mathbb{R} represents the subset of \mathbb{R}^{n} for which the system state is considered safe. The aim of safety-critical control is to design a feedback control law \boldsymbol{k}(\boldsymbol{x}) that renders \mathcal{S} forward invariant. Definition 1 . (Forward Invariance) A set \mathcal{S} is forward invariant with respect to ( 2 ) if, for every initial state \boldsymbol{x}(t_{0})\in\mathcal{S} , the resulting state trajectory t\mapsto\boldsymbol{x}(t) remains in \mathcal{S} for all t\geq t_{0} . For control affine systems as in ( 1 ), the forward invariance of \mathcal{S} can be enforced using CBFs. Definition 2 . (Control Barrier Function (CBF) [ 19 ] ) Let \mathcal{S}\subset\mathbb{R}^{n} be a set as in ( 3 ), with function h satisfying \nabla h(\boldsymbol{x})\neq 0 when h(\boldsymbol{x})=0 . Then, the function h is a CBF on \mathcal{S} if there exists \gamma\in\mathcal{K}_{\infty}^{e} such that for all \boldsymbol{x}\in\mathbb{R}^{n} : \displaystyle\!\!\!\!\sup_{\boldsymbol{u}\in\mathbb{R}^{m}}\left\{\dot{h}(\boldsymbol{x},\boldsymbol{u})=L_{\boldsymbol{f}}h(\boldsymbol{x})+{L_{\boldsymbol{g}}h(\boldsymbol{x})}\boldsymbol{u}>-\gamma(h(\boldsymbol{x}))\right\}. (6) Given a CBF h and function \gamma , the set of control inputs satisfying ( 6 )

Read the complete text