The large misalignment errors of horizontal and azimuthal angle cannot be converged rapidly on the sea surface due to extra disturbance of linear and angular motions caused by wind and waves, which increases the time cost of marine vehicles alignment process and ultimately limits the SINS quick working capability. In order to solve the above problem, an adaptive multiple backtracking UKF method based on Krein space theory is proposed in this paper. Firstly, considering time-varying calibration errors of inertial sensors, a novel robust posterior filtering equation in Krein space is designed to improve the matching degree between the physical process and the mathematical model. Moreover, combined with the multiple forward and reverse navigation processes, an adaptive calculation times control method in backtracking UKF based on the innovation is constructed to solve the nonlinear fast alignment problem in the case of large misalignment angle errors with the purpose of further intelligently shortening the alignment time and ensuring alignment accuracy simultaneously in different periods and working environments. The physical experiment results demonstrate that the horizontal and azimuthal alignment accuracy of the proposed algorithm are improved compared with standard CKF alignment algorithm.
Read full abstract