Efficient Bathymetric SLAM With Invalid Loop Closure Identification

Ma Teng,Li Ye,Zhao Yuxin,Jiang Yanqing,Zhang Qianyi,Antonio M. Pascoal

DOI: https://doi.org/10.1109/tmech.2020.3043136

2021-10-01

IEEE/ASME Transactions on Mechatronics

Abstract:Bathymetric simultaneous localization and mapping (SLAM) holds high potential for accurate navigation in long endurance autonomous underwater vehicle (AUV) missions. Due to nearly flat seabed topography, the occurrence of invalid loop closures is unavoidable in bathymetric SLAM. Thus, invalid loop closure identification is a crucial component of bathymetric SLAM, a procedure that normally requires a substantial amount of computational resources. An efficient bathymetric SLAM method considering invalid loop closures is proposed in this article, which identifies invalid loop closures via PF-Backend, a robust back end method based on particle filtering theory. Using this set-up, all beliefs of historical loop closures are estimated by a small number of particles and, for each particle, the corresponding map consistency calculated via a global graph optimizer is applied as the measurement update in the particle filter. A loop closure solidification procedure is also discussed to decrease the number of particles in the PF-Backend. The new algorithm is shown to be efficient and capable of providing accurate location and mapping results using play-back experiments.

What problem does this paper attempt to address?

The problem that this paper attempts to solve is how to efficiently perform Bathymetric SLAM (Simultaneous Localization and Mapping) under the condition of almost flat seabed terrain when an Autonomous Underwater Vehicle (AUV) is performing long - endurance tasks, especially how to identify Invalid Loop Closure. Due to the almost flat seabed terrain, invalid loop closures will inevitably occur in Bathymetric SLAM, which will seriously affect the accuracy of navigation and map construction. Therefore, the paper proposes a robust back - end method based on particle filter theory (PF - Backend) to identify these invalid loop closures, thereby improving the efficiency and accuracy of the SLAM system.

The core contributions of the paper are as follows:
1. **Proposing an efficient Bathymetric SLAM algorithm**: Through the PF - Backend method, this algorithm can use a small number of particles to estimate the beliefs of all historical loop closures, and the map consistency corresponding to each particle is calculated by the global graph optimizer as the measurement update in the particle filter.
2. **Loop closure solidification process**: Discusses the loop closure solidification process to reduce the number of particles in PF - Backend, thereby reducing the storage and computational complexity.
3. **Experimental verification**: By replaying experimental data, it proves the effectiveness and accuracy of the new algorithm, which can significantly reduce the demand for computational resources while ensuring the accuracy of navigation and map construction.

In conclusion, this paper aims to solve the navigation error problem caused by invalid loop closures in Bathymetric SLAM and proposes an efficient and robust method, which is suitable for long - endurance AUV tasks.