{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2025,12,24]],"date-time":"2025-12-24T12:43:42Z","timestamp":1766580222649,"version":"build-2065373602"},"reference-count":38,"publisher":"MDPI AG","issue":"18","license":[{"start":{"date-parts":[[2022,9,15]],"date-time":"2022-09-15T00:00:00Z","timestamp":1663200000000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"name":"PRE2018-085026","award":["P20_01302","PID2020-117057GB-I00"],"award-info":[{"award-number":["P20_01302","PID2020-117057GB-I00"]}]},{"name":"HOUNDBOT","award":["P20_01302","PID2020-117057GB-I00"],"award-info":[{"award-number":["P20_01302","PID2020-117057GB-I00"]}]},{"name":"Andalusian Regional Government","award":["P20_01302","PID2020-117057GB-I00"],"award-info":[{"award-number":["P20_01302","PID2020-117057GB-I00"]}]},{"name":"ARPEGGIO","award":["P20_01302","PID2020-117057GB-I00"],"award-info":[{"award-number":["P20_01302","PID2020-117057GB-I00"]}]},{"name":"Spain National Research Agency","award":["P20_01302","PID2020-117057GB-I00"],"award-info":[{"award-number":["P20_01302","PID2020-117057GB-I00"]}]},{"name":"University of Malaga","award":["P20_01302","PID2020-117057GB-I00"],"award-info":[{"award-number":["P20_01302","PID2020-117057GB-I00"]}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>In this paper we present a new way to compute the odometry of a 3D lidar in real-time. Due to the significant relation between these sensors and the rapidly increasing sector of autonomous vehicles, 3D lidars have improved in recent years, with modern models producing data in the form of range images. We take advantage of this ordered format to efficiently estimate the trajectory of the sensor as it moves in 3D space. The proposed method creates and leverages a flatness image in order to exploit the information found in flat surfaces of the scene. This allows for an efficient selection of planar patches from a first range image. Then, from a second image, keypoints related to said patches are extracted. This way, our proposal computes the ego-motion by imposing a coplanarity constraint between pairs &lt;point, plane&gt; whose correspondences are iteratively updated. The proposed algorithm is tested and compared with state-of-the-art ICP algorithms. Experiments show that our proposal, running on a single thread, can run 5\u00d7 faster than a multi-threaded implementation of GICP, while providing a more accurate localization. A second version of the algorithm is also presented, which reduces the drift even further while needing less than half of the computation time of GICP. Both configurations of the algorithm run at frame rates common for most 3D lidars, 10 and 20 Hz on a standard CPU.<\/jats:p>","DOI":"10.3390\/s22186976","type":"journal-article","created":{"date-parts":[[2022,9,16]],"date-time":"2022-09-16T01:35:10Z","timestamp":1663292110000},"page":"6976","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":4,"title":["Efficient 3D Lidar Odometry Based on Planar Patches"],"prefix":"10.3390","volume":"22","author":[{"ORCID":"https:\/\/orcid.org\/0000-0001-5853-0838","authenticated-orcid":false,"given":"Andres","family":"Galeote-Luque","sequence":"first","affiliation":[{"name":"Machine Perception and Intelligent Robotics Group (MAPIR-UMA), Malaga Institute for Mechatronics Engineering and Cyber-Physical Systems (IMECH.UMA), University of Malaga, 29071 Malaga, Spain"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-9929-5309","authenticated-orcid":false,"given":"Jose-Raul","family":"Ruiz-Sarmiento","sequence":"additional","affiliation":[{"name":"Machine Perception and Intelligent Robotics Group (MAPIR-UMA), Malaga Institute for Mechatronics Engineering and Cyber-Physical Systems (IMECH.UMA), University of Malaga, 29071 Malaga, Spain"}]},{"ORCID":"https:\/\/orcid.org\/0000-0003-3845-3497","authenticated-orcid":false,"given":"Javier","family":"Gonzalez-Jimenez","sequence":"additional","affiliation":[{"name":"Machine Perception and Intelligent Robotics Group (MAPIR-UMA), Malaga Institute for Mechatronics Engineering and Cyber-Physical Systems (IMECH.UMA), University of Malaga, 29071 Malaga, Spain"}]}],"member":"1968","published-online":{"date-parts":[[2022,9,15]]},"reference":[{"key":"ref_1","unstructured":"Nist\u00e9r, D., Naroditsky, O., and Bergen, J. (July, January 27). Visual odometry. Proceedings of the 2004 IEEE Computer Society Conference on Computer Vision and Pattern Recognition, Washington, DC, USA."},{"key":"ref_2","doi-asserted-by":"crossref","unstructured":"Adis, P., Horst, N., and Wien, M. (2021, January 19\u201322). D3DLO: Deep 3D LiDAR Odometry. Proceedings of the 2021 IEEE International Conference on Image Processing (ICIP), Anchorage, AK, USA.","DOI":"10.1109\/ICIP42928.2021.9506791"},{"key":"ref_3","doi-asserted-by":"crossref","unstructured":"Sun, P., Kretzschmar, H., Dotiwalla, X., Chouard, A., Patnaik, V., Tsui, P., Guo, J., Zhou, Y., Chai, Y., and Caine, B. (2020, January 13\u201319). Scalability in perception for autonomous driving: Waymo open dataset. Proceedings of the IEEE\/CVF Conference on Computer Vision and Pattern Recognition, Seattle, WA, USA.","DOI":"10.1109\/CVPR42600.2020.00252"},{"key":"ref_4","doi-asserted-by":"crossref","unstructured":"Ettinger, S., Cheng, S., Caine, B., Liu, C., Zhao, H., Pradhan, S., Chai, Y., Sapp, B., Qi, C.R., and Zhou, Y. (2021, January 11\u201317). Large scale interactive motion forecasting for autonomous driving: The waymo open motion dataset. Proceedings of the IEEE\/CVF International Conference on Computer Vision, Montreal, QC, Canada.","DOI":"10.1109\/ICCV48922.2021.00957"},{"key":"ref_5","doi-asserted-by":"crossref","unstructured":"Chang, M.F., Lambert, J., Sangkloy, P., Singh, J., Bak, S., Hartnett, A., Wang, D., Carr, P., Lucey, S., and Ramanan, D. (2019, January 15\u201320). Argoverse: 3d tracking and forecasting with rich maps. Proceedings of the IEEE\/CVF Conference on Computer Vision and Pattern Recognition, Long Beach, CA, USA.","DOI":"10.1109\/CVPR.2019.00895"},{"key":"ref_6","unstructured":"Wilson, B., Qi, W., Agarwal, T., Lambert, J., Singh, J., Khandelwal, S., Pan, B., Kumar, R., Hartnett, A., and Pontes, J.K. (2021, January 6\u201314). Argoverse 2: Next Generation Datasets for Self-Driving Perception and Forecasting. Proceedings of the Thirty-Fifth Conference on Neural Information Processing Systems Datasets and Benchmarks Track (Round 2), Virtually."},{"key":"ref_7","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_8","doi-asserted-by":"crossref","first-page":"642","DOI":"10.1177\/0278364919843996","article-title":"Complex Urban Dataset with Multi-level Sensors from Highly Diverse Urban Environments","volume":"38","author":"Jeong","year":"2019","journal-title":"Int. J. Robot. Res."},{"key":"ref_9","unstructured":"Besl, P.J., and McKay, N.D. (1992, January 12\u201315). Method for registration of 3-D shapes. Proceedings of the Sensor fusion IV: Control Paradigms and Data Structures. International Society for Optics and Photonics, Boston, MA, USA."},{"key":"ref_10","doi-asserted-by":"crossref","first-page":"145","DOI":"10.1016\/0262-8856(92)90066-C","article-title":"Object modelling by registration of multiple range images","volume":"10","author":"Chen","year":"1992","journal-title":"Image Vis. Comput."},{"key":"ref_11","unstructured":"Segal, A., Haehnel, D., and Thrun, S. (July, January 28). Generalized-ICP. Proceedings of the Robotics: Science and Systems, Seattle, WA."},{"key":"ref_12","doi-asserted-by":"crossref","first-page":"247","DOI":"10.1016\/j.robot.2016.10.016","article-title":"Multi-Channel Generalized-ICP: A robust framework for multi-channel scan registration","volume":"87","author":"Servos","year":"2017","journal-title":"Robot. Auton. Syst."},{"key":"ref_13","doi-asserted-by":"crossref","unstructured":"Jones, K.H., and Gross, J.N. (2014, January 16\u201320). Reducing size, weight, and power (SWaP) of perception systems in small autonomous aerial systems. Proceedings of the 14th AIAA Aviation Technology, Integration, and Operations Conference, Atlanta, GA, USA.","DOI":"10.2514\/6.2014-2705"},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"73","DOI":"10.1007\/s11263-012-0576-x","article-title":"A theory of minimal 3D point to 3D plane registration and its generalization","volume":"102","author":"Ramalingam","year":"2013","journal-title":"Int. J. Comput. Vis."},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Raposo, C., Louren\u00e7o, M., Antunes, M., and Barreto, J.P. (2013, January 9\u201313). Plane-based Odometry using an RGB-D Camera. Proceedings of the BMVC. Citeseer, Bristol, UK.","DOI":"10.5244\/C.27.114"},{"key":"ref_16","doi-asserted-by":"crossref","unstructured":"Chen, B., Liu, C., Tong, Y., and Wu, Q. (August, January 31). Robust RGB-D Visual Odometry Based on Planar Features. Proceedings of the 2017 IEEE 7th Annual International Conference on CYBER Technology in Automation, Control, and Intelligent Systems (CYBER), Honolulu, HI, USA.","DOI":"10.1109\/CYBER.2017.8446592"},{"key":"ref_17","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_18","doi-asserted-by":"crossref","first-page":"809","DOI":"10.1109\/TRO.2015.2428512","article-title":"Fast visual odometry for 3-D range sensors","volume":"31","author":"Jaimez","year":"2015","journal-title":"IEEE Trans. Robot."},{"key":"ref_19","doi-asserted-by":"crossref","unstructured":"Moosmann, F., and Stiller, C. (2011, January 5\u20139). Velodyne SLAM. Proceedings of the IEEE Intelligent Vehicles Symposium, Baden-Baden, Germany.","DOI":"10.1109\/IVS.2011.5940396"},{"key":"ref_20","doi-asserted-by":"crossref","unstructured":"Prakhya, S.M., Bingbing, L., Weisi, L., and Qayyum, U. (2015, January 26\u201330). Sparse depth odometry: 3D keypoint based pose estimation from dense depth data. Proceedings of the 2015 IEEE International Conference on Robotics and Automation (ICRA), Seattle, WA, USA.","DOI":"10.1109\/ICRA.2015.7139780"},{"key":"ref_21","doi-asserted-by":"crossref","unstructured":"Lu, Y., and Song, D. (2015, January 7\u201313). Robust RGB-D odometry using point and line features. Proceedings of the IEEE International Conference on Computer Vision, Santiago, Chile.","DOI":"10.1109\/ICCV.2015.448"},{"key":"ref_22","doi-asserted-by":"crossref","unstructured":"Steinbr\u00fccker, F., Sturm, J., and Cremers, D. (2011, January 6\u201313). Real-time visual odometry from dense RGB-D images. Proceedings of the 2011 IEEE International Conference on Computer Vision Workshops (ICCV Workshops), Barcelona, Spain.","DOI":"10.1109\/ICCVW.2011.6130321"},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"803","DOI":"10.1002\/rob.20204","article-title":"Scan registration for autonomous mining vehicles using 3D-NDT","volume":"24","author":"Magnusson","year":"2007","journal-title":"J. Field Robot."},{"key":"ref_24","unstructured":"Biber, P., and Stra\u00dfer, W. (2003, January 27\u201331). The normal distributions transform: A new approach to laser scan matching. Proceedings of the 2003 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No. 03CH37453), Las Vegas, NV, USA."},{"key":"ref_25","doi-asserted-by":"crossref","unstructured":"Velas, M., Spanel, M., and Herout, A. (2016, January 16\u201321). Collar line segments for fast odometry estimation from velodyne point clouds. Proceedings of the 2016 IEEE International Conference on Robotics and Automation (ICRA), Stockholm, Sweden.","DOI":"10.1109\/ICRA.2016.7487648"},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"1390","DOI":"10.1109\/JSYST.2020.2995727","article-title":"A novel sparse geometric 3-d lidar odometry approach","volume":"15","author":"Liang","year":"2020","journal-title":"IEEE Syst. J."},{"key":"ref_27","doi-asserted-by":"crossref","unstructured":"Shan, T., Englot, B., Meyers, D., Wang, W., Ratti, C., and Rus, D. (2020, January 25\u201329). 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), Las Vegas, NV, USA.","DOI":"10.1109\/IROS45743.2020.9341176"},{"key":"ref_28","doi-asserted-by":"crossref","unstructured":"Zhang, J., and Singh, S. (2015, January 26\u201330). Visual-lidar odometry and mapping: Low-drift, robust, and fast. Proceedings of the 2015 IEEE International Conference on Robotics and Automation (ICRA), Seattle, WA, USA.","DOI":"10.1109\/ICRA.2015.7139486"},{"key":"ref_29","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 2015 IEEE International Conference on Robotics and Biomimetics (ROBIO), Zhuhai, China.","DOI":"10.1109\/ROBIO.2015.7418763"},{"key":"ref_30","doi-asserted-by":"crossref","unstructured":"Agrawal, P., Iqbal, A., Russell, B., Hazrati, M.K., Kashyap, V., and Akhbari, F. (2017, January 11\u201314). PCE-SLAM: A real-time simultaneous localization and mapping using LiDAR data. Proceedings of the 2017 IEEE Intelligent Vehicles Symposium (IV), Los Angeles, CA, USA.","DOI":"10.1109\/IVS.2017.7995960"},{"key":"ref_31","doi-asserted-by":"crossref","unstructured":"Behley, J., and Stachniss, C. (2018, January 26\u201330). Efficient Surfel-Based SLAM using 3D Laser Range Data in Urban Environments. Proceedings of the Robotics: Science and Systems, Pittsburgh, PA, USA.","DOI":"10.15607\/RSS.2018.XIV.016"},{"key":"ref_32","unstructured":"Flynn, P.J., and Jain, A.K. (1989, January 4\u20138). On reliable curvature estimation. Proceedings of the CVPR, San Diego, CA, USA."},{"key":"ref_33","unstructured":"Agarwal, S., Mierle, K., and The Ceres Solver Team (2022, July 23). Ceres Solver. Available online: http:\/\/ceres-solver.org."},{"key":"ref_34","doi-asserted-by":"crossref","unstructured":"Sturm, J., Engelhard, N., Endres, F., Burgard, W., and Cremers, D. (2012, January 7\u201312). A benchmark for the evaluation of RGB-D SLAM systems. Proceedings of the 2012 IEEE\/RSJ International Conference on Intelligent Robots and Systems, Vilamoura-Algarve, Portugal.","DOI":"10.1109\/IROS.2012.6385773"},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"79","DOI":"10.3354\/cr030079","article-title":"Advantages of the mean absolute error (MAE) over the root mean square error (RMSE) in assessing average model performance","volume":"30","author":"Willmott","year":"2005","journal-title":"Clim. Res."},{"key":"ref_36","doi-asserted-by":"crossref","unstructured":"Rusu, R.B., and Cousins, S. (2011, January 9\u201313). 3D is here: Point Cloud Library (PCL). Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Shanghai, China.","DOI":"10.1109\/ICRA.2011.5980567"},{"key":"ref_37","unstructured":"Zhou, Q.Y., Park, J., and Koltun, V. (2018). Open3D: A Modern Library for 3D Data Processing. arXiv."},{"key":"ref_38","doi-asserted-by":"crossref","first-page":"619","DOI":"10.1016\/0042-6989(89)90047-3","article-title":"Occlusion and the solution to the aperture problem for motion","volume":"29","author":"Shimojo","year":"1989","journal-title":"Vis. Res."}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/22\/18\/6976\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T00:31:51Z","timestamp":1760142711000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/22\/18\/6976"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2022,9,15]]},"references-count":38,"journal-issue":{"issue":"18","published-online":{"date-parts":[[2022,9]]}},"alternative-id":["s22186976"],"URL":"https:\/\/doi.org\/10.3390\/s22186976","relation":{},"ISSN":["1424-8220"],"issn-type":[{"type":"electronic","value":"1424-8220"}],"subject":[],"published":{"date-parts":[[2022,9,15]]}}}