{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,2,10]],"date-time":"2026-02-10T12:53:33Z","timestamp":1770728013460,"version":"3.49.0"},"reference-count":54,"publisher":"MDPI AG","issue":"6","license":[{"start":{"date-parts":[[2022,3,14]],"date-time":"2022-03-14T00:00:00Z","timestamp":1647216000000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"DOI":"10.13039\/100008711","name":"Australian Coal Research (Australia)","doi-asserted-by":"publisher","award":["C27063"],"award-info":[{"award-number":["C27063"]}],"id":[{"id":"10.13039\/100008711","id-type":"DOI","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>The requirement to estimate the six degree-of-freedom pose of a moving platform frequently arises in automation applications. It is common to estimate platform pose by the fusion of global navigation satellite systems (GNSS) measurements and translational acceleration and rotational rate measurements from an inertial measurement unit (IMU). This paper considers a specific situation where two GNSS receivers and one IMU are used and gives the full formulation of a Kalman filter-based estimator to do this. A limitation in using this sensor set is the difficulty of obtaining accurate estimates of the degree of freedom corresponding to rotation about the line passing through the two GNSS receiver antenna centres. The GNSS-aided IMU formulation is extended to incorporate LiDAR measurements in both known and unknown environments to stabilise this degree of freedom. The performance of the pose estimator is established by comparing expected LiDAR range measurements with actual range measurements. Distributions of the terrain point-to-model error are shown to improve from 0.27m mean error to 0.06m when the GNSS-aided IMU estimator is augmented with LiDAR measurements. This precision is marginally degraded to 0.14m when the pose estimator is operated in an a prior unknown environment.<\/jats:p>","DOI":"10.3390\/s22062248","type":"journal-article","created":{"date-parts":[[2022,3,15]],"date-time":"2022-03-15T02:56:20Z","timestamp":1647312980000},"page":"2248","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":11,"title":["LiDAR-Stabilised GNSS-IMU Platform Pose Tracking"],"prefix":"10.3390","volume":"22","author":[{"ORCID":"https:\/\/orcid.org\/0000-0002-4183-9166","authenticated-orcid":false,"given":"Timothy","family":"D\u2019Adamo","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","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","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":[[2022,3,14]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"662","DOI":"10.2514\/3.29327","article-title":"Estimation using sampled data containing sequentially correlated noise","volume":"5","author":"Bryson","year":"1968","journal-title":"J. Spacecr. Rocket."},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"417","DOI":"10.2514\/3.56190","article-title":"Kalman filtering for spacecraft attitude estimation","volume":"5","author":"Lefferts","year":"1982","journal-title":"J. Guid. Control. Dyn."},{"key":"ref_3","doi-asserted-by":"crossref","first-page":"70","DOI":"10.2514\/3.19717","article-title":"Three-axis attitude determination from vector observations","volume":"4","author":"Shuster","year":"1981","journal-title":"J. Guid. Control."},{"key":"ref_4","doi-asserted-by":"crossref","first-page":"41","DOI":"10.1007\/s10291-011-0207-y","article-title":"Attitude determination by integration of MEMS inertial sensors and GPS for autonomous agriculture applications","volume":"16","author":"Li","year":"2012","journal-title":"GPS Solut."},{"key":"ref_5","doi-asserted-by":"crossref","first-page":"345","DOI":"10.1007\/s12239-017-0035-3","article-title":"Integration of GPS and monocular vision for land vehicle navigation in urban area","volume":"18","author":"Lim","year":"2017","journal-title":"Int. J. Automot. Technol."},{"key":"ref_6","doi-asserted-by":"crossref","unstructured":"Gakne, P.V., and O\u2019Keefe, K. (2018). Tightly-coupled GNSS\/vision using a sky-pointing camera for vehicle navigation in urban areas. Sensors, 18.","DOI":"10.3390\/s18041244"},{"key":"ref_7","doi-asserted-by":"crossref","unstructured":"Petritoli, E., Giagnacovo, T., and Leccese, F. (2014, January 29\u201330). Lightweight GNSS\/IRS integrated navigation system for UAV vehicles. Proceedings of the 2014 IEEE Metrology for Aerospace (MetroAeroSpace), Benevento, Italy.","DOI":"10.1109\/MetroAeroSpace.2014.6865894"},{"key":"ref_8","doi-asserted-by":"crossref","unstructured":"Guo, P., Li, X., Gui, Y., Zhou, X., Zhang, H., and Zhang, X. (2014, January 19\u201323). Airborne vision-aided landing navigation system for fixed-wing UAV. Proceedings of the IEEE 2014 12th International Conference on Signal Processing (ICSP), HangZhou, China.","DOI":"10.1109\/ICOSP.2014.7015193"},{"key":"ref_9","doi-asserted-by":"crossref","first-page":"368","DOI":"10.1016\/j.ast.2018.07.026","article-title":"Intelligent GNSS\/INS integrated navigation system for a commercial UAV flight control system","volume":"80","author":"Zhang","year":"2018","journal-title":"Aerosp. Sci. Technol."},{"key":"ref_10","doi-asserted-by":"crossref","unstructured":"Watanabe, Y., Manecy, A., Hiba, A., Nagai, S., and Aoki, S. (2019;, January 7\u201311). Vision-integrated navigation system for aircraft final approach in case of GNSS\/SBAS or ILS failures. Proceedings of the AIAA Scitech 2019 Forum, San Diego, CA, USA.","DOI":"10.2514\/6.2019-0113"},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"216","DOI":"10.1134\/S2075108719040084","article-title":"Optical Aircraft Positioning for Monitoring of the Integrated Navigation System during Landing Approach","volume":"10","author":"Hecker","year":"2019","journal-title":"Gyroscopy Navig."},{"key":"ref_12","doi-asserted-by":"crossref","unstructured":"Bhaskaran, S. (2012, January 11\u201315). Autonomous navigation for deep space missions. Proceedings of the SpaceOps 2012, American Institute of Aeronautics and Astronautics, Stockholm, Sweden.","DOI":"10.2514\/6.2012-1267135"},{"key":"ref_13","doi-asserted-by":"crossref","first-page":"1843","DOI":"10.1177\/0954410014561705","article-title":"X-ray pulsar-based navigation system\/Sun measurement integrated navigation method for deep space explorer","volume":"229","author":"Wang","year":"2015","journal-title":"Proc. Inst. Mech. Eng. Part G J. Aerosp. Eng."},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"969","DOI":"10.2514\/1.G000687","article-title":"Relative computer vision-based navigation for small inspection spacecraft","volume":"38","author":"Tweddle","year":"2015","journal-title":"J. Guid. Control. Dyn."},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Gao, Z., Mu, D., Zhong, Y., and Gu, C. (2018). A strap-down inertial navigation\/spectrum red-shift\/star sensor (SINS\/SRS\/SS) autonomous integrated system for spacecraft navigation. Sensors, 18.","DOI":"10.3390\/s18072039"},{"key":"ref_16","doi-asserted-by":"crossref","unstructured":"English, A., Ross, P., Ball, D., and Corke, P. (June, January 31). Vision based guidance for robot navigation in agriculture. Proceedings of the 2014 IEEE International Conference on Robotics and Automation (ICRA), Hong Kong, China.","DOI":"10.1109\/ICRA.2014.6907079"},{"key":"ref_17","first-page":"89","article-title":"Development of autonomous navigation system for rice transplanter","volume":"11","author":"Yin","year":"2018","journal-title":"Int. J. Agric. Biol. Eng."},{"key":"ref_18","doi-asserted-by":"crossref","unstructured":"Lan, H., Elsheikh, M., Abdelfatah, W., Wahdan, A., and El-Sheimy, N. (2019, January 16\u201320). Integrated RTK\/INS navigation for precision agriculture. 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.17116"},{"key":"ref_19","first-page":"1043","article-title":"An adaptive vision navigation algorithm in agricultural IoT system for smart agricultural robots","volume":"66","author":"Zhang","year":"2021","journal-title":"CMC-Comput. Mater. Contin."},{"key":"ref_20","unstructured":"Lopesa, J., and Trabancoa, J. (2019). Automated control systems for civil construction machinery using RTK-GNSS: An implementation review. Rev. Eng., 28\u201333."},{"key":"ref_21","doi-asserted-by":"crossref","unstructured":"Shcherbakov, V., Karpik, A., and Barsuk, M. (2019, January 22\u201327). Automation of Railroad Construction Technology Using Surveying Methods. Proceedings of the International Scientific Siberian Transport Forum, Novosibirsk, Russia.","DOI":"10.1007\/978-3-030-37919-3_19"},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"429","DOI":"10.3390\/s120100429","article-title":"Sensor fusion of monocular cameras and laser rangefinders for line-based simultaneous localization and mapping (SLAM) tasks in autonomous mobile robots","volume":"12","author":"Zhang","year":"2012","journal-title":"Sensors"},{"key":"ref_23","doi-asserted-by":"crossref","unstructured":"Zhao, S., and Farrell, J.A. (2013, January 28\u201330). 2D LIDAR Aided INS for vehicle positioning in urban environments. Proceedings of the 2013 IEEE International Conference on Control Applications (CCA), Hyderabad, India.","DOI":"10.1109\/CCA.2013.6662778"},{"key":"ref_24","doi-asserted-by":"crossref","first-page":"253","DOI":"10.1017\/S037346331400054X","article-title":"A LiDAR-Aided Indoor Navigation System for UGVs","volume":"68","author":"Liu","year":"2015","journal-title":"J. Navig."},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"247","DOI":"10.1016\/j.robot.2007.07.005","article-title":"Natural landmark extraction for mobile robot navigation based on an adaptive curvature estimation","volume":"56","author":"Bandera","year":"2008","journal-title":"Robot. Auton. Syst."},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"5894","DOI":"10.3390\/s90805894","article-title":"Curvature-Based Environment Description for Robot Navigation Using Laser Range Sensors","volume":"9","author":"Bandera","year":"2009","journal-title":"Sensors"},{"key":"ref_27","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_28","doi-asserted-by":"crossref","first-page":"16710","DOI":"10.3390\/s150716710","article-title":"LiDAR Scan Matching Aided Inertial Navigation System in GNSS-Denied Environments","volume":"15","author":"Tang","year":"2015","journal-title":"Sensors"},{"key":"ref_29","doi-asserted-by":"crossref","unstructured":"Chen, Y., Tang, J., Khoramshahi, E., Hakala, T., Kaartinen, H., Jaakkola, A., Hyypp\u00e4, J., Zhu, Z., and Chen, R. (2016, January 11\u201314). Scan matching technology for forest navigation with map information. Proceedings of the IEEE\/ION PLANS 2016, Savannah, GA, USA.","DOI":"10.1109\/PLANS.2016.7479702"},{"key":"ref_30","first-page":"4802159","article-title":"An online solution of LiDAR scan matching aided inertial navigation system for indoor mobile mapping","volume":"2017","author":"Niu","year":"2017","journal-title":"Mob. Inf. Syst."},{"key":"ref_31","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_32","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_33","unstructured":"de Haag, M.U., Vadlamani, A., Campbell, J., and Dickman, J. (2006, January 17\u201319). Application of laser range scanner based terrain referenced navigation systems for aircraft guidance. Proceedings of the Third IEEE International Workshop on Electronic Design, Test and Applications (DELTA\u201906), Kuala Lumpur, Malaysia."},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"1279","DOI":"10.1109\/TVT.2015.2397004","article-title":"Integrated Indoor Navigation System for Ground Vehicles with Automatic 3-D Alignment and Position Initialization","volume":"64","author":"Atia","year":"2015","journal-title":"IEEE Trans. Veh. Technol."},{"key":"ref_35","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_36","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_37","doi-asserted-by":"crossref","first-page":"865","DOI":"10.1016\/j.asr.2013.05.027","article-title":"An iterative LiDAR DEM-aided algorithm for GNSS positioning in obstructed\/rapidly undulating environments","volume":"52","author":"Danezis","year":"2013","journal-title":"Adv. Space Res."},{"key":"ref_38","doi-asserted-by":"crossref","unstructured":"Yun, S., Lee, Y.J., and Sung, S. (2013, January 2\u20139). IMU\/Vision\/Lidar integrated navigation system in GNSS denied environments. Proceedings of the 2013 IEEE Aerospace Conference, Big Sky, MT, USA.","DOI":"10.1109\/AERO.2013.6497403"},{"key":"ref_39","doi-asserted-by":"crossref","unstructured":"Toth, C., Grejner-Brzezinska, D.A., and Lee, Y.J. (2008, January 5\u20138). Terrain-based navigation: Trajectory recovery from LiDAR data. Proceedings of the 2008 IEEE\/ION Position, Location and Navigation Symposium, Monterey, CA, USA.","DOI":"10.1109\/PLANS.2008.4570067"},{"key":"ref_40","doi-asserted-by":"crossref","first-page":"121","DOI":"10.7551\/mitpress\/7830.003.0017","article-title":"Map-based precision vehicle localization in urban environments","volume":"Volume 3","author":"Levinson","year":"2008","journal-title":"Robotics: Science and Systems"},{"key":"ref_41","unstructured":"Velodyne (2016). Lidar Vlp-16 User Manual and Programming Guide, Velodyne."},{"key":"ref_42","unstructured":"Trawny, N., and Roumeliotis, S.I. (2005). Indirect Kalman filter for 3D attitude estimation. Univ. Minn. Dept. Comp. Sci. Eng. Tech. Rep., 2."},{"key":"ref_43","unstructured":"Gonz\u00e1lez, R., Rodriguez, F., Guzm\u00e1n, J., and Berenguel, M. (2009). Comparative study of localization techniques for mobile robots based on indirect Kalman filter. IFR International Symposium on Robotics, Citeseer."},{"key":"ref_44","unstructured":"Sirtkaya, S., Seymen, B., and Alatan, A.A. (2013, January 9\u201312). Loosely coupled Kalman filtering for fusion of Visual odometry and inertial navigation. Proceedings of the 16th International Conference on Information Fusion, Istanbul, Turkey."},{"key":"ref_45","doi-asserted-by":"crossref","first-page":"26","DOI":"10.1109\/MAES.2014.14110","article-title":"Principles of GNSS, inertial, and multisensor integrated navigation systems, 2nd edition [Book review]","volume":"30","author":"Groves","year":"2015","journal-title":"IEEE Aerosp. Electron. Syst. Mag."},{"key":"ref_46","doi-asserted-by":"crossref","unstructured":"Lee, C.G., Dao, N.N., Jang, S., Kim, D., Kim, Y., and Cho, S. (2016). Gyro drift correction for an indirect Kalman filter based sensor fusion driver. Sensors, 16.","DOI":"10.3390\/s16060864"},{"key":"ref_47","doi-asserted-by":"crossref","first-page":"59","DOI":"10.1109\/MCS.2017.2674458","article-title":"Nonlinear Observers for Integrated INS\u2216GNSS Navigation: Implementation Aspects","volume":"37","author":"Bryne","year":"2017","journal-title":"IEEE Control. Syst."},{"key":"ref_48","doi-asserted-by":"crossref","first-page":"1085","DOI":"10.1177\/0278364920903094","article-title":"Relative multiplicative extended Kalman filter for observable GPS-denied navigation","volume":"39","author":"Koch","year":"2020","journal-title":"Int. J. Robot. Res."},{"key":"ref_49","doi-asserted-by":"crossref","first-page":"96487","DOI":"10.1109\/ACCESS.2020.2997250","article-title":"A Robust Indirect Kalman Filter Based on the Gradient Descent Algorithm for Attitude Estimation During Dynamic Conditions","volume":"8","author":"Sun","year":"2020","journal-title":"IEEE Access"},{"key":"ref_50","doi-asserted-by":"crossref","first-page":"100827","DOI":"10.1109\/ACCESS.2021.3096422","article-title":"A Hybrid Data Fusion Approach to AI-Assisted Indirect Centralized Integrated SINS\/GNSS Navigation System During GNSS Outage","volume":"9","author":"Abdolkarimi","year":"2021","journal-title":"IEEE Access"},{"key":"ref_51","doi-asserted-by":"crossref","first-page":"328","DOI":"10.1109\/70.388775","article-title":"Inertial Navigation Systems for Mobile Robots","volume":"11","author":"Barshan","year":"1995","journal-title":"IEEE Trans. Robot. Autom."},{"key":"ref_52","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_53","first-page":"1","article-title":"Information Filter and Kalman Filter Comparison: Selection of the Faster Filter","volume":"2","author":"Assimakis","year":"2012","journal-title":"Int. J. Inf. Eng."},{"key":"ref_54","unstructured":"FARO Technologies (2013). FARO Laser Scanner Focus3D Manual, FARO Technologies."}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/22\/6\/2248\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,10]],"date-time":"2025-10-10T22:36:13Z","timestamp":1760135773000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/22\/6\/2248"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2022,3,14]]},"references-count":54,"journal-issue":{"issue":"6","published-online":{"date-parts":[[2022,3]]}},"alternative-id":["s22062248"],"URL":"https:\/\/doi.org\/10.3390\/s22062248","relation":{},"ISSN":["1424-8220"],"issn-type":[{"value":"1424-8220","type":"electronic"}],"subject":[],"published":{"date-parts":[[2022,3,14]]}}}