To address the limitations of traditional multi-camera-IMU state estimation systems—namely, insufficient localization accuracy in complex environments and poor robustness under abnormal IMU observations—this paper proposes an asynchronous multi-camera-IMU tightly-coupled navigation algorithm that incorporates a depth confidence scoring strategy and a chi-square test mechanism. The proposed method is built upon the factor graph optimization (FGO) framework. On the basis of conventional multi-camera-IMU fusion, a gated recurrent unit (GRU)-based depth confidence scoring model is introduced to mitigate uncertainty and partially suppress noise errors. These confidence scores are then utilized as weights in the factor graph to minimize the weighted sum of squared residuals, thereby improving the accuracy of the optimized state variables. Furthermore, a dynamic outlier rejection strategy based on chi-square testing is designed, which operates through three stages—pre-screening, initialization, and iterative statistical optimization—to preferentially utilize well-distributed and high-quality observation subsets while effectively excluding noise-sensitive measurements, thus strengthening the 6-DoF pose constraints. Extensive evaluations are conducted using indoor simulation scenarios and the public VINS-Multi dataset (sequence raw_515_435). The results demonstrate that, after incorporating the depth confidence scores, the pose uncertainty in asynchronous settings is reduced from an error range of 0.1 - 0.2 to within 0.05. Across all sequences in the dataset, the proposed method achieves an average improvement of 31.6% in localization accuracy, with particularly significant gains of up to 46.8% in challenging low-texture regions and scenarios with large motion magnitudes.
References
[1]
Wang, L., Xu, Y. and Shen, S. (2024) VINS-Multi: A Robust Asynchronous Multi-camera-IMU State Estimator.
[2]
Kühne, J., Vogt, C., Magno, M. and Benini, L. (2025) Efficient and Accurate Downfacing Visual-Inertial Odometry. IEEEInternetofThingsJournal, 12, 48376-48387. https://doi.org/10.1109/jiot.2025.3609011
[3]
Zhang, D., Zhang, J., Sun, Y., Li, T., Yin, H., Xie, H., et al. (2025) Towards Robust Sensor-Fusion Ground SLAM: A Comprehensive Benchmark and a Resilient Framework. 2025 IEEE/RSJInternationalConferenceonIntelligentRobotsandSystems (IROS), Hangzhou, 19-25 October 2025, 8894-8901. https://doi.org/10.1109/iros60139.2025.11247507
[4]
Cao, Y., He, X., Chen, Y., et al. (2025) Omni-LIVO: Robust RGB-Colored Multi-Camera Visual-Inertial-LiDAR Odometry via Photometric Migration and ESIKF Fusion.
[5]
Ma, C., Cheng, P. and Cai, C. (2024) Localization and Mapping Method Based on Multimodal Information Fusion and Deep Learning for Dynamic Object Removal. InternationalJournalofNetworkDynamicsandIntelligence, 3, Article ID: 100008. https://doi.org/10.53941/ijndi.2024.100008
[6]
Jung, J., Boche, S., Laina, S.B. and Leutenegger, S. (2025) Uncertainty-Aware Visual-Inertial SLAM with Volumetric Occupancy Mapping. 2025 IEEEInternationalConferenceonRoboticsandAutomation (ICRA), Atlanta, 19-23 May 2025, 14550-14556. https://doi.org/10.1109/icra55743.2025.11127824
[7]
Shapira, T.O. and Klein, I. (2025) ICD-Net: Inertial Covariance Displacement Network for Drone Visual-Inertial SLAM.
[8]
Teed, Z. and Deng, J. (2021) DROID-SLAM: Deep Visual SLAM for Monocular, Stereo, and RGB-D Cameras. Proceedings of the 35th International Conference on Neural Information Processing Systems, 6-14 December 2021, 16558-16569.
[9]
Dellaert, F. and Kaess, M. (2017) Factor Graphs for Robot Perception. FoundationsandTrendsinRobotics, 6, 1-139. https://doi.org/10.1561/2300000043
[10]
Wang, W., Zhu, D., Wang, X., Hu, Y., Qiu, Y., Wang, C., et al. (2020) TartanAir: A Dataset to Push the Limits of Visual SLAM. 2020 IEEE/RSJInternationalConferenceonIntelligentRobotsandSystems (IROS), Las Vegas, 24 October 2020-24 January 2021, 4909-4916. https://doi.org/10.1109/iros45743.2020.9341801
[11]
Chung, J., Gulcehre, C., Cho, K.H., et al. (2014) Empirical Evaluation of Gated Recurrent Neural Networks on Sequence Modeling.
[12]
Qin, T., Li, P. and Shen, S. (2018) VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator. IEEETransactionsonRobotics, 34, 1004-1020. https://doi.org/10.1109/tro.2018.2853729
[13]
Qin, T., Cao, S., Pan, J., et al. (2019) A General Optimization-Based Framework for Global Pose Estimation with Multiple Sensors.
[14]
Derpanis, K.G. (2010) Overview of the RANSAC Algorithm. ImageRochesterNY, 4, 2-3.
[15]
Grupp, M. (2017) EVO: Python Package for the Evaluation of Odometry and SLAM. https://github.com/MichaelGrupp/evo
[16]
Umeyama, S. (1991) Least-Squares Estimation of Transformation Parameters between Two Point Patterns. IEEETransactionsonPatternAnalysisandMachineIntelligence, 13, 376-380. https://doi.org/10.1109/34.88573