In this paper, the kinematic models of the Strapdown Inertial Navigation System (SINS) and its errors on the SE(3) group in the Earth-Centered Inertial frame (ECI) are established. On the one hand, with the ECI frame being regarded as the reference, based on the joint representation of attitude and velocity on the SE(3) group, the dynamic of the local geographic coordinate system (n-frame) and the body coordinate system (b-frame) evolve on the differentiable manifold, respectively, and the high-order expansion of the Baker-Campbell-Haussdorff equation compensates for the non-commutative motion errors stimulated by strong maneuverability. On the other hand, the kinematics of the left- and right-invariant errors of the n-frame and the b-frame on the SE(3) group are separately derived, where the errors of the b-frame completely depend on inertial sensor errors, while the errors of the n-frame rely on position errors and velocity errors. In this way, the errors brought by the inconsistency of the reference coordinate system are tackled, and a novel attitude error definition is introduced to separate and decouple the factors affecting the dynamic of the n-frame errors and the b-frame errors for better attitude estimation. Through a turntable experiment and a car-mounted field experiment, the effectiveness of the proposed kinematic models in estimating attitude has been verified, with a remarkable improvement in yaw angle accuracy in the case of large initial misalignment angles, and the models developed have better robustness compared to the traditional SE(3) group-based model.
Read full abstract