Guided Trajectory Filtering for Challenging Long-Range AUV Navigation

Abstract

Aiming at the challenging underwater navigation of autonomous underwater vehicle (AUV), this paper develops a novel filtering method with guided trajectory. The relatively low frequency of ultra-short baseline positioning system (USBL) measurement and the noise caused by complex scenes have a significant impact on the accuracy of AUV motion estimation. Although the existing adaptive extended Kalman filter (EKF) and adaptive unscented Kalman filter (UKF) which can roughly eliminate these outliers, the filtering results of these algorithms are not smooth and have the serious degree of the jitter, and then greatly affect the local consistency and quality of topographic map seamless stitching. We exploit the relatively smooth strap-down inertial navigation system (SINS) as the guided trajectory for motion estimation, and propose a trajectory smoothness preserving filter algorithm. This system has the advantage of maintaining local gradient consistency, which not only improves the navigation accuracy, but also ensures the smoothness of the estimation system. Simulation results show that our approach has high robustness and good smoothness. The effectiveness and practicability of the method are demonstrated by real experiments in multiple deep-sea areas with an average depth of more than 1000 meters in the southwest Indian Ocean.