『表面』在平面模型上提取凸(凹)多边形

『表面』在平面模型上提取凸(凹)多边形_第1张图片 原始点云

『表面』在平面模型上提取凸(凹)多边形_第2张图片 直通滤波,z轴0~1.1

 

『表面』在平面模型上提取凸(凹)多边形_第3张图片 分割模型为平面,分割结果进行投影

 

 

『表面』在平面模型上提取凸(凹)多边形_第4张图片 提取多边形

 

代码:

#include  // 模型系数的数据结构,如平面、圆的系数
#include 

#include  // 点云数据类型
#include  // 采样一致性方法(Sample Consensus Methods)的枚举类型,如RANSAC(随机采样一致性)
#include  // 采样一致性模型(Sample Consensus Models)的枚举类型,例如平面、圆

#include  // 直通滤波器,指定范围筛选
#include  // 点云数据投影到指定模型(如平面),可用于提取点云数据的特定部分

#include  // 基于采样一致性的分割,将点云数据分割为不同的部分,如平面、圆柱
#include  // 生成点云数据凹多边形(concave Hull)表示的方法,可用于提取点云数据的边界信息
#include 

int main(){

    pcl::PointCloud::Ptr cloud(new pcl::PointCloud),
            cloud_filtered(new pcl::PointCloud),
            cloud_projected(new pcl::PointCloud);

    // 读取点云数据
    pcl::PCDReader reader;
    reader.read("/home/jason/file/pcl-learning/11surface表面/2在平面模型上提取凸(凹)多边形/table_scene_mug_stereo_textured.pcd", *cloud);

    // 建立过滤器对z轴进行过滤
    pcl::PassThrough pass;
    pass.setInputCloud(cloud);
    pass.setFilterFieldName("z");
    pass.setFilterLimits(0, 1.1);
    pass.filter(*cloud_filtered);
    std::cerr << "PointCloud after filtering has: "
              << cloud_filtered->points.size() << " data points." << std::endl;

    // 分割点云数据
    pcl::ModelCoefficients::Ptr coefficients(new pcl::ModelCoefficients); // 用于存储模型系数
    pcl::PointIndices::Ptr inliers(new pcl::PointIndices); // 用于存储分割后的点云索引,这里将属于平面的点云索引

    pcl::SACSegmentation seg; // 创建分割对象
    seg.setOptimizeCoefficients(true); // 设置优化系数
    seg.setModelType(pcl::SACMODEL_PLANE);// 设置模型类型为平面
    seg.setMethodType(pcl::SAC_RANSAC); // 设置采用RANSAC算法进行分割
    seg.setDistanceThreshold(0.01); // 设置点到平面的最大距离阈值

    seg.setInputCloud(cloud_filtered);  // 设置输入点云
    seg.segment(*inliers, *coefficients); // 执行点云分割
    std::cerr << "PointCloud after segmentation has: "
              << inliers->indices.size() << "inliers." << std::endl;

    // 对点云投影
    pcl::ProjectInliers proj; // 创建投影对象滤波器对象
    proj.setModelType(pcl::SACMODEL_PLANE); // 设置模型类型为平面
    proj.setIndices(inliers); // 设置输入点云的索引
    proj.setInputCloud(cloud_filtered); // 设置输入点云
    proj.setModelCoefficients(coefficients); // 平面模型的系数设置到投影滤波器中
    proj.filter(*cloud_projected); // 进行投影滤波
    std::cerr << "PointCloud after projection has: "
              << cloud_projected->points.size() << " data points. " << std::endl;

    // 存储提取多边形上的点云
    pcl::PointCloud::Ptr cloud_hull(new pcl::PointCloud);
    pcl::ConcaveHull chull; // 创建多边形提取对象
    chull.setInputCloud(cloud_projected); // 设置输入点云为
    chull.setAlpha(0.1);
    chull.reconstruct(*cloud_hull);

    std::cerr << "Concave hull has: " << cloud_hull->points.size()
              << " data points." << std::endl;
    pcl::PCDWriter writer;
    writer.write("/home/jason/file/pcl-learning/11surface表面/2在平面模型上提取凸(凹)多边形/table_scene_mug_stereo_textured_hull.pcd",
                 *cloud_hull, false);


    pcl::visualization::CloudViewer viewer("cloud viewer");
    viewer.showCloud(cloud);  // 每次只能展示一个
//    viewer.showCloud(cloud_filtered);
//    viewer.showCloud(cloud_hull);

    while (!viewer.wasStopped() ) {

    }


    return 0;
}

你可能感兴趣的:(点云,人工智能)