Air-Ground Multi-Agent System Cooperative Navigation based on Factor Graph Optimization SLAM

Haiying Liu,Xiaolong Wang,Ruihang Liu,Yangguang Xie,Tiexiang Li
DOI: https://doi.org/10.1088/1361-6501/ad3017
IF: 2.398
2024-03-06
Measurement Science and Technology
Abstract:In this study, a cooperative navigation algorithm centered on Factor Graph Optimization - Simultaneous Localization and Mapping (FGO-SLAM) is presented for an air-ground multi-agent system. The algorithm prioritizes the control of error statuses during the position and attitude estimation procedure throughout the entire back-end optimization process. In the conventional Extended Kalman Filtering (EKF) algorithm, periodic cumulative errors may arise, introducing uncertainty to the estimation process. The application of the factor graph optimization algorithm not only mitigates deviation but also stabilizes errors, thereby eliminating the accumulation of periodic errors. In comparison to the practical EKF-SLAM, FGO-SLAM serves as a semi-offline optimization system that leverages key frames to minimize computational load. During multi-agent simulations, when two or more agents have overlapping field views, landmark data is merged, enhancing the optimization effectiveness. Through simulation experiments, the proposed algorithm demonstrates a 40% reduction in position error and a 41% reduction in attitude error, affirming the efficacy of FGO-SLAM for cooperative navigation.
engineering, multidisciplinary,instruments & instrumentation
What problem does this paper attempt to address?