Resumen
Multi-vehicle collaborative mapping proves more efficient in constructing maps in unfamiliar underwater environments in comparison to single-vehicle methods. One of the pivotal hurdles of Simultaneous Localization and Mapping (SLAM) with multiple underwater vehicles is map registration. Due to the inadequate characteristics of the underwater grid maps, matching map features poses a challenge, and outliers between maps add to the complexity. We propose an algorithm to solve this problem. This approach employs the Gaussian Mixture Robust Branch and Bound (GMRBnB) algorithm with an interior point filtering technique. Feature point extraction, registration using the GMRBnB algorithm, inlier extraction based on density, and registration of the inlier are performed to obtain a more precise transformation matrix. The results of the simulation and experiments demonstrate that this technique heightens outlier tolerance and reinforces map registration accuracy. The proposed approach surpasses Iterative Closest Point (ICP) and Normal Distributions Transform (NDT) methods with respect to map registration quality.