使用开源3D点云库进行特征匹配的时候,KdTree 处理pcl::Histogram<N>数据时距离平方值计算出错,此原因尚未查明!!!
pcl::search::KdTree<pcl::Histogram<153>> kd;
kd.setInputCloud(model_descriptor);
std::vector<int> idx;
std::vector<float> dst;
kd.nearestKSearch(scene_descriptor->points[0],1,idx,dst);
float sum=0.0f;
pcl::Histogram<153> feature = scene_descriptor->points[0];
pcl::Histogram<153> m_feature = model_descriptor->points[idx[0]];
for(int i=0; i<153; i++)
{
sum += pow(feature.histogram[i]-m_feature.histogram[i],2);
}
assert(sum==dst[0]);
pcl::search::KdTree 或者 pcl::KdTreeFLANN 都有这个问题,它们在处理pcl已定义好的
数据类型时是正确的,例如处理pcl::SHOT352,pcl::SHOT1344等在point_types.h头文件
中声明定义的对象都是没问题的。