Abstract:Autonomous navigation requires an accurate model or map of the environment. While dramatic progress in the prior two decades has enabled large-scale SLAM, the majority of existing methods rely on non-linear optimization techniques to find the MLE of the robot trajectory and surrounding environment. These methods are prone to local minima and are thus sensitive to initialization. Several recent papers have developed optimization algorithms for the Pose-Graph SLAM problem that can certify the optimality of a computed solution. Though this does not guarantee a priori that this approach generates an optimal solution, a recent extension has shown that when the noise lies within a critical threshold that the solution to the optimization algorithm is guaranteed to be optimal. To address the limitations of existing approaches, this paper illustrates that the Pose-Graph SLAM and Landmark SLAM can be formulated as polynomial optimization programs that are SOS convex. This paper then describes how the Pose-Graph and Landmark SLAM problems can be solved to a global minimum without initialization regardless of noise level using the Sparse-BSOS hierarchy. This paper also empirically illustrates that convergence happens at the second step in this hierarchy. In addition, this paper illustrates how this Sparse-BSOS hierarchy can be implemented in the complex domain and empirically shows that convergence happens also at the second step of this complex domain hierarchy. Finally, the superior performance of the proposed approach when compared to existing SLAM methods is illustrated on graphs with several hundred nodes.

A Global Asymptotic Convergent Observer for SLAM

New Trend in Back-End Techniques of Visual SLAM: from Local Iterative Solvers to Robust Global Optimization

An almost globally convergent observer for visual SLAM without persistent excitation.

Simultaneous localization and map building with linear system model.

Guaranteed Performance Nonlinear Observer for Simultaneous Localization and Mapping

Hybrid Attitude Observer on SO(3) with Global Asymptotic Stability

A Geometric Nonlinear Stochastic Filter for Simultaneous Localization and Mapping

Synchronous Observer Design for Inertial Navigation Systems with Almost-Global Convergence

Global Attitude Stabilization of a Rigid Body on SO(3) via Observer-based Hybrid Feedback Under Constraints

PEBO-SLAM: Observer design for visual inertial SLAM with convergence guarantees

Global finite-time attitude consensus of leader-following spacecraft systems based on distributed observers

Globally exponentially convergent observer for systems evolving on matrix Lie groups

Asymptotically Stable Observer-based Controller for Attitude Tracking with Systematic Convergence

Globally exponentially convergent velocity observer design for mechanical systems with nonholonomic constraints

Hybrid Feedback for Affine Nonlinear Systems with Application to Global Obstacle Avoidance (Extended Version)

An SfM Algorithm with Good Convergence That Addresses Outliers for Realizing Mono-SLAM

Convergence and Consistency Analysis for FastSLAM

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

Hybrid Feedback for Global Tracking on Matrix Lie Groups $SO(3)$ and $SE(3)$

A Nonlinear Navigation Observer Using IMU and Generic Position Information

Stochastic Kinematic Optimal Control on SO(3)