cs.ROOct 19, 2026

SWAP: Test-Time Steerable Humanoid Whole-Body Collision Avoidance

Authors: Zeji Yi, Guanqi He, Xiaofeng Guo, Guannan Qu, Pieter Abbeel, Yan Duan, Karen Liu, Guanya Shi

Organizations: Carnegie Mellon University · Amazon FAR

Abstract

Humanoid robots operating in human-centric environments must coordinate the entire body to traverse tight, cluttered spaces while maintaining balance. Existing methods often struggle to jointly consider dynamic stability and collision avoidance from high-dimensional perceptual inputs. Moreover, for humanoids, safe behavior is inherently multimodal: the same obstacle may admit multiple valid traversals, which is difficult to represent with a single deterministic policy. To address these challenges, we propose SWAP (Steerable Whole-body Avoidance Policy), a hierarchical framework that separates collision-aware decision making from stabilization. A high-level, perception-conditioned diffusion policy generates multimodal, collision-aware motion proposals, while a low-level whole-body RL controller tracks these proposals and maintains dynamic balance. To efficiently train the high-level policy, we obtain scalable supervision via hindsight labeling: we roll out the low-level policy under randomized commands, place obstacles only in the space that each executed motion did not sweep, so the motion is collision-free by construction, and re-render the perception the robot would have seen. At deployment, Monte Carlo sampling with simple cost signals steers the diffusion model toward safe, task-aligned behaviors without heavy reward tuning. Experiments in simulation and on a real Unitree G1 humanoid show reliable avoidance with static and dynamic obstacles. Test-time steering further enables customization, improving targeted rewards (e.g., speed, orientation, or posture) by 34% on average while maintaining a high collision avoidance rate. Together, these results support a practical solution to humanoid whole-body collision avoidance with test-time steerability. Project website: https://iscoyizj.github.io/SWAP-steerable-humanoid-oa-website/

Figures & tables

Appendix figures & tables1 asset

Supplementary material from the paper’s appendix.

Appendix

Explore similar work

CardsList
  1. Whole-Body Planning for Humanoids Navigating Confined Spaces via Self-Collision Avoidance References

    Aug 10, 2026Carlos Gonzalez, Luis SentisConstrained Motion PlanningHumanoid Robot Locomotion

  2. Collision-Aware Humanoid Whole-Body Control under Imperfect Tracking Targets

    Sep 14, 2026Mohitvishnu S. Gadde, Ashish Malik, Pranay Dugar +3Robot Trajectory TrackingHumanoid Robot Control

  3. Egocentric Tactile and Proximity Sensors as Observation Priors for Humanoid Collision Avoidance

    Apr 28, 2026Carson Kohlbrenner, Niraj Pudasaini, William Xie +3RL for RoboticsRobotic Tactile Sensing