Probabilistic sonar scan matching for an AUV

This paper proposes MSISpIC, a probabilistic sonar scan matching algorithm for the localization of an autonomous underwater vehicle (AUV). The technique uses range scans gathered with a Mechanical Scanning Imaging Sonar (MSIS), the robot displacement estimated through dead-reckoning using a Doppler velocity log (DVL) and a motion reference unit (MRU). The proposed method is an extension of the pIC algorithm. An extended Kalman filter (EKF) is used to estimate the robot-path during the scan in order to reference all the range and bearing measurements as well as their uncertainty to a scan fixed frame before registering. The major contribution consists of experimentally proving that probabilistic sonar scan matching techniques have the potential to improve the DVL-based navigation. The algorithm has been tested on an AUV guided along a 600 m path within an abandoned marina underwater environment with satisfactory results.

[1]  Evangelos E. Milios,et al.  Robot Pose Estimation in Unknown Environments by Matching 2D Range Scans , 1994, 1994 Proceedings of IEEE Conference on Computer Vision and Pattern Recognition.

[2]  José A. Castellanos,et al.  Constraint-based mobile robot localization , 1996 .

[3]  Luis Montesano,et al.  Probabilistic scan matching for motion estimation in unstructured environments , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  U. Castellani,et al.  Efficient on-line mosaicing from 3D acoustical images , 2004, Oceans '04 MTS/IEEE Techno-Ocean '04 (IEEE Cat. No.04CH37600).

[5]  Pere Ridao,et al.  ICTINEUAUV Wins the First SAUC-E Competition , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[6]  Wolfram Burgard,et al.  An efficient fastSLAM algorithm for generating maps of large-scale cyclic environments from raw laser range measurements , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[7]  Alberto Elfes,et al.  Using occupancy grids for mobile robot perception and navigation , 1989, Computer.

[8]  Javier Minguez,et al.  Integration of planning and reactive obstacle avoidance in autonomous sensor-based navigation , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[9]  Antoni Burguera,et al.  Probabilistic Sonar Scan Matching for Robust Localization , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[10]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[11]  Florent Lamiraux,et al.  Metric-Based Scan Matching Algorithms for Mobile Robot Displacement Estimation , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[12]  Pere Ridao,et al.  Underwater SLAM in man‐made structured environments , 2008, J. Field Robotics.

[13]  Chieh-Chih Wang,et al.  LADAR-based detection and tracking of moving objects from a ground vehicle at high speeds , 2003, IEEE IV2003 Intelligent Vehicles Symposium. Proceedings (Cat. No.03TH8683).

[14]  David M. Bradley,et al.  Scan matching for flooded subterranean voids , 2004, IEEE Conference on Robotics, Automation and Mechatronics, 2004..

[15]  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.

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

[17]  Marc Levoy,et al.  Efficient variants of the ICP algorithm , 2001, Proceedings Third International Conference on 3-D Digital Imaging and Modeling.