A Novel Adaptive Two-Stage Information Filter Approach for Deep-Sea USBL/DVL Integrated Navigation

An accurate observation model and statistical model are critical in underwater integrated navigation. However, it is often the case that the statistical characteristics of noise are unknown through the ultra-short baseline (USBL) system/Doppler velocity log (DVL) integrated navigation in the deep-sea. Additionally, the velocity of underwater vehicles relative to the bottom of the sea or the currents is commonly provided by the DVL, and an adaptive filtering solution is needed to correctly estimate the velocity with unknown currents. This paper focuses on the estimation of unknown currents and measurement noise covariance for an underwater vehicle based on the USBL, DVL, and a pressure gauge (PG), and proposes a novel unbiased adaptive two-stage information filter (ATSIF) for the underwater vehicle (UV) with an unknown time-varying currents velocity. In the proposed algorithm, the adaptive filter is decomposed into a standard information filter and an unknown currents velocity information filter with interconnections, and the time-varying unknown ocean currents and measurement noise covariance are estimated. The simulation and experimental results illustrate that the proposed algorithm can make full use of high-precision observation information and has better robustness and navigation accuracy to deal with time-varying currents and measurement outliers than existing state-of-the-art algorithms.

[1]  Carlos Silvestre,et al.  Position and velocity filters for intervention AUVs based on single range and depth measurements , 2012, 2012 IEEE International Conference on Robotics and Automation.

[2]  Baoqing Li,et al.  A Robust Adaptive Unscented Kalman Filter for Nonlinear Estimation with Uncertain Noise Covariance , 2018, Sensors.

[3]  Badong Chen,et al.  Robust Constrained Adaptive Filtering Under Minimum Error Entropy Criterion , 2018, IEEE Transactions on Circuits and Systems II: Express Briefs.

[4]  T. Aoki,et al.  An integrated navigation system for autonomous underwater vehicles with two range sonars, inertial sensors and Doppler velocity log , 2004, Oceans '04 MTS/IEEE Techno-Ocean '04 (IEEE Cat. No.04CH37600).

[5]  A. H. Mohamed,et al.  Adaptive Kalman Filtering for INS/GPS , 1999 .

[6]  Peter K. Kitanidis,et al.  Unbiased minimum-variance linear state estimation , 1987, Autom..

[7]  Leang-San Shieh,et al.  Actuator fault detection and performance recovery with Kalman filter-based adaptive observer , 2007, Int. J. Gen. Syst..

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

[9]  Wang Wei,et al.  Adaptive Sequential Adjustment and Its Application , 2007 .

[10]  Stefan Werner,et al.  Distributed Kalman Filtering in Presence of Unknown Outer Network Actuations , 2019, IEEE Control Systems Letters.

[11]  Shu-Li Sun,et al.  Multi-sensor optimal information fusion Kalman filter , 2004, Autom..

[12]  Joaquín Míguez,et al.  Analysis of selection methods for cost-reference particle filtering with applications to maneuvering target tracking and dynamic optimization , 2007, Digit. Signal Process..

[13]  António Manuel Santos Pascoal,et al.  Range-Based Underwater Vehicle Localization in the Presence of Unknown Ocean Currents: Theory and Experiments , 2016, IEEE Transactions on Control Systems Technology.

[14]  Benedetto Allotta,et al.  A new AUV navigation system exploiting unscented Kalman filter , 2016 .

[15]  Qinghua Zhang,et al.  Adaptive observer for multiple-input-multiple-output (MIMO) linear time-varying systems , 2002, IEEE Trans. Autom. Control..

[16]  Manuel Davy,et al.  Particle Filtering for Multisensor Data Fusion With Switching Observation Models: Application to Land Vehicle Positioning , 2007, IEEE Transactions on Signal Processing.

[17]  Alexander Scherbatyuk,et al.  Some Algorithms of AUV Positioning Based on One Moving Beacon , 2012 .

[18]  Mohinder S. Grewal,et al.  Kalman Filtering: Theory and Practice Using MATLAB , 2001 .

[19]  Bart De Moor,et al.  Unbiased minimum-variance input and state estimation for linear discrete-time systems , 2007, Autom..

[20]  Dennis S. Bernstein,et al.  Deadbeat unknown-input state estimation and input reconstruction for linear discrete-time systems , 2019, Autom..

[21]  Hai Zhang,et al.  Redundant measurement-based second order mutual difference adaptive Kalman filter , 2019, Autom..

[22]  David P. Williams,et al.  Adaptive underwater sonar surveys in the presence of strong currents , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[23]  R. Person,et al.  POSIDONIA 6000: a new long range highly accurate ultra short base line positioning system , 1998, IEEE Oceanic Engineering Society. OCEANS'98. Conference Proceedings (Cat. No.98CH36259).

[24]  Carlos Silvestre,et al.  Position USBL/DVL sensor-based navigation filter in the presence of unknown ocean currents , 2010, 49th IEEE Conference on Decision and Control (CDC).

[25]  N. A. Brokloff.  Dead reckoning with an ADCP and current extrapolation , 1997, Oceans '97. MTS/IEEE Conference Proceedings.

[26]  Brian Bingham,et al.  Techniques for Deep Sea Near Bottom Survey Using an Autonomous Underwater Vehicle , 2007, Int. J. Robotics Res..

[27]  A.J. Sorensen,et al.  Robust observer design for underwater vehicles , 2006, 2006 IEEE Conference on Computer Aided Control System Design, 2006 IEEE International Conference on Control Applications, 2006 IEEE International Symposium on Intelligent Control.

[28]  Yuanxi Yang,et al.  An Optimal Adaptive Kalman Filter , 2006 .

[29]  Pere Ridao,et al.  USBL/DVL navigation through delayed position fixes , 2011, 2011 IEEE International Conference on Robotics and Automation.

[30]  Tianhe Xu,et al.  An Adaptive Kalman Filter Based on Sage Windowing Weights and Variance Components , 2003 .

[31]  Donghua Zhou,et al.  Unbiased minimum-variance state estimation for linear systems with unknown input , 2009, Autom..

[32]  Sajad Saeedi,et al.  AUV Navigation and Localization: A Review , 2014, IEEE Journal of Oceanic Engineering.

[33]  Qinghua Zhang,et al.  Adaptive Kalman filter for actuator fault diagnosis , 2017, Autom..

[34]  Badong Chen,et al.  Constrained maximum correntropy adaptive filtering , 2016, Signal Process..

[35]  Nikolaos I. Xiros,et al.  Springer Handbook of Ocean Engineering , 2016 .

[36]  Asgeir J. Sørensen,et al.  Integration Filter for APS, DVL, IMU and Pressure Gauge for Underwater Vehicles , 2013 .

[37]  Luca Martino,et al.  Cooperative parallel particle filters for online model selection and applications to urban mobility , 2015, Digit. Signal Process..

[38]  L.L. Whitcomb,et al.  In Situ Alignment Calibration of Attitude and Doppler Sensors for Precision Underwater Vehicle Navigation: Theory and Experiment , 2007, IEEE Journal of Oceanic Engineering.

[39]  Peng Lu,et al.  Framework for state and unknown input estimation of linear time-varying systems , 2016, Autom..

[40]  Jian Liu,et al.  Acoustic theory application in ultra short baseline system for tracking AUV , 2013 .

[41]  B. Friedland.  Treatment of bias in recursive filtering , 1969 .

[42]  O. Pizarro,et al.  Towards Geo-Referenced AUV Navigation Through Fusion of USBL and DVL Measurements , 2006, OCEANS 2006.

[43]  M. Pebody,et al.  Range-Only Positioning of a Deep-Diving Autonomous Underwater Vehicle From a Surface Ship , 2009, IEEE Journal of Oceanic Engineering.