pith. sign in

arxiv: 2604.23039 · v1 · submitted 2026-04-24 · 💻 cs.RO

Control Barrier Functions Solved with Hierarchical Quadratic Programming for Safe Physical Human-Robot Interaction

Pith reviewed 2026-05-08 11:18 UTC · model grok-4.3

classification 💻 cs.RO
keywords control barrier functionshierarchical quadratic programmingphysical human-robot interactionrobot safetyquadratic programmingredundant manipulatorscollaborative robots
0
0 comments X

The pith

A CBF-based hierarchical quadratic programming framework allows safety and performance tasks to be prioritized flexibly in physical human-robot interaction.

A machine-rendered reading of the paper's core claim, the machinery that carries it, and where it could break.

This paper aims to show that Control Barrier Functions can be incorporated into a Hierarchical Quadratic Programming structure for physical human-robot interaction. By placing both safety constraints and performance objectives at different levels of the hierarchy, conflicts can be handled by relaxing lower-priority tasks without losing higher ones. A sympathetic reader cares because this offers a practical way to maintain robot safety around humans while achieving useful collaborative behaviors like desired interaction points. The work validates the method through experiments on a redundant robot, confirming real-time feasibility and flexibility.

Core claim

The authors claim that using CBFs solved via HQP in pHRI enables performance tasks, such as preserving desired behavior at the interaction point, and safety tasks to be designed at any hierarchy level. This provides a more flexible balance between safety and performance compared to flat QP formulations. Hierarchical relaxation ensures solution feasibility in case of conflicts. The approach is shown effective in extensive real-robot experiments.

What carries the argument

Control Barrier Functions embedded as constraints in a Hierarchical Quadratic Programming optimization problem.

If this is right

  • High-priority safety tasks remain satisfied even if lower tasks are relaxed.
  • Performance at the human-robot interaction point can be prioritized when safety allows.
  • The framework supports redundant robots by exploiting task hierarchies.
  • Real-time implementation is possible without compromising safety guarantees.

Where Pith is reading between the lines

These are editorial extensions of the paper, not claims the author makes directly.

  • Designers could use this to create adaptive safety systems that adjust priorities dynamically based on context.
  • This method might extend to multi-robot or human-in-the-loop systems with shared tasks.
  • Limitations in modeling human behavior could affect CBF accuracy in more complex interactions.

Load-bearing premise

That relaxing lower-priority tasks in the hierarchy will always yield a feasible real-time solution while preserving the safety guarantees of higher-priority tasks, even under task conflicts.

What would settle it

Demonstration of a conflict scenario on the robot where the QP either becomes infeasible or a safety barrier is breached despite the hierarchy.

Figures

Figures reproduced from arXiv: 2604.23039 by Cheng Fang, Federico Califano, Jonas Mariager Jakobsen, Rui Luo, Wesley Roozing.

Figure 1
Figure 1. Figure 1: A real physical human-robot interaction scenario with multiple strict safety tasks and a hierarchy of soft tasks of different priority levels. In most prior work, all CBF safety constraints are for￾mulated as a set of inequality constraints, typically solved together in a single QP, which is desirable when all of these constraints are equally important and strict. However, when we apply the CBF framework t… view at source ↗
Figure 2
Figure 2. Figure 2: Diagram of a cascaded structure of the CBF-HQP for a physical human-robot interaction scenario. Before constructing the hierarchical layers, we first define the initial admissible set S0. All strict safety tasks, including collision avoidance, joint velocity torque limits, are expressed in a unified affine inequality form as A0(x) u ≥ b0(x), (15) where A0(x) and b0(x) are obtained by stacking the corre￾spo… view at source ↗
Figure 3
Figure 3. Figure 3: Experiment 1 (Equilibrium shift): total kinetic energy. Time (s) Wactual ! Wnominal (N, N m) 0 0.2 0.4 0.6 0.8 1 -20 0 20 1-layer QP, . = 10 (a) 0 0.2 0.4 0.6 0.8 1 -20 0 20 1-layer QP, . = 50 (b) 0 0.2 0.4 0.6 0.8 1 -20 0 20 1-layer QP, . = 100 (c) 0 0.2 0.4 0.6 0.8 1 -20 0 20 HQP, . = 10 (d) 0 0.2 0.4 0.6 0.8 1 -20 0 20 HQP, . = 50 (e) 0 0.2 0.4 0.6 0.8 1 -20 0 20 HQP, . = 100 (f) Fx Fy Fz Mx My Mz view at source ↗
Figure 4
Figure 4. Figure 4: Experiment 1 (Equilibrium shift): Cartesian wrench deviation. Time (s) , ! ,nominal (N m) 0 0.2 0.4 0.6 0.8 1 -1 -0.5 0 0.5 1 1-layer QP, . = 10 (a) 0 0.2 0.4 0.6 0.8 1 -1 -0.5 0 0.5 1 1-layer QP, . = 50 (b) 0 0.2 0.4 0.6 0.8 1 -1 -0.5 0 0.5 1 1-layer QP, . = 100 (c) 0 0.2 0.4 0.6 0.8 1 -1 -0.5 0 0.5 1 HQP, . = 10 (d) 0 0.2 0.4 0.6 0.8 1 -1 -0.5 0 0.5 1 HQP, . = 50 (e) 0 0.2 0.4 0.6 0.8 1 -1 -0.5 0 0.5 1 H… view at source ↗
Figure 5
Figure 5. Figure 5: Experiment 1 (Equilibrium shift): Null-space component. elastic potential energy into the system, which was rapidly converted into kinetic energy, potentially leading to large transient motions view at source ↗
Figure 6
Figure 6. Figure 6: Experiment 2 (Sinusoidal external force): total kinetic energy. Time (s) Wactual ! Wnom (N; N m) 0 1 2 3 4 5 -10 0 10 1-layer QP, . = 10 (a) 0 1 2 3 4 5 -10 0 10 1-layer QP, . = 50 (b) 0 1 2 3 4 5 -10 0 10 1-layer QP, . = 100 (c) 0 1 2 3 4 5 -10 0 10 Safety HQP, . = 10 (d) 0 1 2 3 4 5 -10 0 10 Safety HQP, . = 50 (e) 0 1 2 3 4 5 -10 0 10 Safety HQP, . = 100 (f) 0 1 2 3 4 5 -10 0 10 Performance HQP, . = 10 (… view at source ↗
Figure 7
Figure 7. Figure 7: Experiment 2 (Sinusoidal external force): Cartesian wrench deviation. Time (s) , ! ,nom (N m) 0 1 2 3 4 5 -1 0 1 1-layer QP, . = 10 (a) 0 1 2 3 4 5 -1 0 1 1-layer QP, . = 50 (b) 0 1 2 3 4 5 -1 0 1 1-layer QP, . = 100 (c) 0 1 2 3 4 5 -1 0 1 Safety HQP, . = 10 (d) 0 1 2 3 4 5 -1 0 1 Safety HQP, . = 50 (e) 0 1 2 3 4 5 -1 0 1 Safety HQP, . = 100 (f) 0 1 2 3 4 5 -1 0 1 Performance HQP, . = 10 (g) 0 1 2 3 4 5 -1… view at source ↗
Figure 8
Figure 8. Figure 8: Experiment 2 (Sinusoidal external force): null-space compo￾nent. In Figs. 6–8, subplots (a–c) are of the single-layer QP baseline method, (d–f) correspond to the safety-priority HQP, and (g–i) correspond to the performance-priority HQP. Figures 6 and 7 illustrate the kinetic energy evolution and view at source ↗
read the original abstract

Physical human-robot interaction offers the potential to leverage human intelligence and robot physical capabilities to enable a range of exciting applications, e.g., collaborative robots for rehabilitation. Safety is critical for the successful deployment of this kind of robotic system. In recent years, Control Barrier Function (CBF) has emerged as an effective approach to enforce safety guarantees, which has been widely applied in various applications, from adaptive cruise control to navigation of legged robots. CBFs can be solved in a Quadratic Programming (QP) problem, which can include many CBF-formulated tasks. To manage a large number of safety tasks, a hierarchical CBF has been used to allow hierarchical relaxation of safety tasks to ensure the feasibility of a solution in the presence of conflicting tasks. In this work, we propose to use a CBF-based Hierarchical Quadratic Programming (HQP) framework in physical human-robot interaction to allow us to design both performance tasks (e.g., preserve the desired behavior at the human-robot interaction point) and safety tasks at any level of a hierarchy to balance the safety and the performance in a more flexible way. Extensive experiments were carried out on a real redundant robot to validate the effectiveness, flexibility, and generality of this approach.

Editorial analysis

A structured set of objections, weighed in public.

Desk editor's note, referee report, simulated authors' rebuttal, and a circularity audit. Tearing a paper down is the easy half of reading it; the pith above is the substance, this is the friction.

Referee Report

1 major / 1 minor

Summary. The paper proposes a Control Barrier Function (CBF) based Hierarchical Quadratic Programming (HQP) framework for physical human-robot interaction (pHRI). It allows both performance tasks (such as preserving desired behavior at the human-robot interaction point) and safety tasks to be assigned to any level in the task hierarchy, enabling more flexible balancing of safety and performance compared to standard CBF-QP formulations. The approach is validated via extensive experiments on a real redundant robot.

Significance. If the safety guarantees can be rigorously established for arbitrary hierarchy placements, the framework would provide a practical extension of CBF methods to redundant manipulators in collaborative settings, allowing performance objectives to take precedence without immediate loss of feasibility. The real-robot experiments are a strength, though their limited description in the abstract reduces the ability to assess generalizability.

major comments (1)
  1. [Proposed Framework (as described in Abstract)] The central claim relies on CBF safety guarantees holding even when safety tasks are placed below performance tasks in the HQP hierarchy. However, standard CBF theory requires strict enforcement of the barrier constraint (Lie derivative condition) for forward invariance of the safe set; the proposed relaxation via HQP priority ordering or slack variables does not automatically preserve h(x) ≥ 0 for all time when a higher-priority performance task conflicts. No explicit proof, invariance condition, or modified barrier formulation is provided to address this case.
minor comments (1)
  1. [Abstract] The abstract states that 'extensive experiments were carried out on a real redundant robot to validate the effectiveness, flexibility, and generality' but provides no details on the specific robot, task definitions, performance metrics (e.g., tracking error, safety violation rates), failure cases, or how QP feasibility was ensured in real time.

Simulated Author's Rebuttal

1 responses · 0 unresolved

We thank the referee for their thorough review and valuable feedback on our manuscript. We provide a point-by-point response to the major comment below.

read point-by-point responses
  1. Referee: [Proposed Framework (as described in Abstract)] The central claim relies on CBF safety guarantees holding even when safety tasks are placed below performance tasks in the HQP hierarchy. However, standard CBF theory requires strict enforcement of the barrier constraint (Lie derivative condition) for forward invariance of the safe set; the proposed relaxation via HQP priority ordering or slack variables does not automatically preserve h(x) ≥ 0 for all time when a higher-priority performance task conflicts. No explicit proof, invariance condition, or modified barrier formulation is provided to address this case.

    Authors: We acknowledge the validity of this observation. The standard CBF-QP formulation enforces the barrier condition strictly to ensure forward invariance. In our CBF-HQP approach, by allowing safety tasks to be assigned to lower levels in the hierarchy, we intentionally permit relaxation of the safety constraint when it conflicts with a higher-priority performance task. This provides the flexibility highlighted in the paper but does compromise the strict safety guarantee in such cases. The manuscript does not include an explicit proof or modified invariance condition for arbitrary hierarchy placements, as the focus is on the practical implementation and experimental validation on a real robot. We will revise the manuscript to include a clearer discussion of this trade-off, explicitly noting that safety guarantees hold only when the safety task is not relaxed due to higher-priority conflicts, and we will add conditions or examples where the hierarchy preserves safety. revision: yes

Circularity Check

0 steps flagged

No circularity: framework extends established CBF-HQP methods with independent experimental validation

full rationale

The paper's core contribution is a proposed CBF-based HQP architecture that permits safety and performance tasks at arbitrary hierarchy levels for pHRI. No derivation step reduces a claimed result to a fitted parameter, self-referential definition, or unverified self-citation chain. The abstract and described approach explicitly build on prior CBF and hierarchical QP literature (standard external references) and then validate the specific instantiation via real-robot experiments on a redundant manipulator. The skeptic concern about forward-invariance under relaxation is a question of proof completeness or assumption strength, not a circular reduction of the stated claims to their inputs. No equations or load-bearing steps in the provided material exhibit self-definition, renaming of known results, or ansatz smuggling.

Axiom & Free-Parameter Ledger

0 free parameters · 0 axioms · 0 invented entities

Abstract-only review provides no explicit free parameters, axioms, or invented entities; the approach relies on standard CBF and QP assumptions from prior literature.

pith-pipeline@v0.9.0 · 5520 in / 1007 out tokens · 32748 ms · 2026-05-08T11:18:47.473381+00:00 · methodology

discussion (0)

Sign in with ORCID, Apple, or X to comment. Anyone can read and Pith papers without signing in.

Reference graph

Works this paper leans on

24 extracted references · 24 canonical work pages

  1. [1]

    Human modeling in physical human-robot interaction: A brief survey,

    C. Fang, L. Peternel, A. Seth, M. Sartori, K. Mombaur, and E. Yoshida, “Human modeling in physical human-robot interaction: A brief survey,” IEEE Robotics and Automation Letters, vol. 8, no. 9, pp. 5799–5806, 2023

  2. [2]

    Control barrier functions: Theory and applications,

    A. D. Ames, S. Coogan, M. Egerstedt, G. Notomista, K. Sreenath, and P. Tabuada, “Control barrier functions: Theory and applications,” in2019 18th European control conference (ECC). Ieee, 2019, pp. 3420–3431

  3. [3]

    New dynamic obstacle avoidance algorithm with hybrid index based on gradient projection method,

    C. Fang and J. Zhao, “New dynamic obstacle avoidance algorithm with hybrid index based on gradient projection method,”Journal of Mechanical Engineering, vol. 46, no. 19, pp. 30–37, 2010

  4. [4]

    Safety-critical kinematic control of robotic systems,

    A. Singletary, S. Kolathaya, and A. D. Ames, “Safety-critical kinematic control of robotic systems,”IEEE Control Systems Letters, vol. 6, pp. 139–144, 2021

  5. [5]

    Adaptive admittance control for safety-critical physical human robot collaboration,

    Y . Sun, M. Van, S. McIlvanna, N. N. Minh, S. McLoone, and D. Ceglarek, “Adaptive admittance control for safety-critical physical human robot collaboration,”IF AC-PapersOnLine, vol. 56, no. 2, pp. 1313–1318, 2023

  6. [6]

    Safe, task-consistent manipulation with operational space control barrier functions,

    D. Morton and M. Pavone, “Safe, task-consistent manipulation with operational space control barrier functions,” in2025 IEEE/RSJ Inter- national Conference on Intelligent Robots and Systems (IROS). IEEE, 2025, pp. 187–194

  7. [7]

    Safety barrier functions and multi-camera tracking for human–robot shared environment,

    F. Ferraguti, C. T. Landi, S. Costi, M. Bonfè, S. Farsoni, C. Secchi, and C. Fantuzzi, “Safety barrier functions and multi-camera tracking for human–robot shared environment,”Robotics and Autonomous Systems, vol. 124, p. 103388, 2020

  8. [8]

    Proactive hierarchical control barrier function-based constraint prioritization to enhance safety in human-robot interaction,

    P. Maithani, A. Arab, F. Khorrami, and P. Krishnamurthy, “Proactive hierarchical control barrier function-based constraint prioritization to enhance safety in human-robot interaction,”Control Engineering Practice, vol. 166, p. 106624, 2026

  9. [9]

    A novel safety-aware energy tank formulation based on control barrier functions,

    Y . Michel, M. Saveriano, and D. Lee, “A novel safety-aware energy tank formulation based on control barrier functions,”IEEE Robotics and Automation Letters, vol. 9, no. 6, pp. 5206–5213, 2024

  10. [10]

    Limiting kinetic energy through control barrier functions: Analysis and experimental validation,

    F. Califano, D. Logmans, and W. Roozing, “Limiting kinetic energy through control barrier functions: Analysis and experimental validation,” IEEE Robotics and Automation Letters, 2025

  11. [11]

    Adaptive safety with control barrier functions,

    A. J. Taylor and A. D. Ames, “Adaptive safety with control barrier functions,” in2020 American Control Conference (ACC). IEEE, 2020, pp. 1399–1405

  12. [12]

    Control barrier function based quadratic programs with application to adaptive cruise control,

    A. D. Ames, J. W. Grizzle, and P. Tabuada, “Control barrier function based quadratic programs with application to adaptive cruise control,” in53rd IEEE conference on decision and control. IEEE, 2014, pp. 6271–6278

  13. [13]

    Safety-critical coordination of legged robots via layered controllers and forward reachable set based control barrier functions,

    J. Kim, J. Lee, and A. D. Ames, “Safety-critical coordination of legged robots via layered controllers and forward reachable set based control barrier functions,” in2024 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2024, pp. 3478–3484

  14. [14]

    A general framework for managing multiple tasks in highly redundant robotic systems,

    S. B. Slotine and B. Siciliano, “A general framework for managing multiple tasks in highly redundant robotic systems,” inproceeding of 5th International Conference on Advanced Robotics, vol. 2, 1991, pp. 1211–1216

  15. [15]

    Fast resolution of hierarchized inverse kinematics with inequality constraints,

    A. Escande, N. Mansard, and P.-B. Wieber, “Fast resolution of hierarchized inverse kinematics with inequality constraints,” in2010 IEEE International Conference on Robotics and Automation. IEEE, 2010, pp. 3733–3738

  16. [16]

    A unified approach to integrate unilateral constraints in the stack of tasks,

    N. Mansard, O. Khatib, and A. Kheddar, “A unified approach to integrate unilateral constraints in the stack of tasks,”IEEE Transactions on Robotics, vol. 25, no. 3, pp. 670–685, 2009

  17. [17]

    Kinematic control of redundant manipulators: Generalizing the task-priority framework to inequality task,

    O. Kanoun, F. Lamiraux, and P.-B. Wieber, “Kinematic control of redundant manipulators: Generalizing the task-priority framework to inequality task,”IEEE Transactions on Robotics, vol. 27, no. 4, pp. 785–792, 2011

  18. [18]

    Efficient self-collision avoidance based on focus of interest for humanoid robots,

    C. Fang, A. Rocchi, E. M. Hoffman, N. G. Tsagarakis, and D. G. Caldwell, “Efficient self-collision avoidance based on focus of interest for humanoid robots,” in2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids). IEEE, 2015, pp. 1060–1066

  19. [19]

    Feature-based locomotion controllers,

    M. De Lasa, I. Mordatch, and A. Hertzmann, “Feature-based locomotion controllers,”ACM transactions on graphics (TOG), vol. 29, no. 4, pp. 1–10, 2010

  20. [20]

    A dedicated solver for fast operational-space inverse dynamics,

    N. Mansard, “A dedicated solver for fast operational-space inverse dynamics,” in2012 IEEE International Conference on Robotics and Automation. IEEE, 2012, pp. 4943–4949

  21. [21]

    Hierarchical quadratic programming: Fast online humanoid-robot motion generation,

    A. Escande, N. Mansard, and P.-B. Wieber, “Hierarchical quadratic programming: Fast online humanoid-robot motion generation,”The International Journal of Robotics Research, vol. 33, no. 7, pp. 1006– 1028, 2014

  22. [22]

    A generic optimization-based framework for reactive collision avoidance in bipedal locomotion,

    C. Zhou, C. Fang, X. Wang, Z. Li, and N. Tsagarakis, “A generic optimization-based framework for reactive collision avoidance in bipedal locomotion,” in2016 IEEE International Conference on Automation Science and Engineering (CASE). IEEE, 2016, pp. 1026–1033

  23. [23]

    Hierarchical relaxation of safety- critical controllers: Mitigating contradictory safety conditions with application to quadruped robots,

    J. Lee, J. Kim, and A. D. Ames, “Hierarchical relaxation of safety- critical controllers: Mitigating contradictory safety conditions with application to quadruped robots,” in2023 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2023, pp. 2384–2391

  24. [24]

    An overview of null space projections for redundant, torque-controlled robots,

    A. Dietrich, C. Ott, and A. Albu-Schäffer, “An overview of null space projections for redundant, torque-controlled robots,”The International Journal of Robotics Research, p. 0278364914566516, 2015