Scan matching SLAM in underwater environments

This paper proposes a pose-based algorithm to solve the full simultaneous localization and mapping problem for autonomous underwater vehicle (AUV) navigating in unknown and possibly unstructured environments. The proposed method first estimates the local path traveled by the robot while forming the acoustic image (scan) with range data coming from a mono-beam rotating sonar head, providing position estimates for correcting the distortions that the vehicle motion produces in the scans. Then, consecutive scans are cross-registered under a probabilistic scan matching technique for estimating the displacements of the vehicle including the uncertainty of the scan matching result. Finally, an augmented state extended Kalman filter estimates and keeps the registered scans poses. No prior structural information or initial pose are considered. The viability of the proposed approach has been tested reconstructing the trajectory of a guided AUV operating along a 600 m path within a marina environment.

[1]  R. García,et al.  Large-Area Photo-Mosaics Using Global Alignment and Navigation Data , 2007, OCEANS 2007.

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

[3]  Max Pfingsthorn,et al.  Using Robust Spectral Registration for Scan Matching of Sonar Range Data , 2010 .

[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]  Rafael García,et al.  Augmented state–extended Kalman filter combined framework for topology estimation in large‐area underwater mapping , 2010, J. Field Robotics.

[6]  Stergios I. Roumeliotis,et al.  Weighted range sensor matching algorithms for mobile robot displacement estimation , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[7]  Honghai Liu,et al.  Navigation Technologies for Autonomous Underwater Vehicles , 2008, IEEE Transactions on Systems, Man, and Cybernetics, Part C (Applications and Reviews).

[8]  Robert M. Haralick.  Propagating covariance in computer vision , 1994, Proceedings of 12th International Conference on Pattern Recognition.

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

[10]  Stefan B. Williams,et al.  Generation and visualization of large‐scale three‐dimensional reconstructions from underwater robotic surveys , 2010, J. Field Robotics.

[11]  M. Cormier,et al.  A Detailed Near-bottom Survey of Large Gas Blowout Structures Along the US Atlantic Shelf Break Using the Autonomous Underwater Vehicle (AUV) SeaBED , 2004 .

[12]  Pere Ridao Rodriguez,et al.  MSISpIC: A Probabilistic Scan Matching Algorithm Using a Mechanical Scanned Imaging Sonar , 2009 .

[13]  Francesca Pennecchi,et al.  The expression of uncertainty in non-linear parameter estimation , 2006 .

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

[15]  Antoni Burguera,et al.  A Probabilistic Framework for Sonar Scan Matching Localization , 2008, Adv. Robotics.

[16]  Y. Petillot,et al.  Concurrent mapping and localization using sidescan sonar , 2004, IEEE Journal of Oceanic Engineering.

[17]  Christopher M. Clark,et al.  The Malta cistern mapping project: Underwater robot mapping and localization within ancient tunnel systems , 2010 .

[18]  C. Langmuir,et al.  New Techniques for Hydrothermal Exploration: In Situ Chemical Sensors on AUVs - Preliminary Results From the Lau Basin , 2004 .

[19]  Franz S. Hover,et al.  SLAM for ship hull inspection using exactly sparse extended information filters , 2008, 2008 IEEE International Conference on Robotics and Automation.

[20]  L. Barclay.  Propagation of radiowaves , 2003 .

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

[22]  Eduardo Mario Nebot,et al.  Recursive scan-matching SLAM , 2007, Robotics Auton. Syst..

[23]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[24]  Keiichi Uchimura,et al.  SLAM Estimation in Dynamic Outdoor Environments: A Review , 2009, ICIRA.

[25]  J. Leonard,et al.  Decoupled Stochastic Mapping , 2001 .

[26]  R. N. Carpenter,et al.  Concurrent mapping and localization with FLS , 1998, Proceedings of the 1998 Workshop on Autonomous Underwater Vehicles (Cat. No.98CH36290).

[27]  Andreas Birk,et al.  Uncertainty estimation for a 6-DoF spectral registration method as basis for sonar-based underwater 3D SLAM , 2012, 2012 IEEE International Conference on Robotics and Automation.

[28]  Stefan B. Williams,et al.  Efficient View-Based SLAM Using Visual Loop Closures , 2008, IEEE Transactions on Robotics.

[29]  J. Reynolds,et al.  Fisheries and fisheries habitat investigations using undersea technology , 2001, MTS/IEEE Oceans 2001. An Ocean Odyssey. Conference Proceedings (IEEE Cat. No.01CH37295).

[30]  Stefan B. Williams,et al.  Autonomous underwater navigation and control , 2001, Robotica.

[31]  F. Lu,et al.  Shape registration using optimization for mobile robot navigation , 1996 .

[32]  John J. Leonard,et al.  Decoupled stochastic mapping [for mobile robot & AUV navigation] , 2001 .

[33]  Hanumant Singh,et al.  Towards High-resolution Imaging from Underwater Vehicles , 2007, Int. J. Robotics Res..

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

[35]  Terry Moore,et al.  What is the accuracy of DGPS? , 2005, Journal of Navigation.

[36]  Armagan Elibol,et al.  Augmented state–extended Kalman filter combined framework for topology estimation in large-area underwater mapping , 2010 .

[37]  Juan D. Tardós,et al.  Hierarchical SLAM: real-time accurate mapping of large environments , 2005, IEEE Transactions on Robotics.

[38]  C. Roman,et al.  The 2005 Chios Ancient Shipwreck Survey: New Methods for Underwater Archaeology , 2009 .

[39]  R. N. Carpenter,et al.  Sto hasti Mapping Using Forward Look , 1999 .

[40]  John J. Leonard,et al.  Stochastic mapping using forward look sonar , 2001, Robotica.

[41]  Hanumant Singh,et al.  Visually Navigating the RMS Titanic with SLAM Information Filters , 2005, Robotics: Science and Systems.

[42]  Albert-Jan Baerveldt,et al.  Robot localization based on scan-matching - estimating the covariance matrix for the IDC algorithm , 2003, Robotics Auton. Syst..

[43]  C. Roman,et al.  Imaging Coral I: Imaging Coral Habitats with the SeaBED AUV , 2004 .

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

[45]  L. Whitcomb,et al.  A SURVEY OF UNDERWATER VEHICLE NAVIGATION : RECENT ADVANCES AND NEW CHALLENGES , 2006 .

[46]  Christopher M. Clark,et al.  The Malta cistern mapping project: Underwater robot mapping and localization within ancient tunnel systems , 2010, J. Field Robotics.

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

[48]  Stefan B. Williams,et al.  Reconstructing pavlopetri: Mapping the world's oldest submerged town using stereo-vision , 2011, 2011 IEEE International Conference on Robotics and Automation.

[49]  Rafael García,et al.  Efficient Topology Estimation for Large Scale Optical Mapping , 2012, Springer Tracts in Advanced Robotics.

[50]  Pere Ridao,et al.  EKF-SLAM for AUV navigation under probabilistic sonar scan-matching , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[51]  Andreas Birk,et al.  Spectral registration of noisy sonar data for underwater 3D mapping , 2011, Auton. Robots.

[52]  Andrea Censi,et al.  An accurate closed-form estimate of ICP's covariance , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[53]  Stefan B. Williams,et al.  An efficient approach to bathymetric SLAM , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[54]  David Wettergreen,et al.  Real‐Time SLAM with Octree Evidence Grids for Exploration in Underwater Tunnels , 2007, J. Field Robotics.

[55]  Antoni Burguera,et al.  Scan-based SLAM with trajectory correction in underwater environments , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[56]  John J. Leonard,et al.  Towards Constant-Time SLAM on an Autonomous Underwater Vehicle Using Synthetic Aperture Sonar , 2003, ISRR.