Observability analysis of relative localization for AUVs based on ranging and depth measurements

The paper studies the observability properties of the relative localization of two Autonomous Underwater Vehicles (AUVs) equipped with depth sensors, linear/angular velocity sensors, and communication devices with range measurement. The conditions that ensure observability of the linearized model and locally weak observability of the nonlinear system are derived. An Extended Kalman Filter is then designed aimed at estimating the relative position between two AUVs. Simulations in 3D and reconstruction from experimental data in 2D provide a numerical validation of the analysis.

[1]  A. Krener.  The Convergence of the Extended Kalman Filter , 2002, math/0212255.

[2]  Roland Siegwart,et al.  Observability analysis for mobile robot localization , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  S. Singh,et al.  Underwater Acoustic Navigation with the WHOI Micro-Modem , 2006, OCEANS 2006.

[4]  Stergios I. Roumeliotis,et al.  Distributed multirobot localization , 2002, IEEE Trans. Robotics Autom..

[5]  Stergios I. Roumeliotis,et al.  Distributed Maximum A Posteriori Estimation for Multi-robot Cooperative Localization , 2009 .

[6]  Konrad Reif,et al.  Stochastic stability of the discrete-time extended Kalman filter , 1999, IEEE Trans. Autom. Control..

[7]  A. Isidori.  Nonlinear Control Systems: An Introduction , 1986 .

[8]  A. Krener,et al.  Nonlinear controllability and observability , 1977 .

[9]  John J. Leonard,et al.  Cooperative Localization for Autonomous Underwater Vehicles , 2009, Int. J. Robotics Res..

[10]  Andreas Birk,et al.  Cognitive Cooperative Control for Autonomous Underwater Vehicles An overview of achievements in the first project year , 2010 .

[11]  Arthur Gelb,et al.  Applied Optimal Estimation , 1974 .

[12]  Stergios I. Roumeliotis,et al.  Robot-to-Robot Relative Pose Estimation From Range Measurements , 2008, IEEE Transactions on Robotics.

[13]  Wolfram Burgard,et al.  A Probabilistic Approach to Collaborative Multi-Robot Localization , 2000, Auton. Robots.

[14]  Carlos Silvestre,et al.  Necessary and sufficient conditions for the observability of linear motion quantities in strapdown navigation systems , 2009, 2009 American Control Conference.

[15]  John J. Leonard,et al.  Cooperative Localization for Autonomous Underwater Vehicles , 2009, Int. J. Robotics Res..

[16]  Gaurav S. Sukhatme,et al.  Putting the 'I' in 'team': an ego-centric approach to cooperative localization , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).