A Decoupled and Linear Framework for Global Outlier Rejection over Planar Pose Graph

09/18/2022
by   Tianyue Wu, et al.
0

We propose a robust framework for the planar pose graph optimization contaminated by loop closure outliers. Our framework rejects outliers by first decoupling the robust PGO problem wrapped by a Truncated Least Squares kernel into two subproblems. Then, the framework introduces a linear angle representation to rewrite the first subproblem that is originally formulated with rotation matrices. The framework is configured with the Graduated Non-Convexity (GNC) algorithm to solve the two non-convex subproblems in succession without initial guesses. Thanks to the linearity properties of both the subproblems, our framework requires only linear solvers to optimally solve the optimization problems encountered in GNC. We extensively validate the proposed framework, named DEGNC-LAF (DEcoupled Graduated Non-Convexity with Linear Angle Formulation) in planar PGO benchmarks. It turns out that it runs significantly (sometimes up to over 30 times) faster than the standard and general-purpose GNC while resulting in high-quality estimates.

READ FULL TEXT

page 1

page 2

page 3

page 4

research
09/18/2019

Graduated Non-Convexity for Robust Spatial Perception: From Non-Minimal Solvers to Global Outlier Rejection

Semidefinite Programming (SDP) and Sums-of-Squares (SOS) relaxations hav...
research
09/07/2021

Certifiable Outlier-Robust Geometric Perception: Exact Semidefinite Relaxations and Scalable Global Optimization

We propose the first general and scalable framework to design certifiabl...
research
06/11/2020

One Ring to Rule Them All: Certifiably Robust Geometric Perception with Outliers

We propose a general and practical framework to design certifiable algor...
research
07/18/2022

Towards Understanding The Semidefinite Relaxations of Truncated Least-Squares in Robust Rotation Search

The rotation search problem aims to find a 3D rotation that best aligns ...
research
04/16/2021

Optimal Pose and Shape Estimation for Category-level 3D Object Perception

We consider a category-level perception problem, where one is given 3D s...
research
07/04/2022

HiPE: Hierarchical Initialization for Pose Graphs

Pose graph optimization is a non-convex optimization problem encountered...
research
02/24/2023

Evaluation of Legged Robot Landing Capability Under Aggressive Linear and Angular Velocities

This paper proposes a method to evaluate the capability of aggressive le...

Please sign up or login with your details

Forgot password? Click here to reset