Certifiably optimal rotation and pose estimation based on the Cayley map
The International Journal of Robotics Research · 2025-03 · 44 (3) · 366-387
DOI: 10.1177/02783649241269337 ↗Kurz gefasst
Fachartikel in der Zeitschrift The International Journal of Robotics Research, online erschienen am 25.09.2024. Verfasst von Timothy D Barfoot und 2 weiteren Autor:innen. Beteiligte Einrichtung: Robotics Institute, University of Toronto, Toronto, ON, Canada. Die Arbeit wurde bisher 15-mal zitiert (Crossref) und nennt 73 Literaturangaben. Der Volltext ist frei zugänglich (Open Access, CC BY 4.0). Gefördert von: Swiss National Science Foundation, Natural Sciences and Engineering Research Council of Canada.
Abstract (Originalsprache)
We present novel, convex relaxations for rotation and pose estimation problems that can a posteriori guarantee global optimality for practical measurement noise levels. Some such relaxations exist in the literature for specific problem setups that assume the matrix von Mises-Fisher distribution (a.k.a., matrix Langevin distribution or chordal distance) for isotropic rotational uncertainty. However, another common way to represent uncertainty for rotations and poses is to define anisotropic noise in the associated Lie algebra. Starting from a noise model based on the Cayley map, we define our estimation problems, convert them to Quadratically Constrained Quadratic Programs (QCQPs), then relax them to Semidefinite Programs (SDPs), which can be solved using standard interior-point optimization methods; global optimality follows from Lagrangian strong duality. We first show how to carry out basic rotation and pose averaging. We then turn to the more complex problem of trajectory estimation, which involves many pose variables with both individual and inter-pose measurements (or motion priors). Our contribution is to formulate SDP relaxations for all these problems based on the Cayley map (including the identification of redundant constraints) and to show them working in practical settings. We hope our results can add to the catalogue of useful estimation problems whose solutions can be a posteriori guaranteed to be globally optimal.
Schlagwörter
Stichwörter der Autor:innen
Autor:innen und Institutionen
- Robotics Institute, University of Toronto, Toronto, ON, Canada.
ORCID-Profile: Timothy D Barfoot
Förderung
- Swiss National Science Foundation
- Natural Sciences and Engineering Research Council of Canada
Zitieren
APA
Barfoot, T. D., Holmes, C., & Dümbgen, F. (2025). Certifiably optimal rotation and pose estimation based on the Cayley map. The International Journal of Robotics Research, 44(3), 366-387. https://doi.org/10.1177/02783649241269337
Vancouver
Barfoot TD, Holmes C, Dümbgen F. Certifiably optimal rotation and pose estimation based on the Cayley map. The International Journal of Robotics Research. 2025;44(3):366-387. doi:10.1177/02783649241269337
BibTeX
@article{Barfoot2025,
author = {Barfoot, Timothy D and Holmes, Connor and Dümbgen, Frederike},
title = {Certifiably optimal rotation and pose estimation based on the Cayley map},
journal = {The International Journal of Robotics Research},
year = {2025},
volume = {44},
number = {3},
pages = {366--387},
doi = {10.1177/02783649241269337}
}
EUVIMED