A simple example of icp (Iterative Closest Point) with opencv and kdtree.