On the Surprising Robustness of Sequential Convex Optimization for Contact-Implicit Motion Planning

Fuente: arXiv
Gespeichert in:
Bibliographische Detailangaben
Hauptverfasser: Li, Yulin, Han, Haoyu, Kang, Shucheng, Ma, Jun, Yang, Heng
Format: Preprint
Veröffentlicht: 2025
Schlagworte:
Online-Zugang:
Tags: Tag hinzufügen
Keine Tags, Fügen Sie den ersten Tag hinzu!
_version_ 1866912346824245248
author Li, Yulin
Han, Haoyu
Kang, Shucheng
Ma, Jun
Yang, Heng
author_facet Li, Yulin
Han, Haoyu
Kang, Shucheng
Ma, Jun
Yang, Heng
contents Contact-implicit motion planning-embedding contact sequencing as implicit complementarity constraints-holds the promise of leveraging continuous optimization to discover new contact patterns online. Nevertheless, the resulting optimization, being an instance of Mathematical Programming with Complementary Constraints, fails the classical constraint qualifications that are crucial for the convergence of popular numerical solvers. We present robust contact-implicit motion planning with sequential convex programming (CRISP), a solver that departs from the usual primal-dual algorithmic framework but instead only focuses on the primal problem. CRISP solves a convex quadratic program with an adaptive trust region radius at each iteration, and its convergence is evaluated by a merit function using weighted penalty. We (i) provide sufficient conditions on CRISP's convergence to first-order stationary points of the merit function; (ii) release a high-performance C++ implementation of CRISP with a generic nonlinear programming interface; and (iii) demonstrate CRISP's surprising robustness in solving contact-implicit planning with naive initialization. In fact, CRISP solves several contact-implicit problems with all-zero initialization.
format Preprint
id arxiv_https___arxiv_org_abs_2502_01055
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle On the Surprising Robustness of Sequential Convex Optimization for Contact-Implicit Motion Planning
Li, Yulin
Han, Haoyu
Kang, Shucheng
Ma, Jun
Yang, Heng
Optimization and Control
Robotics
Contact-implicit motion planning-embedding contact sequencing as implicit complementarity constraints-holds the promise of leveraging continuous optimization to discover new contact patterns online. Nevertheless, the resulting optimization, being an instance of Mathematical Programming with Complementary Constraints, fails the classical constraint qualifications that are crucial for the convergence of popular numerical solvers. We present robust contact-implicit motion planning with sequential convex programming (CRISP), a solver that departs from the usual primal-dual algorithmic framework but instead only focuses on the primal problem. CRISP solves a convex quadratic program with an adaptive trust region radius at each iteration, and its convergence is evaluated by a merit function using weighted penalty. We (i) provide sufficient conditions on CRISP's convergence to first-order stationary points of the merit function; (ii) release a high-performance C++ implementation of CRISP with a generic nonlinear programming interface; and (iii) demonstrate CRISP's surprising robustness in solving contact-implicit planning with naive initialization. In fact, CRISP solves several contact-implicit problems with all-zero initialization.
title On the Surprising Robustness of Sequential Convex Optimization for Contact-Implicit Motion Planning
topic Optimization and Control
Robotics
url https://arxiv.org/abs/2502.01055