INS-DVL Navigation Improvement Using Rotational Motion Dynamic Model of AUV

INS-DVL integration is a common method for underwater navigation. However, inherent errors of sensors, especially in MEMS IMUs, lead to inaccuracies in estimating the position and attitude. In this paper, dynamic motion model of AUV is used to improve MEMS INS-DVL navigation. In this method, which is called model-aided or model-based navigation, the information of the kinetic model of the vehicle (obtained from Newton–Euler equations) is used to improve the navigation performance. Previous model-aided navigation studies about AUVs have been focused on the translational dynamic model of vehicles. As the best of our knowledge, this paper is the first one which suggests using a rotational motion model of AUVs to improve the navigation performance and at the same time, reports successful implementation of method through field-testing. The utilized dynamic model, describes the rotational motion of AUV in a 3DOF form. Information extracted from the rotational dynamic model and the outputs of gyroscopes, will be fused in a secondary Kalman filter. So, before the fusion with auxiliary sensors in the main Kalman filter, the gyroscopes outputs have been improved by the rotational motion model. Therefore, the overall output will be better than the outputs of gyroscopes by itself. The main Kalman filter is a perturbation-based Kalman filter which is employed for data fusion. This algorithm is implemented on real data collected from field-test. The results show that this inexpensive method which requires no additional equipment was truly effective in improving navigation performance. Using this model, the accuracy of navigation was improved 5 to 10 times.

[1]  Eun-Hwan Shin,et al.  Accuracy Improvement of Low Cost INS/GPS for Land Applications , 2002 .

[2]  Carlos Silvestre,et al.  Embedded Vehicle Dynamics Aiding for USBL/INS Underwater Navigation System , 2014, IEEE Transactions on Control Systems Technology.

[3]  Fangjun Qin,et al.  Strapdown Inertial Navigation System Initial Alignment Based on Modified Process Model , 2019, IEEE Sensors Journal.

[4]  O Hegrenaes,et al.  Model-Aided INS With Sea Current Estimation for Robust Underwater Navigation , 2011, IEEE Journal of Oceanic Engineering.

[5]  Carlos Silvestre,et al.  Embedded UAV model and LASER aiding techniques for inertial navigation systems , 2010 .

[6]  Mohammad Bozorg,et al.  Parameter Estimation of an AUV Using the Maximum Likelihood method and a Kalman Filter with Fading Memory , 2010 .

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

[8]  Jingang Yi,et al.  Dynamic model-aided localization of underwater autonomous gliders , 2013, 2013 IEEE International Conference on Robotics and Automation.

[9]  Giancarlo Fortino,et al.  Heading Drift Reduction for Foot-Mounted Inertial Navigation System via Multi-Sensor Fusion and Dual-Gait Analysis , 2019, IEEE Sensors Journal.

[10]  Zare Ernani Mehdi,et al.  IDENTIFICATION OF AN AUTONOMOUS UNDERWATER VEHICLE DYNAMIC USING EXTENDED KALMAN FILTER WITH ARMA NOISE MODEL , 2015 .

[11]  Mamoun F. Abdel-Hafez,et al.  Non-Linear Autoregressive Delay-Dependent INS/GPS Navigation System Using Neural Networks , 2017, IEEE Sensors Journal.

[12]  J. S. Ortega.  Quaternion kinematics for the error-state KF , 2016 .

[13]  Daniel J. Stilwell,et al.  Model simplification for AUV pitch-axis control design , 2010 .

[14]  Li Ning,et al.  Model-Aided Strapdown Inertial Navigation Integrated Method for AUV Based on H8 Filtering , 2013, 2013 International Conference on Computational and Information Sciences.

[15]  Hichem Sahli,et al.  Model-Aided Navigation with Sea Current Estimation for an Autonomous Underwater Vehicle , 2015 .

[16]  Xin Xin,et al.  Control Design and Analysis for Underactuated Robotic Systems , 2014 .

[17]  Bo Wang,et al.  A Correction Method for DVL Measurement Errors by Attitude Dynamics , 2017, IEEE Sensors Journal.

[18]  Florian Holzapfel,et al.  Unified Model Technique for Inertial Navigation Aided by Vehicle Dynamics Model , 2013 .

[19]  Jana Fuhrmann,et al.  Guidance And Control Of Ocean Vehicles , 2016 .

[20]  Mohammad Bozorg,et al.  Robust estimation of hydrodynamic coefficients of an AUV using Kalman and H∞ filters , 2019, Ocean Engineering.

[21]  Lubin Chang,et al.  MEKF With Navigation Frame Attitude Error Parameterization for INS/GPS , 2020, IEEE Sensors Journal.

[22]  Xiaoji Niu,et al.  Impact Assessment of Various IMU Error Sources on the Relative Accuracy of the GNSS/INS Systems , 2020, IEEE Sensors Journal.

[23]  Yang Liu,et al.  Analysis of Kalman Filter Innovation-Based GNSS Spoofing Detection Method for INS/GNSS Integrated Navigation System , 2019, IEEE Sensors Journal.

[24]  Bo Wang,et al.  An Acoustic Communication Time Delays Compensation Approach for Master–Slave AUV Cooperative Navigation , 2017, IEEE Sensors Journal.

[25]  R. Cossu,et al.  Parameter identification of a nonlinear model: replicating the motion response of an autonomous underwater vehicle for dynamic environments , 2018 .

[26]  F. Markley.  Attitude Error Representations for Kalman Filtering , 2003 .

[27]  Sat Randeni Pathiranachchilage,et al.  A model aided inertial navigation system with a low acoustic signature for localization of surveillance AUVs , 2018 .