🤖 AI Summary
This paper addresses the fragmentation between task planning and motion control in humanoid robot loco-manipulation. We propose a unified task and motion planning (TAMP) framework that employs contact modes as high-level symbolic representations—enabling, for the first time, fully acyclic, dynamics-driven integrated TAMP. Our method jointly incorporates whole-body dynamics, robot–object–environment contact constraints, and object interaction models, combining high-order trajectory optimization with combinatorial search. Unlike conventional hierarchical approaches, our framework supports physically consistent, long-horizon, multimodal behavior generation. Experimental validation on a real humanoid robot demonstrates autonomous execution of complex, logic-intensive loco-manipulation tasks—including stepping-and-grasping and push-pull transport—over extended durations. The framework significantly improves task adaptability and behavioral consistency while ensuring dynamic feasibility and contact-aware coordination.
📝 Abstract
This work presents an optimization-based task and motion planning (TAMP) framework that unifies planning for locomotion and manipulation through a shared representation of contact modes. We define symbolic actions as contact mode changes, grounding high-level planning in low-level motion. This enables a unified search that spans task, contact, and motion planning while incorporating whole-body dynamics, as well as all constraints between the robot, the manipulated object, and the environment. Results on a humanoid platform show that our method can generate a broad range of physically consistent loco-manipulation behaviors over long action sequences requiring complex reasoning. To the best of our knowledge, this is the first work that enables the resolution of an integrated TAMP formulation with fully acyclic planning and whole body dynamics with actuation constraints for the humanoid loco-manipulation problem.