如何使用PCL進行顏色過濾

我正在學習使用 pcl。我想過濾掉顏色為紅色（rgb 255,0,0）的點云，但不起作用。我該怎么辦？我使用的 PCL 版本是 1.12.1。

#include <pcl/point_types.h>
#include <pcl/filters/conditional_removal.h>
int main()
{
    pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZRGB>);
    pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud_filtered(new 
    pcl::PointCloud<pcl::PointXYZRGB>);

    cloud->width = 5;
    cloud->height = 1;
    cloud->points.resize((cloud->width) * (cloud->height));
    //creat point cloud
    for (size_t i = 0; i < cloud->points.size();   i)
    {
       cloud->points[i].x = 1024 * rand() / (RAND_MAX   1.0f) / 1000;
       cloud->points[i].y = 1024 * rand() / (RAND_MAX   1.0f) / 1000;
       cloud->points[i].z = 1024 * rand() / (RAND_MAX   1.0f) / 1000;
       cloud->points[i].r = 110;
       cloud->points[i].g = 110;
       cloud->points[i].b = 110;
    }
   //set rbg 255,0,0
    cloud->points[2].r = 255;cloud->points[2].g = 0;cloud->points[2].b = 0;
    
    pcl::ConditionAnd<pcl::PointXYZRGB>::Ptr range_cond(new pcl::ConditionAnd<pcl::PointXYZRGB>());
    range_cond->addComparison(pcl::FieldComparison<pcl::PointXYZRGB>::ConstPtr(new pcl::FieldComparison<pcl::PointXYZRGB>("r", pcl::ComparisonOps::EQ, 255)));
    range_cond->addComparison(pcl::FieldComparison<pcl::PointXYZRGB>::ConstPtr(new pcl::FieldComparison<pcl::PointXYZRGB>("g", pcl::ComparisonOps::EQ, 0)));
    range_cond->addComparison(pcl::FieldComparison<pcl::PointXYZRGB>::ConstPtr(new pcl::FieldComparison<pcl::PointXYZRGB>("b", pcl::ComparisonOps::EQ, 0)));
   
   pcl::ConditionalRemoval<pcl::PointXYZRGB> condrem;
   condrem.setCondition(range_cond);
   condrem.setInputCloud(cloud);
   condrem.setKeepOrganized(true);
   condrem.filter(*cloud_filtered);
   
   std::cerr << "Cloud before filtering: " << std::endl;
   for (size_t i = 0; i < cloud->points.size();   i)
       std::cerr << "    " << cloud->points[i].x << " "
       << cloud->points[i].y << " "
       << cloud->points[i].z << " "
       << (int)cloud->points[i].r << " "
       << (int)cloud->points[i].g << " "
       << (int)cloud->points[i].b << std::endl;

   std::cerr << "Cloud after filtering: " << std::endl;
   for (size_t i = 0; i < cloud_filtered->points.size();   i)
      std::cerr << "    " << cloud_filtered->points[i].x << " "
      << cloud_filtered->points[i].y << " "
      << cloud_filtered->points[i].z << " "
      << (int)cloud_filtered->points[i].r << " "
      << (int)cloud_filtered->points[i].g << " "
      << (int)cloud_filtered->points[i].b << std::endl;
   return (0);

}

過濾后的云為無。結果： 在此輸入圖片描述

uj5u.com熱心網友回復：

警告訊息給你一個提示：“未找到欄位！” （三次）。PointXYZRGB沒有r、g和b欄位。您可以使用getFields()找出點型別具有哪些欄位。PointXYZRGB有一個rgb可用于過濾的組合欄位。但是，您可能需要考慮使用PointXYZRGBAinstead (with field rgba)，因為另一種點型別使用 afloat進行存盤（歷史原因），我不確定它與過濾的效果如何。

uj5u.com熱心網友回復：

我修改后的代碼在這里：

//creat point cloud
for (size_t i = 0; i < cloud->points.size();   i)
{
   cloud->points[i].x = 1024 * rand() / (RAND_MAX   1.0f) / 1000;
   cloud->points[i].y = 1024 * rand() / (RAND_MAX   1.0f) / 1000;
   cloud->points[i].z = 1024 * rand() / (RAND_MAX   1.0f) / 1000;
   cstd::uint32_t rgb = ((std::uint32_t)110 << 16 | (std::uint32_t)110 << 8 | (std::uint32_t)110);
   cloud->points[i].rgb = *reinterpret_cast<float*>(&rgb);
}
//set red rbg 255,0,0
std::uint32_t red_rgb = ((std::uint32_t)255 << 16 | (std::uint32_t)0 << 8 | (std::uint32_t)0);
cloud->points[2].rgb = *reinterpret_cast<float*>(&red_rgb);
std::cerr << " FieldsList:" << pcl::getFieldsList(*cloud) <<std::endl;

pcl::ConditionAnd<pcl::PointXYZRGB>::Ptr range_cond(new pcl::ConditionAnd<pcl::PointXYZRGB>());
std::uint32_t rgb_filter = ((std::uint32_t)255 << 16 | (std::uint32_t)0 << 8 | (std::uint32_t)0);

//Add a comparison operator less than (255,0,0) on the rgb field
range_cond->addComparison(pcl::FieldComparison<pcl::PointXYZRGB>::ConstPtr(new pcl::FieldComparison<pcl::PointXYZRGB>("rgb", pcl::ComparisonOps::LT, *reinterpret_cast<float*>(&rgb_filter))));

最終結果： 在此輸入圖片描述

標籤：C 筛选 点云库

上一篇：在C 中宣告雙精度陣列

下一篇：在C 中，函式呼叫中傳遞的引數究竟是如何初始化引數的？