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
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.
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
- 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
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.
Referee Report
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)
- [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)
- [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
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
-
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
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
Reference graph
Works this paper leans on
-
[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
work page 2023
-
[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
work page 2019
-
[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
work page 2010
-
[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
work page 2021
-
[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
work page 2023
-
[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
work page 2025
-
[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
work page 2020
-
[8]
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
work page 2026
-
[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
work page 2024
-
[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
work page 2025
-
[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
work page 2020
-
[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
work page 2014
-
[13]
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
work page 2024
-
[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
work page 1991
-
[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
work page 2010
-
[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
work page 2009
-
[17]
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
work page 2011
-
[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
work page 2015
-
[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
work page 2010
-
[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
work page 2012
-
[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
work page 2014
-
[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
work page 2016
-
[23]
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
work page 2023
-
[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
work page 2015
discussion (0)
Sign in with ORCID, Apple, or X to comment. Anyone can read and Pith papers without signing in.