Relocating Underwater Features Autonomously Using Sonar-Based SLAM

This paper describes a system for reacquiring features of interest in a shallow-water ocean environment, using autonomous underwater vehicles (AUVs) equipped with low-cost sonar and navigation sensors. In performing mine countermeasures, it is critical to enable AUVs to navigate accurately to previously mapped objects of interest in the water column or on the seabed, for further assessment or remediation. An important aspect of the overall system design is to keep the size and cost of the reacquisition vehicle as low as possible, as it may potentially be destroyed in the reacquisition mission. This low-cost requirement prevents the use of sophisticated AUV navigation sensors, such as a Doppler velocity log (DVL) or an inertial navigation system (INS). Our system instead uses the Proviewer 900-kHz imaging sonar from Blueview Technologies, which produces forward-looking sonar (FLS) images at ranges up to 40 mat approximately 4 Hz. In large volumes, it is hoped that this sensor can be manufactured at low cost. Our approach uses a novel simultaneous localization and mapping (SLAM) algorithm that detects and tracks features in the FLS images to renavigate to a previously mapped target. This feature-based navigation (FBN) system incorporates a number of recent advances in pose graph optimization algorithms for SLAM. The system has undergone extensive field testing over a period of more than four years, demonstrating the potential for the use of this new approach for feature reacquisition. In this report, we review the methodologies and components of the FBN system, describe the system's technological features, review the performance of the system in a series of extensive in-water field tests, and highlight issues for future research.

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

[2]  Jeffrey K. Uhlmann,et al.  A counter example to the theory of simultaneous localization and map building , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[3]  Shahriar Negahdaripour,et al.  On processing and registration of forward-scan acoustic video imagery , 2005, The 2nd Canadian Conference on Computer and Robot Vision (CRV'05).

[4]  B. Schulz,et al.  The development of a free-swimming UUV for mine neutralization , 2005, Proceedings of OCEANS 2005 MTS/IEEE.

[5]  Sebastian Thrun,et al.  FastSLAM 2.0: an improved particle filtering algorithm for simultaneous localization and mapping that provably converges , 2003, IJCAI 2003.

[6]  Stefan B. Williams,et al.  Towards terrain-aided navigation for underwater robotics , 2001, Adv. Robotics.

[7]  Yuanyuan Zhao,et al.  Autonomous Underwater Vehicle Navigation , 2010, IEEE Journal of Oceanic Engineering.

[8]  Frank Dellaert,et al.  iSAM: Incremental Smoothing and Mapping , 2008, IEEE Transactions on Robotics.

[9]  John J. Leonard,et al.  Autonomy through SLAM for an Underwater Robot , 2009, ISRR.

[10]  勇 広田,et al.  An Introduction to Geophysical Fluid Dynamics , 1970 .

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

[12]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[13]  B. Cushman-Roisin Introduction to Geophysical Fluid Dynamics , 1994 .

[14]  H. Durrant-Whyte,et al.  Simultaneous Localisation and Mapping ( SLAM ) : Part II State of the Art , 2006 .

[15]  A.B. Baggeroer,et al.  The state of the art in underwater acoustic telemetry , 2000, IEEE Journal of Oceanic Engineering.

[16]  José A. Castellanos,et al.  Linear time vehicle relocation in SLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

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

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

[19]  Lina María Paz,et al.  Data Association in O(n) for Divide and Conquer SLAM , 2007, Robotics: Science and Systems.

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

[21]  Nicholas Livingston,et al.  Four flippers or two? Tetrapodal swimming with an aquatic robot , 2006, Bioinspiration & biomimetics.

[22]  Hanumant Singh,et al.  Towards Precision Robotic Maneuvering, Survey, and Manipulation in Unstructured Undersea Environments , 1998 .

[23]  Franz S. Hover,et al.  Imaging sonar-aided navigation for autonomous underwater harbor surveillance , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[25]  Wolfram Burgard,et al.  Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters , 2007, IEEE Transactions on Robotics.

[26]  John Folkesson,et al.  Feature tracking for underwater navigation using sonar , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Daniel E. Clark,et al.  Bayesian multiple target tracking in forward scan sonar images using the PHD filter , 2005 .

[28]  Yvan Petillot,et al.  Underwater vehicle obstacle avoidance and path planning using a multi-beam forward looking sonar , 2001 .

[29]  Frank Dellaert,et al.  Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing , 2006, Int. J. Robotics Res..