Globally optimal consensus maximization for robust visual inertial localization in point and line map

02/27/2020
by   Yanmei Jiao, et al.
0

Map based visual inertial localization is a crucial step to reduce the drift in state estimation of mobile robots. The underlying problem for localization is to estimate the pose from a set of 3D-2D feature correspondences, of which the main challenge is the presence of outliers, especially in changing environment. In this paper, we propose a robust solution based on efficient global optimization of the consensus maximization problem, which is insensitive to high percentage of outliers. We first introduce translation invariant measurements (TIMs) for both points and lines to decouple the consensus maximization problem into rotation and translation subproblems, allowing for a two-stage solver with reduced solution dimensions. Then we show that (i) the rotation can be calculated by minimizing TIMs using only 1-dimensional branch-and-bound (BnB), (ii) the translation can be found by running 1-dimensional search for three times with prioritized progressive voting. Compared with the popular randomized solver, our solver achieves deterministic global convergence without depending on an initial value. While compared with existing BnB based methods, ours is exponentially faster. Finally, by evaluating the performance on both simulation and real-world datasets, our approach gives accurate pose even when there are 90% outliers (only 2 inliers).

READ FULL TEXT

page 1

page 6

research
03/10/2019

2-Entity RANSAC for robust visual localization in changing environment

Visual localization has attracted considerable attention due to its low-...
research
12/30/2020

ALVIO: Adaptive Line and Point Feature-based Visual Inertial Odometry for Robust Localization in Indoor Environments

The amount of texture can be rich or deficient depending on the objects ...
research
11/28/2022

Safety-quantifiable Line Feature-based Monocular Visual Localization with 3D Prior Map

Accurate and safety-quantifiable localization is of great significance f...
research
03/28/2022

ARCS: Accurate Rotation and Correspondence Search

This paper is about the old Wahba problem in its more general form, whic...
research
07/25/2018

Deterministic consensus maximization with biconvex programming

Consensus maximization is one of the most widely used robust fitting par...
research
03/21/2021

Toward Consistent Drift-free Visual Inertial Localization on Keyframe Based Map

Global localization is essential for robots to perform further tasks lik...
research
04/11/2023

Accelerating Globally Optimal Consensus Maximization in Geometric Vision

Branch-and-bound-based consensus maximization stands out due to its impo...

Please sign up or login with your details

Forgot password? Click here to reset