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.
scite is a Brooklyn-based organization that helps researchers better discover and understand research articles through Smart Citations–citations that display the context of the citation and describe whether the article provides supporting or contrasting evidence. scite is used by students and researchers from around the world and is funded in part by the National Science Foundation and the National Institute on Drug Abuse of the National Institutes of Health.