Safe, Task-Consistent Manipulation with Operational Space Control Barrier Functions
Daniel Morton, Marco Pavone · 2025
Read Safe, Task-Consistent Manipulation with Operational Space Control Barrier Functions by Daniel Morton, Marco Pavone (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-2503-06736.txt.
Introduction
A robot arm working near people must never trade safety for the task, yet it also must not freeze. Daniel Morton and Marco Pavone present a safety framework built on control barrier functions, mathematical fences that keep the arm inside safe territory. Their version works in operational space, the space of the hand's position and orientation, and respects the task's own priorities.
Older safety schemes get stuck in local traps or cost too much computing time. This one scales to hundreds of simultaneous constraints, covering collision avoidance, singularity prevention, and staying inside the workspace, while still running at real-time rates. Because the task hierarchy is built into the safety calculation, performance holds up even at the edge of the safe zone. The team validated the system in simulation and on real hardware, and released the code openly.
Catalog record
| CREATOR | Daniel Morton, Marco Pavone |
|---|---|
| YEAR | 2025 |
| COLLECTION | PAPERS |
| FORMAT | TXT |
| FILE SIZE | 38 KB |
| VERSION | 1.0 |
| LICENSE | http://creativecommons.org/licenses/by/4.0/ |
| RIGHTS | CC BY |
| SOURCE | arXiv |
Source: https://arxiv.org/abs/2503-06736
Browse the full library · About the Tower of Babel
Full text
The opening of the work, from the library's hosted text:
Safe, Task-Consistent Manipulation with Operational Space Control Barrier Functions Daniel Morton, Marco Pavone Abstract Safe real-time control of robotic manipulators in unstructured environments requires handling numerous safety constraints without compromising task performance. Traditional approaches, such as artificial potential fields (APFs), suffer from local minima, oscillations, and limited scalability, while model predictive control (MPC) can be computationally expensive. Control barrier functions (CBFs) offer a promising alternative due to their high level of robustness and low computational cost, but these safety filters must be carefully designed to avoid significant reductions in the overall performance of the manipulator. In this work, we introduce an Operational Space Control Barrier Function (OSCBF) framework that integrates safety constraints while preserving task-consistent behavior. Our approach scales to hundreds of simultaneous constraints while retaining real-time control rates, ensuring collision avoidance, singularity prevention, and workspace containment even in highly cluttered and dynamic settings. By explicitly accounting for the task hierarchy in the CBF objective, we prevent degraded performance across both joint-space and operational-space tasks, when at the limit of safety. Our open-source, high-performance software will be available at our project webpage, https://stanfordasl.github.io/oscbf/ Fig. 1: Safe and performant highly-constrained manipulation . Our OSCBF controller maintains safety for hundreds of constraints enforced concurrently, using the full second-order robot dynamics and torque control, and operates at real-time control rates (over 1000 Hz). Shown above is the simultaneous constraint evolution for all CBFs during one adversarial trajectory from teleoperation. Across 168 safety conditions, the robot remains safe ( h(\mathbf{z})>0 ) without over-conservative behavior near the boundary of safety ( h(\mathbf{z})=0 ). I Introduction With autonomous robotic manipulators increasingly operating in unstructured environments, real-time safe control is critical – not only for collision avoidance but also for a broad range of other safety constraints that are common to manipulators, such as singularity avoidance. An ideal control framework should enforce these safety constraints while minimally modifying the robot’s desired behavior, even in dynamic scenarios or when multiple constraints must be satisfied simultaneously. Enforcing safety while retaining performance is particularly relevant for recent learning-based controllers, which may be quite versatile, but do not provide guarantees on safety [ 1 ] . Often, these learning-based policies operate in operational space, via end-effector motion commands. Similarly, when collecting data for imitation learning, teleoperated demonstrations often only command a motion of the end-effector [ 2 , 3 ] . In both settings (training and deployment), the manipulator must rely on a lower-level operational space controller (OSC) [ 4 ] to map the end-effector motions back to the whole-body control of the robot. This introduces potential safety concerns at multiple levels: the operational space command itself may be unsafe, or the mapping back to the whole-body motion may be unsafe. To maintain safety, the low-level controller must therefore consider multiple constraints, in both the operational and joint spaces. Artificial potential fields (APFs) [ 5 ] have long served as a simple way of encoding safety in operational space control via repulsive forces around obstacles. However, APFs suffer from a few key problems: they can lead to oscillations when close to obstacles or moving quickly, they can influence the dynamics even far from an unsafe region, and they can require extensive tuning to avoid creating local minima [ 6 , 7 ] . APFs can be designed to accommodate multiple task objectives and safety constraints [ 8 ] but this requires an explicit hierarchy and null space for each constraint, which does not scale to highly-constrained settings. Model predictive control (MPC), alternatively, handles safety via constrained receding-horizon optimal control. However, MPC can face computational challenges, particularly if the system is subject to nonconvex constraints and nonlinear dynamics. For MPC to run at real-time rates on a manipulator, either safety conditions are not considered [ 9 ] , or assumptions must be made about the reference trajectory [ 10 ] . Another approach, control barrier functions (CBFs) are a minimally-invasive means of enforcing safety for nonlinear systems via optimization-based controllers, and improve upon APFs with less computational demands than MPC [ 7 ] . Due to their robustness and real-time capabilities, CBFs have been successfully demonstrated on a wide range of systems, including manipulators [ 11 , 12 , 13 , 14 , 15 , 16 , 17 ] . Previous work on CBFs for manipulators often assume a reduced-order model with direct control over the joint velocities, and only extend safety conditions to the full-order dynamics with the assumption that a low-level controller can track a velocity command reasonably well [ 11 , 15 ] . However, this condition does not hold under dynamic maneuvers, and cannot be used with compliant control. Often, these safety criteria are analyzed only over joint-space motions, neglecting the impact on the operational-space dynamics which are critical for teleoperation and learning-based control [ 17 ] . Works that analyze the operational space [ 12 , 13 ] often neglect how to best balance hierarchical task performance and safety in the joint space and operational space, or handling multiple safety constraints. I-A Statement of Contributions We present a framework for integrating Control Barrier Functions (CBFs) into Operational Space Contol (OSC) which (1) enforces safety while respecting the hierarchical task definition of OSC across the operational and joint spaces, (2) applies to both kinematically- and dynamically- controlled manipulators, and (3) scales to large numbers of safety conditions while maintaining real-time control rates, even when performing dynamic motions through highly-occluded environments. Additionally, we release our software, CBFpy [ 18 ] , which provides an easy-to-use and high-performance interface for CBF controller design. The code, along with additional media, will be made available at https://stanfordasl.github.io/oscbf/ I-B Paper Organization In Section II , we review the construction of control barrier functions for constraints of relative degree 1 and 2, and discuss practical application of CBFs for highly-constrained systems. In Section III , we review manipulator kinematics, dynamics, and tasks. In Section IV , we detail the necessity of task-consistent safety filters, then we construct our Operational Space Control Barrier Function (OSCBF) controller, for both velocity- and torque- controlled robots. In Section V , we present analysis of the OSCBF controller’s performance and computational efficiency for five common types of safety constraints, then, in simulation, we evaluate the controller in highly constrained environments and during dynamic motions. II Control Barrier Functions Consider a continuous-time dynamical system in control-affine form: \dot{\mathbf{z}}=f(\mathbf{z})+g(\mathbf{z})\mathbf{u} (1) with state \mathbf{z}\in\mathcal{Z}\subseteq\mathbb{R}^{n} , input \mathbf{u}\in\mathcal{U}\subseteq\mathbb{R}^{m} , and locally Lipschitz continuous dynamics functions f:\mathbb{R}^{n}\rightarrow\mathbb{R}^{n} and g:\mathbb{R}^{n}\rightarrow\mathbb{R}^{n\times m} . Safety can be posed through the lens of set invariance. For a safe subset of the state space, \mathcal{C}\subset\mathcal{Z} , if we can define a control barrier function h(\mathbf{z}):\mathbb{R}^{n}\rightarrow\mathbb{R} where \mathcal{C} is the zero-superlevel set of h , then a controller satisfying \dot{h}(\mathbf{z,u})\geq-\alpha(h(\mathbf{z})) (2) for \mathbf{u}\in\mathcal{U} and extended class \mathcal{K}_{\infty} function \alpha will render \mathcal{C} forward-invariant [ 19 ] . This condition, Eq. 2 , can be integrated into a quadratic program (QP) convex optimization problem, paired with a min-norm objective to operate as a safety filter on a nominal (unsafe) controller: \displaystyle\underset{\mathbf{u}}{\text{minimize}} \displaystyle\|\mathbf{u}-\mathbf{u}_{\text{nom}}\|_{2}^{2} (3) \displaystyle\text{subject to} \displaystyle L_{f}h(\mathbf{z})+L_{g}h(\mathbf{z})\mathbf{u}\geq-\alpha\left(h(\mathbf{z})\right) where L_{f} and L_{g} are the Lie derivatives of h along the dynamics, and \dot{h}(\mathbf{z,u})=L_{f}h(\mathbf{z})+L_{g}h(\mathbf{z})\mathbf{u} . The relative degree of a CBF refers to