Adaptive Admittance Control for Safety-Critical Physical Human Robot Collaboration

Yuzhu Sun, Mien Van, Stephen McIlvanna, Seán F. McLoone, Dariusz CeglarekarXiv 2022 · OpenReview

TL;DR

This paper introduces a novel control framework for physical human-robot collaboration that ensures both safety and natural compliance. It achieves this by using Exponential Control Barrier Functions (ECBFs) and Quadratic Programming (QP) to generate a virtual force feedback that compensates for human-induced forces, thereby modifying the robot's trajectory in real-time to avoid safety violations while maintaining fluid interaction.

What Problem Does This Paper Address?

Physical human-robot collaboration (pHRC) is a rapidly growing field with immense potential for increasing productivity and enabling more complex tasks. However, a critical challenge in pHRC is ensuring the safety of both humans and robots when they share a workspace. Traditional approaches often separate humans and robots or rely on simple compliance mechanisms that can fail under unexpected human forces, potentially leading to collisions with workspace boundaries or obstacles. This paper addresses the need for a control system that can guarantee strict safety constraints (like staying within a defined workspace and avoiding obstacles) while simultaneously allowing the robot to exhibit natural, compliant behavior in response to human interaction.

Methods

The proposed approach integrates several key techniques:

  • Admittance Control: This forms the basis for achieving compliant robot behavior. It's reformulated as a second-order nonlinear control system where interaction forces are treated as inputs.
  • Exponential Control Barrier Functions (ECBFs): ECBFs are used to define and enforce safety constraints. They are particularly useful for systems with higher relative degrees, like the robot dynamics considered here. The paper focuses on two types of safety constraints: workspace boundaries and obstacle avoidance.
  • Quadratic Programming (QP): A QP solver is employed to compute an optimal "virtual force feedback." This feedback acts as a compensator for external human forces, ensuring that the robot's trajectory is modified to remain within the safe set defined by the ECBFs.
  • Two-Layered Control Framework: The system operates with a high-level trajectory planner (using ECBFs-QP) that generates a safe trajectory, and a low-level controller (a fixed-time integral sliding mode controller, FxTISMC) that precisely tracks this safe trajectory.

The novelty lies in using the ECBFs-QP framework to generate this adaptive virtual force feedback for admittance control, effectively creating a safety-aware compliance mechanism.

Datasets

Not discussed in the paper. The evaluation is performed through simulation studies.

Key Insights and Ideas

  • Bridging Safety and Compliance: The core insight is that safety and compliance are not mutually exclusive. By using ECBFs-QP to generate a virtual force feedback, the system can actively modify the robot's intended motion to ensure safety without sacrificing the smooth, human-like interaction desired in pHRC.
  • Real-time Safety Adaptation: The ECBFs-QP framework allows for real-time adaptation of the robot's trajectory in response to external human forces. This means the robot can dynamically adjust its path to avoid hazards, even if the human's actions push it towards unsafe conditions.
  • ECBFs for Higher-Order Dynamics: The use of ECBFs is crucial for handling the second-order dynamics of robot manipulators and their associated safety constraints, which are more complex than first-order systems.
  • QP for Optimal Trade-offs: QP is effectively used to find the minimal modifying forces needed to satisfy safety constraints, allowing for a balance between enforcing safety and minimizing deviations from the desired motion.

Key Results

The paper demonstrates the effectiveness of the proposed approach through simulations on a two-link planar robot manipulator.

  • Workspace Constraints: When external human forces are applied, the robot's trajectory, which would have otherwise violated workspace boundaries (shown in Fig. 4b), is successfully constrained within the safe area (shown in Fig. 5). The robot remains compliant with human forces while staying within the defined limits.
  • Obstacle Avoidance: The system successfully avoids obstacles, and when combined with workspace constraints, it ensures the robot navigates safely and compliantly even under external forces.
  • Effective Force Compensation: The optimal interaction forces derived by the ECBFs-QP framework effectively compensate for human forces, ensuring both compliance and safety.

Limitations and Future Work

  • Limitations: The current work focuses on position-based safety constraints (workspace boundaries and obstacle avoidance) and considers the end-effector's position. The paper acknowledges that the dynamics are formulated in Cartesian space, and the implementation is demonstrated via simulation.
  • Future Work: The authors suggest extending the approach to consider constraints for each joint (not just the end-effector). They also propose exploring the integration of barrier Lyapunov functions to further enhance safety guarantees.

Summary updated

Abstract

Physical human-robot collaboration requires strict safety guarantees since robots and humans work in a shared workspace. This letter presents a novel control framework to handle safety-critical position-based constraints for human-robot physical interaction. The proposed methodology is based on admittance control, exponential control barrier functions (ECBFs) and quadratic program (QP) to achieve compliance during the force interaction between human and robot, while simultaneously guaranteeing safety constraints. In particular, the formulation of admittance control is rewritten as a second-order nonlinear control system, and the interaction forces between humans and robots are regarded as the control input. A virtual force feedback for admittance control is provided in real-time by using the ECBFs-QP framework as a compensator of the external human forces. A safe trajectory is therefore derived from the proposed adaptive admittance control scheme for a low-level controller to track. The innovation of the proposed approach is that the proposed controller will enable the robot to comply with human forces with natural fluidity without violation of any safety constraints even in cases where human external forces incidentally force the robot to violate constraints. The effectiveness of our approach is demonstrated in simulation studies on a two-link planar robot manipulator.
BibTeX
@misc{sun2022adaptive,
  author = {Yuzhu Sun and Mien Van and Stephen McIlvanna and Seán F. McLoone and Dariusz Ceglarek},
  title = {{Adaptive Admittance Control for Safety-Critical Physical Human Robot Collaboration}},
  year = {2022},
  eprint = {2208.05061},
  archivePrefix = {arXiv},
  url = {https://arxiv.org/abs/2208.05061},
}
Figure