A comparison of DVL/INS fusion by UKF and EKF to localize an autonomous underwater vehicle

In this paper, the position of an autonomous underwater vehicle (AUV) has been estimated by fusion of the data of two sensors: Doppler velocity log (DVL) and inertial navigation system (INS). Two different filters have been used in order to estimate the position of AUV, namely, Extended Kalman Filter (EKF) and Unscented Kalman Filter (UKF). The approach of EKF is based on linearization of system state space equation around the instantaneous values of the state variables. The UKF is based on the nonlinear transformation of selected points of a Gaussian distribution of the state variables. These two filters are implemented, using nonlinear kinetic model of a sample AUV, and the results of the position estimation of the two filters are compared. The results show that despite the linearization approximations, the EKF results are closer to the real path of the vehicle than the UKF estimates.

[1]  Stefan B. Williams,et al.  Autonomous underwater simultaneous localisation and map building , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[2]  Hugh F. Durrant-Whyte,et al.  A decentralised navigation architecture , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[3]  Einar Berglund,et al.  Model-aided inertial navigation for underwater vehicles , 2008, 2008 IEEE International Conference on Robotics and Automation.

[4]  M. Bozorg,et al.  A Decentralized Architecture for Simultaneous Localization and Mapping , 2009, IEEE/ASME Transactions on Mechatronics.

[5]  Gaurav S. Sukhatme,et al.  Circumventing dynamic modeling: evaluation of the error-state Kalman filter applied to mobile robot localization , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

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

[7]  Xavier Cufí,et al.  Augmented state Kalman filtering for AUV navigation , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[8]  I.T. Ruiz,et al.  Decentralised Simultaneous Localisation and Mapping for AUVs , 2007, OCEANS 2007 - Europe.

[9]  Alireza Khayatian,et al.  Attitude Estimation By Separate-Bias Kalman Filter-Based Data Fusion , 2004 .

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

[11]  K.J. Kyriakopoulos,et al.  Localization of an underwater vehicle using an IMU and a laser-based vision system , 2007, 2007 Mediterranean Conference on Control & Automation.

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

[13]  S. Grime,et al.  Data fusion in decentralized sensor networks , 1994 .

[14]  Zheping Yan,et al.  Research on the error model of INS/DVL system for Autonomous Underwater Vehicle , 2008, 2008 IEEE International Conference on Automation and Logistics.

[15]  Thor I. Fossen,et al.  Guidance and control of ocean vehicles , 1994 .