Indoor Point Cloud Registration Process Using ICP Algorithm


  • Youngwoo Chang St. Mary's International School
  • Nate Bartlett Motiv Research co.



Lidar, Point Cloud, SVD, ICP, Point Cloud Registration


In this paper, there are three major sections covered. The paper begins with the explanation of the Lidar sensor, which is a device that uses one or more lasers to measure distances from itself to objects in the world. Such a measurement can be represented as a point cloud, which is a set of (x,y,z) values for every surface that the laser(s) irradiate. Then, the theory of rigid transformations, including the covariance matrix, the translation matrix, and how the Singular Value Decomposition (SVD) can decompose the covariance matrix between two point-clouds to obtain the rotation matrix relating them. In addition, the concept of Iterative Closest Point (ICP) is explored and tested, along with the SVD algorithm, by using the Stanford bunny data sets. Finally, the ICP algorithm is used to combine two different Lidar scans of an office room together to see its effectiveness in a real-world environment.


Download data is not yet available.

References or Bibliography

S. Spielberg, Director, Ready Player One. [Film]. USA: Warner Bros. Pictures, 2018.

"What is Digital Twin? How does it work?," YouTube, 10 January 2019. [Online]. Available:

"What is LiDAR? (& Why is It on Apple Devices All of a Sudden)," YouTube, 17 May 2020. [Online]. Available:

W. Burgard and C. Stachniss, "Introduction to Mobile Robotics Interative Closest Point Algorithm," [Online]. Available:

D. Kalman, "A Singularly Valuable Decomposition: The SVD of a Matrix," The College Mathematics Journal, vol. 27, no. 1, 1996.

"Velodyne Lidar VLP-16 User Manual," 26 February 2019. [Online]. Available:

"ROS," ROS.ORG, [Online]. Available:

P. Evans, "Rotations and rotation matrices," Biological Crystallography, p. 1355~1359, 12 June 2011.

"The Stanford 3D Scanning Repository," Stanford University, 14 August 2014. [Online]. Available:

N. Janakiev, "Understanding the Covariance Matrix," datascience+, 3 August 2018. [Online]. Available:

D. Eggert, A. Lorusso and R. Fisher, "Estimating 3-D rigid body transformations: a comparison of four major algorithms," Machine Vision and Applications, pp. 272-290, 1997.

P. Jana and M. Dalibor, "Notes on Iterative Closest Point Algorithm," in 17th Conference on Applied Mathematics, Slovak University of Technology in Bratislava, 2018.

D. Holz, A. Ichim, F. Tombari, R. Rusu and S. Behnke, "Registration with the Point Cloud Library," IEEE Robotics & Automation Magazine, vol. 22, no. 4, pp. 110-124, 2015.

H. Marius, "Tree algorithms explained: Ball Tree Algorithm vs. KD Tree vs. Brute Force," towards data science, 15 June 2020. [Online]. Available:

"sklearn.neighbors.KDTree," scikit-learn, [Online]. Available:

J. Shlens, "A Tutorial on Principal Component Analysis," 7 April 2014. [Online]. Available:

"numpy.linalg.svd,", [Online]. Available:

"YouTube," dronegenuity, 2 March 2020. [Online]. Available:



How to Cite

Chang, Y., & Bartlett, N. (2022). Indoor Point Cloud Registration Process Using ICP Algorithm. Journal of Student Research, 10(4).



HS Research Projects