Core Concepts
This paper proposes an automatic method to find a set of sufficient redundant constraints to obtain tight semidefinite relaxations for globally optimal solutions to state estimation problems in robotics.
Abstract
The paper presents two methods, AUTOTIGHT and AUTOTEMPLATE, to automatically discover redundant constraints required for tightening semidefinite relaxations of common optimization problems in robotics, such as range-based localization and stereo-based pose estimation.
AUTOTIGHT determines if a given problem formulation can be tightened by adding enough redundant constraints, without requiring any manual steps for guessing the constraints. It does this by numerically retrieving the nullspace basis of a data matrix constructed from randomly generated feasible samples.
AUTOTEMPLATE builds on AUTOTIGHT to automatically determine a set of 'constraint templates' that can be generalized to problems of any size. This is achieved by identifying different variable types in the problem and learning templates that can be applied to any combination of these variables.
The proposed methods circumvent the tedious manual process typically required to find the right redundant constraints for tightening semidefinite relaxations. This lowers the barrier for adopting semidefinite programming techniques to find globally optimal solutions to optimization problems in robotics.
The effectiveness of the approach is showcased in simulation and on real datasets for range-based localization and stereo-based pose estimation. The authors also reproduce semidefinite relaxations from recent literature and show that their automatic method always finds a smaller set of constraints sufficient for tightness than previously considered.