不知道行不行

#include <iostream>
#include <pcl/point_types.h>
#include <pcl/filters/radius_outlier_removal.h>
#include <pcl/filters/conditional_removal.h>
#include <pcl/io/pcd_io.h>
#include <pcl/visualization/cloud_viewer.h>

int
 main (int argc, char** argv)
{
  if (argc != 2)
  {
    std::cerr << "please specify command line arg '-r' or '-c'" << std::endl;
    exit(0);
  }
  
  pcl::PointCloud<pcl::PointXYZ>::Ptr cloud (new pcl::PointCloud<pcl::PointXYZ>);
  pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_filtered (new pcl::PointCloud<pcl::PointXYZ>);
  // 填入点云数据
  cloud->width  = 1000;
  cloud->height = 1;
  cloud->points.resize (cloud->width * cloud->height);
  for (size_t i = 0; i < cloud->points.size (); ++i)
  {
    cloud->points[i].x = 1024 * rand () / (RAND_MAX + 1.0f);
    cloud->points[i].y = 1024 * rand () / (RAND_MAX + 1.0f);
    cloud->points[i].z = 1024 * rand () / (RAND_MAX + 1.0f);
  }
 

  if (strcmp(argv[1], "-r") == 0)
  {

      pcl::RadiusOutlierRemoval<pcl::PointXYZ> outrem;
      // 创建滤波器
      outrem.setInputCloud(cloud);
      outrem.setRadiusSearch(50); //在半径为100的范围内搜索领近点
      outrem.setMinNeighborsInRadius(30);//设置查询点的邻近点集数小于3的删除
      // 应用滤波器
      outrem.filter(*cloud_filtered);
  }
   //用户使用CondtionalRemoval滤波器,
   else if (strcmp(argv[1], "-c") == 0)
   {
     // 创建环境  GT表示大于等于,LT表示小于等于 该比较算子大于等于0小于等于0.8
     pcl::ConditionAnd<pcl::PointXYZ>::Ptr range_cond (new pcl::ConditionAnd<pcl::PointXYZ> ());
     range_cond->addComparison (pcl::FieldComparison<pcl::PointXYZ>::ConstPtr (new
       pcl::FieldComparison<pcl::PointXYZ> ("z", pcl::ComparisonOps::GT, 100.0)));
     range_cond->addComparison (pcl::FieldComparison<pcl::PointXYZ>::ConstPtr (new
       pcl::FieldComparison<pcl::PointXYZ> ("z", pcl::ComparisonOps::LT, 200.0)));
     // 创建滤波器
     pcl::ConditionalRemoval<pcl::PointXYZ> condrem;
  condrem.setCondition(range_cond);
     condrem.setInputCloud (cloud);
    condrem.setKeepOrganized(true);//保持点云的结构
     // 应用滤波器
     condrem.filter (*cloud_filtered);
   }
   else
   {
     std::cerr << "please specify command line arg '-r' or '-c'" << std::endl;
     exit(0);
   }

  std::cout << "输入的点云个数: " << cloud->points.size() << std::endl;
   for (size_t i = 0; i < cloud->points.size(); ++i)
  {
  std::cout << cloud->points[i].x << " "
  << cloud->points[i].y << " "
  << cloud->points[i].z << std::endl;
  }
  std::cout << "输出的点云个数: " << cloud_filtered->points.size() << std::endl;
   for (size_t i = 0; i < cloud->points.size(); ++i)
  {
       std::cout << cloud_filtered->points[i].x << " "
           << cloud_filtered->points[i].y << " "
  << cloud_filtered->points[i].z << std::endl;
  }
  pcl::visualization::PCLVisualizer viewer1;
  pcl::visualization::PCLVisualizer viewer2;
  viewer1.addPointCloud(cloud);
  viewer2.addPointCloud(cloud_filtered);
  while (!viewer1.wasStopped())
  {
      viewer1.spinOnce(100);
      viewer1.spinOnce(100);
  }
  return (0);
}
 

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值