SLAM for an AUV using vision and an acoustic beacon

Abstract The estimation of the position and attitude of an autonomous underwater vehicle (AUV) is a challenging and important problem in marine robotics. It is well known that the underwater environment posses considerable problems, that include i) the fact that there is no GPS signal, ii) the communication is usually done through acoustic signals, which suffers from faults, delays and low bandwidth, and iii) the use of vision and/or laser is very limited due to poor visibility. In this paper, we combine a multiple set of sensors to address the full state 6DOF pose estimation of an AUV. The problem is formulated assuming that we have partial measurements from an Inertial Measurement Unit (IMU), an acoustic ranging from a single beacon buoy, and a monocular camera attached to the AUV. Using multiple model estimation techniques and the concept of Extended Kalman Filters with Simultaneous Localization and Mapping (EKF-SLAM), we propose an algorithm that integrates the AUV measurements (that arrive at different sampling-times) and compute in real time an estimate of the position and attitude of the AUV. Simulation results are presented and discussed.

[1]  Antonio Pedro Aguiar,et al.  Modeling and control of an autonomous underwater shuttle for the transport of benthic laboratories , 1997, Oceans '97. MTS/IEEE Conference Proceedings.

[2]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[3]  H. G. Thomas,et al.  GIB buoys: an interface between space and depths of the oceans , 1998, Proceedings of the 1998 Workshop on Autonomous Underwater Vehicles (Cat. No.98CH36290).

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

[5]  Wolfram Burgard,et al.  Probabilistic Robotics (Intelligent Robotics and Autonomous Agents) , 2005 .

[6]  Yolanda González Cid,et al.  Real-time 3d SLAM with wide-angle vision , 2004 .

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

[8]  K.J. Kyriakopoulos,et al.  Localization of an underwater vehicle using an IMU and a laser-based vision system , 2007, 2007 Mediterranean Conference on Control & Automation.

[9]  Massimo Caccia.  Vision-based ROV horizontal motion control: Near-seafloor experimental results , 2007 .

[10]  Stefan B. Williams,et al.  Autonomous underwater simultaneous localisation and map building , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[11]  S. Shankar Sastry,et al.  An Invitation to 3-D Vision: From Images to Geometric Models , 2003 .

[12]  Simon Lacroix,et al.  Position estimation in outdoor environments using pixel tracking and stereovision , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[13]  J. M. M. Montiel,et al.  Continuous mobile robot localization: vision vs. laser , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[14]  S. Rock,et al.  ROV POSE AND SHAPE ESTIMATION OF TETHERED TARGETS WITHOUT FIDUCIALS , 2009 .

[15]  I. Nygren,et al.  Terrain navigation for underwater vehicles using the correlator method , 2004, IEEE Journal of Oceanic Engineering.

[16]  David W. Murray,et al.  Simultaneous Localization and Map-Building Using Active Vision , 2002, IEEE Trans. Pattern Anal. Mach. Intell..

[17]  Paulo Oliveira,et al.  Study and implementation of an EKF GIB-based underwater positioning system , 2004 .

[18]  Stefan B. Williams,et al.  AUV Benthic Habitat Mapping in South Eastern Tasmania , 2009, FSR.

[19]  Darius Burschka,et al.  V-GPS(SLAM): vision-based inertial system for mobile robots , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[20]  João Pedro Hespanha,et al.  Robust filtering for deterministic systems with implicit outputs , 2009, Syst. Control. Lett..

[21]  Olivier Stasse,et al.  MonoSLAM: Real-Time Single Camera SLAM , 2007, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[22]  Agusti Solanas,et al.  3D simultaneous localization and modeling from stereo vision , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[23]  R. Eustice,et al.  Development of a multi-AUV SLAM testbed at the University of Michigan , 2008, OCEANS 2008.