ICP算法Matlab源码

代码说明：

This is an implementation of the Iterative Closest Point (ICP) algorithm.  The function takes two data sets and registers data2 with data1.  It is assumed that data1 and data2 are in approximation registration. The code iterates till no more correspondences can be found.  % Arguments: data1 - 3 x n matrix of the x, y and z coordinates of data set 1 %            data2 - 3 x m matrix of the x, y and z coordinates of data set 2