Abstract:This paper considers the collaborative graph exploration problem in GPS-denied environments, where a group of robots are required to cover a graph environment while maintaining reliable pose estimations in collaborative simultaneous localization and mapping (SLAM). Considering both objectives presents challenges for multi-robot pathfinding, as it involves the expensive covariance inference for SLAM uncertainty evaluation, especially considering various combinations of robots' paths. To reduce the computational complexity, we propose an efficient two-stage strategy where exploration paths are first generated for quick coverage, and then enhanced by adding informative and distance-efficient loop-closing actions, called loop edges, along the paths for reliable pose estimation. We formulate the latter problem as a non-monotone submodular maximization problem by relating SLAM uncertainty with pose graph topology, which (1) facilitates more efficient evaluation of SLAM uncertainty than covariance inference, and (2) allows the application of approximation algorithms in submodular optimization to provide optimality guarantees. We further introduce the ordering heuristics to improve objective values while preserving the optimality bound. Simulation experiments over randomly generated graph environments verify the efficiency of our methods in finding paths for quick coverage and enhanced pose graph reliability, and benchmark the performance of the approximation algorithms and the greedy-based algorithm in the loop edge selection problem. Our implementations will be open-source at <a class="link-external link-https" href="https://github.com/bairuofei/CGE" rel="external noopener nofollow">this https URL</a>.

A Pose Pruning Driven Solution to Pose Feature GraphSLAM

Kullback-Leibler Divergence Based Graph Pruning in Robotic Feature Mapping

Multi-Session Slam over Low Dynamic Workspace Using Rgbd Sensor

A Framework for Multi-Session RGBD SLAM in Low Dynamic Workspace Environment.

Guaranteed Globally Optimal Planar Pose Graph and Landmark SLAM via Sparse-Bounded Sums-of-Squares Programming

Local Optimized and Scalable Frame-to-model SLAM

Solution to the SLAM problem in low dynamic environments using a pose graph and an RGB-D sensor

SLAM with Objects using a Nonparametric Pose Graph

Keeping Less is More: Point Sparsification for Visual SLAM

Robust Monocular SLAM in Dynamic Environments

Distributed Pose-graph Optimization with Multi-level Partitioning for Collaborative SLAM

Collaborative Graph Exploration with Reduced Pose-SLAM Uncertainty via Submodular Optimization

Model-based Dynamic Pose Graph SLAM in Unstructured Dynamic Environments

A Multi-Hypothesis Approach to Pose Ambiguity in Object-Based SLAM

Non-convex Pose Graph Optimization in SLAM via Proximal Linearized Riemannian ADMM

Occupancy-SLAM: Simultaneously Optimizing Robot Poses and Continuous Occupancy Map

Ground-SLAM: Ground Constrained LiDAR SLAM for Structured Multi-Floor Environments

Active Rendezvous for Multi-Robot Pose Graph Optimization using Sensing over Wi-Fi

A Robot Pose Estimation Optimized Visual SLAM Algorithm Based on CO-HDC Instance Segmentation Network for Dynamic Scenes

Spectral Measurement Sparsification for Pose-Graph SLAM

Graph SLAM for rescue robots