接触を陽に扱う軌道最適化に対するSQP法の大域的収束性
Global Convergence of an SQP Method for Contact-Implicit Trajectory Optimization
接触を含む複雑な系の軌道最適化(CITO)に対し、陰的な物理制約とペナルティ緩和を用いたSQP法が任意の初期解から大域的に収束することを証明した。
著者: Zherong Pan, Fuquan Wang, Yifan Zhu
分類: math.OC, cs.RO
原文アブストラクト
Contact-Implicit Trajectory Optimization (CITO) is a powerful framework for planning motions of robots that interact with complex environments, but its convergence behavior remains difficult to characterize. Existing formulations either rely on off-the-shelf nonlinear programming solvers whose guarantees require constraint qualifications that are hard to verify for contact-rich systems, or require differentiable explicit dynamics maps that are difficult to formulate in the presence of impacts, changing contact modes, and geometric non-smoothness. This paper studies CITO for a broader class of constraint-rich dynamic systems formulated through implicit physics constraints. By exploiting maximal-coordinate structure, penalty relaxations of equality and inequality constraints, and finite-horizon Hamiltonian bounds, we prove global convergence in the numerical-optimization sense for a specific line-search Sequential Quadratic Programming (SQP) method with adaptive timestep refinement. Under the stated constraint-rich dynamic-system assumptions and fixed pre-horizon data satisfying the strict-interior predecessor condition, the method terminates finitely from any finite discretized optimized trajectory guess at an $\epsilon$-feasible, force-parameterized stationary point---a unit-objective, penalty-induced force-parameterized Fritz--John certificate for smooth damping, weakening to a homogeneous force-parameterized Clarke--Fritz--John certificate whose objective multiplier may vanish under nonsmooth frictional contact.
