Global integrated navigation position correction algorithm and virtual polar region technology based on normal vector

Abstract

To achieve the inherent uniformity of all-earth navigation for autonomous underwater vehicles (AUV), a global integrated navigation position correction algorithm based on the normal vector (n-vector) is proposed. First, a four-element vector comprising the non-singular n-vector and height represents the carrier’s position in the Earth-centered Earth-fixed (ECEF) frame. The integrated navigation systems are designed with the strapdown inertial navigation system (SINS), Doppler velocity log (DVL), and other equipment. Secondly, the reverse navigation algorithm in the ECEF mechanization is derived, and the results of forward and reverse navigation are fused to correct the AUV’s underwater position. Additionally, a virtual polar region technology based on the ECEF attitude, velocity, and height invariant method (E-AVHIM) is proposed to convert the actual test data obtained at low and middle latitudes into high latitudes for more convincing polar region algorithm verification. Simulations and lake trial demonstrated the excellence and efficiency of the proposed algorithm.