{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,7,30]],"date-time":"2026-07-30T12:13:21Z","timestamp":1785413601653,"version":"3.56.0"},"reference-count":45,"publisher":"MDPI AG","issue":"5","license":[{"start":{"date-parts":[[2026,4,29]],"date-time":"2026-04-29T00:00:00Z","timestamp":1777420800000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"DOI":"10.13039\/501100001809","name":"National Natural Science Foundation of China","doi-asserted-by":"publisher","award":["52278448"],"award-info":[{"award-number":["52278448"]}],"id":[{"id":"10.13039\/501100001809","id-type":"DOI","asserted-by":"publisher"}]},{"award":["52278448"],"award-info":[{"award-number":["52278448"]}],"id":[{"id":"https:\/\/ror.org\/01h0zpd94","id-type":"ROR","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Robotics"],"abstract":"<jats:p>Accurate and robust localization and mapping in complex and dynamic environments remain a fundamental challenge for autonomous systems. LiDAR\u2013Inertial\u2013Visual Odometry (LIVO) integrates the complementary strengths of LiDAR geometry, visual appearance, and inertial motion constraints. However, existing LIVO systems still suffer from limited adaptability to sensor degradation, weak loop-closure robustness, and insufficient cross-modal consistency modeling. This paper presents a robust multi-sensor SLAM framework that integrates an uncertainty-aware LIVO front-end, a geometry-driven loop-closure module, and a cross-modal consistency factor-graph back-end. We develop an uncertainty-aware iterated error-state Kalman filter (iESKF) to tightly fuse LiDAR, visual, and inertial measurements, with measurement covariances dynamically adjusted according to innovation statistics, feature-matching quality, and observability. To improve global consistency, we propose a multi-channel Binary Triangle Constraint (mBTC) descriptor for LiDAR-based loop detection, which enhances robustness under viewpoint changes and appearance degradation. In addition, we introduce a cross-modal consistency factor to explicitly constrain the relative motion agreement between visual and LiDAR odometries. Extensive experiments on multiple public benchmarks demonstrate improved accuracy, loop-closure reliability, and long-term consistency compared with state-of-the-art LIVO systems.<\/jats:p>","DOI":"10.3390\/robotics15050090","type":"journal-article","created":{"date-parts":[[2026,4,29]],"date-time":"2026-04-29T15:01:18Z","timestamp":1777474878000},"page":"90","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":0,"title":["Uncertainty-Aware LiDAR\u2013Inertial\u2013Visual SLAM with Adaptive Fusion and Multi-Channel Geometric Loop Closure"],"prefix":"10.3390","volume":"15","author":[{"given":"Qixue","family":"Zhong","sequence":"first","affiliation":[{"name":"Institute of Microelectronics of the Chinese Academy of Sciences, Beijing 100029, China"},{"name":"University of Chinese Academy of Sciences, Beijing 100049, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Jing","family":"Xing","sequence":"additional","affiliation":[{"name":"Institute of Microelectronics of the Chinese Academy of Sciences, Beijing 100029, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Jian","family":"Liu","sequence":"additional","affiliation":[{"name":"Institute of Microelectronics of the Chinese Academy of Sciences, Beijing 100029, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Luqing","family":"Luo","sequence":"additional","affiliation":[{"name":"Institute of Microelectronics of the Chinese Academy of Sciences, Beijing 100029, China"}],"role":[{"vocabulary":"crossref","role":"author"}]}],"member":"1968","published-online":{"date-parts":[[2026,4,29]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","unstructured":"Graeter, J., Wilczynski, A., and Lauer, M. (2018). LIMO: Lidar-monocular visual odometry. Proceedings of the 2018 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE.","DOI":"10.1109\/IROS.2018.8594394"},{"key":"ref_2","doi-asserted-by":"crossref","unstructured":"Zhu, Y., Zheng, C., Yuan, C., Huang, X., and Hong, Y. CamVox: A low-cost and accurate LiDAR-assisted visual SLAM system. Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), IEEE.","DOI":"10.1109\/ICRA48506.2021.9561149"},{"key":"ref_3","doi-asserted-by":"crossref","unstructured":"Shao, W., Vijayarangan, S., Li, C., and Kantor, G. (2019). Stereo visual inertial LiDAR simultaneous localization and mapping. Proceedings of the 2019 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE.","DOI":"10.1109\/IROS40897.2019.8968012"},{"key":"ref_4","doi-asserted-by":"crossref","unstructured":"Shan, T., Englot, B., Ratti, C., and Rus, D. (2021). LVI-SAM: Tightly-coupled lidar-visual-inertial odometry via smoothing and mapping. Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), IEEE.","DOI":"10.1109\/ICRA48506.2021.9561996"},{"key":"ref_5","doi-asserted-by":"crossref","first-page":"7469","DOI":"10.1109\/LRA.2021.3095515","article-title":"R2LIVE: A robust, real-time, LiDAR-inertial-visual tightly-coupled state estimator and mapping","volume":"6","author":"Lin","year":"2021","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_6","doi-asserted-by":"crossref","unstructured":"Lin, J., and Zhang, F. (2022). R3LIVE: A robust, real-time, RGB-colored, LiDAR-inertial-visual tightly-coupled state estimation and mapping package. Proceedings of the 2022 IEEE International Conference on Robotics and Automation (ICRA), IEEE.","DOI":"10.1109\/ICRA46639.2022.9811935"},{"key":"ref_7","doi-asserted-by":"crossref","unstructured":"Zheng, C., Zhu, Q., Xu, W., Liu, X., and Guo, Q. FAST-LIVO: Fast and tightly-coupled sparse-direct LiDAR-inertial-visual odometry. Proceedings of the 2022 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE.","DOI":"10.1109\/IROS47612.2022.9981107"},{"key":"ref_8","doi-asserted-by":"crossref","unstructured":"Zheng, C., Xu, W., Zou, Z., Hua, T., Yuan, C., He, D., Zhou, B., Liu, Z., Lin, J., and Zhu, F. (2024). FAST-LIVO2: Fast, direct LiDAR-inertial-visual odometry. arXiv.","DOI":"10.1109\/TRO.2024.3502198"},{"key":"ref_9","doi-asserted-by":"crossref","first-page":"611","DOI":"10.1109\/TPAMI.2017.2658577","article-title":"Direct sparse odometry","volume":"40","author":"Engel","year":"2017","journal-title":"IEEE Trans. Pattern Anal. Mach. Intell."},{"key":"ref_10","doi-asserted-by":"crossref","unstructured":"Engel, J., Sch\u00f6ps, T., and Cremers, D. (2014). LSD-SLAM: Large-scale direct monocular SLAM. Proceedings of the European Conference on Computer Vision, Springer.","DOI":"10.1007\/978-3-319-10605-2_54"},{"key":"ref_11","doi-asserted-by":"crossref","unstructured":"Forster, C., Pizzoli, M., and Scaramuzza, D. (2014). SVO: Fast semi-direct monocular visual odometry. Proceedings of the 2014 IEEE International Conference on Robotics and Automation (ICRA), IEEE.","DOI":"10.1109\/ICRA.2014.6906584"},{"key":"ref_12","doi-asserted-by":"crossref","first-page":"1255","DOI":"10.1109\/TRO.2017.2705103","article-title":"ORB-SLAM2: An open-source SLAM system for monocular, stereo, and RGB-D cameras","volume":"33","year":"2017","journal-title":"IEEE Trans. Robot."},{"key":"ref_13","doi-asserted-by":"crossref","first-page":"1004","DOI":"10.1109\/TRO.2018.2853729","article-title":"VINS-Mono: A robust and versatile monocular visual-inertial state estimator","volume":"34","author":"Qin","year":"2018","journal-title":"IEEE Trans. Robot."},{"key":"ref_14","unstructured":"Qin, T., Pan, J., Cao, S., and Shen, S. (2019). A general optimization-based framework for local odometry estimation with multiple sensors. arXiv."},{"key":"ref_15","doi-asserted-by":"crossref","first-page":"2004","DOI":"10.1109\/TRO.2021.3133730","article-title":"GVINS: Tightly coupled GNSS\u2013visual\u2013inertial fusion for smooth and consistent state estimation","volume":"38","author":"Cao","year":"2022","journal-title":"IEEE Trans. Robot."},{"key":"ref_16","doi-asserted-by":"crossref","unstructured":"Zhang, J., and Singh, S. (2014, January 12\u201316). LOAM: Lidar odometry and mapping in real-time. Proceedings of the Robotics: Science and Systems, Berkeley, CA, USA.","DOI":"10.15607\/RSS.2014.X.007"},{"key":"ref_17","doi-asserted-by":"crossref","unstructured":"Shan, T., and Englot, B. (2018). LEGO-LOAM: Lightweight and ground-optimized lidar odometry and mapping on variable terrain. Proceedings of the 2018 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE.","DOI":"10.1109\/IROS.2018.8594299"},{"key":"ref_18","doi-asserted-by":"crossref","unstructured":"Lin, J., and Zhang, F. (2020). LOAM LIVOX: A fast, robust, high-precision LiDAR odometry and mapping package for LiDARs of small FoV. Proceedings of the 2020 IEEE International Conference on Robotics and Automation (ICRA), IEEE.","DOI":"10.1109\/ICRA40945.2020.9197440"},{"key":"ref_19","doi-asserted-by":"crossref","first-page":"8518","DOI":"10.1109\/LRA.2022.3187250","article-title":"Efficient and probabilistic adaptive voxel mapping for accurate online lidar odometry","volume":"7","author":"Yuan","year":"2022","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_20","unstructured":"Liu, Z., Li, H., Yaun, C., Liu, X., Lin, J., Li, R., Zheng, C., Zhou, B., Liu, W., and Zhang, F. (2024). Voxel-SLAM: A complete, accurate, and versatile lidar-inertial SLAM system. arXiv."},{"key":"ref_21","doi-asserted-by":"crossref","first-page":"3317","DOI":"10.1109\/LRA.2021.3064227","article-title":"FAST-LIO: A fast, robust LiDAR-inertial odometry package by tightly-coupled iterated Kalman filter","volume":"6","author":"Xu","year":"2021","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"2053","DOI":"10.1109\/TRO.2022.3141876","article-title":"FAST-LIO2: Fast direct LiDAR-inertial odometry","volume":"38","author":"Xu","year":"2022","journal-title":"IEEE Trans. Robot."},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"2200459","DOI":"10.1002\/aisy.202200459","article-title":"Point-LIO: Robust high-bandwidth light detection and ranging inertial odometry","volume":"5","author":"He","year":"2023","journal-title":"Adv. Intell. Syst."},{"key":"ref_24","doi-asserted-by":"crossref","unstructured":"Dellenbach, P., Deschaud, J.E., Jacquet, B., and Goulette, F. (2022). CT-ICP: Real-time elastic LiDAR odometry with loop closure. Proceedings of the 2022 IEEE International Conference on Robotics and Automation (ICRA), IEEE.","DOI":"10.1109\/ICRA46639.2022.9811849"},{"key":"ref_25","doi-asserted-by":"crossref","unstructured":"Devarajan, H., Zheng, H., Kougkas, A., Sun, X.H., and Vishwanath, V. (2021). DLIO: A data-centric benchmark for scientific deep learning applications. Proceedings of the 2021 IEEE\/ACM 21st International Symposium on Cluster, Cloud and Internet Computing (CCGrid), IEEE.","DOI":"10.1109\/CCGrid51090.2021.00018"},{"key":"ref_26","doi-asserted-by":"crossref","unstructured":"Shan, T., Englot, B., Meyers, D., Wang, W., Ratti, C., and Rus, D. (2020). LIO-SAM: Tightly-coupled LiDAR inertial odometry via smoothing and mapping. Proceedings of the 2020 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE.","DOI":"10.1109\/IROS45743.2020.9341176"},{"key":"ref_27","doi-asserted-by":"crossref","unstructured":"Kim, G., and Kim, A. (2018). Scan context: Egocentric spatial descriptor for place recognition within 3D point cloud map. Proceedings of the 2018 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE.","DOI":"10.1109\/IROS.2018.8593953"},{"key":"ref_28","doi-asserted-by":"crossref","unstructured":"He, L., Wang, X., and Zhang, H. (2016). M2DP: A novel 3D point cloud descriptor and its application in loop closure detection. Proceedings of the 2016 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE.","DOI":"10.1109\/IROS.2016.7759060"},{"key":"ref_29","doi-asserted-by":"crossref","first-page":"1856","DOI":"10.1109\/TRO.2021.3116424","article-title":"Scan context++: Structural place recognition robust to rotation and lateral variations in urban environments","volume":"38","author":"Kim","year":"2021","journal-title":"IEEE Trans. Robot."},{"key":"ref_30","doi-asserted-by":"crossref","unstructured":"Wang, H., Wang, C., and Xie, L. (2020). Intensity scan context: Coding intensity and geometry relations for loop closure detection. Proceedings of the 2020 IEEE International Conference on Robotics and Automation (ICRA), IEEE.","DOI":"10.1109\/ICRA40945.2020.9196764"},{"key":"ref_31","doi-asserted-by":"crossref","unstructured":"Wang, Y., Sun, Z., Xu, C., Sarma, S., Yang, J., and Kong, H. (2020). LiDAR iris for loop-closure detection. Proceedings of the 2020 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE.","DOI":"10.1109\/IROS45743.2020.9341010"},{"key":"ref_32","doi-asserted-by":"crossref","unstructured":"Yuan, C., Lin, J., Zou, Z., Hong, X., and Zhang, F. (2022). STD: Stable triangle descriptor for 3D place recognition. arXiv.","DOI":"10.1109\/ICRA48891.2023.10160413"},{"key":"ref_33","doi-asserted-by":"crossref","first-page":"1580","DOI":"10.1109\/TRO.2024.3353076","article-title":"BTC: A binary and triangle combined descriptor for 3-D place recognition","volume":"40","author":"Yuan","year":"2024","journal-title":"IEEE Trans. Robot."},{"key":"ref_34","doi-asserted-by":"crossref","unstructured":"Bar-Shalom, Y., and Li, X.R.K.T. (2001). Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software, John Wiley & Sons.","DOI":"10.1002\/0471221279"},{"key":"ref_35","unstructured":"Maybeck, P.S. (1982). Stochastic Models, Estimation, and Control, Academic Press."},{"key":"ref_36","doi-asserted-by":"crossref","first-page":"100785","DOI":"10.1016\/j.rineng.2022.100785","article-title":"Adaptive SVSF-KF estimation strategies based on the normalized innovation square metric and IMM strategy","volume":"16","author":"Goodman","year":"2022","journal-title":"Results Eng."},{"key":"ref_37","unstructured":"Groves, P.D. (2013). Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems, Artech House. [2nd ed.]."},{"key":"ref_38","doi-asserted-by":"crossref","first-page":"922","DOI":"10.1109\/LRA.2025.3634906","article-title":"LODESTAR: Degeneracy-aware LiDAR-inertial odometry with adaptive Schmidt-Kalman filter and data exploitation","volume":"11","author":"Lee","year":"2025","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_39","doi-asserted-by":"crossref","first-page":"73","DOI":"10.1214\/aoms\/1177703732","article-title":"Robust estimation of a location parameter","volume":"35","author":"Huber","year":"1964","journal-title":"Ann. Math. Stat."},{"key":"ref_40","doi-asserted-by":"crossref","first-page":"813","DOI":"10.1080\/03610927708827533","article-title":"Robust regression using iteratively reweighted least-squares","volume":"6","author":"Holland","year":"1977","journal-title":"Commun. Stat. Theory Methods"},{"key":"ref_41","doi-asserted-by":"crossref","first-page":"513","DOI":"10.1016\/0306-4573(88)90021-0","article-title":"Term-weighting approaches in automatic text retrieval","volume":"24","author":"Salton","year":"1988","journal-title":"Inf. Process. Manag."},{"key":"ref_42","doi-asserted-by":"crossref","first-page":"1231","DOI":"10.1177\/0278364913491297","article-title":"Vision meets robotics: The KITTI dataset","volume":"32","author":"Geiger","year":"2013","journal-title":"Int. J. Robot. Res."},{"key":"ref_43","doi-asserted-by":"crossref","first-page":"2266","DOI":"10.1109\/LRA.2021.3138527","article-title":"M2DGR: A multi-sensor and multi-scenario SLAM dataset for ground robots","volume":"7","author":"Yin","year":"2021","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_44","doi-asserted-by":"crossref","unstructured":"Zhang, D., Zhang, J., Sun, Y., Li, T., Yin, H., Xie, H., and Yin, J. (2025). Towards robust sensor-fusion ground SLAM: A comprehensive benchmark and a resilient framework. arXiv.","DOI":"10.1109\/IROS60139.2025.11247507"},{"key":"ref_45","doi-asserted-by":"crossref","first-page":"1023","DOI":"10.1177\/0278364915614638","article-title":"University of Michigan North Campus long-term vision and LiDAR dataset","volume":"35","author":"Ushani","year":"2016","journal-title":"Int. J. Robot. Res."}],"container-title":["Robotics"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/2218-6581\/15\/5\/90\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2026,4,29]],"date-time":"2026-04-29T15:36:53Z","timestamp":1777477013000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/2218-6581\/15\/5\/90"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2026,4,29]]},"references-count":45,"journal-issue":{"issue":"5","published-online":{"date-parts":[[2026,5]]}},"alternative-id":["robotics15050090"],"URL":"https:\/\/doi.org\/10.3390\/robotics15050090","relation":{},"ISSN":["2218-6581"],"issn-type":[{"value":"2218-6581","type":"electronic"}],"subject":[],"published":{"date-parts":[[2026,4,29]]}}}