Observability Analysis for AUV Range-only Localization and Mapping Measures of Unobservability and Experimental Results

Abstract We investigate the observability problem of the Simultaneous Localization and Mapping (SLAM) process of an Autonomous Underwater Vehicle (AUV) equipped with inertial sensors, a depth sensor, and an acoustic ranging device that provides relative range measurements to stationary beacons. For trimming trajectories (that is, when the motion of the AUV is in steady-state with constant linear and angular velocities expressed in the body-frame), we provide conditions under which it is possible to reconstruct the initial state of the resulting SLAM system (and in particular the position of the AUV). We show that the unobservable subspace UO restricted to the assumption that the position of one of the beacons or the initial position of the AUV is known, contains only the zero vector with exception of a distinct case where the UO is composed by a finite set of isolated points. Another problem that we also address in this paper is to understand (independently of the observer scheme) how difficult it is to accurately estimate the state of the system from the pair input/output measured signals. To this end, we compute explicitly the unobservability index and the estimation condition number that provide measures of the degree of unobservability. Simulation and experimental results with the Medusa robotic vehicle are presented and discussed.

[1]  João Pedro Hespanha,et al.  Linear Systems Theory , 2009 .

[2]  Daniel J. Stilwell,et al.  Underwater navigation in the presence of unknown currents based on range measurements from a single location , 2005, Proceedings of the 2005, American Control Conference, 2005..

[3]  John J. Leonard,et al.  Pure range-only sub-sea SLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[4]  Franck Plestan,et al.  Linearization by generalized input-output injection , 1997 .

[5]  M. B. Larsen,et al.  Synthetic long baseline navigation of underwater vehicles , 2000, OCEANS 2000 MTS/IEEE Conference and Exhibition. Conference Proceedings (Cat. No.00CH37158).

[6]  A. S. Gadre,et al.  OBSERVABILITY ANALYSIS IN NAVIGATION SYSTEMS WITH AN UNDERWATER VEHICLE APPLICATION , 2007 .

[7]  Arthur J. Krener,et al.  Linearization by output injection and nonlinear observers , 1983 .

[8]  J. Hu,et al.  Underwater Vehicle Positioning Based on Time of Arrival Measurements from a Single Beacon , 2007, OCEANS 2007.

[9]  A. Kelly,et al.  Cooperative AUV Navigation Using a Single Surface Craft , 2009 .

[10]  Arthur J. Krener,et al.  Measures of unobservability , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[11]  E. Olson,et al.  Robust Range-Only Beacon Localization , 2004, IEEE Journal of Oceanic Engineering.

[12]  Antonio Pedro Aguiar,et al.  Minimum-energy state estimation for systems with perspective outputs and state constraints , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[13]  C Silvestre,et al.  Single beacon navigation: Observability analysis and filter design , 2010, Proceedings of the 2010 American Control Conference.

[14]  João Pedro Hespanha,et al.  Minimum-energy state estimation for systems with perspective outputs , 2006, IEEE Transactions on Automatic Control.

[15]  António Manuel Santos Pascoal,et al.  Observability metric for the relative localization of AUVs based on range and depth measurements: Theory and experiments , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Antonio Pedro Aguiar,et al.  Single Beacon Acoustic Navigation for an AUV in the Presence of Unknown Ocean Currents , 2009 .