Enregistré dans:
Détails bibliographiques
Auteurs principaux: Bazzana, Barbara, Andreasson, Henrik, Grisetti, Giorgio
Format: Preprint
Publié: 2023
Sujets:
Accès en ligne:https://arxiv.org/abs/2308.05444
Tags: Ajouter un tag
Pas de tags, Soyez le premier à ajouter un tag!
_version_ 1866912086979772416
author Bazzana, Barbara
Andreasson, Henrik
Grisetti, Giorgio
author_facet Bazzana, Barbara
Andreasson, Henrik
Grisetti, Giorgio
contents Factor graphs are a very powerful graphical representation, used to model many problems in robotics. They are widely spread in the areas of Simultaneous Localization and Mapping (SLAM), computer vision, and localization. In this paper we describe an approach to fill the gap with other areas, such as optimal control, by presenting an extension of Factor Graph Solvers to constrained optimization. The core idea of our method is to encapsulate the Augmented Lagrangian (AL) method in factors of the graph that can be integrated straightforwardly in existing factor graph solvers. We show the generality of our approach by addressing three applications, arising from different areas: pose estimation, rotation synchronization and Model Predictive Control (MPC) of a pseudo-omnidirectional platform. We implemented our approach using C++ and ROS. Besides the generality of the approach, application results show that we can favorably compare against domain specific approaches.
format Preprint
id arxiv_https___arxiv_org_abs_2308_05444
institution arXiv
publishDate 2023
record_format arxiv
spellingShingle How-to Augmented Lagrangian on Factor Graphs
Bazzana, Barbara
Andreasson, Henrik
Grisetti, Giorgio
Robotics
Factor graphs are a very powerful graphical representation, used to model many problems in robotics. They are widely spread in the areas of Simultaneous Localization and Mapping (SLAM), computer vision, and localization. In this paper we describe an approach to fill the gap with other areas, such as optimal control, by presenting an extension of Factor Graph Solvers to constrained optimization. The core idea of our method is to encapsulate the Augmented Lagrangian (AL) method in factors of the graph that can be integrated straightforwardly in existing factor graph solvers. We show the generality of our approach by addressing three applications, arising from different areas: pose estimation, rotation synchronization and Model Predictive Control (MPC) of a pseudo-omnidirectional platform. We implemented our approach using C++ and ROS. Besides the generality of the approach, application results show that we can favorably compare against domain specific approaches.
title How-to Augmented Lagrangian on Factor Graphs
topic Robotics
url https://arxiv.org/abs/2308.05444