分别使用pcl::icp和libicp两种icp算法处理相同的一对点云数据,target数据由source数据作缸体转换得来,转换关系:
fprintf(pOutFile, "%d", int(point.x*1 + point.y*0 + point.z*0 + 100));
fputc(',', pOutFile);
fprintf(pOutFile, "%d", int(point.x*0 + point.y*0.707 + point.z*0.707 + 200));
fputc(',', pOutFile);
fprintf(pOutFile, "%d", int(point.x*0 - point.y*0.707 + point.z*0.707 + 300));
fputc(',', pOutFile);
pcl::icp的转换矩阵:
libicp的转换矩阵: