Abstract:We consider the following problem: a team of robots is deployed in an unknown environment and it has to collaboratively build a map of the area without a reliable infrastructure for communication. The backbone for modern mapping techniques is pose graph optimization, which estimates the trajectory of the robots, from which the map can be easily built. The first contribution of this paper is a set of distributed algorithms for pose graph optimization: rather than sending all sensor data to a remote sensor fusion server, the robots exchange very partial and noisy information to reach an agreement on the pose graph configuration. Our approach can be considered as a distributed implementation of the two-stage approach of Carlone et al., where we use the Successive Over-Relaxation (SOR) and the Jacobi Over-Relaxation (JOR) as workhorses to split the computation among the robots. As a second contribution, we extend %and demonstrate the applicability of the proposed distributed algorithms to work with object-based map models. The use of object-based models avoids the exchange of raw sensor measurements (e.g., point clouds) further reducing the communication burden. Our third contribution is an extensive experimental evaluation of the proposed techniques, including tests in realistic Gazebo simulations and field experiments in a military test facility. Abundant experimental evidence suggests that one of the proposed algorithms (the Distributed Gauss-Seidel method or DGS) has excellent performance. The DGS requires minimal information exchange, has an anytime flavor, scales well to large teams, is robust to noise, and is easy to implement. Our field tests show that the combined use of our distributed algorithms and object-based models reduces the communication requirements by several orders of magnitude and enables distributed mapping with large teams of robots in real-world problems.

Resource-Efficient Cooperative Online Scalar Field Mapping via Distributed Sparse Gaussian Process Regression

Cooperative and Active Sensing in Mobile Sensor Networks for Scalar Field Mapping

Distributed Gaussian Process Mapping for Robot Teams with Time-varying Communication

Coxgraph: Multi-Robot Collaborative, Globally Consistent, Online Dense Reconstruction System

Modeling and Tracking of Spatio-Temporal Scalar Fields with Multiple Robots

Distributed Online Sparse Gaussian Process Regression for Multi-Agent Coverage Control

Distributed Mapping with Privacy and Communication Constraints: Lightweight Algorithms and Object-based Models

Gaussian Process Autonomous Mapping and Exploration for Range Sensing Mobile Robots

HGS-Mapping: Online Dense Mapping Using Hybrid Gaussian Representation in Urban Scenes

Multi-Robot Area Coverage and Environment Estimation Based on the Mixture of Gaussian Processes

Multi-Robot Swarm for Cooperative Scalar Field Mapping

POAM: Probabilistic Online Attentive Mapping for Efficient Robotic Information Gathering

MR-GMMapping: Communication Efficient Multi-Robot Mapping System via Gaussian Mixture Model

Voxel-Based Localization and Mapping for Multirobot System in GPS-Denied Environments

Lightweight Distributed Gaussian Process Regression for Online Machine Learning

GPmap: A Unified Framework for Robotic Mapping Based on Sparse Gaussian Processes

OG-Mapping: Octree-based Structured 3D Gaussians for Online Dense Mapping

Gaussian Process based Non-myopic Cooperative Exploration of Multiple Robots

Robotic Active Information Gathering for Spatial Field Reconstruction with Rapidly-Exploring Random Trees and Online Learning of Gaussian Processes

Distributed Gaussian Process Regression Under Localization Uncertainty

Learning Spatial Constraints Using Gaussian Process For Shared Control Of Semi-Autonomous Mobile Robots