FPFH+ICP点云配准

A, UniformSampling降噪

B, ISS计算关键点, FPFH特征

在FeatureCloud::setInputCloud中读入点云,并调用processInput进行处理:

processInput处理包括:

1,  computeSurfaceNormals ()

使用NormalEstimation计算得到表面法向量

2,  computeLocalFeatures ()

FPFHEstimation

KdTree

ISSKeypoint3D

getKeypointsIndicesinRadius

C, SAC-IA配准

findBestAlignment中进行SAC-IA配准计算

D, ICP进一步配准

IterativeClosestPoint

//==打印输出调试信息==//

FILE* fxp = fopen("F:\\x_p.txt","w+");

fprintf(fxp,"%.2f  ",df);

fclose(fxp);