Navigation and guidance control system of UNUSAITS AUV based on dynamical system using ensemble kalman filter square root

This study presents the development of navigation system of AUV. It is initially in the form of a nonlinear system model to determine the trajectory for the AUV motion control. The non-linear system model of UNUSAITS AUV is then implemented in the Square Root Ensemble Kalman filter (SR-EnKF) to estimate the trajectory of the AUV. The developed EnKF algorithm covers two types of simulations. The contribution from this paper is trajectory or position estimation of nonlinear UNUSAITS AUV system with 6-DOF AUV model. The result of model estimation is presented based on numeric study and simulation. The first simulation is dedicated to generate 400 ensembles, and the second simulation is to generate 400 ensembles. The second simulation shows that the 500 ensembles give more accurate results. A further examination on the accuracy has been performed by accounting for the RMSE of actual condition and the estimation from the simulation, which yields the range of accuracy between 97 % up to 99%.