Constrained Sampling MPC for Safe Contact-Rich Control: From Exploration to Precision via Hybrid Refinement
Constrained Annealing-based Sampling MPC (CAS-MPC), which integrates inequality constraints via a primal–dual weight reshaping scheme that preserves sample diversity, and a hybrid refinement strategy that switches to Sequential Linear–Quadratic MPC for millimeter-level precision once near the goal is proposed.