cs.ROOct 14, 2026

Towards Certifiable State Estimation under Observability Degeneracy

Authors: Baoshan Song

Abstract

Certifiable optimization provides global optimality guarantees for non-convex state estimation in robotics. However, under severe physical sensing degeneracy, convex Semidefinite Programming relaxations solved via Interior-Point Methods suffer from rank expansion, rendering direct semidefinite solving and spectral rounding algebraically invalid. In this paper, we establish a universal candidate-driven dual certification framework that resolves this challenge without incurring rank expansion. First, from an epigraph perspective, we prove that while sensing degeneracy expands the primal optimal set into a flat equi-cost face, cost tightness and multiplier recovery remain strictly intact, enabling global verification without direct semidefinite solving. Second, we propose an observability-aware local search using solution remapping, coupled with a closed-form dual multiplier recovery scheme that executes in sub-microsecond latency. Third, we derive a model-specific adaptive dual safety threshold parameterized by the minimum non-zero eigenvalue of the observable Hessian and uneradicated residual leakage, preventing false rejections of optimal candidates under weak observability. We validate our universal framework with robust registration under degenerate measurements.

Figures & tables

Explore similar work

CardsList
  1. Following a Unique Path: A Fast Certifier Applied to Outlier-Robust Pose Registration

    Sep 2, 2026Connor Holmes, Abhishek Goudar, Timothy D. BarfootSemidefinite ProgrammingPoint Cloud Registration

  2. Exploiting Chordal Sparsity for Globally Optimal Estimation with Factor Graphs

    May 28, 2026Avinash Subramanian, Connor Holmes, Timothy D. Barfoot +2Semidefinite ProgrammingFactor Graph Optimization

  3. Implementing Robust M-Estimators with Certifiable Factor Graph Optimization

    Mar 21, 2026Zhexin Xu, Hanna Jiamei Zhang, Helena Calatrava +2Robust EstimationFactor Graph Optimization