Approximating Global Contact-Implicit MPC via Sampling and Local Complementarity

To achieve general-purpose dexterous manipulation, robots must rapidly devise and execute contact-rich behaviors. Existing model-based controllers cannot globally optimize in real time over the exponential number of possible contact sequences. Instead, progress in contact-implicit control leverages simpler models that, while still hybrid, make local approximations. Locality limits the controller to exploit only nearby interactions, requiring intervention to richly explore contacts more broadly. Our approach leverages the strengths of local complementarity-based control combined with low-dimensional, but global, sampling of possible end effector locations. Our key insight is to consider a contact-free stage preceding a contact-rich stage at every control loop. Our algorithm, in parallel, samples end effector locations to which the contact-free stage can move the robot, then considers the cost predicted by contact-rich MPC local to each sampled location. The result is a globally-informed, contact-implicit controller capable of real-time dexterous manipulation. We demonstrate our controller on precise, non-prehensile manipulation of non-convex objects with a Franka arm.