Strapdown inertial navigation system coarse alignment method based on recursive quaternion

Abstract

The invention discloses a strapdown inertial navigation system coarse alignment method based on a recursive quaternion. According to the method, a constant value attitude matrix in solidification method coarse alignment is calculated by adopting a recursive quaternion algorithm, and then the strapdown inertial navigation coarse alignment process is completed on the basis of solidification method coarse alignment. Solving of an initial attitude matrix is converted into calculation of the constant value attitude matrix in solidification method coarse alignment, an optimal quaternion solution of the constant value attitude matrix in a solidification method can be solved by constructing observation vectors and a reference vector and adopting a recursive quaternion algorithm, and then the strapdown inertial navigation coarse alignment process is completed. By constructing different observation vectors, the method can be applied in initial alignment under a static base and a swinging base and also applied in initial alignment under a movable base. The recursive quaternion algorithm is applied in the solidification method coarse alignment process, the alignment precision and the convergence speed can be improved. Therefore, the method has a very good engineering reference and application value by serving as a coarse alignment method for the swinging base or the movable base.

Description

technical field [0001] The invention belongs to the technical field of strapdown inertial navigation, relates to initial alignment, and is a rough alignment method for strapdown inertial navigation systems based on recursive quaternions. Background technique [0002] Inertial Navigation System (INS) is widely used in unmanned equipment and autonomous robots because of its good autonomy, strong concealment and excellent short-term accuracy. A key technology of the strapdown inertial navigation system is the initial alignment technology. The initial alignment of strapdown inertial navigation is to determine the attitude matrix at the initial moment. The essence of the initial alignment of the strapdown inertial navigation system is to determine the attitude through vector observation, so the attitude determination algorithm based on vector observation can be used to complete the initial alignment. How to achieve the highest alignment accuracy in the shortest time is the key ...

AI Technical Summary

Problems solved by technology

[0005] The technical solution of the present invention is to provide a strapdown inertial navigation system based on recursive quaternions for the problems of low accuracy and slow convergence speed of the two-vector attitude determination in the rough alignment of the solidification method of the strapdown inertial navigation system Coarse alignment method, which uses the recursive quaternion algorithm to calculate the constant attitude matrix in the solidification method coarse alignment, and then completes the strapdown inertial navigation coarse alignment process on the basis of the solidification method coarse alignment

Images