Skip to main content

Cluster ICP: Towards Sparse to Dense Registration

  • Conference paper
  • First Online:
Intelligent Autonomous Systems 15 (IAS 2018)

Abstract

Normal segmentation of geometric range data has been a common practice integrated in the building blocks of point cloud registration. Most well-known point to plane and plane to plane state-of-the-art registration techniques make use of normal features to ensure a better alignment. However, the latter is influenced by noise, pattern scanning and difference in densities. Consequently, the resulting normals in both a source point cloud and a target point cloud will not be perfectly adapted, thereby influencing the alignment process, due to weak inter surface correspondences. In this paper, a novel approach is introduced, exploiting normals differently, by clustering points of the same surface into one topological pattern and replacing all the points held by this model by one representative point. These particular points are then used for the association step of registration instead of directly injecting all the points with their extracted normals. In our work, normals are only used to distinguish different local surfaces and are ignored for later stages of point cloud alignment. This approach enables us to overcome two major shortcomings; the problem of correspondences in different point cloud densities, noise inherent in sensors leading to noisy normals. In so doing, improvement on the convergence domain between two reference frames tethered to two dissimilar depth sensors is considerably improved leading to robust localization. Moreover, our approach increases the precision as well as the computation time of the alignment since matching is performed on a reduced set of points. Finally, these claims are backed up by experimental proofs on real data to demonstrate the robustness and the efficiency of the proposed approach.

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

Access this chapter

Chapter
USD 29.95
Price excludes VAT (USA)
  • Available as PDF
  • Read on any device
  • Instant download
  • Own it forever
eBook
USD 169.00
Price excludes VAT (USA)
  • Available as EPUB and PDF
  • Read on any device
  • Instant download
  • Own it forever
Softcover Book
USD 219.99
Price excludes VAT (USA)
  • Compact, lightweight edition
  • Dispatched in 3 to 5 business days
  • Free shipping worldwide - see info

Tax calculation will be finalised at checkout

Purchases are for personal use only

Institutional subscriptions

Notes

  1. 1.

    Leica P20: http://leica-geosystems.com/.

  2. 2.

    Velodyne LiDAR: http://velodynelidar.com/.

  3. 3.

    PAVIN: http://www.institutpascal.uca.fr/index.php/en/the-institut-pascal/equipments.

References

  1. Agamennoni, G., Fontana, S., Siegwart, R.Y., Sorrenti, D.G.: Point clouds registration with probabilistic data association. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 4092–4098 (2016)

    Google Scholar 

  2. Aldoma, A., Vincze, M., Blodow, N., Gossow, D., Gedikli, S., Rusu, R.B., Bradski, G.: CAD-model recognition and 6DOF pose estimation using 3D cues. In: 2011 IEEE International Conference on Computer Vision Workshops (ICCV Workshops), pp. 585–592. IEEE (2011)

    Google Scholar 

  3. Arthur, D., Vassilvitskii, S.: K-means++: the advantages of careful seeding. In: Proceedings of the Eighteenth Annual ACM-SIAM Symposium on Discrete Algorithms, SODA 2007, pp. 1027–1035. Society for Industrial and Applied Mathematics, Philadelphia, PA, USA (2007)

    Google Scholar 

  4. Besl, P.J., McKay, N.D.: A method for registration of 3-D shapes. IEEE Trans. Pattern Anal. Mach. Intell. 14(2), 239–256 (1992)

    Article  Google Scholar 

  5. Blanco, J.L.: A tutorial on se(3) transformation parameterizations and on-manifold optimization. Technical report, University of Malaga (2010)

    Google Scholar 

  6. Cadena, C., Carlone, L., Carrillo, H., Latif, Y., Scaramuzza, D., Neira, J., Reid, I., Leonard, J.: Past, present, and future of simultaneous localization and mapping: towards the robust-perception age. IEEE Trans. Robot. 32(6), 1309–1332 (2016)

    Article  Google Scholar 

  7. Caselitz, T., Steder, B., Ruhnke, M., Burgard, W.: Monocular camera localization in 3D LiDAR maps. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 1–6 (2016)

    Google Scholar 

  8. Chen, Y., Medioni, G.: Object modeling by registration of multiple range images. In: IEEE International Conference on Robotics and Automation, pp. 2724–2729 (1991)

    Google Scholar 

  9. Costa, C.M., Sobreira, H.M., Sousa, A.J., Veiga, G.M.: Robust 3/6 DoF self-localization system with selective map update for mobile robot platforms. Robot. Auton. Syst. 76(C), 113–140 (2016)

    Article  Google Scholar 

  10. Das, A., Diu, M., Mathew, N., Scharfenberger, C., Servos, J., Wong, A., Zelek, J.S., Clausi, D.A., Waslander, S.L.: Mapping, planning, and sample detection strategies for autonomous exploration. J. Field Robot. 31(1), 75–106 (2014)

    Article  Google Scholar 

  11. Feng, Y., Schlichting, A., Brenner, C.: 3D feature point extraction from LiDAR data using a neural network. In: International Archives of the Photogrammetry. Remote Sensing and Spatial Information Sciences-ISPRS Archives 41, vol. 41, pp. 563–569 (2016)

    Article  Google Scholar 

  12. Hänsch, R., Weber, T., Hellwich, O.: Comparison of 3D interest point detectors and descriptors for point cloud fusion. In: ISPRS Annals of Photogrammetry, Remote Sensing and Spatial Information Sciences, vol. II-3, pp. 57–64 (2014)

    Article  Google Scholar 

  13. Holz, D., Ichim, A.E., Tombari, F., Rusu, R.B., Behnke, S.: Registration with the point cloud library PCL. IEEE Robot. Autom. Mag. 22(4), 1–13 (2015)

    Article  Google Scholar 

  14. Jolliffe, I.T.: Principal Component Analysis for Special Types of Data, pp. 199–222. Springer, New York (1986)

    Google Scholar 

  15. Lowe, D.G.: Object recognition from local scale-invariant features. In: Proceedings of the Seventh IEEE International Conference on Computer Vision, pp. 1150–1157 (1999)

    Google Scholar 

  16. Ma, Y., Soatto, S., Košecká, J., Sastry, S.S.: An Invitation to 3-D Vision. Springer, Dordrecht (2004)

    Book  Google Scholar 

  17. Maddern, W., Newman, P.: Real-time probabilistic fusion of sparse 3d lidar and dense stereo. In: 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 2181–2188. IEEE (2016)

    Google Scholar 

  18. Magnusson, M., Lilienthal, A., Duckett, T.: Scan registration for autonomous mining vehicles using 3D-NDT. J. Field Robot. 24(10), 803–827 (2007)

    Article  Google Scholar 

  19. Marani, R., Reno, V., Nitti, M., D’Orazio, T., Stella, E.: A modified iterative closest point algorithm for 3D point cloud registration. Comput. Aided Civ. Infrastruct. Eng. 31(7), 515–534 (2016)

    Article  Google Scholar 

  20. Nieto, J., Bailey, T., Nebot, E.: Scan-SLAM: combining EKF-SLAM and scan correlation. In: Springer Tracts in Advanced Robotics, vol. 25, pp. 167–178 (2006)

    Google Scholar 

  21. Pomerleau, F., Colas, F., Siegwart, R.: A review of point cloud registration algorithms for mobile robotics. Found. Trends Robot. 4(1–104), 1–104 (2015)

    Google Scholar 

  22. Rusinkiewicz, S., Levoy, M.: Efficient variants of the ICP algorithm. In: Proceedings of International Conference on 3-D Digital Imaging and Modeling, 3DIM, pp. 145–152 (2001)

    Google Scholar 

  23. Rusu, R.B., Blodow, N., Beetz, M.: Fast Point Feature Histograms (FPFH) for 3D registration. In: IEEE International Conference on Robotics and Automation, pp. 3212–3217 (2009)

    Google Scholar 

  24. Rusu, R.B., Bradski, G., Thibaux, R., Hsu, J.: Fast 3d recognition and pose using the viewpoint feature histogram. In: 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 2155–2162. IEEE (2010)

    Google Scholar 

  25. Rusu, R.B., Cousins, S.: 3D is here: point cloud library. In: IEEE International Conference on Robotics and Automation (ICRA), pp. 1–4 (2011). http://pointclouds.org/

  26. Segal, A., Haehnel, D., Thrun, S.: Generalized-ICP. In: Robotics: Science and Systems (2009)

    Google Scholar 

  27. Serafin, J., Grisetti, G.: NICP: dense normal based point cloud registration. In: IEEE International Conference on Intelligent Robots and Systems, vol. 2015, pp. 742–749 (2015)

    Google Scholar 

  28. Serafin, J., Olson, E., Grisetti, G.: Fast and robust 3D feature extraction from sparse point clouds. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 4105–4112 (2016)

    Google Scholar 

  29. Tazir, M.L., Checchin, P., Trassoudaine, L.: Color-based 3D point cloud reduction. In: the 14th International Conference on Control, Automation, Robotics and Vision, ICARCV, pp. 1–7 (2016)

    Google Scholar 

  30. Tibshirani, R., Walther, G., Hastie, T.: Estimating the number of clusters in a data set via the gap statistic. J. R. Stat. Soc. Ser. B (Stat. Methodol.) 63(2), 411–423 (2001)

    Article  MathSciNet  Google Scholar 

  31. Velas, M., Spanel, M., Herout, A.: Collar line segments for fast odometry estimation from velodyne point clouds. In: IEEE International Conference on Robotics and Automation (ICRA), pp. 4486–4495 (2016)

    Google Scholar 

  32. Wiemann, T., Mrozinski, M., Feldschnieders, D., Lingemann, K., Hertzberg, J.: Data handling in large-scale surface reconstruction. In: 13th International Conference on Intelligent Autonomous Systems, pp. 1–12 (2014)

    Google Scholar 

  33. Wolcott, R.W., Eustice, R.M.: Visual localization within LIDAR maps for automated urban driving. In: 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2014), pp. 176–183. IEEE (2014)

    Google Scholar 

  34. Yang, B., Dong, Z., Liang, F., Liu, Y.: Automatic registration of large-scale urban scene point clouds based on semantic feature points. ISPRS J. Photogramm. Remote. Sens. 113, 43–58 (2016)

    Article  Google Scholar 

  35. Yang, J., Li, H., Jia, Y.: Go-ICP: solving 3d registration efficiently and globally optimally. In: Proceedings of the IEEE International Conference on Computer Vision, pp. 1457–1464 (2013)

    Google Scholar 

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Mohamed Lamine Tazir .

Editor information

Editors and Affiliations

Rights and permissions

Reprints and permissions

Copyright information

© 2019 Springer Nature Switzerland AG

About this paper

Check for updates. Verify currency and authenticity via CrossMark

Cite this paper

Tazir, M.L., Gokhool, T., Checchin, P., Malaterre, L., Trassoudaine, L. (2019). Cluster ICP: Towards Sparse to Dense Registration. In: Strand, M., Dillmann, R., Menegatti, E., Ghidoni, S. (eds) Intelligent Autonomous Systems 15. IAS 2018. Advances in Intelligent Systems and Computing, vol 867. Springer, Cham. https://doi.org/10.1007/978-3-030-01370-7_57

Download citation

Publish with us

Policies and ethics