Sensor‐Based Long Baseline Navigation: Observability Analysis and Filter Design

This paper presents a novel long baseline (LBL) position and velocity navigation filter for underwater vehicles based directly on the sensor measurements. The solution departs from previous approaches as the range measurements are explicitly embedded in the filter design, therefore avoiding inversion algorithms and allowing also the consideration of the cases of reduced numbers of readings, in particular when there are only two or three distance measurements. The nonlinear system dynamics are considered to their full extent and no linearizations are carried out whatsoever. The filter error dynamics are globally exponentially stable (GES) and it is shown, in a realistic simulation environment, that the filter achieves similar performance to the extended Kalman filter (EKF) and outperforms linear position and velocity filters based on algebraic estimates of the position obtained from the range measurements.

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

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

[3]  Alonzo Kelly.  Modern Inertial and Satellite Navigation Systems , 1994 .

[4]  John J. Leonard,et al.  Autonomous Underwater Vehicle Navigation , 2016 .

[5]  Chingiz Hajiyev,et al.  GNSS signals processing via linear and extended Kalman filters , 2011 .

[6]  Andrew Ross,et al.  Remarks on the observability of single beacon underwater navigation , 2005 .

[7]  Thor I. Fossen,et al.  A nonlinear observer for GPS and INS integration , 2001, Proceedings of the 40th IEEE Conference on Decision and Control (Cat. No.01CH37228).

[8]  Carlos Silvestre,et al.  Single range aided navigation and source localization: Observability and filter design , 2011, Syst. Control. Lett..

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

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

[11]  Carlos Silvestre,et al.  Position USBL/DVL sensor-based navigation filter in the presence of unknown ocean currents , 2011, Autom..

[12]  Carlos Silvestre,et al.  A Sensor-based Long Baseline Position and Velocity Navigation Filter for Underwater Vehicles , 2010 .

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

[14]  Gaurav S. Sukhatme,et al.  Observability analysis of relative localization for AUVs based on ranging and depth measurements , 2010, 2010 IEEE International Conference on Robotics and Automation.

[15]  Javier González,et al.  A pure probabilistic approach to range-only SLAM , 2008, 2008 IEEE International Conference on Robotics and Automation.

[16]  Hanumant Singh,et al.  Preliminary deep water results in single-beacon one-way-travel-time acoustic navigation for underwater vehicles , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  Carlos Silvestre,et al.  Single range navigation in the presence of constant unknown drifts , 2009, 2009 European Control Conference (ECC).

[18]  Louis L. Whitcomb,et al.  Preliminary Field Experience with the DVLNAV Integrated Navigation System for Manned and Unmanned , 2003 .

[19]  J. Opderbecke,et al.  Underwater vehicle trajectory estimation using contracting PDE-based observers , 2004, Proceedings of the 2004 American Control Conference.

[20]  Hugh F. Durrant-Whyte,et al.  A high integrity IMU/GPS navigation loop for autonomous land vehicle applications , 1999, IEEE Trans. Robotics Autom..

[21]  G. Parlangeli,et al.  Relative Pose Observability Analysis for 3D Nonholonomic Vehicles Based on Range Measurements Only , 2012 .

[22]  Carlos Silvestre,et al.  On the observability of linear motion quantities in navigation systems , 2011, Syst. Control. Lett..

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

[24]  Johann Reger,et al.  An algebraic perspective to single-transponder underwater navigation , 2006, 2006 IEEE Conference on Computer Aided Control System Design, 2006 IEEE International Conference on Control Applications, 2006 IEEE International Symposium on Intelligent Control.

[25]  Carlos Silvestre,et al.  USBL/INS Tightly-Coupled Integration Technique for Underwater Vehicles , 2006, 2006 9th International Conference on Information Fusion.

[26]  Paulo Oliveira,et al.  Study and implementation of an EKF GIB-based underwater positioning system , 2004 .

[27]  Robert B. McGhee,et al.  Testing and evaluation of an integrated GPS/INS system for small AUV navigation , 1999 .

[28]  Carlos Silvestre,et al.  Optimal position and velocity navigation filters for autonomous vehicles , 2010, Autom..

[29]  Jeff Smith,et al.  Autonomous Underwater Vehicle Navigation , 1995 .

[30]  H. G. Thomas,et al.  GIB buoys: an interface between space and depths of the oceans , 1998, Proceedings of the 1998 Workshop on Autonomous Underwater Vehicles (Cat. No.98CH36290).

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

[32]  Fu-Kuang Yeh,et al.  Using Delta Range for Fault Detection/Exclusion on GPS Positioning , 2012 .

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

[34]  Carlos Silvestre,et al.  Position and velocity optimal sensor-based navigation filters for UAVs , 2009, 2009 American Control Conference.

[35]  John J. Leonard,et al.  Comparison of fix computation and filtering for autonomous acoustic navigation , 1998, Int. J. Syst. Sci..