{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2025,12,18]],"date-time":"2025-12-18T14:09:59Z","timestamp":1766066999361,"version":"build-2065373602"},"reference-count":30,"publisher":"MDPI AG","issue":"9","license":[{"start":{"date-parts":[[2019,5,8]],"date-time":"2019-05-08T00:00:00Z","timestamp":1557273600000},"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":["No.2018YFF01013101"],"award-info":[{"award-number":["No.2018YFF01013101"]}],"id":[{"id":"10.13039\/501100001809","id-type":"DOI","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>Iterative closest point (ICP) is a method commonly used to perform scan-matching and registration. To be a simple and robust algorithm, it is still computationally expensive, and it has been regarded as having a crucial challenge especially in a real-time application as used for the simultaneous localization and mapping (SLAM) problem. For these reasons, this paper presents a new method for the acceleration of ICP with an assisted intensity. Unlike the conventional ICP, this method is proposed to reduce the computational cost and avoid divergences. An initial transformation guess is computed with an assisted intensity for their relative rigid-body transformation. Moreover, a target function is proposed to determine the best initial transformation guess based on the statistic of their spatial distances and intensity residuals. Additionally, this method is also proposed to reduce the iteration number. The Anderson acceleration is utilized for increasing the iteration speed which has better ability than the Picard iteration procedure. The proposed algorithm is operated in real time with a single core central processing unit (CPU) thread. Hence, it is suitable for the robot which has limited computation resources. To validate the novelty, this proposed method is evaluated on the SEMANTIC3D.NET benchmark dataset. According to comparative results, the proposed method is declared as having better accuracy and robustness than the conventional ICP methods.<\/jats:p>","DOI":"10.3390\/s19092124","type":"journal-article","created":{"date-parts":[[2019,5,9]],"date-time":"2019-05-09T11:22:35Z","timestamp":1557400955000},"page":"2124","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":17,"title":["Intensity-Assisted ICP for Fast Registration of 2D-LIDAR"],"prefix":"10.3390","volume":"19","author":[{"ORCID":"https:\/\/orcid.org\/0000-0003-2494-8667","authenticated-orcid":false,"given":"Yingzhong","family":"Tian","sequence":"first","affiliation":[{"name":"School of Mechatronic Engineering and Automation, Shanghai University, Shanghai 200072, China"},{"name":"Shanghai Key Laboratory of Intelligent Manufacturing and Robotics, Shanghai University, Shanghai 200072, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Xining","family":"Liu","sequence":"additional","affiliation":[{"name":"School of Mechatronic Engineering and Automation, Shanghai University, Shanghai 200072, China"},{"name":"Shanghai Key Laboratory of Intelligent Manufacturing and Robotics, Shanghai University, Shanghai 200072, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"ORCID":"https:\/\/orcid.org\/0000-0003-1973-8550","authenticated-orcid":false,"given":"Long","family":"Li","sequence":"additional","affiliation":[{"name":"School of Mechatronic Engineering and Automation, Shanghai University, Shanghai 200072, China"},{"name":"Shanghai Key Laboratory of Intelligent Manufacturing and Robotics, Shanghai University, Shanghai 200072, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Wenbin","family":"Wang","sequence":"additional","affiliation":[{"name":"School of Mechanical and Electrical, Shenzhen Polytechnic, Shenzhen 518055, China"}],"role":[{"role":"author","vocabulary":"crossref"}]}],"member":"1968","published-online":{"date-parts":[[2019,5,8]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"1309","DOI":"10.1109\/TRO.2016.2624754","article-title":"Past, present, and future of simultaneous localization and mapping: toward the robust-perception age","volume":"32","author":"Cadena","year":"2016","journal-title":"IEEE Trans. Robot."},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"239","DOI":"10.1109\/34.121791","article-title":"A method for registration of 3-D shapes","volume":"14","author":"Besl","year":"1992","journal-title":"IEEE Trans. Pattern Anal. Mach. Intell."},{"key":"ref_3","doi-asserted-by":"crossref","first-page":"11805","DOI":"10.3390\/s140711805","article-title":"NAVIS\u2014An UGV indoor positioning system using laser scan matching for large-area real-time applications","volume":"14","author":"Tang","year":"2014","journal-title":"Sensors"},{"key":"ref_4","doi-asserted-by":"crossref","unstructured":"Im, J.H., Im, S.H., and Jee, G.I. (2016). Vertical Corner Feature Based Precise Vehicle Localization Using 3D LIDAR in Urban Area. Sensors, 16.","DOI":"10.3390\/s16081268"},{"key":"ref_5","doi-asserted-by":"crossref","first-page":"129","DOI":"10.1002\/rob.21441","article-title":"Real time egomotion of a nonholonomic vehicle using LIDAR measurements","volume":"30","author":"Almeida","year":"2012","journal-title":"J. Field Robot."},{"key":"ref_6","doi-asserted-by":"crossref","unstructured":"Kuramachi, R., Ohsato, A., Sasaki, Y., and Mizoguchi, H. (2015, January 6\u20139). G-ICP SLAM: An odometry-free 3D mapping system with robust 6DoF pose estimation. Proceedings of the IEEE International Conference on Robotics & Biomimetics, Zhuhai, China.","DOI":"10.1109\/ROBIO.2015.7418763"},{"key":"ref_7","doi-asserted-by":"crossref","unstructured":"Yang, Y., Yang, G., Zheng, T., Tian, Y., and Li, L. (2017, January 19\u201321). Feature extraction method based on 2.5-dimensions lidar platform for indoor mobile robots localization. Proceedings of the 2017 IEEE International Conference on Cybernetics and Intelligent Systems (CIS) and IEEE Conference on Robotics, Automation and Mechatronics (RAM), Ningbo, China.","DOI":"10.1109\/ICCIS.2017.8274870"},{"key":"ref_8","doi-asserted-by":"crossref","unstructured":"Yang, Y., Yang, G., Tian, Y., Zheng, T., Li, L., and Wang, Z. (June, January 31). A robust and accurate SLAM algorithm for omni-directional mobile robots based on a novel 2.5D lidar device. Proceedings of the 2018 13th IEEE Conference on Industrial Electronics and Applications (ICIEA), Wuhan, China.","DOI":"10.1109\/ICIEA.2018.8398060"},{"key":"ref_9","doi-asserted-by":"crossref","unstructured":"Witt, J., and Weltin, U. (2013, January 3\u20137). Robust Stereo Visual Odometry Using Iterative Closest Multiple Lines. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots & Systems, Tokyo, Japan.","DOI":"10.1109\/IROS.2013.6696953"},{"key":"ref_10","doi-asserted-by":"crossref","unstructured":"Zhao, S., and Fang, Z. (2018). Direct Depth SLAM: Sparse Geometric Feature Enhanced Direct Depth SLAM System for Low-Texture Environments. Sensors, 18.","DOI":"10.3390\/s18103339"},{"key":"ref_11","doi-asserted-by":"crossref","unstructured":"Yang, J., Li, H., and Jia, Y. (2013, January 3\u20136). Go-ICP: Solving 3D Registration Efficiently and Globally Optimally. Proceedings of the IEEE International Conference on Computer Vision, Sydney, Australia.","DOI":"10.1109\/ICCV.2013.184"},{"key":"ref_12","doi-asserted-by":"crossref","unstructured":"Censi, A. (2008, January 19\u201323). An ICP variant using a point-to-line metric. Proceedings of the IEEE International Conference on Robotics & Automation, Pasadena, CA, USA.","DOI":"10.1109\/ROBOT.2008.4543181"},{"key":"ref_13","doi-asserted-by":"crossref","unstructured":"Burlacu, A., Cohal, A., Caraiman, S., and Condurache, D. (2016, January 13\u201315). Iterative closest point problem: A tensorial approach to finding the initial guess. Proceedings of the International Conference on System Theory, Sinaia, Romania.","DOI":"10.1109\/ICSTCC.2016.7790716"},{"key":"ref_14","doi-asserted-by":"crossref","unstructured":"Attia, M., Slama, Y., Attia, M., Slama, Y., Attia, M., and Slama, Y. (2017, January 17\u201321). Efficient Initial Guess Determination Based on 3D Point Cloud Projection for ICP Algorithms. Proceedings of the International Conference on High Performance Computing & Simulation, Genoa, Italy.","DOI":"10.1109\/HPCS.2017.122"},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Men, H., Gebre, B., and Pochiraju, K. (2011, January 9\u201313). Color point cloud registration with 4D ICP algorithm. Proceedings of the IEEE International Conference on Robotics & Automation, Shanghai, China.","DOI":"10.1109\/ICRA.2011.5980407"},{"key":"ref_16","unstructured":"Serafin, J., and Grisetti, G. (October, January 28). NICP: Dense Normal Based Point Cloud Registration. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots & Systems, Hamburg, Germany."},{"key":"ref_17","unstructured":"Greenspan, M., and Yurick, M. (2003, January 6\u201310). Approximate k-d tree search for efficient ICP. Proceedings of the International Conference on 3-d Digital Imaging & Modeling, Banff, AB, Canada."},{"key":"ref_18","doi-asserted-by":"crossref","unstructured":"Granger, S., and Pennec, X. (2002, January 28\u201331). Multi-scale EM-ICP: A Fast and Robust Approach for Surface Registration. Proceedings of the European Conference on Computer Vision, Copenhagen, Denmark.","DOI":"10.1007\/3-540-47979-1_28"},{"key":"ref_19","unstructured":"Rusinkiewicz, S., and Levoy, M. (June, January 28). Efficient Variants of the ICP Algorithm. Proceedings of the International Conference on 3-d Digital Imaging & Modeling, Quebec, QC, Canada."},{"key":"ref_20","doi-asserted-by":"crossref","first-page":"120","DOI":"10.1016\/j.compbiomed.2015.12.013","article-title":"Geometry-based vs. intensity-based medical image registration: A comparative study on 3D CT data","volume":"69","author":"Savva","year":"2016","journal-title":"Comput. Biol. Med."},{"key":"ref_21","doi-asserted-by":"crossref","first-page":"992","DOI":"10.1109\/LRA.2016.2530164","article-title":"Fast Visual Odometry Using Intensity-Assisted Iterative Closest Point","volume":"1","author":"Li","year":"2016","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"226","DOI":"10.1016\/j.cviu.2007.08.004","article-title":"Registration of combined range\u2013intensity scans: Initialization through verification","volume":"110","author":"Smith","year":"2008","journal-title":"Comput. Vis. Image Underst."},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"1518","DOI":"10.1109\/LRA.2017.2673868","article-title":"Robust Vehicle Localization using Entropy-weighted Particle Filter-based Data Fusion of Vertical and Road Intensity Information for a Large Scale Urban Area","volume":"2","author":"Kim","year":"2017","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_24","doi-asserted-by":"crossref","unstructured":"Pavlov, A.L., Ovchinnikov, G.V., Derbyshev, D.Y., Tsetserukou, D., and Oseledets, I.V. (2018, January 21\u201325). AA-ICP: Iterative Closest Point with Anderson Acceleration. Proceedings of the 2018 IEEE International Conference on Robotics and Automation (ICRA), Brisbane, Australia.","DOI":"10.1109\/ICRA.2018.8461063"},{"key":"ref_25","first-page":"1715","article-title":"Anderson Acceleration for Fixed-Point Iterations","volume":"49","author":"Walker","year":"2007","journal-title":"Math. Sci. Fac. Publ."},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"1002","DOI":"10.1016\/j.laa.2012.09.008","article-title":"A characterization of the behavior of the Anderson acceleration on linear problems","volume":"438","author":"Potra","year":"2013","journal-title":"Linear Algebra Its Appl."},{"key":"ref_27","doi-asserted-by":"crossref","unstructured":"Kerl, C., Sturm, J., and Cremers, D. (2013, January 6\u201310). Robust odometry estimation for RGB-D cameras. Proceedings of the 2013 IEEE International Conference on Robotics and Automation, Karlsruhe, Germany.","DOI":"10.1109\/ICRA.2013.6631104"},{"key":"ref_28","first-page":"881","article-title":"Robust Statistical Modeling Using the t Distribution","volume":"84","author":"Lange","year":"1989","journal-title":"Publ. Am. Stat. Assoc."},{"key":"ref_29","doi-asserted-by":"crossref","unstructured":"Hackel, T., Savinov, N., Ladicky, L., Wegner, J.D., Schindler, K., and Pollefeys, M. (2017). Semantic3D.net: A new Large-scale Point Cloud Classification Benchmark. arXiv.","DOI":"10.5194\/isprs-annals-IV-1-W1-91-2017"},{"key":"ref_30","doi-asserted-by":"crossref","unstructured":"Deschaud, J.E. (2018, January 21\u201325). IMLS-SLAM: scan-to-model matching based on 3D data. Proceedings of the 2018 IEEE International Conference on Robotics and Automation (ICRA), Brisbane, Australia.","DOI":"10.1109\/ICRA.2018.8460653"}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/19\/9\/2124\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T12:50:01Z","timestamp":1760187001000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/19\/9\/2124"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2019,5,8]]},"references-count":30,"journal-issue":{"issue":"9","published-online":{"date-parts":[[2019,5]]}},"alternative-id":["s19092124"],"URL":"https:\/\/doi.org\/10.3390\/s19092124","relation":{},"ISSN":["1424-8220"],"issn-type":[{"type":"electronic","value":"1424-8220"}],"subject":[],"published":{"date-parts":[[2019,5,8]]}}}