{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2025,12,19]],"date-time":"2025-12-19T09:57:22Z","timestamp":1766138242666,"version":"build-2065373602"},"reference-count":57,"publisher":"MDPI AG","issue":"6","license":[{"start":{"date-parts":[[2023,3,13]],"date-time":"2023-03-13T00:00:00Z","timestamp":1678665600000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>The task of tracking the pose of an object with a known geometry from point cloud measurements arises in robot perception. It calls for a solution that is both accurate and robust, and can be computed at a rate that aligns with the needs of a control system that might make decisions based on it. The Iterative Closest Point (ICP) algorithm is widely used for this purpose, but it is susceptible to failure in practical scenarios. We present a robust and efficient solution for pose-from-point cloud estimation called the Pose Lookup Method (PLuM). PLuM is a probabilistic reward-based objective function that is resilient to measurement uncertainty and clutter. Efficiency is achieved through the use of lookup tables, which substitute complex geometric operations such as raycasting used in earlier solutions. Our results show millimetre accuracy and fast pose estimation in benchmark tests using triangulated geometry models, outperforming state-of-the-art ICP-based methods. These results are extended to field robotics applications, resulting in real-time haul truck pose estimation. By utilising point clouds from a LiDAR fixed to a rope shovel, the PLuM algorithm tracks a haul truck effectively throughout the excavation load cycle at a rate of 20 Hz, matching the sensor frame rate. PLuM is straightforward to implement and provides dependable and timely solutions in demanding environments.<\/jats:p>","DOI":"10.3390\/s23063085","type":"journal-article","created":{"date-parts":[[2023,3,14]],"date-time":"2023-03-14T03:04:46Z","timestamp":1678763086000},"page":"3085","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":7,"title":["Real-Time 6-DOF Pose Estimation of Known Geometries in Point Cloud Data"],"prefix":"10.3390","volume":"23","author":[{"ORCID":"https:\/\/orcid.org\/0000-0003-2306-9740","authenticated-orcid":false,"given":"Vedant","family":"Bhandari","sequence":"first","affiliation":[{"name":"School of Mechanical and Mining Engineering, The University of Queensland, Brisbane, QLD 4072, Australia"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"ORCID":"https:\/\/orcid.org\/0000-0001-8729-0693","authenticated-orcid":false,"given":"Tyson Govan","family":"Phillips","sequence":"additional","affiliation":[{"name":"School of Mechanical and Mining Engineering, The University of Queensland, Brisbane, QLD 4072, Australia"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"ORCID":"https:\/\/orcid.org\/0000-0001-9259-0615","authenticated-orcid":false,"given":"Peter Ross","family":"McAree","sequence":"additional","affiliation":[{"name":"School of Mechanical and Mining Engineering, The University of Queensland, Brisbane, QLD 4072, Australia"}],"role":[{"role":"author","vocabulary":"crossref"}]}],"member":"1968","published-online":{"date-parts":[[2023,3,13]]},"reference":[{"key":"ref_1","unstructured":"Phillips, T. (2016). Determining and Verifying Object Pose from LiDAR Measurements to Support the Perception Needs of an Autonomous Excavator. [Ph.D. Thesis, The University of Queensland]."},{"key":"ref_2","doi-asserted-by":"crossref","unstructured":"Phillips, T., D\u2019adamo, T., and McAree, P. (2021). Maximum Sum of Evidence\u2014An Evidence-Based Solution to Object Pose Estimation in Point Cloud Data. Sensors, 21.","DOI":"10.3390\/s21196473"},{"key":"ref_3","doi-asserted-by":"crossref","first-page":"985","DOI":"10.1002\/rob.21701","article-title":"When the Dust Settles","volume":"34","author":"Phillips","year":"2017","journal-title":"J. Field Robot."},{"key":"ref_4","unstructured":"Bergelt, R., Khan, O., and Hardt, W. (November, January 29). Improving the intrinsic calibration of a Velodyne LiDAR sensor. Proceedings of the IEEE Sensors, Glasgow, UK."},{"key":"ref_5","unstructured":"Mirzaei, F.M. (2013). Extrinsic and Intrinsic Sensor Calibration. [Ph.D. Thesis, University of Minnesota]."},{"key":"ref_6","doi-asserted-by":"crossref","first-page":"675","DOI":"10.1177\/0278364911429475","article-title":"Self-calibration for a 3D laser","volume":"31","author":"Sheehan","year":"2012","journal-title":"Int. J. Robot. Res."},{"key":"ref_7","doi-asserted-by":"crossref","first-page":"1182","DOI":"10.1002\/rob.21811","article-title":"Registration of three-dimensional scanning LiDAR sensors: An evaluation of model-based and model-free methods","volume":"35","author":"Phillips","year":"2018","journal-title":"J. Field Robot."},{"key":"ref_8","doi-asserted-by":"crossref","first-page":"748","DOI":"10.1002\/rob.21562","article-title":"An Adaptive Structure Filter for Sensor Registration from Unstructured Terrain","volume":"32","author":"Phillips","year":"2015","journal-title":"J. Field Robot."},{"key":"ref_9","unstructured":"Thorpe, C., and Durrant-Whyte, H. (2001). Field Robots, Australian Centre for Field Robotics, The University of Sydney. Technical Report."},{"key":"ref_10","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_11","doi-asserted-by":"crossref","first-page":"921","DOI":"10.1002\/rob.21788","article-title":"An evidence-based approach to object pose estimation from LiDAR measurements in challenging environments","volume":"35","author":"Phillips","year":"2018","journal-title":"J. Field Robot."},{"key":"ref_12","unstructured":"(2022, October 11). Velodyne ULTRA Puck. Available online: https:\/\/velodynelidar.com\/wp-content\/uploads\/2019\/12\/63-9378_Rev-F_Ultra-Puck_Datasheet_Web.pdf."},{"key":"ref_13","unstructured":"(2022, October 11). High-Resolution OS1 Lidar Sensor: Robotics, Trucking, Mapping|Ouster. Available online: https:\/\/ouster.com\/products\/scanning-lidar\/os1-sensor\/."},{"key":"ref_14","unstructured":"(2022, October 11). OpenCL Overview\u2014The Khronos Group Inc. Available online: https:\/\/www.khronos.org\/opencl\/."},{"key":"ref_15","unstructured":"(2022, October 11). CUDA Toolkit\u2014Free Tools and Training|NVIDIA Developer. Available online: https:\/\/developer.nvidia.com\/cuda-toolkit."},{"key":"ref_16","first-page":"2724","article-title":"Object modeling by registration of multiple range images","volume":"3","author":"Chen","year":"1991","journal-title":"Proc. IEEE Int. Conf. Robot. Autom."},{"key":"ref_17","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 and Modeling, 3DIM, Quebec City, QC, Canada."},{"key":"ref_18","doi-asserted-by":"crossref","first-page":"1395","DOI":"10.1016\/j.cad.2004.02.009","article-title":"Free-form surface inspection techniques state of the art review","volume":"36","author":"Li","year":"2004","journal-title":"Comput.-Aided Des."},{"key":"ref_19","doi-asserted-by":"crossref","unstructured":"Ellingson, L., and Zhang, J. (2011, January 1\u20133). An efficient algorithm for matching protein binding sites for protein function prediction. Proceedings of the 2011 ACM Conference on Bioinformatics, Computational Biology and Biomedicine (BCB 2011), Chicago, IL, USA.","DOI":"10.1145\/2147805.2147837"},{"key":"ref_20","doi-asserted-by":"crossref","unstructured":"Bertolazzi, P., Liuzzi, G., and Guerra, C. (2009, January 1\u20134). A global optimization algorithm for protein surface alignment. Proceedings of the 2009 IEEE International Conference on Bioinformatics and Biomedicine Workshops (BIBMW 2009), Washington, DC, USA.","DOI":"10.1109\/BIBMW.2009.5332143"},{"key":"ref_21","doi-asserted-by":"crossref","first-page":"1379","DOI":"10.1109\/TMI.2003.819276","article-title":"The dual-bootstrap iterative closest point algorithm with application to retinal image registration","volume":"22","author":"Stewart","year":"2003","journal-title":"IEEE Trans. Med. Imaging"},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"72390X","DOI":"10.1117\/12.805825","article-title":"System for conveyor belt part picking using structured light and 3D pose estimation","volume":"7239","author":"Thielemann","year":"2009","journal-title":"Three-Dimens. Imaging Metrol."},{"key":"ref_23","unstructured":"Borthwick, J.R. (2003). Mining Haul Truck Pose Estimation and Load Profiling Using Stereo Vision. [Ph.D. Thesis, The University of British Columbia]."},{"key":"ref_24","first-page":"1","article-title":"Memory-Augmented Point Cloud Registration Network for Bucket Pose Estimation of the Intelligent Mining Excavator","volume":"71","author":"Cui","year":"2022","journal-title":"IEEE Trans. Instrum. Meas."},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1561\/2300000035","article-title":"A Review of Point Cloud Registration Algorithms for Mobile Robotics","volume":"4","author":"Pomerleau","year":"2015","journal-title":"Found. Trends Robot."},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"147","DOI":"10.1016\/j.robot.2016.10.011","article-title":"How do ICP variants perform when used for scan matching terrain point clouds?","volume":"87","author":"Donoso","year":"2017","journal-title":"Robot. Auton. Syst."},{"key":"ref_27","doi-asserted-by":"crossref","first-page":"113","DOI":"10.1111\/cgf.12178","article-title":"Sparse Iterative Closest Point","volume":"32","author":"Bouaziz","year":"2013","journal-title":"Comput. Graph. Forum"},{"key":"ref_28","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, Australia.","DOI":"10.1109\/ICCV.2013.184"},{"key":"ref_29","first-page":"3450","article-title":"Fast and Robust Iterative Closest Point","volume":"44","author":"Zhang","year":"2022","journal-title":"IEEE Trans. Pattern Anal. Mach. Intell."},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"2262","DOI":"10.1109\/TPAMI.2010.46","article-title":"Point set registration: Coherent point drift","volume":"32","author":"Myronenko","year":"2010","journal-title":"IEEE Trans. Pattern Anal. Mach. Intell."},{"key":"ref_31","doi-asserted-by":"crossref","first-page":"63","DOI":"10.1023\/A:1007923522710","article-title":"Statistical Approaches to Feature-Based Object Recognition","volume":"21","author":"III","year":"1997","journal-title":"Int. J. Comput. Vis."},{"key":"ref_32","doi-asserted-by":"crossref","first-page":"26","DOI":"10.1016\/S1077-3142(03)00097-3","article-title":"A unified framework for alignment and correspondence","volume":"92","author":"Luo","year":"2003","journal-title":"Comput. Vis. Image Underst."},{"key":"ref_33","doi-asserted-by":"crossref","unstructured":"McNeill, G., and Vijayakumar, S. (2006, January 8\u201311). A probabilistic approach to robust shape matching. Proceedings of the International Conference on Image Processing, ICIP, Atlanta, GA, USA.","DOI":"10.1109\/ICIP.2006.312629"},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"18","DOI":"10.1109\/MSP.2017.2693418","article-title":"Geometric deep learning: Going beyond Euclidean data","volume":"34","author":"Bronstein","year":"2016","journal-title":"IEEE Signal Process. Mag."},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"29","DOI":"10.1007\/978-3-030-96359-0_3","article-title":"Deep Learning and OcTree-GPU-Based ICP for Efficient 6D Model Registration of Large Objects","volume":"23","author":"Ahmadli","year":"2022","journal-title":"Human-Friendly Robotics 2021"},{"key":"ref_36","unstructured":"Wang, Y., and Solomon, J. (November, January 27). Deep Closest Point: Learning Representations for Point Cloud Registration. Proceedings of the IEEE International Conference on Computer Vision, Seoul, Republic of Korea."},{"key":"ref_37","first-page":"537","article-title":"3D Pose estimation using genetic-based iterative closest point algorithm","volume":"14","author":"Lin","year":"2018","journal-title":"Int. J. Innov. Comput. Inf. Control"},{"key":"ref_38","unstructured":"(2022, October 11). Aeries 1: The First 4D LiDAR\u2122 System for Autonom|Aeva Inc. Available online: https:\/\/www.aeva.com\/aeries-i\/."},{"key":"ref_39","unstructured":"Hexsel, B., Vhavle, H., and Chen, Y. (July, January 27). DICP: Doppler Iterative Closest Point Algorithm. Proceedings of the Robotics: Science and Systems, New York City, NY, USA."},{"key":"ref_40","doi-asserted-by":"crossref","first-page":"3412","DOI":"10.1109\/TNNLS.2020.3015992","article-title":"Deep Learning for LiDAR Point Clouds in Autonomous Driving: A Review","volume":"32","author":"Li","year":"2021","journal-title":"IEEE Trans. Neural Netw. Learn. Syst."},{"key":"ref_41","doi-asserted-by":"crossref","first-page":"105","DOI":"10.20517\/ir.2021.20","article-title":"Deep learning for LiDAR-only and LiDAR-fusion 3D perception: A survey","volume":"2","author":"Wu","year":"2022","journal-title":"Intell. Robot."},{"key":"ref_42","unstructured":"Pitkin, T.A. (2013). GPU Ray Tracing with CUDA. [Ph.D. Thesis, Eastern Washington University]."},{"key":"ref_43","unstructured":"Zhang, J., Yao, Y., and Deng, B. (2022, October 15). yaoyx689\/Fast-Robust-ICP. Available online: https:\/\/github.com\/yaoyx689\/Fast-Robust-ICP."},{"key":"ref_44","doi-asserted-by":"crossref","unstructured":"Tsin, Y., and Kanade, T. (2004, January 11\u201314). A Correlation-Based Approach to Robust Point Set Registration. Proceedings of the 8th European Conference on Computer Vision, Prague, Czech Republic.","DOI":"10.1007\/978-3-540-24672-5_44"},{"key":"ref_45","unstructured":"Jian, B., and Vemuri, B.C. (2005, January 17\u201321). A robust algorithm for point set registration using mixture of Gaussians. Proceedings of the Tenth IEEE International Conference on Computer Vision (ICCV\u201905), Beijing, China."},{"key":"ref_46","doi-asserted-by":"crossref","first-page":"179","DOI":"10.1061\/(ASCE)0893-1321(1997)10:4(179)","article-title":"State of the Art in Automation of Earthmoving","volume":"10","author":"Singh","year":"1997","journal-title":"J. Aerosp. Eng."},{"key":"ref_47","doi-asserted-by":"crossref","unstructured":"D\u2019adamo, T., Phillips, T., and McAree, P. (2022). LiDAR-Stabilised GNSS-IMU Platform Pose Tracking. Sensors, 22.","DOI":"10.3390\/s22062248"},{"key":"ref_48","doi-asserted-by":"crossref","first-page":"379","DOI":"10.1002\/rob.20132","article-title":"Autonomous excavation using a rope shovel","volume":"23","author":"Dunbabin","year":"2006","journal-title":"J. Field Robot."},{"key":"ref_49","doi-asserted-by":"crossref","first-page":"20","DOI":"10.1016\/j.mechatronics.2019.01.001","article-title":"Path planning for autonomous bulldozers","volume":"58","author":"Hirayama","year":"2019","journal-title":"Mechatronics"},{"key":"ref_50","doi-asserted-by":"crossref","first-page":"102890","DOI":"10.1016\/j.autcon.2019.102890","article-title":"Development of bulldozer sensor system for estimating the position of blade cutting edge","volume":"106","author":"Kim","year":"2019","journal-title":"Autom. Constr."},{"key":"ref_51","doi-asserted-by":"crossref","first-page":"157","DOI":"10.1007\/s13748-021-00233-7","article-title":"DeepHaul: A deep learning and reinforcement learning-based smart automation framework for dump trucks","volume":"10","author":"Ali","year":"2021","journal-title":"Prog. Artif. Intell."},{"key":"ref_52","doi-asserted-by":"crossref","unstructured":"Egli, P., and Hutter, M. (2020, January 25\u201329). Towards RL-Based Hydraulic Excavator Automation. Proceedings of the 2020 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Las Vegas, NV, USA.","DOI":"10.1109\/IROS45743.2020.9341598"},{"key":"ref_53","doi-asserted-by":"crossref","first-page":"73","DOI":"10.1023\/A:1007932011161","article-title":"The Development, Control and Operation of an Autonomous Robotic Excavator","volume":"21","author":"Bradley","year":"1998","journal-title":"J. Intell. Robot. Syst."},{"key":"ref_54","unstructured":"Lanz, G. (2022, October 18). Guided Spotting. Available online: https:\/\/www.modularmining.com\/wp-content\/uploads\/2019\/09\/EMJ_Guided-Spotting-V2_August2018.pdf."},{"key":"ref_55","unstructured":"Dudley, J., and McAree, R. (2016). Shovel Load Assist Project, CRC Mining. Technical Report."},{"key":"ref_56","unstructured":"(2022, October 18). Neptec Technologies Demonstrates 3DRi-Based Truck Spotting Application at Fording River Coal Mine|Geo Week New|Lidar, 3D, and More Tools at the Intersection of Geospatial Technology and the Built World. Available online: https:\/\/www.geoweeknews.com\/news\/vol13no8-neptec-demonstrates-3dri-based-truck-spotting-at-fording-river-coal-mine."},{"key":"ref_57","unstructured":"(2022, October 28). FlexPak6. Available online: https:\/\/hexagondownloads.blob.core.windows.net\/public\/Novatel\/assets\/Documents\/Papers\/FlexPak6\/FlexPak6.pdf."}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/23\/6\/3085\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,10]],"date-time":"2025-10-10T18:54:08Z","timestamp":1760122448000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/23\/6\/3085"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2023,3,13]]},"references-count":57,"journal-issue":{"issue":"6","published-online":{"date-parts":[[2023,3]]}},"alternative-id":["s23063085"],"URL":"https:\/\/doi.org\/10.3390\/s23063085","relation":{},"ISSN":["1424-8220"],"issn-type":[{"type":"electronic","value":"1424-8220"}],"subject":[],"published":{"date-parts":[[2023,3,13]]}}}