Robust Two-Stage Filtering for INS/Gravity Matching Passive Integrated Navigation Systems

With the expansion of the exploration scope of underwater vehicles and the improvement of their safety requirements, integrated navigation under passive conditions has become a hot topic in the field of navigation. Due to the stability and detectability of the Earth’s gravity field, the use of a matching result for external correction of inertial navigation systems (INSs) can be effective. For practical navigation applications, an inertial gravity matching integrated navigation algorithm must be designed for real-time applicability, diversified output information capability, and anti-interference capability. In this paper, an INS/gravity matching (INS-GM) integrated navigation algorithm is improved to extract the information of gravity fields in real time and correct the navigation results, and a robust integrated algorithm is proposed. Through two-hierarchy filtering, correction of the gravity field to the carrier position and of the integrated navigation system is obtained. According to the first-hierarchy filtering noise characteristics of gravity matching, the robustness of the algorithm to a complex environment is improved by second-hierarchy filtering. The ocean experiment data processing results show that the algorithm can effectively handle a certain degree of initial error, and an integrated navigation accuracy of 205 m is achieved in a good experimental environment. In the case of severe test conditions, the accuracy of the robust integrated navigation algorithm is 72% higher than that of the ordinary navigation algorithm, and it has a strong anti-jamming ability, which can meet the requirements of marine inertial gravity matching integrated navigation tasks.