Bathymetric Particle Filter SLAM Based on Mean Trajectory Map Representation

To obtain independent navigation results for autonomous underwater vehicles (AUVs) and construct high-resolution consistent seabed maps, a particle filter-based bathymetric simultaneous localization and mapping (BSLAM) method with the mean trajectory map representation is proposed. To reduce the computational consumption, particles only keep the current estimated position of the vehicle, while all historical states of the vehicle are stored in the mean trajectory map. Using this set-up, only the weights of the particles which closed to the mean trajectory map are calculated with newly collected bathymetric data. A hierarchical clustering procedure is also discussed to identify invalid loop closures. The performance of the proposed method is validated using both the simulated data and the field data collected from sea trails. The results demonstrate that the proposed method is 50% more accurate and 50% faster than a state-of-the-art particle filter-based BSLAM method, and it has similar accuracy but 30% faster compared with a graph-based BSLAM method.

[1]  Onur Köksoy,et al.  Multiresponse robust design: Mean square error (MSE) criterion , 2006, Appl. Math. Comput..

[2]  Stefan B. Williams,et al.  A featureless approach to efficient bathymetric SLAM using distributed particle mapping , 2011, J. Field Robotics.

[3]  Brian Claus,et al.  Terrain‐aided Navigation for an Underwater Glider , 2015, J. Field Robotics.

[4]  Edwin Olson,et al.  Single-Cluster Spectral Graph Partitioning for Robotics Applications , 2005, Robotics: Science and Systems.

[5]  Hanumant Singh,et al.  Improved vehicle based multibeam bathymetry using sub-maps and SLAM , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[7]  Anibal Matos,et al.  Survey on advances on terrain based navigation for autonomous underwater vehicles , 2017 .

[8]  John J. Leonard,et al.  Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age , 2016, IEEE Transactions on Robotics.

[9]  Yuanyuan Zhao,et al.  Autonomous Underwater Vehicle Navigation , 2010, IEEE Journal of Oceanic Engineering.

[10]  Ye Li,et al.  Review of AUV Underwater Terrain Matching Navigation , 2015 .

[11]  R. Stuckey.  Navigational Error Reduction of Underwater Vehicles with Selective Bathymetric SLAM , 2012 .

[12]  Zhou Tian,et al.  Terrain aided navigation for underwater vehicles using maximum likelihood method , 2016, 2016 IEEE/OES China Ocean Acoustics (COA).

[13]  Hugh Durrant-Whyte,et al.  Simultaneous localization and mapping (SLAM): part II , 2006 .

[14]  Ye Li,et al.  Terrain Correlation Correction Method for AUV Seabed Terrain Mapping , 2017, Journal of Navigation.

[15]  Fionn Murtagh,et al.  Algorithms for hierarchical clustering: an overview, II , 2017, WIREs Data Mining Knowl. Discov..

[16]  Stefan B. Williams,et al.  Bathymetric particle filter SLAM using trajectory maps , 2012, Int. J. Robotics Res..

[17]  Pere Ridao,et al.  Multibeam 3D Underwater SLAM with Probabilistic Registration , 2016, Sensors.

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

[19]  W. J. Kirkwood,et al.  Development of the DORADO mapping vehicle for multibeam, subbottom, and sidescan science missions , 2007, J. Field Robotics.

[20]  Fionn Murtagh,et al.  Algorithms for hierarchical clustering: an overview , 2012, WIREs Data Mining Knowl. Discov..

[21]  Beom Hee Lee,et al.  Analysis of Resampling Process for the Particle Depletion Problem in FastSLAM , 2007, RO-MAN 2007 - The 16th IEEE International Symposium on Robot and Human Interactive Communication.

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

[23]  Yunhui Li,et al.  Research on simultaneous localization and mapping for AUV by an improved method: Variance reduction FastSLAM with simulated annealing , 2020 .

[24]  S. Rock,et al.  Improving robustness of terrain-relative navigation for AUVs in regions with flat terrain , 2012, 2012 IEEE/OES Autonomous Underwater Vehicles (AUV).

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

[26]  David M. W. Powers,et al.  Evaluation: from precision, recall and F-measure to ROC, informedness, markedness and correlation , 2011, ArXiv.

[27]  Sebastian Thrun,et al.  Particle Filters in Robotics , 2002, UAI.

[28]  David Wettergreen,et al.  Towards particle filter SLAM with three dimensional evidence grids in a flooded subterranean environment , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[29]  Eric Rogers,et al.  Terrain Aided Navigation for Long Range AUV operations at arctic latitudes , 2016, 2016 IEEE/OES Autonomous Underwater Vehicles (AUV).