使用matlab实现点云匹配(ICP算法)。参数设置在代码的最前面,可以选择kd-tree或者暴力计算最近邻点。