Holistic Fusion: Task- and Setup-Agnostic Robot Localization and State Estimation with Factor Graphs

Fuente: arXiv
Saved in:
Bibliographic Details
Main Authors: Nubert, Julian, Tuna, Turcan, Frey, Jonas, Cadena, Cesar, Kuchenbecker, Katherine J., Khattak, Shehryar, Hutter, Marco
Format: Preprint
Published: 2025
Subjects:
Online Access:
Tags: Add Tag
No Tags, Be the first to tag this record!
_version_ 1866908308521091072
author Nubert, Julian
Tuna, Turcan
Frey, Jonas
Cadena, Cesar
Kuchenbecker, Katherine J.
Khattak, Shehryar
Hutter, Marco
author_facet Nubert, Julian
Tuna, Turcan
Frey, Jonas
Cadena, Cesar
Kuchenbecker, Katherine J.
Khattak, Shehryar
Hutter, Marco
contents Seamless operation of mobile robots in challenging environments requires low-latency local motion estimation (e.g., dynamic maneuvers) and accurate global localization (e.g., wayfinding). While most existing sensor-fusion approaches are designed for specific scenarios, this work introduces a flexible open-source solution for task- and setup-agnostic multimodal sensor fusion that is distinguished by its generality and usability. Holistic Fusion formulates sensor fusion as a combined estimation problem of i) the local and global robot state and ii) a (theoretically unlimited) number of dynamic context variables, including automatic alignment of reference frames; this formulation fits countless real-world applications without any conceptual modifications. The proposed factor-graph solution enables the direct fusion of an arbitrary number of absolute, local, and landmark measurements expressed with respect to different reference frames by explicitly including them as states in the optimization and modeling their evolution as random walks. Moreover, local smoothness and consistency receive particular attention to prevent jumps in the robot state belief. HF enables low-latency and smooth online state estimation on typical robot hardware while simultaneously providing low-drift global localization at the IMU measurement rate. The efficacy of this released framework is demonstrated in five real-world scenarios on three robotic platforms, each with distinct task requirements.
format Preprint
id arxiv_https___arxiv_org_abs_2504_06479
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle Holistic Fusion: Task- and Setup-Agnostic Robot Localization and State Estimation with Factor Graphs
Nubert, Julian
Tuna, Turcan
Frey, Jonas
Cadena, Cesar
Kuchenbecker, Katherine J.
Khattak, Shehryar
Hutter, Marco
Robotics
Computer Vision and Pattern Recognition
Systems and Control
Seamless operation of mobile robots in challenging environments requires low-latency local motion estimation (e.g., dynamic maneuvers) and accurate global localization (e.g., wayfinding). While most existing sensor-fusion approaches are designed for specific scenarios, this work introduces a flexible open-source solution for task- and setup-agnostic multimodal sensor fusion that is distinguished by its generality and usability. Holistic Fusion formulates sensor fusion as a combined estimation problem of i) the local and global robot state and ii) a (theoretically unlimited) number of dynamic context variables, including automatic alignment of reference frames; this formulation fits countless real-world applications without any conceptual modifications. The proposed factor-graph solution enables the direct fusion of an arbitrary number of absolute, local, and landmark measurements expressed with respect to different reference frames by explicitly including them as states in the optimization and modeling their evolution as random walks. Moreover, local smoothness and consistency receive particular attention to prevent jumps in the robot state belief. HF enables low-latency and smooth online state estimation on typical robot hardware while simultaneously providing low-drift global localization at the IMU measurement rate. The efficacy of this released framework is demonstrated in five real-world scenarios on three robotic platforms, each with distinct task requirements.
title Holistic Fusion: Task- and Setup-Agnostic Robot Localization and State Estimation with Factor Graphs
topic Robotics
Computer Vision and Pattern Recognition
Systems and Control
url https://arxiv.org/abs/2504.06479