Multi-Layer Fault-Tolerant Robust Filter for Integrated Navigation in Launch Inertial Coordinate System

As to an aerospace vehicle, the flight span is large and the flight environment is complex. More than that, the existing navigation algorithms cannot meet the needs to provide accurate navigation parameters for aerospace vehicles, which results in the decline of navigation accuracy. This paper proposes a multi-layer, fault-tolerant robust filtering algorithm of aerospace vehicle in the launch inertial coordinate system to address this problem. Firstly, the launch inertial coordinate system is used as the reference coordinate system for navigation calculation, and the state equation and measurement equation of the navigation system are established in this coordinate system to improve the modeling accuracy of the navigation system. On this basis, a multi-layer, fault-tolerant robust filtering algorithm is designed to estimate and compensate the unknown input in the state equation in real time and adjust the noise variance matrix in the measurement equation adaptively. Simulation results show that the errors about the integrated navigation system output parameters are reduced, through this algorithm, which improves the attitude, velocity and position estimation accuracy of the integrated navigation system. In addition, the algorithm enhances the fault tolerance and robustness of the filtering algorithm.