Contents
This is a 2D ICP matching example with singular value decomposition.
It can calculate a rotation matrix and a translation vector between points to points.
Introduction to Mobile Robotics: Iterative Closest Point Algorithm