Saved in:
Bibliographic Details
Main Authors: Warke, William D., Ramos, J. Humberto, Ganesh, Prashant, Brink, Kevin M., Hale, Matthew T.
Format: Preprint
Published: 2024
Subjects:
Online Access:https://arxiv.org/abs/2404.00010
Tags: Add Tag
No Tags, Be the first to tag this record!
_version_ 1866911026753044480
author Warke, William D.
Ramos, J. Humberto
Ganesh, Prashant
Brink, Kevin M.
Hale, Matthew T.
author_facet Warke, William D.
Ramos, J. Humberto
Ganesh, Prashant
Brink, Kevin M.
Hale, Matthew T.
contents It is common in pose graph optimization (PGO) algorithms to assume that noise in the translations and rotations of relative pose measurements is uncorrelated. However, existing work shows that in practice these measurements can be highly correlated, which leads to degradation in the accuracy of PGO solutions that rely on this assumption. Therefore, in this paper we develop a novel algorithm derived from a realistic, correlated model of relative pose uncertainty, and we quantify the resulting improvement in the accuracy of the solutions we obtain relative to state-of-the-art PGO algorithms. Our approach utilizes Riemannian optimization on the planar unit dual quaternion (PUDQ) manifold, and we prove that it converges to first-order stationary points of a Lie-theoretic maximum likelihood objective. Then we show experimentally that, compared to state-of-the-art PGO algorithms, this algorithm produces estimation errors that are lower by 10% to 25% across several orders of magnitude of noise levels and graph sizes.
format Preprint
id arxiv_https___arxiv_org_abs_2404_00010
institution arXiv
publishDate 2024
record_format arxiv
spellingShingle Technical Report: Pose Graph Optimization over Planar Unit Dual Quaternions: Improved Accuracy with Provably Convergent Riemannian Optimization
Warke, William D.
Ramos, J. Humberto
Ganesh, Prashant
Brink, Kevin M.
Hale, Matthew T.
Optimization and Control
It is common in pose graph optimization (PGO) algorithms to assume that noise in the translations and rotations of relative pose measurements is uncorrelated. However, existing work shows that in practice these measurements can be highly correlated, which leads to degradation in the accuracy of PGO solutions that rely on this assumption. Therefore, in this paper we develop a novel algorithm derived from a realistic, correlated model of relative pose uncertainty, and we quantify the resulting improvement in the accuracy of the solutions we obtain relative to state-of-the-art PGO algorithms. Our approach utilizes Riemannian optimization on the planar unit dual quaternion (PUDQ) manifold, and we prove that it converges to first-order stationary points of a Lie-theoretic maximum likelihood objective. Then we show experimentally that, compared to state-of-the-art PGO algorithms, this algorithm produces estimation errors that are lower by 10% to 25% across several orders of magnitude of noise levels and graph sizes.
title Technical Report: Pose Graph Optimization over Planar Unit Dual Quaternions: Improved Accuracy with Provably Convergent Riemannian Optimization
topic Optimization and Control
url https://arxiv.org/abs/2404.00010