Modeling Perceptual Aliasing in SLAM via Discrete-Continuous Graphical Models

TL;DR

This paper introduces a novel Discrete-Continuous Graphical Model for SLAM that effectively handles perceptual aliasing and outliers without requiring an initial trajectory guess, improving robustness and accuracy.

Contribution

It proposes a unified DC-GM framework for modeling perceptual aliasing and a semidefinite relaxation for inference with provable guarantees, advancing SLAM robustness.

Findings

Outperforms state-of-the-art methods on benchmark datasets

Does not rely on initial trajectory guesses

Provides provable sub-optimality guarantees

Abstract

Perceptual aliasing is one of the main causes of failure for Simultaneous Localization and Mapping (SLAM) systems operating in the wild. Perceptual aliasing is the phenomenon where different places generate a similar visual (or, in general, perceptual) footprint. This causes spurious measurements to be fed to the SLAM estimator, which typically results in incorrect localization and mapping results. The problem is exacerbated by the fact that those outliers are highly correlated, in the sense that perceptual aliasing creates a large number of mutually-consistent outliers. Another issue stems from the fact that most state-of-the-art techniques rely on a given trajectory guess (e.g., from odometry) to discern between inliers and outliers and this makes the resulting pipeline brittle, since the accumulation of error may result in incorrect choices and recovery from failures is far from trivial. This work provides a unified framework to model perceptual aliasing in SLAM and provides practical algorithms that can cope with outliers without relying on any initial guess. We present two main contributions. The first is a Discrete-Continuous Graphical Model (DC-GM) for SLAM: the continuous portion of the DC-GM captures the standard SLAM problem, while the discrete portion describes the selection of the outliers and models their correlation. The second contribution is a semidefinite relaxation to perform inference in the DC-GM that returns estimates with provable sub-optimality guarantees. Experimental results on standard benchmarking datasets show that the proposed technique compares favorably with state-of-the-art methods while not relying on an initial guess for optimization.