Polar Transversal Initial Alignment Algorithm for UUV with a Large Misalignment Angle

Abstract

The conventional initial alignment algorithms are invalid in the polar region. This is caused by the rapid convergence of the Earth meridians in the high-latitude areas. However, the initial alignment algorithms are important for the accurate navigation of Unmanned Underwater Vehicles. The polar transversal initial alignment algorithm is proposed to overcome this problem. In the polar transversal initial alignment algorithm, the transversal geographic frame is chosen as the navigation frame. The polar region in the conventional frames is equivalent to the equatorial region in the transversal frames. Therefore, the polar transversal initial can be effectively applied in the polar region. According to the complex environment in the polar region, a large misalignment angle is considered in this paper. Based on the large misalignment angle condition, the non-linear dynamics models are established. In addition, the simplified unscented Kalman filter (UKF) is chosen to realize the data fusion. Two comparison simulations and an experiment are performed to verify the performance of the proposed algorithm. The simulation and experiment results indicate the validity of the proposed algorithm, especially when large misalignment angles occur.