Performance Guarantees for Spectral Initialization in Rotation Averaging and Pose-Graph SLAM

01/11/2022
by   Kevin J. Doherty, et al.
0

In this work we present the first initialization methods equipped with explicit performance guarantees adapted to the pose-graph simultaneous localization and mapping (SLAM) and rotation averaging (RA) problems. SLAM and rotation averaging are typically formalized as large-scale nonconvex point estimation problems, with many bad local minima that can entrap the smooth optimization methods typically applied to solve them; the performance of standard SLAM and RA algorithms thus crucially depends upon the quality of the estimates used to initialize this local search. While many initialization methods for SLAM and RA have appeared in the literature, these are typically obtained as purely heuristic approximations, making it difficult to determine whether (or under what circumstances) these techniques can be reliably deployed. In contrast, in this work we study the problem of initialization through the lens of spectral relaxation. Specifically, we derive a simple spectral relaxation of SLAM and RA, the form of which enables us to exploit classical linear-algebraic techniques (eigenvector perturbation bounds) to control the distance from our spectral estimate to both the (unknown) ground-truth and the global minimizer of the estimation problem as a function of measurement noise. Our results reveal the critical role that spectral graph-theoretic properties of the measurement network play in controlling estimation accuracy; moreover, as a by-product of our analysis we obtain new bounds on the estimation error for the maximum likelihood estimators in SLAM and RA, which are likely to be of independent interest. Finally, we show experimentally that our spectral estimator is very effective in practice, producing initializations of comparable or superior quality at lower computational cost compared to existing state-of-the-art techniques.

READ FULL TEXT
research
03/25/2022

Spectral Measurement Sparsification for Pose-Graph SLAM

Simultaneous localization and mapping (SLAM) is a critical capability in...
research
09/20/2018

Guaranteed Globally Optimal Planar Pose Graph and Landmark SLAM via Sparse-Bounded Sums-of-Squares Programming

Autonomous navigation requires an accurate model or map of the environme...
research
10/06/2022

SCORE: A Second-Order Conic Initialization for Range-Aided SLAM

We present a novel initialization technique for the range-aided simultan...
research
11/02/2020

Pushing the Envelope of Rotation Averaging for Visual SLAM

As an essential part of structure from motion (SfM) and Simultaneous Loc...
research
07/10/2012

A Spectral Learning Approach to Range-Only SLAM

We present a novel spectral learning algorithm for simultaneous localiza...
research
04/02/2019

Sparse Bounded Degree Sum of Squares Optimization for Certifiably Globally Optimal Rotation Averaging

Estimating unknown rotations from noisy measurements is an important ste...
research
09/16/2023

Optimal Initialization Strategies for Range-Only Trajectory Estimation

Range-only (RO) pose estimation involves determining a robot's pose over...

Please sign up or login with your details

Forgot password? Click here to reset