An Improved Unscented Kalman Filter Applied to Positioning and Navigation of Autonomous Underwater Vehicles

To enhance the positioning accuracy of autonomous underwater vehicles (AUVs), a new adaptive filtering algorithm (RHAUKF) is proposed. The most widely used filtering algorithm is the traditional Unscented Kalman Filter or the Adaptive Robust UKF (ARUKF). Excessive noise interference may cause a decrease in filtering accuracy and is highly likely to result in divergence by means of the traditional Unscented Kalman Filter, resulting in an increase in uncertainty factors during submersible mission execution. An estimation model for system noise, the adaptive Unscented Kalman Filter (UKF) algorithm was derived in light of the maximum likelihood criterion and optimized by applying the rolling-horizon estimation method, using the Newton-Raphson algorithm for the maximum likelihood estimation of noise statistics, and it was verified by simulation experiments using the Lie group inertial navigation error model. The results indicate that, compared with the UKF algorithm and the ARUKF, the improved algorithm reduces attitude angle errors by 45%, speed errors by 44%, and three-dimensional position errors by 47%. It can better cope with complex underwater environments, effectively address the problems of low filtering accuracy and even divergence, and improve the stability of submersibles.