这几天在学习数据关联的方法,本来想使用ICP算法进行距离测距数据的配准,但是用的过程中出现问题,配的不准,而且偏差更大了. 红色的和黄色的2维激光点进行ICP配准,但将变换矩阵和黄色进行乘之后偏差更大了.怀疑是因为两个点集只有部分数据重合,而ICP算法最好是点能一一对应. 之后使用PCL进行点集匹配测试,出现同样的问题. 于是我自己构造了一个数据,将A点集进行一个刚体变换,之后用ICP配准,再进行对比,发现算法可以配准的很好,应该是部分点集重合造成的. 现在想想,主要原因是ICP算法并不是全局最