Skip to main content
Springer Nature Link
Log in

PCR-DAT: a new point cloud registration method for lidar inertial odometry via distance and Gauss distributed

  • Original Research Paper
  • Published:
Intelligent Service Robotics Aims and scope Submit manuscript

Abstract

We propose a novel point cloud alignment algorithm, namely PCR-DAT, for radar inertial ranging and localization. In environments with complex feature variations, the distribution trend of features is always changing, and the traditional alignment algorithms often fall into local optimums when dealing with regional point clouds with a combination of rich and sparse feature points, thus affecting the accuracy and stability of point cloud alignment. This paper addresses this issue by constructing a cost function composed of distance factors obtained from lidar measurements, normal distribution factors, and IMU pre-integration measurement factors. The core idea involves analyzing and classifying features in the target environment, defining different residual factors based on feature categories. Sparse features correspond to distance factors, while rich features correspond to distribution factors. Subsequently, a nonlinear optimization process is employed to estimate the robot’s pose. We evaluate the accuracy and robustness of the algorithm in various scenarios, including experiments on the KITTI dataset and field data collected during UGV movement. The results demonstrate that the DAT point cloud registration algorithm effectively addresses the pose prediction problem in the presence of feature degradation.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Log in via an institution

Subscribe and save

Springer+ Basic
$34.99 /Month
  • Get 10 units per month
  • Download Article/Chapter or eBook
  • 1 Unit = 1 Article or 1 Chapter
  • Cancel anytime
Subscribe now

Buy Now

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Institutional subscriptions

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Algorithm 1
Fig. 5
Fig. 6
Fig. 7
Fig. 8

Similar content being viewed by others

Explore related subjects

Discover the latest articles, news and stories from top researchers in related subjects.

References

  1. Koval A, Kanellakis C, Nikolakopoulos G (2022) Evaluation of lidar-based 3d slam algorithms in subt environment. IFAC-PapersOnLine 55(38):126–131

    Article  Google Scholar 

  2. Qin T, Li P, Shen S (2018) Vins-mono: a robust and versatile monocular visual-inertial state estimator. IEEE Trans Rob 34(4):1004–1020

    Article  Google Scholar 

  3. Raul M-A, Maria Martinez MJ, Tardos Juan D (2015) Orb-slam: a versatile and accurate monocular slam system. IEEE Trans Rob 31(5):1147–1163

    Article  Google Scholar 

  4. Zhou X, Wen X, Wang Z, Gao Y, Li H, Wang Q, Yang T, Haojian L, Cao Y, Chao X et al (2022) Swarm of micro flying robots in the wild. Sci Robot 7(66):eabm5954

    Article  Google Scholar 

  5. Zhang J, Singh S (2017) Low-drift and real-time lidar odometry and mapping. Auton Robot 41:401–416

    Article  Google Scholar 

  6. Shan T, Englot B, Meyers D, Wang W, Ratti C, Rus D (2020) Lio-sam: tightly-coupled lidar inertial odometry via smoothing and mapping. In: 2020 IEEE/RSJ international conference on intelligent robots and systems (IROS). IEEE, pp 5135–5142

  7. Daniele C, Matteo V, Simone F, Augusto Luis B, Domenico GS (2020) Global visual localization in lidar-maps through shared 2d-3d embedding space. In: 2020 IEEE international conference on robotics and automation (ICRA). IEEE, pp 4365–4371

  8. Nguyen T-M, Cao M, Yuan S, Lyu Y, Nguyen TH, Xie L (2021) Liro: tightly coupled lidar-inertia-ranging odometry. In: 2021 IEEE international conference on robotics and automation (ICRA). IEEE, pp 14484–14490

  9. Tardif J-P, Pavlidis Y, Daniilidis K (2008) Monocular visual odometry in urban environments using an omnidirectional camera. In: 2008 IEEE/RSJ international conference on intelligent robots and systems. IEEE, pp 2531–2538

  10. Merten H (2008) The three-dimensional normal-distributions transform. Threshold 10:3

    Google Scholar 

  11. Biber P, Straßer W (2003) The normal distributions transform: a new approach to laser scan matching. In: Proceedings 2003 IEEE/RSJ international conference on intelligent robots and systems (IROS 2003)(Cat. No. 03CH37453), vol 3. IEEE, pp 2743–2748

  12. Lim H, Hwang S, Shin S, Myung H (2020) Normal distributions transform is enough: real-time 3d scan matching for pose correction of mobile robot under large odometry uncertainties. In: 2020 20th International conference on control, automation and systems (ICCAS). IEEE, pp 1155–1161

  13. Myronenko A, Song X (2010) Point set registration: coherent point drift. IEEE Trans Pattern Anal Mach Intell 32(12):2262–2275

    Article  Google Scholar 

  14. Tiemann J, Wietfeld C (2017) Scalable and precise multi-uav indoor navigation using tdoa-based uwb localization. In: 2017 International conference on indoor positioning and indoor navigation (IPIN). IEEE, pp 1–7

  15. Poulose A, Emeršič Ž, Eyobu OS, Han DS (2020) An accurate indoor user position estimator for multiple anchor uwb localization. In: 2020 international conference on information and communication technology convergence (ICTC). IEEE, pp 478–482

  16. Poulose A, Han DS (2021) Feature-based deep lstm network for indoor localization using uwb measurements. In: 2021 International conference on artificial intelligence in information and communication (ICAIIC). IEEE, pp 298–301

  17. Guo K, Qiu Z, Miao C, Zaini AH, Chen C-L, Meng W, Xie L (2016) Ultra-wideband-based localization for quadcopter navigation. Unmanned Syst 4(01):23–34

    Article  Google Scholar 

  18. Zihajeh zadeh S, Yoon PK, Kang B-S, Park EJ (2015) Uwb-aided inertial motion capture for lower body 3-d dynamic activity and trajectory tracking. IEEE Trans Instrum Meas 64(12):3577–3587

    Article  Google Scholar 

  19. Shan T, Englot B (2018) Lego-loam: lightweight and ground-optimized lidar odometry and mapping on variable terrain. In: 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, pp 4758–4765

  20. Rozenberszki D, Majdik AL (2020) Lol: lidar-only odometry and localization in 3d point cloud maps. In: 2020 IEEE international conference on robotics and automation (ICRA). IEEE, pp 4379–4385

  21. Segal A, Haehnel D, Thrun S (2009) Generalized-icp. In: Robotics: science and systems, vol 2. Seattle, WA, p 435

  22. Koide K, Yokozuka M, Oishi S, Banno A (2021) Voxelized gicp for fast and accurate 3d point cloud registration. In: 2021 IEEE international conference on robotics and automation (ICRA). IEEE, pp 11054–11059

  23. Feng H, Luo J, Gui L, Huang H (2022) A new approach of initial localization for unmanned vehicles based on 3d descriptor and normal distributions transform. In: 2022 8th International conference on control, automation and robotics (ICCAR). IEEE, pp 242–247

  24. Yoshida A, Yoshida I, Hashimoto M, Takahashi K (2022) Point-cloud mapping by helmet-mounted lidar based on NDT slam. In: 2022 IEEE international conference on industrial technology (ICIT). IEEE, pp 1–6

  25. Chen S, Ma H, Jiang C, Zhou B, Xue W, Xiao Z, Li Q (2021) Ndt-loam: a real-time lidar odometry and mapping with weighted NDT and LFA. IEEE Sens J 22(4):3660–3671

    Article  Google Scholar 

  26. Pan L, Ji K, Zhao J (2021) Tightly-coupled multi-sensor fusion for localization with lidar feature maps. In: 2021 IEEE international conference on robotics and automation (ICRA). IEEE, pp 5215–5221

  27. Mahalanobis PC (2018) On the generalized distance in statistics. Sankhyā: Indian J Stat Ser A (2008) 80:S1–S7

  28. Eberly D (1998) A robust Eigensolver for 3\(\times \) 3 symmetric matrices

Download references

Author information

Authors and Affiliations

  1. Mechatronics Laboratory, China Jiliang University, Hangzhou, Zhejiang, China

    XiaoSong Wang

  2. Key Laboratory of Intelligent Manufacturing Quality Big Data Tracing and Analysis, China Jiliang University, Hangzhou, Zhejiang, China

    YuChen He

  3. Mechanical Engineering, China Jiliang University, Hangzhou, Zhejiang, China

    XianQi Cai

  4. Institute of Mechanical and Electrical Engineering, China Jiliang University, Hangzhou, Zhejiang, China

    Wei Li

Authors
  1. XiaoSong Wang
    View author publications

    You can also search for this author inPubMed Google Scholar

  2. YuChen He
    View author publications

    You can also search for this author inPubMed Google Scholar

  3. XianQi Cai
    View author publications

    You can also search for this author inPubMed Google Scholar

  4. Wei Li
    View author publications

    You can also search for this author inPubMed Google Scholar

Corresponding author

Correspondence to Wei Li.

Additional information

Publisher's Note

Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Rights and permissions

Springer Nature or its licensor (e.g. a society or other partner) holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Wang, X., He, Y., Cai, X. et al. PCR-DAT: a new point cloud registration method for lidar inertial odometry via distance and Gauss distributed. Intel Serv Robotics 17, 579–589 (2024). https://doi.org/10.1007/s11370-024-00517-6

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s11370-024-00517-6

Keywords