Orthogonalization correction method for strapdown attitude matrix in analytic expression coarse alignment

Abstract

The present invention relates to an orthogonalization correction method for a strapdown attitude matrix in analytic expression coarse alignment. The method comprises: adopting a gravity acceleration and an earth rotation angular velocity to determine three three-dimensional vectors; carrying out determining measurement from the three three-dimensional vectors to obtain a non-orthogonal error-containing strapdown attitude matrix, writing the non-orthogonal error-containing strapdown attitude matrix into a row vector form, carrying out an orthogonalization and normalization treatment to obtain a corrected strapdown attitude matrix, and judging whether the corrected strapdown attitude matrix meets a precision requirement according to a preset condition, wherein the process is completed if the corrected strapdown attitude matrix meets the precision requirement, and iterative computation is repeated until the judging condition is met if the corrected strapdown attitude matrix does not meet the precision requirement. With the present invention, influence of strapdown attitude matrix non-orthogonalization on the analytic expression coarse alignment measurement is solved, and carrier attitude measurement precision can be increased.

Description

(1) Technical field: [0001] The present invention relates to a carrier attitude measurement method, specifically in the analytical rough alignment, correcting the non-orthogonal error of the measured strapdown attitude matrix to improve the measurement accuracy of the strapdown attitude matrix, thereby Improve attitude accuracy. (two) background technology: [0002] Analytical coarse alignment usually uses the output of the gyroscope and accelerometer to measure the strapdown attitude matrix. Further, the attitude of the carrier can be measured from the relationship between the strapdown attitude matrix and the attitude angle of the carrier. It can be seen that strapdown attitude matrix measurement is the key to analytical coarse alignment. [0003] Due to the existence of computer calculation errors, the strapdown attitude matrix is ​​often not an orthogonal matrix. If the strapdown attitude matrix is ​​not an orthogonal matrix, errors will occur in the carrier attitude a...

AI Technical Summary

Problems solved by technology

[0012] The purpose of the present invention is to provide a method for correcting the strapdown matrix applicable to the strapdown inertial navigation system in the analytical rough alignment, which can solve the non-orthogonality of the attitude matrix of the rough alignment using the acceleration of gravity and the earth's rotation angular velocity estimation Problems affecting navigation accuracy

Images