Monte Carlo Localization for an Autonomous Underwater Vehicle with a Low-Cost Sonar

This paper proposes a Monto Carlo based localization (MCL) algorithm for autonomous underwater vehicle (AUV) with a low-cost mechanical scanning imaging sonar (MSIS). As MSIS has a slow-sampling characteristic, its scan is distorted by the vehicle motion during the scan interval and the sonar readings are sparse. Our contribution is introducing this two-stage approach to overcome the shortages of MSIS to achieve accurate localization: 1) the scan formation module is devised to eliminate the motion induced distortion of sonar scan; 2) MCL is applied to estimate the AUV pose accurately by the Dead Reckoning (DR) result and the formed sonar scan. Results of simulation verify that the proposed algorithm performs well in terms of effectiveness and accuracy.

[1]  Thomas R. Collins,et al.  An implementation of ROS on the Yellowfin autonomous underwater vehicle (AUV) , 2011, OCEANS'11 MTS/IEEE KONA.

[2]  Wolfram Burgard,et al.  Robust Monte Carlo localization for mobile robots , 2001, Artif. Intell..

[3]  Zbigniew Suchorab,et al.  Application of Gas Sensor Arrays in Assessment of Wastewater Purification Effects , 2014, Sensors.

[4]  Bin Fang,et al.  Underwater Matching Correction Navigation Based on Geometric Features Using Sonar Point Cloud Data , 2017, Sci. Program..

[5]  Mustapha Hamerlain,et al.  SLAM Problem for Autonomous Underwater Vehicle using SVSF Filter , 2018, 2018 25th International Conference on Systems, Signals and Image Processing (IWSSIP).

[6]  Ling Chen,et al.  Improving Localization Accuracy for an Underwater Robot With a Slow-Sampling Sonar Through Graph Optimization , 2015, IEEE Sensors Journal.

[7]  Jinwhan Kim,et al.  A robust loop-closure method for visual SLAM in unstructured seafloor environments , 2016, Auton. Robots.

[8]  Dieter Fox,et al.  Adapting the Sample Size in Particle Filters Through KLD-Sampling , 2003, Int. J. Robotics Res..

[9]  N. Gordon,et al.  Novel approach to nonlinear/non-Gaussian Bayesian state estimation , 1993 .

[10]  Alexander L. Forrest,et al.  Chapter 2: Emerging Mapping Techniques for Autonomous Underwater Vehicles (AUVs) , 2016 .

[11]  Antoni Burguera,et al.  The UspIC: Performing Scan Matching Localization Using an Imaging Sonar , 2012, Sensors.

[12]  Mae L. Seto,et al.  Fast Monte Carlo localization of AUV using acoustic range measurement , 2015, 2015 IEEE 28th Canadian Conference on Electrical and Computer Engineering (CCECE).

[13]  Carlos Silvestre,et al.  Tightly coupled long baseline/ultra-short baseline integrated navigation system , 2016, Int. J. Syst. Sci..

[14]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[15]  Yimin Xia,et al.  Mobile Robot Localization Method Based on Adaptive Particle Filter , 2008, ICIRA.