滤波

1.源文件

#include <iostream>
#include <pcl/console/parse.h>
#include <pcl/filters/extract_indices.h>
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
#include <pcl/sample_consensus/ransac.h>
#include <pcl/sample_consensus/sac_model_plane.h>
#include <pcl/sample_consensus/sac_model_sphere.h>
#include <pcl/visualization/pcl_visualizer.h>
#include <boost/thread/thread.hpp>
#include <pcl/filters/passthrough.h>
#include <pcl/segmentation/sac_segmentation.h>
#include <pcl/filters/voxel_grid.h>
#include <pcl/filters/statistical_outlier_removal.h>
#include <pcl/filters/radius_outlier_removal.h>
#include <pcl/filters/conditional_removal.h>


int main()
{
    pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>); // 创建POintCloud<PointXYZ>boost共享指针并进行实例化
     // 打开点云文件
    if (pcl::io::loadPCDFile<pcl::PointXYZ>("C:\\Users\\Administrator\\Desktop\\testHMI\\KOScanTruckServerSetup\\config\\points666.pcd", *cloud) == -1) {
        return -1;
    }

    // 直通滤波:过滤掉不符合阈值范围的点
    pcl::PointCloud<pcl::PointXYZ>::Ptr pass_cloud(new pcl::PointCloud<pcl::PointXYZ>); // 过滤后存储的点云数据
    pcl::PassThrough<pcl::PointXYZ> pass;   // 直通滤波器
    pass.setInputCloud(cloud);  // 添加原始数据
    pass.setFilterFieldName("z");   // 设置过滤的名称
    pass.setFilterLimits(-2964.0f, 3463.0f);    // 设置过滤的最小最大值
    pass.filter(*pass_cloud);   // 过滤

    // 体素滤波:减少点云数量,保持点云特质
    pcl::PointCloud<pcl::PointXYZ>::Ptr voxel_cloud(new pcl::PointCloud<pcl::PointXYZ>);    // 过滤后存储的点云数据
    pcl::VoxelGrid<pcl::PointXYZ> voxel;    // 体素滤波器
    voxel.setInputCloud(cloud); // 添加原始数据
    voxel.setLeafSize(100.0f, 100.0f, 100.0f);  // 设置网格大小,网格越大点云越稀疏
    voxel.filter(*voxel_cloud); // 过滤

    // 统计离群滤波器:删除离群点(噪点和杂点)
    pcl::PointCloud<pcl::PointXYZ>::Ptr sor_cloud(new pcl::PointCloud<pcl::PointXYZ>);  // 过滤后存储的点云数据
    pcl::StatisticalOutlierRemoval<pcl::PointXYZ> sor;  // 统计离群滤波器
    sor.setInputCloud(cloud);   // 添加原始数据
    sor.setMeanK(10);   // 设置统计时邻近的点数
    sor.setStddevMulThresh(1.0);    // 设置距离阈值
    sor.filter(*sor_cloud);     // 过滤

    // 半径滤波器:删除离群点
    pcl::PointCloud<pcl::PointXYZ>::Ptr ror_cloud(new pcl::PointCloud<pcl::PointXYZ>);  // 过滤后存储的点云数据
    pcl::RadiusOutlierRemoval<pcl::PointXYZ> ror;   // 半径滤波器
    ror.setInputCloud(cloud);   // 添加原始点云数据
    ror.setRadiusSearch(1000);  // 设置半径值
    ror.setMinNeighborsInRadius(100);   // 设置该半径范围内的最小点数据,小于最小点数则删除
    //ror.setKeepOrganized(true);   // 保持数据组织结构
    ror.filter(*ror_cloud);     // 过滤

    // 条件滤波器:删除不符合条件的离群点
    pcl::PointCloud<pcl::PointXYZ>::Ptr cr_cloud(new pcl::PointCloud<pcl::PointXYZ>);   // 过滤后存储的点云数据
    // 过滤条件
    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, -2964.0f)));   // z方向最小值
    range_cond->addComparison(pcl::FieldComparison<pcl::PointXYZ>::ConstPtr(new pcl::FieldComparison<pcl::PointXYZ>("z", pcl::ComparisonOps::LT, 3463.0f)));    // z方向最大值
    range_cond->addComparison(pcl::FieldComparison<pcl::PointXYZ>::ConstPtr(new pcl::FieldComparison<pcl::PointXYZ>("x", pcl::ComparisonOps::GT, -9574.0f)));   // x方向最小值
    range_cond->addComparison(pcl::FieldComparison<pcl::PointXYZ>::ConstPtr(new pcl::FieldComparison<pcl::PointXYZ>("x", pcl::ComparisonOps::LT, 7805.0f)));    // x方向最大值
    range_cond->addComparison(pcl::FieldComparison<pcl::PointXYZ>::ConstPtr(new pcl::FieldComparison<pcl::PointXYZ>("y", pcl::ComparisonOps::GT, 11635.0f)));   // y方向最小值
    range_cond->addComparison(pcl::FieldComparison<pcl::PointXYZ>::ConstPtr(new pcl::FieldComparison<pcl::PointXYZ>("y", pcl::ComparisonOps::LT, 13135.0f)));   // y方向最大值
    pcl::ConditionalRemoval<pcl::PointXYZ> cr;  // 条件滤波器
    cr.setInputCloud(cloud);        // 添加原始点云数据
    cr.setCondition(range_cond);    // 设置条件
    //cr.setKeepOrganized(true);        // 保持数据组织结构
    cr.filter(*cr_cloud);           // 过滤


    pcl::io::savePCDFileASCII("result.pcd", *cr_cloud); // 写文件
    // 显示
    boost::shared_ptr<pcl::visualization::PCLVisualizer> viewer(new pcl::visualization::PCLVisualizer("3D viewer"));
    viewer->setBackgroundColor(0, 0, 0);    // 显示的背景颜色
    viewer->addPointCloud<pcl::PointXYZ>(cr_cloud, "sample cloud"); // 添加要显示的点云数据和设置标题
    viewer->setPointCloudRenderingProperties(pcl::visualization::PCL_VISUALIZER_POINT_SIZE, 3, "sample cloud");
    viewer->addCoordinateSystem (1.0);  // 添加坐标轴
    viewer->initCameraParameters();

    while (!viewer->wasStopped()) {
        viewer->spinOnce(100);
        
    }

    return 0;
}
最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 162,825评论 4 377
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 68,887评论 2 308
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 112,425评论 0 255
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 44,801评论 0 224
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 53,252评论 3 299
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 41,089评论 1 226
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 32,216评论 2 322
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 31,005评论 0 215
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 34,747评论 1 250
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 30,883评论 2 255
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 32,354评论 1 265
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 28,694评论 3 265
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 33,406评论 3 246
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 26,222评论 0 9
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 26,996评论 0 201
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 36,242评论 2 287
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 36,017评论 2 281

推荐阅读更多精彩内容