A novel adaptive federated filter for GNSS/INS/VO integrated navigation system

摘要

In order to solve the problem of decreased navigation performance of the Global Navigation Satellite System (GNSS)/inertial navigation system (INS) integrated navigation systems in GNSS-denied environments, and to improve the navigation accuracy and robustness of the navigation system, a novel adaptive federated filter with a feedback scheme for a GNSS/INS/visual odometry (VO) integrated navigation system is proposed in this paper. A visual-inertial odometry system model with a multi-state constraint Kalman filter structure based on a polar geometry and trifocal tensor geometry between different images is established, which can provide better navigation accuracy in GNSS-denied environments. Moreover, a new method to obtain the information allocation factor according to the different navigation performances of local filters is deduced in this paper, which has low computational complexity and a simple structure. Meanwhile, an abnormal measurement detection algorithm based on fuzzy logic is proposed to detect the abnormal measurements of local filters. The results of the vehicle experiment with the publicly available real-world KITTI dataset show that the proposed algorithm can obtain reliable navigation results in GNSS-denied environments and improve the navigation accuracy and robustness of the GNSS/INS/VO integrated navigation system.