{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,2,1]],"date-time":"2026-02-01T04:53:18Z","timestamp":1769921598558,"version":"3.49.0"},"reference-count":46,"publisher":"MDPI AG","issue":"17","license":[{"start":{"date-parts":[[2022,8,29]],"date-time":"2022-08-29T00:00:00Z","timestamp":1661731200000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"name":"National Natural Science Foundation of China","award":["42074012"],"award-info":[{"award-number":["42074012"]}]},{"name":"National Natural Science Foundation of China","award":["2020JH2\/10100044"],"award-info":[{"award-number":["2020JH2\/10100044"]}]},{"name":"National Natural Science Foundation of China","award":["XLYC2002101"],"award-info":[{"award-number":["XLYC2002101"]}]},{"name":"National Natural Science Foundation of China","award":["XLYC2008034"],"award-info":[{"award-number":["XLYC2008034"]}]},{"name":"National Natural Science Foundation of China","award":["LJ2020JCL016"],"award-info":[{"award-number":["LJ2020JCL016"]}]},{"name":"Liaoning Key Research and Development Program","award":["42074012"],"award-info":[{"award-number":["42074012"]}]},{"name":"Liaoning Key Research and Development Program","award":["2020JH2\/10100044"],"award-info":[{"award-number":["2020JH2\/10100044"]}]},{"name":"Liaoning Key Research and Development Program","award":["XLYC2002101"],"award-info":[{"award-number":["XLYC2002101"]}]},{"name":"Liaoning Key Research and Development Program","award":["XLYC2008034"],"award-info":[{"award-number":["XLYC2008034"]}]},{"name":"Liaoning Key Research and Development Program","award":["LJ2020JCL016"],"award-info":[{"award-number":["LJ2020JCL016"]}]},{"name":"Liaoning Revitalization Talents Program","award":["42074012"],"award-info":[{"award-number":["42074012"]}]},{"name":"Liaoning Revitalization Talents Program","award":["2020JH2\/10100044"],"award-info":[{"award-number":["2020JH2\/10100044"]}]},{"name":"Liaoning Revitalization Talents Program","award":["XLYC2002101"],"award-info":[{"award-number":["XLYC2002101"]}]},{"name":"Liaoning Revitalization Talents Program","award":["XLYC2008034"],"award-info":[{"award-number":["XLYC2008034"]}]},{"name":"Liaoning Revitalization Talents Program","award":["LJ2020JCL016"],"award-info":[{"award-number":["LJ2020JCL016"]}]},{"name":"Fundamental Research Program of the Liaoning Education Department","award":["42074012"],"award-info":[{"award-number":["42074012"]}]},{"name":"Fundamental Research Program of the Liaoning Education Department","award":["2020JH2\/10100044"],"award-info":[{"award-number":["2020JH2\/10100044"]}]},{"name":"Fundamental Research Program of the Liaoning Education Department","award":["XLYC2002101"],"award-info":[{"award-number":["XLYC2002101"]}]},{"name":"Fundamental Research Program of the Liaoning Education Department","award":["XLYC2008034"],"award-info":[{"award-number":["XLYC2008034"]}]},{"name":"Fundamental Research Program of the Liaoning Education Department","award":["LJ2020JCL016"],"award-info":[{"award-number":["LJ2020JCL016"]}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Remote Sensing"],"abstract":"<jats:p>In this study, we propose a tightly coupled integrated method of ultrawideband (UWB) and light detection and ranging (LiDAR)-based simultaneous localization and mapping (SLAM) for global navigation satellite system (GNSS)-denied environments to achieve high-precision positioning with reduced drift. Specifically, we focus on non-line-of-sight (NLOS) identification and correction. In previous work, we utilized laser point cloud maps to identify and exclude NLOS measurements in real time to attenuate their severe effects on the integrated system. However, the complete exclusion of NLOS measurements will likely lead to deterioration in the dilution of precision (DOP) for the remaining line-of-sight (LOS) anchors, counterproductively introducing large positioning errors into the integrated system. Therefore, this study considers the ranging accuracy and geometric distribution of UWB anchors and innovatively proposes an NLOS correction method using a grey prediction model. For a poor line-of-sight (LOS) anchor geometric distribution, the grey prediction model is used to fill in the gaps by predicting the NLOS measurements based on historical measurements. Including the corrected measurements effectively improves the original poor geometric configuration, improving the system positioning accuracy. Since conventional filtering-based fusion methods are exceedingly sensitive to measurement outliers, we use state-of-the-art factor graph optimization (FGO) to tightly integrate the UWB measurements (LOS and corrected measurements) with LiDAR-SLAM. The temporal correlation between measurements and the redundant system measurements effectively enhance the robustness of the integrated system. Experimental results show that the tightly coupled integrated method combining NLOS correction and FGO improves the positioning accuracy under a poor geometric distribution, increases the system availability, and achieves better positioning than filtering-based fusion methods with a root-mean-square error of 0.086 m in the plane direction, achieving subdecimeter indoor high-precision positioning.<\/jats:p>","DOI":"10.3390\/rs14174258","type":"journal-article","created":{"date-parts":[[2022,8,30]],"date-time":"2022-08-30T01:37:55Z","timestamp":1661823475000},"page":"4258","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":17,"title":["NLOS Identification- and Correction-Focused Fusion of UWB and LiDAR-SLAM Based on Factor Graph Optimization for High-Precision Positioning with Reduced Drift"],"prefix":"10.3390","volume":"14","author":[{"ORCID":"https:\/\/orcid.org\/0000-0002-9868-2614","authenticated-orcid":false,"given":"Zhijian","family":"Chen","sequence":"first","affiliation":[{"name":"School of Geomatics, Liaoning Technical University, Fuxin 123000, China"}]},{"given":"Aigong","family":"Xu","sequence":"additional","affiliation":[{"name":"School of Geomatics, Liaoning Technical University, Fuxin 123000, China"}]},{"given":"Xin","family":"Sui","sequence":"additional","affiliation":[{"name":"School of Geomatics, Liaoning Technical University, Fuxin 123000, China"}]},{"given":"Yuting","family":"Hao","sequence":"additional","affiliation":[{"name":"School of Geomatics, Liaoning Technical University, Fuxin 123000, China"}]},{"given":"Cong","family":"Zhang","sequence":"additional","affiliation":[{"name":"School of Geomatics, Liaoning Technical University, Fuxin 123000, China"}]},{"given":"Zhengxu","family":"Shi","sequence":"additional","affiliation":[{"name":"School of Geomatics, Liaoning Technical University, Fuxin 123000, China"}]}],"member":"1968","published-online":{"date-parts":[[2022,8,29]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"1715","DOI":"10.1109\/LRA.2021.3059567","article-title":"Intensity-slam: Intensity assisted localization and mapping for large scale environment","volume":"6","author":"Wang","year":"2021","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_2","doi-asserted-by":"crossref","unstructured":"Zhen, W., and Scherer, S. (2019, January 20\u201324). Estimating the localizability in tunnel-like environments using LiDAR and UWB. Proceedings of the 2019 International Conference on Robotics and Automation (ICRA), Montreal, QC, Canada.","DOI":"10.1109\/ICRA.2019.8794167"},{"key":"ref_3","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_4","doi-asserted-by":"crossref","unstructured":"Yokozuka, M., Koide, K., Oishi, S., and Banno, A. (January, January 24). LiTAMIN: LiDAR-based Tracking and Mapping by Stabilized ICP for Geometry Approximation with Normal Distributions. Proceedings of the 2020 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Las Vegas, NV, USA.","DOI":"10.1109\/IROS45743.2020.9341341"},{"key":"ref_5","doi-asserted-by":"crossref","unstructured":"Yokozuka, M., Koide, K., Oishi, S., and Banno, A. (June, January 30). LiTAMIN2: Ultra light lidar-based slam using geometric approximation applied with KL-divergence. Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi\u2019an, China.","DOI":"10.1109\/ICRA48506.2021.9560947"},{"key":"ref_6","unstructured":"Hong, S., Ko, H., and Kim, J. (2010, January 3\u20137). VICP: Velocity updating iterative closest point algorithm. Proceedings of the 2010 IEEE International Conference on Robotics and Automation, Anchorage, AK, USA."},{"key":"ref_7","doi-asserted-by":"crossref","unstructured":"Yang, J., Li, H., and Jia, Y. (2013, January 1\u20138). Go-icp: Solving 3d registration efficiently and globally optimally. Proceedings of the IEEE International Conference on Computer Vision, Sydney, NSW, Australia.","DOI":"10.1109\/ICCV.2013.184"},{"key":"ref_8","doi-asserted-by":"crossref","first-page":"1377","DOI":"10.1177\/0278364912460895","article-title":"Fast and accurate scan registration through minimization of the distance between compact 3D NDT representations","volume":"31","author":"Stoyanov","year":"2012","journal-title":"Int. J. Robot. Res."},{"key":"ref_9","doi-asserted-by":"crossref","unstructured":"Zhou, Z., Zhao, C., Adolfsson, D., Su, S., Gao, Y., Duckett, T., and Sun, L. (June, January 30). Ndt-transformer: Large-scale 3d point cloud localisation using the normal distribution transform representation. Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi\u2019an, China.","DOI":"10.1109\/ICRA48506.2021.9560932"},{"key":"ref_10","doi-asserted-by":"crossref","first-page":"401","DOI":"10.1007\/s10514-016-9548-2","article-title":"Low-drift and real-time lidar odometry and mapping","volume":"41","author":"Zhang","year":"2017","journal-title":"Auton. Robot."},{"key":"ref_11","doi-asserted-by":"crossref","unstructured":"Shan, T., and Englot, B. (2018, January 1\u20135). 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), Madrid, Spain.","DOI":"10.1109\/IROS.2018.8594299"},{"key":"ref_12","doi-asserted-by":"crossref","unstructured":"Pan, Y., Xiao, P., He, Y., Shao, Z., and Li, Z. (June, January 30). MULLS: Versatile LiDAR SLAM via multi-metric linear least square. Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi\u2019an, China.","DOI":"10.1109\/ICRA48506.2021.9561364"},{"key":"ref_13","doi-asserted-by":"crossref","first-page":"192","DOI":"10.1016\/j.ins.2021.06.006","article-title":"Cooperative indoor 3D mapping and modeling using LiDAR data","volume":"574","author":"Wen","year":"2021","journal-title":"Inf. Sci."},{"key":"ref_14","doi-asserted-by":"crossref","unstructured":"Droeschel, D., and Behnke, S. (2018, January 21\u201325). Efficient continuous-time SLAM for 3D lidar-based online mapping. Proceedings of the 2018 IEEE International Conference on Robotics and Automation (ICRA), Brisbane, QLD, Australia.","DOI":"10.1109\/ICRA.2018.8461000"},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Chang, L., Niu, X., Liu, T., Tang, J., and Qian, C. (2019). GNSS\/INS\/LiDAR-SLAM integrated navigation system based on graph optimization. Remote Sens., 11.","DOI":"10.3390\/rs11091009"},{"key":"ref_16","doi-asserted-by":"crossref","first-page":"10896","DOI":"10.1109\/TVT.2018.2870160","article-title":"Augmentation of fingerprints for indoor WiFi localization based on Gaussian process regression","volume":"67","author":"Sun","year":"2018","journal-title":"IEEE Trans. Veh. Technol."},{"key":"ref_17","doi-asserted-by":"crossref","first-page":"5288","DOI":"10.1109\/JSEN.2021.3089516","article-title":"A data-driven inertial navigation\/Bluetooth fusion algorithm for indoor localization","volume":"22","author":"Chen","year":"2021","journal-title":"IEEE Sens. J."},{"key":"ref_18","doi-asserted-by":"crossref","first-page":"1163","DOI":"10.1109\/TASE.2018.2873800","article-title":"RSS-based indoor localization using belief function theory","volume":"16","author":"Achroufene","year":"2018","journal-title":"IEEE Trans. Autom. Sci. Eng."},{"key":"ref_19","doi-asserted-by":"crossref","first-page":"5914","DOI":"10.1109\/TIE.2012.2230596","article-title":"Efficient object localization using sparsely distributed passive RFID tags","volume":"60","author":"Yang","year":"2012","journal-title":"IEEE Trans. Ind. Electron."},{"key":"ref_20","doi-asserted-by":"crossref","first-page":"7571","DOI":"10.3390\/s150407571","article-title":"NFC internal: An indoor navigation system","volume":"15","author":"Ozdenizci","year":"2015","journal-title":"Sensors"},{"key":"ref_21","doi-asserted-by":"crossref","first-page":"6903","DOI":"10.1109\/TII.2020.2969886","article-title":"Ranging error mitigation for through-the-wall non-line-of-sight conditions","volume":"16","author":"Silva","year":"2020","journal-title":"IEEE Trans. Ind. Inform."},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"11203","DOI":"10.1109\/JSEN.2021.3061468","article-title":"A novel NLOS error compensation method based IMU for UWB indoor positioning system","volume":"21","author":"Yang","year":"2021","journal-title":"IEEE Sens. J."},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"1689","DOI":"10.1109\/TWC.2014.2372341","article-title":"Non-line-of-sight identification and mitigation using received signal strength","volume":"14","author":"Xiao","year":"2014","journal-title":"IEEE Trans. Wirel. Commun."},{"key":"ref_24","doi-asserted-by":"crossref","first-page":"2420","DOI":"10.1109\/LCOMM.2021.3070311","article-title":"A low-cost NLOS identification and mitigation method for UWB ranging in static and dynamic environments","volume":"25","author":"Dong","year":"2021","journal-title":"IEEE Commun. Lett."},{"key":"ref_25","doi-asserted-by":"crossref","unstructured":"Schroeder, J., Galler, S., Kyamakya, K., and Jobmann, K. (2007, January 22). NLOS detection algorithms for ultra-wideband localization. Proceedings of the 2007 4th Workshop on Positioning, Navigation and Communication, Hannover, Germany.","DOI":"10.1109\/WPNC.2007.353628"},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"111191","DOI":"10.1016\/j.measurement.2022.111191","article-title":"NLOS identification using parallel deep learning model and time-frequency information in UWB-based positioning system","volume":"195","author":"Wei","year":"2022","journal-title":"Measurement"},{"key":"ref_27","doi-asserted-by":"crossref","unstructured":"Chen, Z., Xu, A., Sui, X., Wang, C., Wang, S., Gao, J., and Shi, Z. (2022). Improved-UWB\/LiDAR-SLAM Tightly Coupled Positioning System with NLOS Identification Using a LiDAR Point Cloud in GNSS-Denied Environments. Remote Sens., 14.","DOI":"10.3390\/rs14061380"},{"key":"ref_28","doi-asserted-by":"crossref","first-page":"1719","DOI":"10.1109\/TCOMM.2012.042712.110035","article-title":"A machine learning approach to ranging error mitigation for UWB localization","volume":"60","author":"Wymeersch","year":"2012","journal-title":"IEEE Trans. Commun."},{"key":"ref_29","doi-asserted-by":"crossref","first-page":"456","DOI":"10.1109\/TWC.2014.2350493","article-title":"Measurement analysis and channel modeling for TOA-based ranging in tunnels","volume":"14","author":"Savic","year":"2014","journal-title":"IEEE Trans. Wirel. Commun."},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"1357","DOI":"10.1109\/JSAC.2015.2430191","article-title":"Machine learning for wideband localization","volume":"33","author":"Jeong","year":"2015","journal-title":"IEEE J. Sel. Area. Commun."},{"key":"ref_31","doi-asserted-by":"crossref","first-page":"4028","DOI":"10.1109\/TIM.2018.2884605","article-title":"Human body shadowing effect on UWB-based ranging system for pedestrian tracking","volume":"68","author":"Tian","year":"2018","journal-title":"IEEE Trans. Instrum. Meas."},{"key":"ref_32","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1109\/TIM.2021.3070619","article-title":"Feature Selection for Real-Time NLOS Identification and Mitigation for Body-Mounted UWB Transceivers","volume":"70","author":"Ferreira","year":"2021","journal-title":"IEEE Trans. Instrum. Meas."},{"key":"ref_33","doi-asserted-by":"crossref","first-page":"3182","DOI":"10.1109\/TVT.2007.900397","article-title":"NLOS mitigation using linear programming in ultrawideband location-aware networks","volume":"56","author":"Venkatesh","year":"2007","journal-title":"IEEE Trans. Veh. Technol."},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"820","DOI":"10.1109\/TVT.2020.3045767","article-title":"Lidar\/UWB fusion based SLAM with anti-degeneration capability","volume":"70","author":"Zhou","year":"2020","journal-title":"IEEE Trans. Veh. Technol."},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"1321","DOI":"10.1109\/TMECH.2021.3087957","article-title":"Cost-effective mapping of mobile robot based on the fusion of uwb and short-range 2-d lidar","volume":"27","author":"Liu","year":"2021","journal-title":"IEEE-ASME Trans. Mech."},{"key":"ref_36","doi-asserted-by":"crossref","first-page":"3133","DOI":"10.1109\/JIOT.2020.2965115","article-title":"Kalman-filter-based integration of IMU and UWB for high-accuracy indoor positioning and navigation","volume":"7","author":"Feng","year":"2020","journal-title":"IEEE Internet Things"},{"key":"ref_37","doi-asserted-by":"crossref","first-page":"73","DOI":"10.1016\/j.ins.2012.03.015","article-title":"Grey-prediction self-organizing fuzzy controller for robotic motion control","volume":"202","author":"Lian","year":"2012","journal-title":"Inf. Sci."},{"key":"ref_38","doi-asserted-by":"crossref","first-page":"55","DOI":"10.1007\/s10291-019-0844-0","article-title":"A state-constrained tracking approach for Kalman filter-based ultra-tightly coupled GPS\/INS integration","volume":"23","author":"Qin","year":"2019","journal-title":"GPS Solut."},{"key":"ref_39","doi-asserted-by":"crossref","first-page":"4838","DOI":"10.1109\/TITS.2020.2980307","article-title":"A novel multi-level integrated navigation system for challenging GNSS environments","volume":"22","author":"Abosekeen","year":"2020","journal-title":"IEEE Trans. Intell. Transp."},{"key":"ref_40","doi-asserted-by":"crossref","unstructured":"Li, W., Liu, G., Cui, X., and Lu, M. (2021). Feature-Aided RTK\/LiDAR\/INS Integrated Positioning System with Parallel Filters in the Ambiguity-Position-Joint Domain for Urban Environments. Remote Sens., 13.","DOI":"10.3390\/rs13102013"},{"key":"ref_41","doi-asserted-by":"crossref","unstructured":"Wen, W., Kan, Y.C., and Hsu, L.T. (2019, January 16\u201320). Performance comparison of GNSS\/INS integrations based on EKF and factor graph optimization. Proceedings of the 32nd International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2019), Miami, FL, USA.","DOI":"10.33012\/2019.17129"},{"key":"ref_42","doi-asserted-by":"crossref","first-page":"316","DOI":"10.1016\/j.isprsjprs.2020.05.012","article-title":"SLAM integrated mobile mapping system in complex urban environments","volume":"166","author":"Li","year":"2020","journal-title":"ISPRS J. Photogramm. Remote Sens."},{"key":"ref_43","doi-asserted-by":"crossref","first-page":"106370","DOI":"10.1016\/j.ast.2020.106370","article-title":"Tightly coupled integrated navigation system via factor graph for UAV indoor localization","volume":"108","author":"Song","year":"2021","journal-title":"Aerosp. Sci. Technol."},{"key":"ref_44","doi-asserted-by":"crossref","unstructured":"Barfoot, T.D. (2017). State Estimation for Robotics, Cambridge University Press.","DOI":"10.1017\/9781316671528"},{"key":"ref_45","doi-asserted-by":"crossref","first-page":"216","DOI":"10.1177\/0278364911430419","article-title":"iSAM2: Incremental smoothing and mapping using the Bayes tree","volume":"31","author":"Kaess","year":"2012","journal-title":"Int. J. Robot. Res."},{"key":"ref_46","doi-asserted-by":"crossref","first-page":"587","DOI":"10.1002\/rob.20360","article-title":"Sliding window filter with application to planetary landing","volume":"27","author":"Sibley","year":"2010","journal-title":"J. Field Robot."}],"container-title":["Remote Sensing"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/2072-4292\/14\/17\/4258\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T00:19:43Z","timestamp":1760141983000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/2072-4292\/14\/17\/4258"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2022,8,29]]},"references-count":46,"journal-issue":{"issue":"17","published-online":{"date-parts":[[2022,9]]}},"alternative-id":["rs14174258"],"URL":"https:\/\/doi.org\/10.3390\/rs14174258","relation":{},"ISSN":["2072-4292"],"issn-type":[{"value":"2072-4292","type":"electronic"}],"subject":[],"published":{"date-parts":[[2022,8,29]]}}}