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