Enhanced Multi-Robot SLAM System with Cross-Validation Matching and Exponential Threshold Keyframe Selection

Ang He, Ximei Wu, Xiaobin Guo, Libin LiuarXiv 2024 · DOI · arXiv

Abstract

The evolving field of mobile robotics has increased the demand for simultaneous localization and mapping (SLAM) systems. To augment localization accuracy and mapping efficacy, this research introduces a refined SLAM core module. Within the feature matching phase, cross-validation matching is employed to filter out mismatches. In the keyframe selection strategy, an exponential threshold function quantifies the selection process. Compared with single-robot systems, this multi-robot collaborative SLAM (CSLAM) system substantially improves task efficiency and robustness. Utilizing a centralized structure, the system incorporates a coarse-to-fine matching approach for multi-map point cloud registration. Built upon ORB-SLAM3, the system achieved a 12.90% reduction in absolute trajectory error across standard datasets.

Introduction

Simultaneous Localization and Mapping (SLAM) is foundational for autonomous robotics, yet state-of-the-art systems like ORB-SLAM3 face persistent challenges. Two primary hurdles include feature mismatching, where single-step verification often leads to "ghost" points and tracking errors, and heuristic keyframe selection, which typically lacks a quantitative approach to account for the complex relationships between time, movement, and view quality. Furthermore, merging maps from multiple agents often ignores prior state information, leading to high computational overhead and misaligned global maps.

System Architecture and Methodology

The proposed system enhances the standard SLAM pipeline through a centralized multi-robot architecture and refined processing modules.

The centralized multi-robot SLAM architecture, illustrating the flow from individual robot frame processing to global map generation.

Cross-Validation Feature Matching

To address the issue of outliers in visual odometry, the system implements a "reciprocity check" during feature matching. Instead of a one-way search, the system projects points from Frame B to Frame A to find matches, then performs an inverse transformation to project Frame A back to Frame B. Only points that consistently match in both directions are retained. This mathematical "handshake" significantly filters out mismatches that traditional brute-force methods might accept.

Illustration of the cross-validation matching mechanism, showing how bidirectional transformation (T_AB and T_BA) filters successful matches from failures.

Exponential Threshold Keyframe Selection

The authors constructed a non-linear function to quantify keyframe importance, weighing four factors: temporal cost, common view quality, translation cost, and rotational cost. By utilizing an exponential function ($T_H = \sum W(e^x - 1)$), the system becomes more sensitive to rapid geometric changes, such as sharp turns. This ensures keyframes are added precisely when the motion model requires them most, preventing the "lost track" issues common in high-frequency signal scenes.

Multi-Map Registration and Processing

For multi-robot collaboration, the system uses a coarse-to-fine registration strategy. It first performs coarse matching using the robots' initial poses, followed by fine matching using the Generalized Iterative Closest Point (GICP) algorithm. To ensure the resulting dense maps are computationally viable, uniform sampling is applied (reducing data redundancy by approximately 32%) alongside 3D Gaussian filtering to smooth noise.

Experimental Results

The system was rigorously evaluated using the TUM RGB-D, EuRoC MAV, and TUM_VI datasets. Key findings include:

  • Accuracy: The system outperformed ORB-SLAM3, specifically reducing the Root Mean Square Error (RMSE) by 12.90% and the maximum absolute trajectory error by 10.25% on the fr1_desk2 sequence.
  • Robustness: The improved keyframe strategy maintained tracking in challenging sequences like fr3_teddy, where standard ORB-SLAM3 often struggles with sharp rotations.
  • Efficiency: Despite the added complexity of cross-validation, the system maintains real-time performance. Uniform sampling effectively reduced point cloud density without deteriorating mapping quality, making it suitable for real-time hardware deployment.

Conclusion and Future Work

This enhanced CSLAM system demonstrates that non-linear keyframe selection and reciprocal feature matching significantly improve localization and mapping consistency. While the current centralized architecture is robust, future research will explore distributed or hybrid schemes to mitigate the risk of single-point communication failures. Additionally, integrating deep learning to filter dynamic objects (e.g., pedestrians) remains a priority for improving performance in crowded public environments.

Summary updated

Abstract

The evolving field of mobile robotics has indeed increased the demand for simultaneous localization and mapping (SLAM) systems. To augment the localization accuracy and mapping efficacy of SLAM, we refined the core module of the SLAM system. Within the feature matching phase, we introduced cross-validation matching to filter out mismatches. In the keyframe selection strategy, an exponential threshold function is constructed to quantify the keyframe selection process. Compared with a single robot, the multi-robot collaborative SLAM (CSLAM) system substantially improves task execution efficiency and robustness. By employing a centralized structure, we formulate a multi-robot SLAM system and design a coarse-to-fine matching approach for multi-map point cloud registration. Our system, built upon ORB-SLAM3, underwent extensive evaluation utilizing the TUM RGB-D, EuRoC MAV, and TUM_VI datasets. The experimental results demonstrate a significant improvement in the positioning accuracy and mapping quality of our enhanced algorithm compared to those of ORB-SLAM3, with a 12.90% reduction in the absolute trajectory error.
BibTeX
@misc{he2024enhanced,
  author = {Ang He and Ximei Wu and Xiaobin Guo and Libin Liu},
  title = {{Enhanced Multi-Robot SLAM System with Cross-Validation Matching and Exponential Threshold Keyframe Selection}},
  year = {2024},
  eprint = {2410.05017},
  archivePrefix = {arXiv},
  url = {https://arxiv.org/abs/2410.05017},
}
Figure