A Clearpath Jackal navigates an unknown environment with BubbleCBF, mapping the SDF online (right).

Abstract

Satisfying safety constraints for systems with second-order dynamics is challenging because a position constraint may require infeasible deceleration. Higher-order control barrier functions (CBFs) provide an approach for expressing safety conditions for such systems but feasibility depends on the system dynamics and available control authority. We develop a constructive approach for designing feasible safety constraints for second-order control-affine systems. Starting from a signed distance function (SDF), we construct collision-free spheres, i.e., bubbles, in position space, and use their quadratic geometry and overlap to construct a velocity-dependent safety constraint. The associated safe set is represented as a union of intersections and enforced through a quadratic-program safety filter. Under mild assumptions on the dynamics, bubble overlap, and design parameters, we prove that the quadratic-program-based controller is well defined, continuous in the system state, and renders the set forward invariant. We also derive sufficient conditions for feasibility under bounded inputs. We demonstrate that our BubbleCBF, applied to a differential-drive robot, achieves safe autonomous navigation in unknown environments.

Why Bubbles?

Using an SDF directly as a CBF is common, but for second-order systems the resulting higher-order CBF constraint may become infeasible even if the SDF is C², because the robot can approach an obstacle too fast for any admissible input to stop it.

SDF-CBF baseline

Overshoots the turn and gets stuck.

BubbleCBF

Stays inside the bubbles and makes the turn.

Method

Each bubble is a ball sized by an SDF query at its center. Their union is lifted to a velocity-dependent safe set, and a QP safety filter limits outward motion near bubble boundaries so the robot can always stop in time.

  • SDF-to-HOCBF construction through BubbleCBF. For robot navigation, we convert SDF queries into quadratic balls whose analytic derivatives enable a feasible higher-order CBF design.
  • Feasibility of the union-of-balls CBF-QP. We construct a QP over the union of velocity-dependent bubble sets and prove feasibility and forward invariance under bounded control inputs.
  • Unknown-environment validation. We apply BubbleCBF to differential-drive navigation with online SDF estimation and demonstrate safe, deadlock-free operation in simulation and on hardware.
BubbleCBF navigation pipeline

LiDAR → online SDF → bubble cover → BubbleCBF safety filter.

Simulation at Increasing Speeds

Simulated trajectories at 1.0, 2.5 and 5.0 m/s

The nominal controller collides above 1 m/s, and SDF-CBF deadlocks at 5 m/s. BubbleCBF never collides or deadlocks.

Speed (m/s) Method Success (%) ↑ Collision (%) ↓ Deadlock (%) ↓ Timeout (%) ↓
5.0Nominal386200
BubbleCBF100000
SDF-CBF810190
2.5Nominal841600
BubbleCBF96004
SDF-CBF870130
1.0Nominal95500
BubbleCBF100000
SDF-CBF98020

100 trials per method and speed.

Real-World Experiments

Exploring an unknown cluttered arena (2× speed).

Cluttered environment and bubble cover

Bubble cover with executed trajectory (green) and reference Bézier path (white).

Metric BubbleCBF Nominal SDF-CBF
Success (%) ↑100.016.750.0
Collision (%) ↓0.083.30.0
Deadlock (%) ↓0.00.050.0
Covered area (m²) ↑8.42 ± 0.897.86 ± 1.758.75 ± 0.80
Obstacle distance (m) ↑0.720 ± 0.0300.714 ± 0.0520.687 ± 0.028

Six two-minute trials per method.

BibTeX

Coming soon.