Underwater SLAM in man-made structured environments

This paper describes a navigation system for autonomous underwater vehicles (AUVs) in partially structured environments, such as dams, harbors, marinas, and marine platforms. A mechanically scanned imaging sonar is used to obtain information about the location of vertical planar structures present in such environments. A robust voting algorithm has been developed to extract line features, together with their uncertainty, from the continuous sonar data flow. The obtained information is incorporated into a feature-based simultaneous localization and mapping (SLAM) algorithm running an extended Kalman filter. Simultaneously, the AUV's position estimate is provided to the feature extraction algorithm to correct the distortions that the vehicle motion produces in the acoustic images. Moreover, a procedure to build and maintain a sequence of local maps and to posteriorly recover the full global map has been adapted for the application presented. Experiments carried out in a marina located in the Costa Brava (Spain) with the Ictineu AUV show the viability of the proposed approach. © 2008 Wiley Periodicals, Inc.

[1]  Sebastian Thrun,et al.  Simultaneous Localization and Mapping , 2008, Robotics and Cognitive Approaches to Spatial Mapping.

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

[3]  Eduardo Mario Nebot,et al.  Optimization of the simultaneous localization and map-building algorithm for real-time implementation , 2001, IEEE Trans. Robotics Autom..

[4]  John J. Leonard,et al.  Pure range-only sub-sea SLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[5]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

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

[7]  J. M. M. Montiel,et al.  The SPmap: a probabilistic framework for simultaneous localization and map building , 1999, IEEE Trans. Robotics Autom..

[8]  J. A. Castellanos,et al.  Limits to the consistency of EKF-based SLAM , 2004 .

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

[10]  Thor I. Fossen,et al.  Marine Control Systems Guidance, Navigation, and Control of Ships, Rigs and Underwater Vehicles , 2002 .

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

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

[13]  Stefan B. Williams,et al.  Simultaneous localisation and mapping on the Great Barrier Reef , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[14]  Pere Ridao,et al.  SLAM using an Imaging Sonar for Partially Structured Underwater Environments , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Stefan B. Williams,et al.  An efficient approach to the simultaneous localisation and mapping problem , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[16]  Pedro Pini.  Scalable SLAM building Conditionally Independent Local Maps , 2007 .

[17]  José A. Castellanos,et al.  Mobile Robot Localization and Map Building: A Multisensor Fusion Approach , 2000 .

[18]  Michael Bosse,et al.  Simultaneous Localization and Map Building in Large-Scale Cyclic Environments Using the Atlas Framework , 2004, Int. J. Robotics Res..

[19]  Salah Sukkarieh,et al.  Airborne simultaneous localisation and map building , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[20]  Gamini Dissanayake,et al.  Convergence and Consistency Analysis for Extended Kalman Filter Based SLAM , 2007, IEEE Transactions on Robotics.

[21]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[22]  David M. Lane,et al.  Feature extraction and data association for AUV concurrent mapping and localisation , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[23]  Josef Kittler,et al.  A survey of the hough transform , 1988, Comput. Vis. Graph. Image Process..

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

[25]  Frank Dellaert,et al.  Tectonic SAM: Exact, Out-of-Core, Submap-Based SLAM , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[26]  Fernando Lobo Pereira,et al.  IES an open system for underwater inspection , 1999, Oceans '99. MTS/IEEE. Riding the Crest into the 21st Century. Conference and Exhibition. Conference Proceedings (IEEE Cat. No.99CH37008).

[27]  Ian D. Reid,et al.  Mapping Large Loops with a Single Hand-Held Camera , 2007, Robotics: Science and Systems.

[28]  Yvan Petillot,et al.  Concurrent Mapping and Localisation using Side-scan sonar for autonomous navigation , 2003 .

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

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

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

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

[33]  José A. Castellanos,et al.  Mobile Robot Localization and Map Building , 1999 .

[34]  Juan D. Tardós,et al.  Scalable SLAM building conditionally independent local maps , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[35]  John J. Leonard,et al.  Consistent, Convergent, and Constant-Time SLAM , 2003, IJCAI.

[36]  Juan D. Tardós,et al.  Data association in stochastic mapping using the joint compatibility test , 2001, IEEE Trans. Robotics Autom..

[37]  John J. Leonard,et al.  Directed Sonar Sensing for Mobile Robot Navigation , 1992 .

[38]  John J. Leonard,et al.  Robust Mapping and Localization in Indoor Environments Using Sonar Data , 2002, Int. J. Robotics Res..

[39]  Michael Bosse,et al.  An Atlas framework for scalable mapping , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).