Contact-Aware Safety in Soft Robots Using High-Order Control Barrier and Lyapunov Functions

Kiwan Wong, Maximilian Stölzle, Wei Xiao, Cosimo Della Santina, Daniela Rus, Gioele Zardini · 2025

Read Contact-Aware Safety in Soft Robots Using High-Order Control Barrier and Lyapunov Functions by Kiwan Wong, Maximilian Stölzle, Wei Xiao, Cosimo Della Santina, Daniela Rus, Gioele Zardini (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-2505-03841.txt.

Introduction

Soft robots are gentle by nature, but stronger, faster designs with stiff parts can hurt people again. The authors build a safety framework that caps contact forces across the whole body of a soft manipulator as it touches the world. Their controller combines high-order barrier functions, which hard-limit danger, with high-order Lyapunov functions, which steer the motion. A differentiable model of the robot's bending segments supplies the physics, and a fast geometric test tracks distances to nearby objects.

The distance method approximates shapes with convex polygons and stays smooth enough for real-time optimization. In planar simulations, the robot keeps its contacts inside the safety bounds while still following shape and position goals precisely. The authors present the framework as a foundation for deploying soft robots around people with provable safety, from elder care to factory floors. They note the results so far are in simulation.

Catalog record

CREATORKiwan Wong, Maximilian Stölzle, Wei Xiao, Cosimo Della Santina, Daniela Rus, Gioele Zardini
YEAR2025
COLLECTIONPAPERS
FORMATTXT
FILE SIZE47 KB
VERSION1.0
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2505-03841

Browse the full library · About the Tower of Babel

Full text

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

Contact-Aware Safety in Soft Robots Using High-Order Control Barrier and Lyapunov Functions Kiwan Wong, Maximilian Stölzle, Wei Xiao, Cosimo Della Santina, Daniela Rus, Gioele Zardini Abstract Robots operating alongside people, particularly in sensitive scenarios such as aiding the elderly with daily tasks or collaborating with workers in manufacturing, must guarantee safety and cultivate user trust. Continuum soft manipulators promise safety through material compliance, but as designs evolve for greater precision, payload capacity, and speed, and increasingly incorporate rigid elements, their injury risk resurfaces. In this letter, we introduce a comprehensive High-Order Control Barrier Function (HOCBF) + High-Order Control Lyapunov Function (HOCLF) framework that enforces strict contact force limits across the entire soft-robot body during environmental interactions. Our approach combines a differentiable Piecewise Cosserat-Segment (PCS) dynamics model with a convex-polygon distance approximation metric, named Differentiable Conservative Separating Axis Theorem (DCSAT), based on the soft robot geometry to enable real-time, whole-body collision detection, resolution, and enforcement of the safety constraints. By embedding HOCBFs into our optimization routine, we guarantee safety, allowing, for instance, safe navigation in operational space under HOCLF-driven motion objectives. Extensive planar simulations demonstrate that our method maintains safety-bounded contacts while achieving precise shape and task-space regulation. This work thus lays a foundation for the deployment of soft robots in human-centric environments with provable safety and performance. I Introduction Deploying robots in human-centered environments, such as assisting workers in manufacturing or supporting older adults in everyday activities [ 1 ] , demands not only demonstrable safety but also user confidence in the robot’s behavior. Traditional rigid collaborative manipulators address this need through increasingly sophisticated algorithms for collision detection [ 2 ] , impedance control [ 3 ] , Model Predictive Control [ 4 ] , and, more recently, Control Barrier Functions [ 5 , 6 ] , and the successful integration of Lyapunov-based methods with reinforcement learning to ensure robotic safety [ 7 ] . Yet, perception errors or model inaccuracies can still expose users to hazardous impacts. Continuum soft manipulators offer a fundamentally different path to safety: instead of relying solely on software, they seek to embed safety directly through compliance [ 8 ] . However, material softness is not a panacea [ 9 , 10 ] . As the field advances toward greater precision and functionality, emerging designs are expected to incorporate increased stiffness, exert larger forces and velocities [ 11 ] , and adopt hybrid rigid-soft architectures [ 12 ] . Such developments reintroduce risks traditionally associated with rigid systems. Thus, mechanical compliance must be augmented with algorithmic guarantees that ensure real-time safety and foster user trust. Fig. 1: Contact Safety-Aware Control of Soft Robots with High-Order CBFs and High-Order CLFs. Illustration of compliant contact control with safety bounds guaranteed by High-Order CBFs. By respecting contact force limits, the robot can intentionally engage with its surroundings without sacrificing safety. Task goals are shaped through High-Order CLFs, while constraint satisfaction is upheld by High-Order CBFs. This approach enables the secure use of soft robots in demanding settings—from search‑and‑rescue missions to delicate medical procedures. Our approach embraces, rather than avoids, physical contact 1 1 1 Please note that we use “contact” and “collision” interchangeably. [ 13 , 14 , 10 ] , deviating from the predominant paradigm in rigid robotics [ 2 , 15 ] . Instead of treating contact as a failure, we exploit the soft robot’s embodied intelligence [ 16 ] —its intrinsic physical coupling with the environment—to enhance robustness, stabilize deformation and motion, and adapt to external constraints, all while ensuring that every interaction respects safety standards such as the injury severity thresholds set out in ISO/TS 15066:2016 [ 15 ] . To date, no method explicitly enforces upper bounds on the contact force or pressure applied across the entire surface of a soft robot, while accounting for the system’s inertia. Classical impedance and force control schemes cannot impose strict bounds [ 17 ] , and Control Barrier Function-based methods [ 12 ] address only self-contact avoidance. A recently published paper [ 10 ] adapts Control Barrier Functions as a safety filter to constrain end-effector forces, but it neglects distributed body interactions and relies on a simplified template model that approximates the continuum bending behavior with an articulated chain of masses connected by prismatic joints [ 17 ] while neglecting important strains such as shear or elongation. Instead, Xu et al. [ 14 ] measures contact forces between the soft robot body and obstacles in the environment, but defines a kinematics-aware Control Barrier Function instead of a dynamics-aware High-Order CBF; therefore, it neglects the dynamics of the system, which can, in turn, cause safety issues. To fill this research gap, we present an integrated control framework that imposes contact‑force limits along the entire body of a soft manipulator based on differentiable dynamic strain models. Building on the well‑established Control Barrier Function+Control Lyapunov Function framework [ 5 ] —specifically its high‑order extension [ 18 ] —our method optimizes for a control objective encoded in an High-Order CLF while keeping the system’s trajectory inside a certified safe set as specified by High-Order CBF constraints by solving a constrained Quadratic Program online. The proposed High-Order CBF+High-Order CLF control scheme rests on two pillars: (i) a fully differentiable implementation of the Piecewise Constant Strain [ 19 , 20 ] , and (ii) a fast, differentiable collision detection & resolution routine that represents the soft manipulator with convex‑polygon approximations. In support of pillar (ii), we propose a new convex‑polygon distance measure—Differentiable Conservative SAT—that serves as a conservative, differentiable proxy for the standard Separating Axis Theorem metric. Compared with recent differentiable SAT surrogates such as Smooth SAT [ 21 ] , our approach (1) systematically underestimates the separation distance, yielding the conservative buffer required for formal safety guarantees, and (2) achieves an increase of roughly 1.5–3× in computational efficiency, enabling real-time, full-body collision checks. We then validate the proposed framework through extensive simulations in a planar setting. In summary, this letter (i) develops a principled High-Order CBF-based method to enforce global contact force constraints on soft robots, (ii) adapts the High-Order CBF+High-Order CLF framework for operational space regulation supporting navigation tasks, and (iii) presents Differentiable Conservative SAT, a new, fast, and conservative differentiable collision-detection method for arbitrary convex geometries, improving the feasibility of real-time use for full-body safety guarantees. A video attachment is available on YouTube 2 2 2 https://youtu.be/ahUhVXiRDPE and the code is open-sourced on GitHub 3 3 3 https://edu.nl/yekue . II Background This section introduces the background necessary for introducing the methodology and, later, the baseline methods. For clarity and simplicity, we focus on the planar case throughout this letter, though the framework naturally generalizes to 3D scenarios. II-A Soft Robotic Kinematics and Dynamics We model the soft robot kinematics using the Piecewise Constant Strain formulation [ 19 ] , which approximates the continuous backbone by discretizing it into N segments, where each segment exhibits the spatially constant strain \bm{\xiit}_{i}\in\mathbb{R}^{3} . The robot configuration \bm{q} is then defined as the deviation of these strains from their equilibrium values, yielding a generalized coordinate vector \bm{q}\in\mathbb{R}^{3N} . Based on this kinematic model, the forward kinematics map \bm{\chiit}=\operatorname{FK}(\bm{q},s):\mathbb{R}^{3N}\times(0,L]\rightarrow SE(2) returns the Cartesian position \bm{\chiit}=\begin{bmatrix}\thetait&p_{\mathrm{x}}&p_{\mathrm{y}}\end{bmatrix}^{\top} at a given arc-length position s along the backbone,

Read the complete text