Fault-Tolerant GNSS/SINS/DVL/CNS Integrated Navigation and Positioning Mechanism Based on Adaptive Information Sharing Factors

Real-time positioning feature is becoming an essential part in a variety of military and civilian applications. In particular, the cooperation of multisensors helps to improve navigation accuracy and the universality of the system. In this article, we propose a novel robust fault-tolerant federated filter based on strapdown inertial navigation system (SINS), global navigation satellite system (GNSS), celestial navigation system (CNS), and doppler velocity log (DVL). In the proposed algorithm, the position information of the GNSS, the velocity information of the DVL, and the attitude information of the CNS are introduced as measurement information to correct the divergence error of SINS. The federated filter is exploited for its flexibility and capability in fault toleration. To amend fault and recover information in local filters, a simplified state Chi-square test (SSCST) is utilized as the fault detection, isolation, and recovery procedure. Meanwhile, a new adaptive information sharing factor algorithm based on the results of SSCST and the residuals between the actual observations and the predicted observations is designed, which can adaptively reflect the performance of each local filter. Experimental results show that the accuracy of the proposed integrated navigation and positioning algorithm can be improved and the system remains stable even when the error occurs.