On Semidefinite Relaxations for Matrix-Weighted State-Estimation Problems in Robotics
arXiv:2308.07275 · doi:10.1109/TRO.2024.3475220
Abstract
In recent years, there has been remarkable progress in the development of so-called certifiable perception methods, which leverage semidefinite, convex relaxations to find global optima of perception problems in robotics. However, many of these relaxations rely on simplifying assumptions that facilitate the problem formulation, such as an isotropic measurement noise distribution. In this paper, we explore the tightness of the semidefinite relaxations of matrix-weighted (anisotropic) state-estimation problems and reveal the limitations lurking therein: matrix-weighted factors can cause convex relaxations to lose tightness. In particular, we show that the semidefinite relaxations of localization problems with matrix weights may be tight only for low noise levels. To better understand this issue, we introduce a theoretical connection between the posterior uncertainty of the state estimate and the certificate matrix obtained via convex relaxation. With this connection in mind, we empirically explore the factors that contribute to this loss of tightness and demonstrate that redundant constraints can be used to regain it. As a second technical contribution of this paper, we show that the state-of-the-art relaxation of scalar-weighted SLAM cannot be used when matrix weights are considered. We provide an alternate formulation and show that its SDP relaxation is not tight (even for very low noise levels) unless specific redundant constraints are used. We demonstrate the tightness of our formulations on both simulated and real-world data.
References in corpus (9)
- Graduated Non-Convexity for Robust Spatial Perception: From Non-Minimal Solvers to Global Outlier Rejection
- Tightness of the maximum likelihood semidefinite relaxation for angular synchronization
- Deterministic guarantees for Burer-Monteiro factorizations of smooth semidefinite programs
- Convex Iteration for Distance-Geometric Inverse Kinematics
- Certifiably Optimal Monocular Hand-Eye Calibration
- Safe and Smooth: Certified Continuous-Time Range-Only Localization
- Certifiably Correct Range-Aided SLAM
- Toward Globally Optimal State Estimation Using Automatically Tightened Semidefinite Relaxations
- Strict Complementarity in MaxCut SDP
Cited by in corpus (4)
- Toward Globally Optimal State Estimation Using Automatically Tightened Semidefinite Relaxations
- A Certifiable Algorithm for Simultaneous Shape Estimation and Object Tracking
- Data-Driven Batch Localization and SLAM Using Koopman Linearization
- A Certifably Correct Algorithm for Generalized Robot-World and Hand-Eye Calibration