PassThrough直通滤波实现

原理：对指定的某一维度进行滤波，去掉用户指定字段范围内（或外）的点。

void passthrough(pcl::PointCloud<pcl::PointXYZ>::Ptr& cloud, pcl::PointCloud<pcl::PointXYZ>::Ptr& cloud_filtered,
std::string field_name, float limit_min, float limit_max, bool limit_negative = false)
{
vector<int> index;
for (size_t i = 0; i < cloud->points.size(); ++i)
{
if (field_name == "x")
{
if (cloud->points[i].x >= limit_min && cloud->points[i].x <= limit_max)
index.push_back(i);
}
if (field_name == "y")
{
if (cloud->points[i].y >= limit_min && cloud->points[i].y <= limit_max)
index.push_back(i);
}
if (field_name == "z")
{
if (cloud->points[i].z >= limit_min && cloud->points[i].z <= limit_max)
index.push_back(i);
}
}
boost::shared_ptr<std::vector<int>> index_ptr = boost::make_shared<std::vector<int>>(index);
pcl::ExtractIndices<pcl::PointXYZ> extract;
extract.setInputCloud(cloud);
extract.setIndices(index_ptr);
extract.setNegative(limit_negative);
extract.filter(*cloud_filtered);
}

最后

以上就是热情棉花糖为你收集整理的PassThrough直通滤波实现的全部内容，希望文章能够帮你解决PassThrough直通滤波实现所遇到的程序开发问题。

如果觉得靠谱客网站的内容还不错，欢迎将靠谱客网站推荐给程序员好友。