Tightly Coupled Integrated Navigation Algorithm for Hypersonic Boost-Glide Vehicles in the LCEF Frame
According to the trajectory characteristics of hypersonic boost-glide vehicles, a tightly coupled integrated navigation algorithm for hypersonic vehicles based on the launch-centered Earth-fixed (LCEF) frame is proposed. First, the strapdown inertial navigation mechanization algorithm and discrete update algorithm in the LCEF frame are introduced. Subsequently, the attitude, velocity, and position error equations of strapdown inertial navigation in the LCEF frame are introduced. The strapdown inertial navigation system/global positioning system (SINS/GPS) pseudo-range and pseudo-range rate measurement equations in the LCEF frame are derived. Further, the tightly coupled SINS/GPS integrated navigation filter state equation and the measurement equation are presented. Finally, the tightly coupled SINS/GPS integrated navigation algorithm is verified in the hardware-in-the-loop (HWIL) simulation environment. The simulation results indicate that the precision of tightly coupled integrated navigation is better than that of loosely coupled integrated navigation. Moreover, even when the number of effective satellites is less than four, tightly coupled integrated navigation functions well, thus verifying the effectiveness and feasibility of the algorithm.