Incremental cycle bases for cycle-based pose graph optimization

09/15/2022
by   Brendon Forsgren, et al.
0

Pose graph optimization is a special case of the simultaneous localization and mapping problem where the only variables to be estimated are pose variables and the only measurements are inter-pose constraints. The vast majority of PGO techniques are vertex based (variables are robot poses), but recent work has parameterized the pose graph optimization problem in a relative fashion (variables are the transformations between poses) that utilizes a minimum cycle basis to maximize the sparsity of the problem. We explore the construction of a cycle basis in an incremental manner while maximizing the sparsity. We validate an algorithm that constructs a sparse cycle basis incrementally and compare its performance with a minimum cycle basis. Additionally, we present an algorithm to approximate the minimum cycle basis of two graphs that are sparsely connected as is common in multi-agent scenarios. Lastly, the relative parameterization of pose graph optimization has been limited to using rigid body transforms on SE(2) or SE(3) as the constraints between poses. We introduce a methodology to allow for the use of lower-degree-of-freedom measurements in the relative pose graph optimization problem. We provide extensive validation of our algorithms on standard benchmarks, simulated datasets, and custom hardware.

READ FULL TEXT

page 1

page 2

page 3

page 4

research
03/29/2022

Sparse Pose Graph Optimization in Cycle Space

The state-of-the-art modern pose-graph optimization (PGO) systems are ve...
research
10/01/2020

GeoD: Consensus-based Geodesic Distributed Pose Graph Optimization

We present a consensus-based distributed pose graph optimization algorit...
research
10/04/2022

DGORL: Distributed Graph Optimization based Relative Localization of Multi-Robot Systems

An optimization problem is at the heart of many robotics estimating, pla...
research
09/09/2021

BDPGO: Balanced Distributed Pose Graph Optimization Framework for Swarm Robotics

Distributed pose graph optimization (DPGO) is one of the fundamental tec...
research
10/16/2021

Partial Hierarchical Pose Graph Optimization for SLAM

In this paper we consider a hierarchical pose graph optimization (HPGO) ...
research
04/24/2018

Mining Automatically Estimated Poses from Video Recordings of Top Athletes

Human pose detection systems based on state-of-the-art DNNs are on the g...
research
12/23/2018

End-to-end Learning for Graph Decomposition

We propose a novel end-to-end trainable framework for the graph decompos...

Please sign up or login with your details

Forgot password? Click here to reset