cs.RONov 17, 2026

Body Schema Policy: Body as the Vision-Action Interface for Efficient Robot Loco-Manipulation

Authors: Lechen Zhang, Chenyuan Chen, Muxin Zhou, Zewen He, Yoshihiko Nakamura

Organizations: Mohamed bin Zayed University of Artificial Intelligence

Abstract

Currently, robots can learn whole-body loco-manipulation through scale: the strongest policies have billions of parameters and still need task-specific fine-tuning. Humans have limited processing capacity, yet learn and act efficiently through a body schema that organizes what they see and how they move. We introduce Body Schema Policy (BSP), an imitation learning policy that builds such a schema into the vision-action interface. Its latent body schema places joint and link tokens on the robot's kinematic tree, where learned screw motions carry features between links. Through body-queried vision, each body part retrieves its own visual evidence, which conditions the denoising of its actions. With this inductive bias, BSP returns an action chunk faster than any policy we compare. Compact, body-specific visual readouts also emerge without spatial supervision: manipulation commands depend strongly on task objects, while locomotion commands respond more broadly to the scene. On nine simulated Unitree G1 whole-body tasks, BSP matches the Ψ0Ψ_0 humanoid foundation model with 75×75\times fewer parameters and nearly doubles Diffusion Policy's success. The same holds on a real G1 and a Fetch mobile manipulator.

Figures & tables

Explore similar work

CardsList
  1. OpenHLM: An Empirical Recipe for Whole-Body Humanoid Loco-Manipulation

    Jun 20, 2026Yingdong Hu, Haodong Zhu, Boyuan Zheng +6Humanoid Loco-ManipulationWhole-Body Robotic Manipulation

  2. Know Your Body: A Harness for Direct and Self-Improving Robot Control with VLMs

    Sep 22, 2026Zeyu Lou, Yanhong Zeng, Yong Wang +1VLMs for RoboticsLarge Language Model-Based Robot Planning