Safe Whole-Body Loco-Manipulation via Combined Model and Learning-based Control
Organizations: Mitsubishi Electric Research Laboratories (MERL), Cambridge, MA, 02139, USA. · Yeping Wang was with Mitsubishi Electric Research Laboratories (MERL) during part of the work of this paper, Cambridge, MA, 02139, USA.
Abstract
Simultaneous locomotion and manipulation enables robots to interact with their environment beyond the constraints of a fixed base. However, coordinating legged locomotion with arm manipulation, while considering safety and compliance during contact interaction remains challenging. To this end, we propose a whole-body controller that combines a model-based admittance control for the manipulator arm with a Reinforcement Learning (RL) policy for legged locomotion. The admittance controller maps external wrenches--such as those applied by a human during physical interaction--into desired end-effector velocities, allowing for compliant behavior. The velocities are tracked jointly by the arm and leg controllers, enabling a unified 6-DoF force response. The model-based design permits accurate force control and safety guarantees via a Reference Governor (RG), while robustness is further improved by a Kalman filter enhanced with neural networks for reliable base velocity estimation. We validate our approach in both simulation and hardware using the Unitree Go2 quadruped robot with a 6-DoF arm and wrist-mounted 6-DoF Force/Torque sensor. Results demonstrate accurate tracking of interaction-driven velocities, compliant behavior, and safe, reliable performance in dynamic settings.
Figures & tables
| Reward | Expression |
| Velocity Tracking | |
| End-Effector Lin Vel Tracking | |
| End-Effector Ang Vel Tracking | |
| Energy Saving | |
| Joint Torque (Penalty) | |
| Action Rate (Penalty) |
| Metric | (rad/s) | (rad/s) | (rad/s) |
| MAE | 0.0031 | 0.0013 | 0.0009 |
| RMSE | 0.0035 | 0.0017 | 0.0013 |
| STD | 0.0018 | 0.0015 | 0.0013 |
| Metric | (m/s) | (m/s) | (m/s) |
| MAE | 0.0385 | 0.0235 | 0.0202 |
| RMSE | 0.0564 | 0.0297 | 0.0273 |
Robotic Control
Robotic control studies how machines use sensing and computation to produce reliable movement and interaction in changing environments.
See all 567 papers