Skip to main content

Chapter 35: Whole-Body Control

Introduction to Whole-Body Control​

Whole-Body Control (WBC) is an advanced paradigm in robotics that aims to coordinate the movements of all a robot's joints (legs, arms, torso, head) simultaneously to achieve multiple tasks while respecting physical constraints and optimizing overall performance. For humanoid robots, WBC is essential for fluid, human-like motion, dynamic stability, and complex interactions with the environment. It moves beyond controlling individual limbs in isolation to managing the robot as a unified, interconnected system.

Inverse Kinematics and Inverse Dynamics​

These are foundational tools for WBC:

Inverse Kinematics (IK)​

Inverse Kinematics (IK) is the process of determining the joint angles required to achieve a desired position and orientation of an end-effector (e.g., a hand or foot) in space. In WBC, IK is extended to calculate joint configurations for multiple end-effectors concurrently, often subject to additional constraints like maintaining balance or avoiding joint limits.

Inverse Dynamics (ID)​

Inverse Dynamics (ID) calculates the joint torques (or forces) required to produce a desired motion, given the robot's kinematics, mass properties, and external forces. WBC algorithms use ID to ensure that the robot's physical interactions (e.g., foot contact forces, arm interaction forces) are consistent with its desired movements and overall stability.

Prioritized Task Execution​

Humanoid robots often need to perform multiple tasks simultaneously, some of which may conflict (e.g., reaching for an object while maintaining balance). Prioritized task execution addresses this by ordering tasks based on importance.

Hierarchy of Tasks​

Tasks are typically arranged in a strict hierarchy:

  1. High-Priority Tasks: Must be achieved without compromise (e.g., maintaining balance, avoiding collisions).
  2. Medium-Priority Tasks: Achieved as much as possible without interfering with higher-priority tasks (e.g., reaching a target with an end-effector).
  3. Low-Priority Tasks: Used to exploit remaining degrees of freedom (e.g., optimizing joint configurations for energy efficiency or singularity avoidance, maintaining a natural posture).

When a higher-priority task uses up certain joint movements or force capabilities, those resources are no longer available for lower-priority tasks. This approach ensures that critical behaviors (like not falling) are always prioritized.

Balance and Compliance​

Maintaining Balance​

WBC inherently integrates balance control. By considering the entire robot's dynamics, WBC algorithms can actively shift the robot's Center of Mass (CoM), control Zero Moment Point (ZMP) trajectories, and adjust foot contact forces to ensure stability during static poses, walking, or external disturbances. This involves actively using all available joints, including the torso and arms, to contribute to balance.

Compliance​

Compliance refers to the robot's ability to yield to external forces, making interactions safer and more robust. In WBC, compliance can be integrated at various levels:

  • Joint-Level Compliance: Actuators can be controlled to exhibit spring-like or damping-like behavior.
  • Task-Level Compliance: The robot can be programmed to be compliant in certain directions for specific tasks (e.g., compliant in the horizontal direction when pushing against a surface, but stiff in the vertical direction to maintain support). This is crucial for physical Human-Robot Interaction (HRI).

Reactive Responses to Disturbances​

A key advantage of WBC is its ability to generate rapid and coordinated reactive responses to unexpected disturbances, such as pushes or changes in terrain.

  • Disturbance Estimation: Sensors (e.g., IMUs, force/torque sensors) continuously monitor for external forces or unexpected motions.
  • Real-time Adaptation: WBC algorithms can quickly recalculate optimal joint torques and positions across the entire robot to counteract the disturbance, regain balance, and maintain task execution. This might involve stepping strategies, arm movements for counterbalancing, or adjusting posture.

Whole-Body Control represents the state-of-the-art in humanoid robotics, enabling highly dynamic, stable, and interactive behaviors that are crucial for operation in complex, unstructured environments alongside humans.