Toward Globally Optimal State Estimation Using Automatically Tightened Semidefinite Relaxations
arXiv:2308.05783 · doi:10.1109/TRO.2024.3454570
Abstract
In recent years, semidefinite relaxations of common optimization problems in robotics have attracted growing attention due to their ability to provide globally optimal solutions. In many cases, it was shown that specific handcrafted redundant constraints are required to obtain tight relaxations and thus global optimality. These constraints are formulation-dependent and typically identified through a lengthy manual process. Instead, the present paper suggests an automatic method to find a set of sufficient redundant constraints to obtain tightness, if they exist. We first propose an efficient feasibility check to determine if a given set of variables can lead to a tight formulation. Secondly, we show how to scale the method to problems of bigger size. At no point of the process do we have to find redundant constraints manually. We showcase the effectiveness of the approach, in simulation and on real datasets, for range-based localization and stereo-based pose estimation. Finally, we reproduce semidefinite relaxations presented in recent literature and show that our automatic method always finds a smaller set of constraints sufficient for tightness than previously considered.
20 pages, 22 figures. Version history: v5 (published version T-RO), v4 (conditionally accepted version T-RO), v3 (revised version), v2 (submitted version), v1 (initial version)
References in corpus (9)
- Pymanopt: A Python Toolbox for Optimization on Manifolds using Automatic Differentiation
- Shortest Paths in Graphs of Convex Sets
- A Riemannian low-rank method for optimization over semidefinite matrices with block-diagonal constraints
- Certifiably Optimal Monocular Hand-Eye Calibration
- Sampling algebraic varieties for sum of squares programs
- Safe and Smooth: Certified Continuous-Time Range-Only Localization
- Certifiably Correct Range-Aided SLAM
- On Semidefinite Relaxations for Matrix-Weighted State-Estimation Problems in Robotics
- STAR-loc: Dataset for STereo And Range-based localization