Asynchronous Distributed Smoothing and Mapping via On-Manifold Consensus ADMM

Daniel McGann,Kyle Lassak,Michael Kaess
2024-03-20
Abstract:In this paper we present a fully distributed, asynchronous, and general purpose optimization algorithm for Consensus Simultaneous Localization and Mapping (CSLAM). Multi-robot teams require that agents have timely and accurate solutions to their state as well as the states of the other robots in the team. To optimize this solution we develop a CSLAM back-end based on Consensus ADMM called MESA (Manifold, Edge-based, Separable ADMM). MESA is fully distributed to tolerate failures of individual robots, asynchronous to tolerate communication delays and outages, and general purpose to handle any CSLAM problem formulation. We demonstrate that MESA exhibits superior convergence rates and accuracy compare to existing state-of-the art CSLAM back-end optimizers.
Robotics
What problem does this paper attempt to address?
### Problems Addressed by the Paper The paper primarily addresses the issue of Collaborative Simultaneous Localization and Mapping (CSLAM) in multi-robot cooperation. Specifically: 1. **Background**: - Multi-robot teams have advantages in many application scenarios, such as search and rescue, scientific exploration, etc. - To effectively deploy multi-robot teams, an efficient and consistent CSLAM method is required. 2. **Core Issues**: - Existing CSLAM backend optimization algorithms have deficiencies in robustness, convergence speed, and consistency. - There is a need for an optimization algorithm that can operate in a distributed environment and tolerate communication delays and failures. 3. **Proposed Method**: - This paper proposes a new algorithm based on the Consensus Alternating Direction Method of Multipliers (C-ADMM), called MESA (Manifold, Edge-based, Separable ADMM). - MESA is a fully distributed, asynchronous general optimization algorithm capable of handling any form of CSLAM problem. - Experimental results show that MESA outperforms existing state-of-the-art CSLAM backend optimizers in terms of convergence speed and accuracy. ### Summary The paper aims to develop a new CSLAM backend optimization algorithm, MESA, to address the shortcomings of existing methods in robustness, convergence speed, and consistency, thereby achieving efficient multi-robot collaborative localization and mapping.