{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,4,6]],"date-time":"2026-04-06T04:56:23Z","timestamp":1775451383650,"version":"3.50.1"},"reference-count":39,"publisher":"MDPI AG","issue":"1","license":[{"start":{"date-parts":[[2019,12,31]],"date-time":"2019-12-31T00:00:00Z","timestamp":1577750400000},"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":["51309058"],"award-info":[{"award-number":["51309058"]}],"id":[{"id":"10.13039\/501100001809","id-type":"DOI","asserted-by":"publisher"}]},{"DOI":"10.13039\/501100005046","name":"Natural Science Foundation of Heilongjiang Province","doi-asserted-by":"publisher","award":["E2017015"],"award-info":[{"award-number":["E2017015"]}],"id":[{"id":"10.13039\/501100005046","id-type":"DOI","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>Localization and mapping are key requirements for autonomous mobile systems to perform navigation and interaction tasks. Iterative Closest Point (ICP) is widely applied for LiDAR scan-matching in the robotic community. In addition, the standard ICP algorithm only considers geometric information when iteratively searching for the nearest point. However, ICP individually cannot achieve accurate point-cloud registration performance in challenging environments such as dynamic environments and highways. Moreover, the computation of searching for the closest points is an expensive step in the ICP algorithm, which is limited to meet real-time requirements, especially when dealing with large-scale point-cloud data. In this paper, we propose a segment-based scan-matching framework for six degree-of-freedom pose estimation and mapping. The LiDAR generates a large number of ground points when scanning, but many of these points are useless and increase the burden of subsequent processing. To address this problem, we first apply an image-based ground-point extraction method to filter out noise and ground points. The point cloud after removing the ground points is then segmented into disjoint sets. After this step, a standard point-to-point ICP is applied into to calculate the six degree-of-freedom transformation between consecutive scans. Furthermore, once closed loops are detected in the environment, a 6D graph-optimization algorithm for global relaxation (6D simultaneous localization and mapping (SLAM)) is employed. Experiments based on publicly available KITTI datasets show that our method requires less runtime while at the same time achieves higher pose estimation accuracy compared with the standard ICP method and its variants.<\/jats:p>","DOI":"10.3390\/s20010237","type":"journal-article","created":{"date-parts":[[2019,12,31]],"date-time":"2019-12-31T07:40:55Z","timestamp":1577778055000},"page":"237","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":52,"title":["Integrate Point-Cloud Segmentation with 3D LiDAR Scan-Matching for Mobile Robot Localization and Mapping"],"prefix":"10.3390","volume":"20","author":[{"given":"Xuyou","family":"Li","sequence":"first","affiliation":[{"name":"College of Automation, Harbin Engineering University, Harbin 150001, China"}]},{"given":"Shitong","family":"Du","sequence":"additional","affiliation":[{"name":"College of Automation, Harbin Engineering University, Harbin 150001, China"}]},{"given":"Guangchun","family":"Li","sequence":"additional","affiliation":[{"name":"College of Automation, Harbin Engineering University, Harbin 150001, China"}]},{"given":"Haoyu","family":"Li","sequence":"additional","affiliation":[{"name":"College of Automation, Harbin Engineering University, Harbin 150001, China"}]}],"member":"1968","published-online":{"date-parts":[[2019,12,31]]},"reference":[{"key":"ref_1","first-page":"23","article-title":"Autonomous aerial navigation using monocular visual inertial fusion","volume":"35","author":"Lin","year":"2018","journal-title":"IEEE Intell. Transp. Syst. Mag."},{"key":"ref_2","doi-asserted-by":"crossref","unstructured":"Pinies, P., Lupton, T., Sukkarieh, S., and Tardos, J.D. (2007, January 10\u201314). Inertial aiding of inverse depth SLAM using a monocular camera. Proceedings of the IEEE International Conference on Robotics and Automation, Roma, Italy.","DOI":"10.1109\/ROBOT.2007.363895"},{"key":"ref_3","doi-asserted-by":"crossref","unstructured":"Tong, C.H., and Barfoot, T.D. (2013, January 6\u201310). Gaussian process gaussnewton for 3d laser-based visual odometry. Proceedings of the IEEE International Conference on Robotics and Automation, Karlsruhe, Germany.","DOI":"10.1109\/ICRA.2013.6631321"},{"key":"ref_4","doi-asserted-by":"crossref","first-page":"487","DOI":"10.1007\/978-3-319-28872-7_28","article-title":"Into darkness: Visual navigation based on a lidar-intensity-image pipeline","volume":"114","author":"Barfoot","year":"2016","journal-title":"Robot. Res."},{"key":"ref_5","doi-asserted-by":"crossref","first-page":"2241","DOI":"10.1109\/TPAMI.2015.2513405","article-title":"Go-ICP: A Globally Optimal Solution to 3D ICP Point-Set Registration","volume":"38","author":"Yang","year":"2016","journal-title":"IEEE Trans. Pattern Anal. Mach. Intell."},{"key":"ref_6","doi-asserted-by":"crossref","unstructured":"Ren, Z., Wang, L., and Bi, L. (2019). Robust GICP-Based 3D LiDAR SLAM for Underground Mining Environment. Sensors, 19.","DOI":"10.3390\/s19132915"},{"key":"ref_7","doi-asserted-by":"crossref","first-page":"239","DOI":"10.1109\/34.121791","article-title":"A Method for Registration of 3D Shapes","volume":"14","author":"Besl","year":"1992","journal-title":"IEEE Trans. Pattern Anal. Mach. Intell."},{"key":"ref_8","doi-asserted-by":"crossref","unstructured":"Segal, A., Haehnel, D., and Thrun, S. (2009, January 25\u201328). Generalized-ICP. Proceedings of the Robotics: Science and Systems, Zurich, Switzerland.","DOI":"10.15607\/RSS.2009.V.021"},{"key":"ref_9","doi-asserted-by":"crossref","unstructured":"Zhou, Q.Y., Park, J., and Koltun, V. (2016, January 11\u201314). Fast global registration. Proceedings of the European Conference on Computer Vision, Amsterdam, The Netherlands.","DOI":"10.1007\/978-3-319-46475-6_47"},{"key":"ref_10","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, Cambridge, CA, USA.","DOI":"10.15607\/RSS.2014.X.007"},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"2942","DOI":"10.1109\/LRA.2018.2848308","article-title":"Integrating Deep Semantic Segmentation into 3D Point Cloud Registration","volume":"3","author":"Zaganidis","year":"2018","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_12","doi-asserted-by":"crossref","unstructured":"Stoyanov, T., Magnusson, M., and Lilienthal, A.J. (2012, January 14\u201318). Point Set Registration through Minimization of the L2 Distance between 3D-NDT Models. Proceedings of the 2012 IEEE International Conference on Robotics and Automation, Saint Paul, MN, USA.","DOI":"10.1109\/ICRA.2012.6224717"},{"key":"ref_13","doi-asserted-by":"crossref","unstructured":"Liu, H., Ye, Q., Wang, H., Chen, L., and Yang, J. (2019). A Precise and Robust Segmentation-Based Lidar Localization System for Automated Urban Driving. Remote Sens., 11.","DOI":"10.3390\/rs11111348"},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1155\/2017\/4241651","article-title":"PCA-Based Line Detection from Range Data for Mapping and Localization-Aiding of UAVs","volume":"38","author":"Opromolla","year":"2017","journal-title":"Int. J. Aerosp. Eng."},{"key":"ref_15","doi-asserted-by":"crossref","first-page":"99","DOI":"10.1109\/MRA.2006.1678144","article-title":"Simultaneous Localization and Mapping (SLAM): Part I the essential algorithms","volume":"13","author":"Bailey","year":"2006","journal-title":"IEEE Robot. Autom. Mag."},{"key":"ref_16","doi-asserted-by":"crossref","first-page":"31","DOI":"10.1109\/MITS.2010.939925","article-title":"A Tutorial on GraphBased SLAM","volume":"4","author":"Grisetti","year":"2010","journal-title":"IEEE Intell. Transp. Syst. Mag."},{"key":"ref_17","doi-asserted-by":"crossref","unstructured":"Rusu, R., and Cousins, S. (2011, January 9\u201313). 3D is here: Point Cloud Library (PCL). Proceedings of the 2011 IEEE International Conference on Robotics and Automation, Shanghai, China.","DOI":"10.1109\/ICRA.2011.5980567"},{"key":"ref_18","doi-asserted-by":"crossref","unstructured":"Na, K., Byun, J., Roh, M., and Seo, B. (2013, January 2\u20136). The ground segmentation of 3D LIDAR point cloud with the optimized region merging. Proceedings of the 2017 IEEE\/RSJ International Conference on Intelligent Robots and Systems, Las Vegas, NV, USA.","DOI":"10.1109\/ICCVE.2013.6799834"},{"key":"ref_19","unstructured":"Luo, Z., Mohrenschildt, M., and Habibi, S. (2019). A Probability Occupancy Grid Based Approach for Real-Time LiDAR Ground Segmentation. IEEE Trans. Intell. Transp. Syst., 1\u201313."},{"key":"ref_20","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_21","doi-asserted-by":"crossref","unstructured":"Pomares, A., Mart\u00ednez, J., Mandow, A., Martinez, M., Moran, M., and Morales, J. (2018, January 19\u201322). Ground Extraction from 3D Lidar Point Clouds with the Classification Learner App. Proceedings of the 26th Mediterranean Conference on Control and Automation (MED), Zadar, Croatia.","DOI":"10.1109\/MED.2018.8442569"},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"177","DOI":"10.5194\/isprs-annals-III-3-177-2016","article-title":"Fast Semantic Segmentation of 3d Point Clouds with Strongly Varying Density","volume":"3","author":"Hackel","year":"2016","journal-title":"ISPRS Ann. Photogramm. Remote Sens. Spat. Inf. Sci."},{"key":"ref_23","doi-asserted-by":"crossref","unstructured":"Velas, M., Spanel, M., Hradis, M., and Herout, A. (2018, January 25\u201327). CNN for Very Fast Ground Segmentation in Velodyne Lidar Data. Proceedings of the 2018 IEEE International Conference on Autonomous Robot Systems and Competitions (ICARSC), Torres Vedras, Portugal.","DOI":"10.1109\/ICARSC.2018.8374167"},{"key":"ref_24","unstructured":"Qi, C.R., Su, H., Mo, K., and Guibas, L.J. (2017, January 21\u201326). PointNet: Deep Learning on Point Sets for 3D Classification and Segmentation. Proceedings of the IEEE Conference on Computer Vision and Pattern Recognition, Honolulu, HI, USA."},{"key":"ref_25","doi-asserted-by":"crossref","unstructured":"Huhle, B., Magnusson, M., Strasser, W., and Lilienthal, A.J. (2008, January 19\u201323). Registration of colored 3D point clouds with a Kernel-based extension to the normal distributions transform. Proceedings of the 2008 IEEE International Conference on Robotics and Automation, Pasadena, CA, USA.","DOI":"10.1109\/ROBOT.2008.4543829"},{"key":"ref_26","unstructured":"N\u00fcchter, A., Wulf, O., Lingemann, K., Hertzberg, J., Wagner, B., and Surmann, H. (2005). 3D mapping with semantic knowledge. Robot Soccer World Cup, Springer."},{"key":"ref_27","doi-asserted-by":"crossref","unstructured":"Zaganidis, A., Magnusson, M., Duckett, T., and Cielniak, G. (2017, January 24\u201328). Semantic-assisted 3d normal distributions transform for scan registration in environments with limited structure. Proceedings of the 2017 IEEE\/RSJ International Conference on Intelligent Robots and Systems, Vancouver, BC, Canada.","DOI":"10.1109\/IROS.2017.8206262"},{"key":"ref_28","doi-asserted-by":"crossref","first-page":"1094","DOI":"10.1109\/TRO.2008.2004636","article-title":"Large-Scale SLAM Building Conditionally Independent Local Maps: Application to Monocular Vision","volume":"24","year":"2008","journal-title":"IEEE Trans. Robot."},{"key":"ref_29","doi-asserted-by":"crossref","first-page":"34","DOI":"10.1109\/TRO.2006.889486","article-title":"Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters","volume":"23","author":"Grisetti","year":"2007","journal-title":"IEEE Trans. Robot."},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"2236","DOI":"10.1109\/TMECH.2015.2506041","article-title":"Sensor fusion for robotic workspace state estimation","volume":"21","author":"Olofsson","year":"2016","journal-title":"IEEE\/ASME Trans. Mechatronics"},{"key":"ref_31","doi-asserted-by":"crossref","first-page":"1447","DOI":"10.1109\/TMECH.2014.2298247","article-title":"A Simple and Parallel Algorithm for Real-Time Robot Localization by Fusing Monocular Vision and Odometry\/AHRS Sensors","volume":"19","author":"Wang","year":"2014","journal-title":"IEEE\/ASME Trans. Mechatronics"},{"key":"ref_32","doi-asserted-by":"crossref","first-page":"130","DOI":"10.1016\/j.robot.2007.07.002","article-title":"Globally consistent 3D mapping with scan matching","volume":"56","author":"Borrmann","year":"2008","journal-title":"Robot. Auton. Syst."},{"key":"ref_33","doi-asserted-by":"crossref","first-page":"76","DOI":"10.1016\/j.isprsjprs.2012.10.004","article-title":"One billion points in the cloud\u2014An octree for efficient processing of 3D laser scans","volume":"76","author":"Elseberg","year":"2013","journal-title":"Int. J. Photogramm. Remote. Sens."},{"key":"ref_34","doi-asserted-by":"crossref","unstructured":"Bogoslavskyi, I., and Stachniss, C. (2016, January 9\u201314). Fast range image-based segmentation of sparse 3D laser scans for online operation. Proceedings of the 2016 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Daejeon, Korea.","DOI":"10.1109\/IROS.2016.7759050"},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"1627","DOI":"10.1021\/ac60214a047","article-title":"Smoothing and Differentiation of Data by Simplified Least Squares Procedures","volume":"36","author":"Savitzky","year":"1964","journal-title":"Anal. Chem."},{"key":"ref_36","unstructured":"N\u00fcchter, A., and Lingemann, K. (2019, December 31). 6D SLAM Software. Available online: http:\/\/slam6d.sourceforge.net\/."},{"key":"ref_37","doi-asserted-by":"crossref","unstructured":"Geiger, A., Lenz, P., and Urtasum, R. (2012, January 16\u201321). Are we ready for autonomous driving? the kitti vision benchmark suite. Proceedings of the IEEE Conference on Computer Vision and Pattern Recognition (CVPR), Providence, RI, USA.","DOI":"10.1109\/CVPR.2012.6248074"},{"key":"ref_38","doi-asserted-by":"crossref","first-page":"934","DOI":"10.1002\/rob.20321","article-title":"Three dimensional mapping with time of flight cameras","volume":"26","author":"May","year":"2009","journal-title":"J. Field Robot."},{"key":"ref_39","first-page":"578","article-title":"SOFT-SLAM: Computationally Efficient Stereo Visual SLAM for Autonomous UAVs","volume":"35","year":"2017","journal-title":"J. Field Robot."}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/20\/1\/237\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T13:47:11Z","timestamp":1760190431000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/20\/1\/237"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2019,12,31]]},"references-count":39,"journal-issue":{"issue":"1","published-online":{"date-parts":[[2020,1]]}},"alternative-id":["s20010237"],"URL":"https:\/\/doi.org\/10.3390\/s20010237","relation":{},"ISSN":["1424-8220"],"issn-type":[{"value":"1424-8220","type":"electronic"}],"subject":[],"published":{"date-parts":[[2019,12,31]]}}}