Using Augmented Measurements to Improve the Convergence of ICP

  • Jacopo Serafin
  • Giorgio Grisetti
Part of the Lecture Notes in Computer Science book series (LNCS, volume 8810)


Point cloud registration is an essential part for many robotics applications and this problem is usually addressed using some of the existing variants of the Iterative Closest Point (ICP) algorithm. In this paper we propose a novel variant of the ICP objective function which is minimized while searching for the registration. We show how this new function, which relies not only on the point distance, but also on the difference between surface normals or surface tangents, improves the registration process. Experiments are performed on synthetic data and real standard benchmark datasets, showing that our approach outperforms other state of the art techniques in terms of convergence speed and robustness.


Point Cloud Registration ICP Surface Normals 


Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.


  1. 1.
    Besl, P.J., McKay, N.D.: A method for registration of 3-D shapes. IEEE Transactions on Pattern Analysis and Machine Intelligence (1992)Google Scholar
  2. 2.
    Grisetti, G., Kummerle, R., Stachniss, C., Burgard, W.: A tutorial on graph-based slam. IEEE Intelligent Transportation Systems Magazine 2(4), 31–43 (2010)CrossRefGoogle Scholar
  3. 3.
    Horn, B.K., Hilden, H.M., Negahdaripour, S.: Closed-form solution of absolute orientation using orthonormal matrices. Journal of the Optical Society of America (1988)Google Scholar
  4. 4.
    Magnusson, M., Duckett, T., Lilienthal, A.J.: Scan registration for autonomous mining vehicles using 3D-ndt. Journal on Field Robotics (2007)Google Scholar
  5. 5.
    Pomerleau, F., Colas, F., Siegwart, R., Magnenat, S.: Comparing icp variants on real-world data sets. Autonomous Robots (2013)Google Scholar
  6. 6.
    Segal, A.V., Haehnel, D., Thrun, S.: Generalized-ICP. In: Proc. of Robotics: Science and Systems, RSS (2009)Google Scholar
  7. 7.
    Sturm, J., Engelhard, N., Endres, F., Burgard, W., Cremers, D.: A benchmark for the evaluation of rgb-d slam systems. In: Proc. of the IEEE/RSJ Int. Conf. on Intelligent Robots and Systems, IROS (2012)Google Scholar

Copyright information

© Springer International Publishing Switzerland 2014

Authors and Affiliations

  • Jacopo Serafin
    • 1
  • Giorgio Grisetti
    • 1
  1. 1.Dept. of Computer, Control and Management EngineeringSapienza University of RomeRomeItaly

Personalised recommendations