2017-02-18 218 views
0

。該程序看起來像被絞死。 並且沒有錯誤。pcl :: StatisticalOutlierRemoval無法在sor.filter()運行時運行

我認爲這些pcd文件有問題,因爲它可以很好地與PCL提供的pcd數據一起使用。我的pcd文件是從Kinect2保存的。但我找不到它們之間的區別。

boost::shared_ptr<pcl::PointCloud<pcl::PointXYZ> > cloud(new pcl::PointCloud<pcl::PointXYZ>); 
boost::shared_ptr<pcl::visualization::PCLVisualizer> viewer(
new pcl::visualization::PCLVisualizer("Point Cloud Viewer")); 
viewer->setCameraPosition(0.0, 0.0, -2.5, 0.0, 0.0, 0.0); 
pcl::io::loadPCDFile("table_scene_lms400.pcd",*cloud); 
//pcl::io::loadPCDFile("test.pcd",*cloud); 
pcl::StatisticalOutlierRemoval<pcl::PointXYZ> sor; 
sor.setMeanK(50); 
sor.setStddevMulThresh(1); 
pcl::PointCloud <pcl::PointXYZ>::Ptr cloud_filtered(new pcl::PointCloud<pcl::PointXYZ>); 
sor.setInputCloud(cloud); 
sor.filter(*cloud_filtered); 
viewer->addPointCloud(cloud_filtered,"cloud"); 

回答

0

至少,我發現在我的pcd文件中有很多點的座標是[0,0,0]。這就是問題所在。我試圖通過傳遞過濾器來提醒他們。而且,這個方案令人興奮。但我想要更好地提出這些觀點。

0

我用這個函數從點雲中刪除有限和零點,它是基於PCL Conditional removal類和isFinite()

PointCloudPtr null_filter(const PointCloudPtr cloud_in) 
{ 
    PointCloudPtr cloud_out(new PointCloud); 
    PointCloudPtr temp(new PointCloud); 

    // build the condition 
    pcl::ConditionOr<PointT>::Ptr range_cond(new pcl::ConditionOr<PointT>()); 
    range_cond->addComparison(pcl::FieldComparison<PointT>::ConstPtr(new pcl::FieldComparison<PointT>("x", pcl::ComparisonOps::GT, 0.0))); 
    range_cond->addComparison(pcl::FieldComparison<PointT>::ConstPtr(new pcl::FieldComparison<PointT>("x", pcl::ComparisonOps::LT, 0.0))); 

    range_cond->addComparison(pcl::FieldComparison<PointT>::ConstPtr(new pcl::FieldComparison<PointT>("y", pcl::ComparisonOps::GT, 0.0))); 
    range_cond->addComparison(pcl::FieldComparison<PointT>::ConstPtr(new pcl::FieldComparison<PointT>("y", pcl::ComparisonOps::LT, 0.0))); 

    range_cond->addComparison(pcl::FieldComparison<PointT>::ConstPtr(new pcl::FieldComparison<PointT>("z", pcl::ComparisonOps::GT, 0.0))); 
    range_cond->addComparison(pcl::FieldComparison<PointT>::ConstPtr(new pcl::FieldComparison<PointT>("z", pcl::ComparisonOps::LT, 0.0))); 

    // build the filter 
    pcl::ConditionalRemoval<PointT> condrem; 
    condrem.setCondition(range_cond); 
    condrem.setInputCloud(cloud_in); 

    // apply filter 
    condrem.filter(*cloud_out); 

    pcl::PointCloud<PointT>::iterator del = cloud_out->points.begin(); 
    for (int i = 0; i < cloud_out->points.size(); i++) 
    { 
     if (!pcl::isFinite<PointT>(cloud_out->points[i])) 
     { 
      //  PCL_WARN("normals[%d] is not finite\n", i); 
      cloud_out->points.erase(del + i); 
     } 
    } 
    std::vector<int> indices; 
    pcl::removeNaNFromPointCloud(*cloud_out, *temp, indices); 

    return temp; 
}