MSISpIC: A Probabilistic Scan Matching Algorithm Using a Mechanical Scanned Imaging Sonar

This paper compares two well known scan matching algorithms: the MbICP and the pIC. As a result of the study, it is proposed the MSISpIC, a probabilistic 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), and the robot displacement estimated through dead-reckoning with the help of a Doppler Velocity Log (DVL) and a Motion Reference Unit (MRU). The proposed method is an extension of the pIC algorithm. Its major contribution consists in: 1) using an EKF to estimate the local path traveled by the robot while grabbing the scan as well as its uncertainty and 2) proposing a method to group into a unique scan, with a convenient uncertainty model, all the data grabbed along the path described by the robot. The algorithm has been tested on an AUV guided along a 600m path within a marina environment with satisfactory results.

[1]  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).

[2]  Simon Lacroix,et al.  Autonomous Rover Navigation on Unknown Terrains: Functions and Integration , 2000, Int. J. Robotics Res..

[3]  M. Carreras,et al.  ICTINEU AUV Wins the First SAUCE Competition , 2007 .

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

[5]  Y. Bar-Shalom.  Tracking and data association , 1988 .

[6]  Ingemar J. Cox,et al.  Blanche-an experiment in guidance and navigation of an autonomous robot vehicle , 1991, IEEE Trans. Robotics Autom..

[7]  Pere Ridao,et al.  Underwater SLAM in man-made structured environments , 2008 .

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

[9]  Riccardo Poli,et al.  Robust mobile robot localisation from sparse and noisy proximity readings using Hough transform and probability grids , 2001, Robotics Auton. Syst..

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

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

[12]  Thor I. Fossen,et al.  Guidance and control of ocean vehicles , 1994 .

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

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

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

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