Online iLQR-MPC with Whole-Body Control for Robust Humanoid Locomotion
Organizations: Zhejiang University of Technology, Hangzhou, China
Abstract
Humanoid locomotion requires deciding where to step and how to distribute contact forces. However, a disturbance can invalidate the nominal plan, requiring coordinated revision under constraints that switch with every footfall. To solve this online, the proposed approach employs the single-rigid-body model, which retains attitude dynamics and the full contact wrench. An iterative linear-quadratic-regulator MPC (iLQR-MPC) then jointly optimizes contact forces and footstep locations in a single receding-horizon problem, without a separate step planner. Specifically, contact and motion constraints are incorporated into the backward pass through augmented-Lagrangian and relaxed-barrier penalties. A whole-body controller subsequently maps the plan to joint torques at 500 Hz while preserving contact feasibility. The model-based formulation makes disturbance responses interpretable through explicit costs and constraints, and requires no platform-specific policy training. In MuJoCo simulations, the iLQR-MPC replans at 100 Hz (mean solve time 8.9 ms); the Unitree G1 sustains steady-state walking and recovers from impulsive 245 N forward and 175 N lateral pushes.
Figures & tables
| State | RMSE | State | RMSE |
|---|---|---|---|
| Roll (rad) | 0.038 | (rad/s) | 0.214 |
| Pitch (rad) | 0.016 | (rad/s) | 0.114 |
| Yaw (rad) | 0.029 | (rad/s) | 0.175 |
| (m) | 0.231 | (m/s) | 0.078 |
| (m) | 0.064 | (m/s) | 0.267 |
| (m) | 0.004 | (m/s) | 0.064 |
| Direction | Type | Max Force (N) |
|---|---|---|
| (forward) | sagittal | 245 |
| (backward) | sagittal | 205 |
| (right-to-left) | lateral | 80 |
| (left-to-right) | lateral | 175 |
| Module | Time (ms) | Share (%) |
|---|---|---|
| iLQR inner loop (per iteration, ) | ||
| Dynamics linearization | 0.083 | 3.7 |
| Cost quadratization | 1.204 | 53.8 |
| Backward pass & gain computation | 0.274 | 12.2 |
| Forward rollout | 0.680 | 30.3 |
| iLQR iteration total | 2.24 | 100 |
Robotic Control
Robotic control studies how machines use sensing and computation to produce reliable movement and interaction in changing environments.
See all 620 papers