The application discloses a kind of inertial navigation unit rotation axis and full attitude calculation method of rotation angle, comprising:θ x0 ,ξ y0 Andξ z0 Are solved;Determine the
angular velocity of body relative navigation coordinate
system of strapdown inertial
system at t k Based on
differential equation,θ k ,ξ xk ,ξ yk Andξ zk Are solved;According to θ k ,ξ xk ,ξ yk ,ξ zk Update calculation,θ k+1 ,ξ xk+1 ,ξ yk+1 Andξ zk+1 Are obtained;According to θ k+1 ,ξ xk+1 ,ξ yk+1 Andξ zk+1 , coordinate
transformation matrix update is carried out, and velocity update and position update based on updated coordinate
transformation matrix are carried out.The method disclosed in the application uses
accelerometer and
gyroscope output information as the input information of unit rotation axis and rotation angle
kinematics equation, realizes the real-time update of coordinate
transformation matrix of carrier relative navigation coordinate
system by integral calculation,
singular value does not appear in the solving process, solution is unique, ensure that the full attitude of body coordinate system relative navigation coordinate system, high-precision requirement.