Underwater simultaneous localization and mapping based on EKF and point features

The paper describes a localization system for autonomous underwater vehicles (AUV). It uses a DVL (Doppler velocity log) sensor and AHRS (attitude and heading reference system) sensor to measure AUV's depth, attitude and velocities relative to the bottom. A mechanically scanning imaging sonar (MSIS) is employed to obtain acoustic images of objects in underwater environment. In order to estimate optimally AUV pose without a priori map of the environment, simultaneous localization and map building (SLAM), a prevailing method in the past decade, is presented based on point features extraction and EKF-based estimator. Use Fluvia Nautic marina data set we compare the proposed method with traditional dead-reckoning, results show that our solution can reduce estimation error significantly.

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

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

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

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

[5]  Stergios I. Roumeliotis,et al.  Stochastic cloning: a generalized framework for processing relative state measurements , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

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

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

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

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

[10]  Sebastian Thrun,et al.  Particle Filters in Robotics , 2002, UAI.

[11]  Andrew J. Davison,et al.  Real-time simultaneous localisation and mapping with a single camera , 2003, Proceedings Ninth IEEE International Conference on Computer Vision.

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

[13]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

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

[15]  Pere Ridao,et al.  Line Extraction from Mechanically Scanned Imaging Sonar , 2007, IbPRIA.