Unscented Kalman Filter Based Single Beacon Underwater Localization with Unknown Effective Sound Velocity

The extended Kalman filter (EKF) is the most widely applied state estimation algorithm for single beacon underwater localization systems. However, since the assumptions of local linearity are often violated during underwater surveys, the EKF is difficult to tune and often gives unreliable estimates. Compared with the EKF, the unscented Kalman filter (UKF) can achieve improved estimation performance for nonlinear systems, while its computational efforts is the same order of magnitude as the EKF. This paper investigates the estimator performance and computational complexity while implementing the UKF based on a novel single beacon localization model with unknown effective sound velocity. Furthermore, the estimator performance while using the iterated EKF, which is an alternative way to reduce the linearization error of the EKF, is also investigated. In addition, the Rauch-Tung-Striebel (RTS) smoother is applied for postprocessing. Through numerical examples of using simulated data, both the filter and RTS smoother results show that while implementing the UKF, the localization accuracy, as well as the estimation of effective sound velocity, can be improved.

[1]  Pere Ridao,et al.  Sum of gaussian single beacon range-only localization for AUV homing , 2016, Annu. Rev. Control..

[2]  António Manuel Santos Pascoal,et al.  Observability analysis of 3D AUV trimming trajectories in the presence of ocean currents using range and depth measurements , 2015, Annu. Rev. Control..

[3]  A. P. Scherbatyuk The AUV positioning using ranges from one transponder LBL , 1995, 'Challenges of Our Changing Global Environment'. Conference Proceedings. OCEANS '95 MTS/IEEE.

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

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

[6]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[7]  Hanumant Singh,et al.  Advances in single-beacon one-way-travel-time acoustic navigation for underwater vehicles , 2012, Int. J. Robotics Res..

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

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

[10]  Bo Wang,et al.  A Particle Filter-Based Matching Algorithm With Gravity Sample Vector for Underwater Gravity Aided Navigation , 2016, IEEE/ASME Transactions on Mechatronics.

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

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

[13]  Filippo Arrichiello,et al.  Underwater localization using single beacon measurements: Observability analysis for a double integrator system , 2017 .

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

[15]  Ralph E. White,et al.  Comparison of a particle filter and other state estimation methods for prognostics of lithium-ion batteries , 2015 .

[16]  Ling Chen,et al.  Single Beacon-Based Localization With Constraints and Unknown Initial Poses , 2016, IEEE Transactions on Industrial Electronics.

[17]  D. Simon Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches , 2006 .

[18]  Huajun Li,et al.  Kalman-based underwater tracking with unknown effective sound velocity , 2016, OCEANS 2016 MTS/IEEE Monterey.

[19]  Luigi Chisci,et al.  An unscented Kalman filter based navigation algorithm for autonomous underwater vehicles , 2016 .

[20]  Sau-Lon James Hu,et al.  Model and Algorithm Improvement on Single Beacon Underwater Tracking , 2018, IEEE Journal of Oceanic Engineering.

[21]  Huajun Li,et al.  Effect on Kalman based underwater tracking due to ocean current uncertainty , 2016, 2016 IEEE/OES Autonomous Underwater Vehicles (AUV).

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

[23]  Jinwhan Kim,et al.  Comparison Between Nonlinear Filtering Techniques for Spiraling Ballistic Missile State Estimation , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[24]  Faisal Khan,et al.  Unscented Kalman Filter trained neural networks based rudder roll stabilization system for ship in waves , 2017 .

[25]  Mandar Chitre,et al.  Cooperative Path Planning for Range-Only Localization Using a Single Moving Beacon , 2014, IEEE Journal of Oceanic Engineering.