使用Matlab实现ICP(Iterative Closest Point Algorithm)算法,封装为一个函数!