广泛用于比较两个点云对象相似度的一些度量或方法是什么? (例如,可能是PCD文件或PLY文件)。
我已经搜索了PCL库的文档,但没有找到。用Google搜索它,发现了一些研究,但他们谈论的是新方法,而不是广泛使用或已经使用的方法。
有没有比较点云相似度的基本方法?甚至PCL库中的某些功能可以完成这项工作?
答案 0 :(得分:2)
这是我的方法:
#include <algorithm>
#include <numeric>
#include <pcl/point_cloud.h>
#include <pcl/point_types.h>
#include <pcl/common/geometry.h>
#include <pcl/search/kdtree.h>
template<typename TreeT, typename PointT>
float nearestDistance(const TreeT& tree, const PointT& pt)
{
const int k = 1;
std::vector<int> indices (k);
std::vector<float> sqr_distances (k);
tree.nearestKSearch(pt, k, indices, sqr_distances);
return sqr_distances[0];
}
// compare cloudB to cloudA
// use threshold for identifying outliers and not considering those for the similarity
// a good value for threshold is 5 * <cloud_resolution>, e.g. 10cm for a cloud with 2cm resolution
template<typename CloudT>
float _similarity(const CloudT& cloudA, const CloudT& cloudB, float threshold)
{
// compare B to A
int num_outlier = 0;
pcl::search::KdTree<typename CloudT::PointType> tree;
tree.setInputCloud(cloudA.makeShared());
auto sum = std::accumulate(cloudB.begin(), cloudB.end(), 0.0f, [&](auto current_sum, const auto& pt) {
const auto dist = nearestDistance(tree, pt);
if(dist < threshold)
{
return current_sum + dist;
}
else
{
num_outlier++;
return current_sum;
}
});
return sum / (cloudB.size() - num_outlier);
}
// comparing the clouds each way, A->B, B->A and taking the average
template<typename CloudT>
float similarity(const CloudT& cloudA, const CloudT& cloudB, float threshold = std::numeric_limits<float>::max())
{
// compare B to A
const auto similarityB2A = _similarity(cloudA, cloudB, threshold);
// compare A to B
const auto similarityA2B = _similarity(cloudB, cloudA, threshold);
return (similarityA2B * 0.5f) + (similarityB2A * 0.5f);
}
想法是,通过搜索B的每个点到邻居的最近距离,将点云B与A进行比较。通过平均找到的距离(不包括异常值),可以对点云B进行很好的估计。相似。
答案 1 :(得分:0)
不幸的是,我认为它没有正式记录过,但是PCL有一个命令行应用程序来报告两朵云之间的Hausdorff distance。尝试运行pcl_compute_hausdorff
。在PDAL库(https://pdal.io/apps/hausdorff.html)中也可以使用它,而您可以在其中运行pdal hausdorff
。
另一种常见的倒角距离(如https://arxiv.org/abs/1612.00603中所述),尽管我尚未立即意识到实现。