Autonomous Navigation for Autonomous Underwater Vehicles Based on Information Filters and Active Sensing

This paper addresses an autonomous navigation method for the autonomous underwater vehicle (AUV) C-Ranger applying information-filter-based simultaneous localization and mapping (SLAM), and its sea trial experiments in Tuandao Bay (Shangdong Province, P.R. China). Weak links in the information matrix in an extended information filter (EIF) can be pruned to achieve an efficient approach-sparse EIF algorithm (SEIF-SLAM). All the basic update formulae can be implemented in constant time irrespective of the size of the map; hence the computational complexity is significantly reduced. The mechanical scanning imaging sonar is chosen as the active sensing device for the underwater vehicle, and a compensation method based on feedback of the AUV pose is presented to overcome distortion of the acoustic images due to the vehicle motion. In order to verify the feasibility of the navigation methods proposed for the C-Ranger, a sea trial was conducted in Tuandao Bay. Experimental results and analysis show that the proposed navigation approach based on SEIF-SLAM improves the accuracy of the navigation compared with conventional method; moreover the algorithm has a low computational cost when compared with EKF-SLAM.

[1]  Pere Ridao,et al.  Underwater SLAM for Structured Environments Using an Imaging Sonar , 2010, Springer Tracts in Advanced Robotics.

[2]  Hugh F. Durrant-Whyte.  Uncertain geometry in robotics , 1988, IEEE J. Robotics Autom..

[3]  Peter Cheeseman,et al.  On the Representation and Estimation of Spatial Uncertainty , 1986 .

[4]  Sebastian Thrun,et al.  FastSLAM 2.0: An Improved Particle Filtering Algorithm for Simultaneous Localization and Mapping that Provably Converges , 2003, IJCAI.

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

[6]  Udo Frese.  Treemap: An O(log n) Algorithm for Simultaneous Localization and Mapping , 2004, Spatial Cognition.

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

[8]  Matthew R. Walter,et al.  Sparse extended information filters: insights into sparsification , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

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

[11]  Wan Kyun Chung,et al.  Robust sonar feature detection for the SLAM of mobile robot , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[13]  Ricardo O. Carelli,et al.  Analysis of Different Feature Selection Criteria Based on a Covariance Convergence Perspective for a SLAM Algorithm , 2010, Sensors.

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

[15]  Hanumant Singh,et al.  Exactly Sparse Delayed-State Filters , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

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

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

[18]  Hugh Durrant-Whyte,et al.  Simultaneous Localisation and Mapping ( SLAM ) : Part I The Essential Algorithms , 2006 .

[19]  M. Purcell,et al.  REMUS: a small, low cost AUV; system description, field trials and performance results , 1997, Oceans '97. MTS/IEEE Conference Proceedings.

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

[21]  Mark A. Paskin,et al.  Thin Junction Tree Filters for Simultaneous Localization and Mapping , 2002, IJCAI.

[22]  Sebastian Thrun,et al.  FastSLAM: A Scalable Method for the Simultaneous Localization and Mapping Problem in Robotics , 2007 .

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

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

[25]  Gamini Dissanayake,et al.  Sparse Local Submap Joining Filter for Building Large-Scale Maps , 2008, IEEE Transactions on Robotics.

[26]  Udo Frese.  A Proof for the Approximate Sparsity of SLAM Information Matrices , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[27]  D. Cecchi,et al.  Autonomous underwater vehicles for scientific and naval operations , 2004, Annu. Rev. Control..

[28]  Udo Frese.  Treemap: An O(log n) algorithm for indoor simultaneous localization and mapping , 2006, Auton. Robots.

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

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

[31]  Sebastian Thrun,et al.  Results for outdoor-SLAM using sparse extended information filters , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[32]  Matthew R. Walter,et al.  Exactly Sparse Extended Information Filters for Feature-based SLAM , 2007, Int. J. Robotics Res..