Navigating and mapping with the SPARUS AUV in a natural and unstructured underwater environment

In spite of the recent advances in unmanned underwater vehicles (UUV) navigation techniques, robustly solving their localization in unstructured and unconstrained areas is still a challenging problem. In this paper, we propose a pose-based algorithm to solve the full Simultaneous Localization And Mapping (SLAM) problem for an Autonomous Underwater Vehicle (AUV), navigating in the unknown and unstructured environment. A probabilistic scan matching technique using range scans gathered from a Mechanical Scanning Imaging Sonar (MSIS) is used together with the robot dead-reckoning displacements. The raw data from the sensors are processed and fused in-line with an augmented state extended Kalman filter (EKF), that estimates and keeps the scans poses. The proposed SLAM method has been tested with a real world dataset acquired from the Sparus AUV, guided in a natural underwater environment.

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

[2]  U. Castellani,et al.  Efficient on-line mosaicing from 3D acoustical images , 2004, Oceans '04 MTS/IEEE Techno-Ocean '04 (IEEE Cat. No.04CH37600).

[3]  Christopher M. Clark,et al.  Archaeology via underwater robots: Mapping and localization within maltese cistern systems , 2008, 2008 10th International Conference on Control, Automation, Robotics and Vision.

[4]  Joaquín Aranda Almansa,et al.  Robotics and Automation in the maritime industries , 2006 .

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

[6]  Pere Ridao,et al.  Probabilistic sonar scan matching SLAM for underwater environment , 2010, OCEANS'10 IEEE SYDNEY.

[7]  David M. Bradley,et al.  Scan matching for flooded subterranean voids , 2004, IEEE Conference on Robotics, Automation and Mechatronics, 2004..

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

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

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

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

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

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

[14]  Randall Smith,et al.  Estimating Uncertain Spatial Relationships in Robotics , 1987, Autonomous Robot Vehicles.

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