Robust bathymetric SLAM algorithm considering invalid loop closures

Abstract Autonomous underwater vehicles (AUVs) are important tools for topography mapping and geological surveys, and bathymetric simultaneous localization and mapping (BSLAM) method holds high potential for accurate navigation in long endurance AUV missions. However, invalid loop closures caused by nearly flat seabed topography may cause BSLAM algorithm fail catastrophically. In this paper, a robust BSLAM algorithm is proposed, whose robustness is guaranteed by both a residual-based loop closure identification method and a robust filter algorithm. In residual-based loop closure identification, a Gini impurity based on probabilistic labels is proposed in the random forest (RF) method to classify invalid and valid loop closures; meanwhile, a posteriori state estimate function of the vehicle considering the stability of robust BSLAM algorithm is proposed to generate both stable and accurate navigational results in robust filter. The play-back experiments have shown that robust BSLAM algorithm can provide accurate and stable navigational results in real-time.

[1]  Peilin Liu,et al.  Tightly Coupled Integration of GNSS and Vision SLAM Using 10-DoF Optimization on Manifold , 2019, IEEE Sensors Journal.

[2]  Ryan M. Eustice,et al.  Pairwise Consistent Measurement Set Maximization for Robust Multi-Robot Map Merging , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Rui Yao,et al.  A novel intelligent diagnosis method using optimal LS-SVM with improved PSO algorithm , 2017, Soft Computing.

[4]  Sajad Saeedi,et al.  AUV Navigation and Localization: A Review , 2014, IEEE Journal of Oceanic Engineering.

[5]  Eric Rogers,et al.  Terrain‐aided navigation for long‐endurance and deep‐rated autonomous underwater vehicles , 2018, J. Field Robotics.

[6]  Chengsheng Yuan,et al.  Difference co-occurrence matrix using BP neural network for fingerprint liveness detection , 2019, Soft Comput..

[7]  Jia Guo,et al.  Intelligent assistance positioning methodology based on modified iSAM for AUV using low-cost sensors , 2018 .

[8]  Nils Bore,et al.  Sparse Gaussian Process SLAM, Storage and Filtering for AUV Multibeam Bathymetry , 2018, 2018 IEEE/OES Autonomous Underwater Vehicle Workshop (AUV).

[9]  Ye Li,et al.  AUV robust bathymetric simultaneous localization and mapping , 2018, Ocean Engineering.

[10]  Pere Ridao,et al.  Semantic SLAM for an AUV using object recognition from point clouds , 2018 .

[11]  Pere Ridao,et al.  A Comparison of G2o Graph SLAM and EKF Pose Based SLAM with Bathymetry Grids , 2013 .

[12]  Tao Liu,et al.  Investigation of the vectored thruster AUVs based on 3SPS-S parallel manipulator , 2019 .

[13]  Luca Carlone,et al.  Modeling Perceptual Aliasing in SLAM via Discrete–Continuous Graphical Models , 2018, IEEE Robotics and Automation Letters.

[14]  Roger Skjetne,et al.  A Multibeam-Based SLAM Algorithm for Iceberg Mapping Using AUVs , 2018, IEEE Access.

[15]  Gabriel Oliver,et al.  Submap bathymetric SLAM using structured light in underwater environments , 2016, 2016 IEEE/OES Autonomous Underwater Vehicles (AUV).

[16]  Erwan Scornet,et al.  A random forest guided tour , 2015, TEST.