Hierarchical Contact-Rich Trajectory Optimization for Multi-Modal Manipulation using Tight Convex Relaxations
arXiv:2503.07963 · doi:10.1109/ICRA55743.2025.11127667
Abstract
Designing trajectories for manipulation through contact is challenging as it requires reasoning of object \& robot trajectories as well as complex contact sequences simultaneously. In this paper, we present a novel framework for simultaneously designing trajectories of robots, objects, and contacts efficiently for contact-rich manipulation. We propose a hierarchical optimization framework where Mixed-Integer Linear Program (MILP) selects optimal contacts between robot \& object using approximate dynamical constraints, and then a NonLinear Program (NLP) optimizes trajectory of the robot(s) and object considering full nonlinear constraints. We present a convex relaxation of bilinear constraints using binary encoding technique such that MILP can provide tighter solutions with better computational complexity. The proposed framework is evaluated on various manipulation tasks where it can reason about complex multi-contact interactions while providing computational advantages. We also demonstrate our framework in hardware experiments using a bimanual robot system. The video summarizing this paper and hardware experiments is found https://youtu.be/s2S1Eg5RsRE?si=chPkftz_a3NAHxLq
2025 IEEE International Conference on Robotics and Automation (2025 ICRA)
References in corpus (13)
- Simultaneous Contact, Gait and Motion Planning for Robust Multi-Legged Locomotion via Mixed-Integer Convex Optimization
- Versatile Multi-Contact Planning and Control for Legged Loco-Manipulation
- Contact-Implicit Trajectory Optimization using Orthogonal Collocation
- Efficient Multi-Contact Pattern Generation with Sequential Convex Approximations of the Centroidal Dynamics
- Tactile Tool Manipulation
- Kinodynamic Motion Planning for Multi-Legged Robot Jumping via Mixed-Integer Convex Program
- Simultaneous Contact-Rich Grasping and Locomotion via Distributed Optimization Enabling Free-Climbing for Multi-Limbed Robots
- Robust Pivoting: Exploiting Frictional Stability Using Bilevel Optimization
- Covariance Steering for Uncertain Contact-rich Systems
- Robust Pivoting Manipulation using Contact Implicit Bilevel Optimization
- Is Linear Feedback on Smoothed Dynamics Sufficient for Stabilizing Contact-Rich Plans?
- Explicit Contact Optimization in Whole-Body Contact-Rich Manipulation
- Accelerating Hybrid Model Predictive Control using Warm-Started Generalized Benders Decomposition