cs.RONov 5, 2026

CRISP: Constraint-Resolved Interactions between Subsystems for Predictive Whole-Body Cooperation

Authors: Dario Valenzuela, Jeeseop Kim

Organizations: D. Valenzuela and J. Kim are with Aerospace and Mechanical Engineering, University of Texas at El Paso, El Paso, TX 79968 USA

Abstract

This paper presents a layered control framework that recasts high-dimensional system dynamics as a composition of dynamically interconnected subsystems, with dynamic dual-arm manipulation on the humanoid serving as a representative application. The humanoid is decomposed into a single rigid body (SRB) representing the torso and floating-base dynamic models representing the articulated arms and lower-body. The rigid connections between arm and torso and the closed kinematic chain formed between the end-effectors during cooperative manipulation are represented as holonomic constraints. The corresponding Lagrange multipliers parametrize the interaction wrenches transmitted at the shoulders and between the end-effectors. The high-level nonlinear model predictive control (NMPC) jointly optimizes the subsystem state trajectories, arm torques, ground reaction forces (GRFs), and interaction wrenches, enabling online wrench design and optimization while preserving the dynamic coupling among the independently modeled subsystems. The optimized arm torques are applied directly for cooperative dual-arm manipulation, whereas the prescribed GRFs are mapped to lower-body joint torque for whole-body coordination. We validate the proposed framework through numerical simulations and hardware experiments on a G1 humanoid robot. The results demonstrate optimal interaction wrenches consistent with simulated contact measurement, cooperative dual-arm trajectory tracking, and stable whole-body coordination while executing the NMPC in online manner.

Figures & tables

Explore similar work

CardsList
  1. Rhythm: Learning Interactive Whole-Body Control for Dual Humanoids

    Mar 3, 2026Hongjin Chen, Wei Zhang, Pengfei Li +10RL for RoboticsHumanoid Robot Control

  2. HCLM: A Hierarchical Framework for Cooperative Loco-Manipulation with Dual Quadrupeds

    May 17, 2026Qixuan Li, Chen Le, Jincheng Yu +1Whole-Body ControlMulti-Task Robotic Manipulation

  3. GenerativeMPC: VLM-RAG-guided Whole-Body MPC with Virtual Impedance for Bimanual Mobile Manipulation

    Apr 21, 2026Marcelino Julio Fernando, Miguel Altamirano Cabrera, Jeffrin Sam +3Mobile ManipulationBimanual Robotic Manipulation