【PCL】Segmentation 模块—— 欧几里得聚类提取（Euclidean Cluster Extraction）

devtools/2025/1/19 2:44:32/

1、简介

PCL 的 Euclidean Cluster Extraction（欧几里得聚类提取） 是一种基于欧几里得距离的点云聚类算法。它的目标是将点云数据分割成多个独立的簇（clusters），每个簇代表一个独立的物体或结构。该算法通过计算点与点之间的欧几里得距离，将距离小于给定阈值的点归为同一个簇。

1.1 欧几里得聚类提取的原理

  1. 基于距离的聚类：

    • 算法通过计算点云中每个点与其邻近点之间的欧几里得距离来判断它们是否属于同一个簇。
    • 如果两个点之间的距离小于设定的阈值（ClusterTolerance），则认为它们属于同一个簇。

  2. 使用 KdTree 加速搜索：

    • 为了高效地查找每个点的邻近点，算法使用 KdTree 数据结构来组织点云数据。
    • KdTree 是一种空间划分数据结构，可以快速找到某个点附近的点。

  3. 聚类条件：

    • 每个簇需要满足一定的点数范围：
      • 最小点数（MinClusterSize）：少于该点数的簇会被丢弃。
      • 最大点数（MaxClusterSize）：超过该点数的簇会被分割或丢弃。

1.2 PCL 中 EuclideanClusterExtraction 的关键参数

在 PCL 中，pcl::EuclideanClusterExtraction 类用于实现欧几里得聚类提取。以下是其关键参数：

  1. setClusterTolerance：

    • 设置聚类的距离阈值。
    • 例如，setClusterTolerance(0.02) 表示两点之间的距离小于 2cm 时，它们属于同一个簇。

  2. setMinClusterSize：

    • 设置每个簇的最小点数。
    • 例如，setMinClusterSize(100) 表示点数少于 100 的簇会被丢弃。

  3. setMaxClusterSize：

    • 设置每个簇的最大点数。
    • 例如，setMaxClusterSize(25000) 表示点数超过 25000 的簇会被分割或丢弃。

  4. setSearchMethod：

    • 设置用于搜索邻近点的数据结构，通常是 KdTree。
    • 例如，setSearchMethod(tree)，其中 tree 是一个 KdTree 对象。

  5. setInputCloud：

    • 设置输入的点云数据。

  6. extract：

    • 执行聚类提取，结果存储在 std::vector<pcl::PointIndices> 中，每个 pcl::PointIndices 表示一个簇。

1.3 欧几里得聚类提取的步骤

  1. 构建 KdTree：

    • 使用点云数据构建 KdTree，以便快速查找邻近点。

  2. 遍历点云：

    • 遍历点云中的每个点，找到其邻近点。
    • 如果邻近点与当前点的距离小于阈值，则将它们归为同一个簇。

  3. 递归扩展簇：

    • 对于每个邻近点，继续查找其邻近点，直到没有新的点可以加入当前簇。

  4. 过滤簇：

    • 根据设定的最小点数和最大点数，过滤掉不符合条件的簇。

  5. 输出结果：

    • 将每个簇的点云索引存储在 std::vector<pcl::PointIndices> 中。

2、代码示例

2.1 cluster_extraction.cpp

这段代码适用于处理3D点云数据，特别是在场景中分割平面和物体的应用中，代码主要包括点云的读取、滤波、平面分割、聚类以及保存聚类结果等步骤：

#include <pcl/ModelCoefficients.h>
#include <pcl/point_types.h>
#include <pcl/io/pcd_io.h>
#include <pcl/filters/extract_indices.h>
#include <pcl/filters/voxel_grid.h>
#include <pcl/features/normal_3d.h>
#include <pcl/search/kdtree.h>
#include <pcl/sample_consensus/method_types.h>
#include <pcl/sample_consensus/model_types.h>
#include <pcl/segmentation/sac_segmentation.h>
#include <pcl/segmentation/extract_clusters.h>
#include <iomanip> // for setw, setfillint 
main ()
{// 读取点云数据pcl::PCDReader reader;pcl::PointCloud<pcl::PointXYZ>::Ptr cloud (new pcl::PointCloud<pcl::PointXYZ>), cloud_f (new pcl::PointCloud<pcl::PointXYZ>);reader.read ("table_scene_lms400.pcd", *cloud);std::cout << "PointCloud before filtering has: " << cloud->size () << " data points." << std::endl; // 输出滤波前的点云数量// 创建滤波对象：使用1cm的叶子大小对数据集进行下采样pcl::VoxelGrid<pcl::PointXYZ> vg;pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_filtered (new pcl::PointCloud<pcl::PointXYZ>);vg.setInputCloud (cloud);vg.setLeafSize (0.01f, 0.01f, 0.01f);vg.filter (*cloud_filtered);std::cout << "PointCloud after filtering has: " << cloud_filtered->size ()  << " data points." << std::endl; // 输出滤波后的点云数量// 创建平面模型的分割对象并设置所有参数pcl::SACSegmentation<pcl::PointXYZ> seg;pcl::PointIndices::Ptr inliers (new pcl::PointIndices);pcl::ModelCoefficients::Ptr coefficients (new pcl::ModelCoefficients);pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_plane (new pcl::PointCloud<pcl::PointXYZ> ());pcl::PCDWriter writer;seg.setOptimizeCoefficients (true);seg.setModelType (pcl::SACMODEL_PLANE);seg.setMethodType (pcl::SAC_RANSAC);seg.setMaxIterations (100);seg.setDistanceThreshold (0.02);int nr_points = (int) cloud_filtered->size ();while (cloud_filtered->size () > 0.3 * nr_points){// 从剩余的点云中分割出最大的平面组件seg.setInputCloud (cloud_filtered);seg.segment (*inliers, *coefficients);if (inliers->indices.size () == 0){std::cout << "Could not estimate a planar model for the given dataset." << std::endl;break;}// 从输入点云中提取平面内点pcl::ExtractIndices<pcl::PointXYZ> extract;extract.setInputCloud (cloud_filtered);extract.setIndices (inliers);extract.setNegative (false);// 获取与平面表面相关的点extract.filter (*cloud_plane);std::cout << "PointCloud representing the planar component: " << cloud_plane->size () << " data points." << std::endl;// 移除平面内点，提取剩余点extract.setNegative (true);extract.filter (*cloud_f);*cloud_filtered = *cloud_f;}// 为提取方法创建KdTree对象pcl::search::KdTree<pcl::PointXYZ>::Ptr tree (new pcl::search::KdTree<pcl::PointXYZ>);tree->setInputCloud (cloud_filtered);std::vector<pcl::PointIndices> cluster_indices;pcl::EuclideanClusterExtraction<pcl::PointXYZ> ec;ec.setClusterTolerance (0.02); // 2cmec.setMinClusterSize (100);ec.setMaxClusterSize (25000);ec.setSearchMethod (tree);ec.setInputCloud (cloud_filtered);ec.extract (cluster_indices);int j = 0;for (const auto& cluster : cluster_indices){pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_cluster (new pcl::PointCloud<pcl::PointXYZ>);for (const auto& idx : cluster.indices) {cloud_cluster->push_back((*cloud_filtered)[idx]);} // 将聚类中的点添加到新的点云中cloud_cluster->width = cloud_cluster->size ();cloud_cluster->height = 1;cloud_cluster->is_dense = true;std::cout << "PointCloud representing the Cluster: " << cloud_cluster->size () << " data points." << std::endl;std::stringstream ss;ss << std::setw(4) << std::setfill('0') << j;writer.write<pcl::PointXYZ> ("cloud_cluster_" + ss.str () + ".pcd", *cloud_cluster, false); // 保存聚类结果到PCD文件j++;}return (0);
}

2.2 主要步骤：

  1. 读取点云数据：从PCD文件中读取点云数据，并输出点云的数量。
  2. 滤波：使用VoxelGrid滤波器对点云进行下采样，减少点云的数量，同时保持点云的形状。
  3. 平面分割：使用RANSAC算法从点云中分割出最大的平面组件，并提取出平面内点。
  4. 移除平面内点：将平面内点从点云中移除，保留剩余的点云。
  5. 聚类：使用欧几里得聚类算法对剩余的点云进行聚类，将点云分割成多个簇。
  6. 保存聚类结果：将每个聚类结果保存为单独的PCD文件。

2.3 关键点：

  • VoxelGrid滤波：通过设置叶子大小（setLeafSize）来控制下采样的精度。
  • RANSAC平面分割：通过设置最大迭代次数（setMaxIterations）和距离阈值（setDistanceThreshold）来控制平面分割的精度。
  • 欧几里得聚类：通过设置聚类容差（setClusterTolerance）、最小聚类大小（setMinClusterSize）和最大聚类大小（setMaxClusterSize）来控制聚类的效果。

2.4 CMakeLists.txt

cmake_minimum_required(VERSION 3.5 FATAL_ERROR)project(cluster_extraction)find_package(PCL 1.2 REQUIRED)include_directories(${PCL_INCLUDE_DIRS})
link_directories(${PCL_LIBRARY_DIRS})
add_definitions(${PCL_DEFINITIONS})add_executable (${PROJECT_NAME} cluster_extraction.cpp)
target_link_libraries (${PROJECT_NAME} ${PCL_LIBRARIES})

3、运行结果

  • 编译
mkdir build && cd build
cmake ..
make
  • 运行./cluster_extraction 
./cluster_extraction 
PointCloud before filtering has: 460400 data points.
PointCloud after filtering has: 41049 data points.
PointCloud representing the planar component: 20536 data points.
PointCloud representing the planar component: 12442 data points.
PointCloud representing the Cluster: 4857 data points.
PointCloud representing the Cluster: 1386 data points.
PointCloud representing the Cluster: 321 data points.
PointCloud representing the Cluster: 291 data points.
PointCloud representing the Cluster: 123 data points.

  • 保存提取到的点云文件
    在这里插入图片描述

  • 点云源文件table_scene_lms400.pcd
    在这里插入图片描述

  • 点云提取后
    在这里插入图片描述


http://www.ppmy.cn/devtools/151722.html

相关文章

25/1/15 嵌入式笔记 初学STM32F108

25/1/15 嵌入式笔记 初学STM32F108

GPIO初始化函数 GPIO_Ini&#xff1a;初始化GPIO引脚的模式&#xff0c;速度和引脚号 GPIO_Init(GPIOA, &GPIO_InitStruct); // 初始化GPIOA的引脚0 GPIO输出控制函数 GPIO_SetBits&#xff1a;将指定的GPIO引脚设置为高电平 GPIO_SetBits(GPIOA, GPIO_Pin_0); // 将GPIO…
阅读更多...
windows 极速安装 Linux （Ubuntu）-- 无需虚拟机

windows 极速安装 Linux （Ubuntu）-- 无需虚拟机

1. 安装 WSL 和 Ubuntu 打开命令行&#xff0c;执行 WSL --install -d ubuntu若报错&#xff0c;则先执行 WSL --update2. 重启电脑 因安装了子系统&#xff0c;需重启电脑才生效 3. 配置 Ubuntu 的账号密码 打开 Ubuntu 的命令行 按提示&#xff0c;输入账号&#xff0c;密…
阅读更多...
【Redis】初识Redis

【Redis】初识Redis

目录 Redis简介 Redis在内存中存储数据 Redis数据库中的应用 Redis缓存中的应用 Redis消息中间件 尾言 Redis简介 如下是Redis官网中&#xff0c;对Redis的一段描述 在这段描述中&#xff0c;我们提取如下关键要点&#xff1a; Redis主要用于在内存中存储数据Redis可…
阅读更多...
勾股数元组

勾股数元组

勾股数元组 真题目录: 点击去查看 E 卷 100分题型 题目描述 如果3个正整数(a,b,c)满足a^2 b^2 c^2的关系&#xff0c;则称(a,b,c)为勾股数&#xff08;著名的勾三股四弦五&#xff09;&#xff0c; 为了探索勾股数的规律&#xff0c;我们定义如果勾股数(a,b,c)之间两两互质…
阅读更多...
以太网详解（五）GMII、RGMII、SGMII接口时序约束（Quartus 平台）

以太网详解（五）GMII、RGMII、SGMII接口时序约束（Quartus 平台）

文章目录 接口时序Avalon Streaming 接口时序Receive TimingTransmit Timing GMII 接口时序Receive TimingTransmit Timing RGMII 接口时序Receive TimingTransmit Timing 如何创建 .sdc 约束文件三速以太网系统时钟信号创建 set_input_delay&#xff0c;set_output_delay 约束…
阅读更多...
1️⃣Java中的集合体系学习汇总（List/Map/Set 详解）

1️⃣Java中的集合体系学习汇总（List/Map/Set 详解）

目录 01. Java中的集合体系 02. 单列集合体系​ 1. Collection系列集合的遍历方式 &#xff08;1&#xff09;迭代器遍历&#xff08;2&#xff09;增强for遍历​编辑&#xff08;3&#xff09;Lambda表达式遍历 03.List集合详解 04.Set集合详解 05.总结 Collection系列…
阅读更多...
2025年01月16日Github流行趋势

2025年01月16日Github流行趋势

项目名称&#xff1a;tabby 项目地址url&#xff1a;https://github.com/TabbyML/tabby 项目语言&#xff1a;Rust 历史star数&#xff1a;27449 今日star数&#xff1a;1439 项目维护者&#xff1a;wsxiaoys, apps/autofix-ci, icycodes, liangfung, boxbeam 项目简介&#xf…
阅读更多...
tplink rt406路由器如何配置端口映射

tplink rt406路由器如何配置端口映射

配置TP-Link RT406路由器的端口映射&#xff08;端口转发&#xff09;步骤如下&#xff1a; 1. 登录路由器管理界面 打开浏览器&#xff0c;输入默认IP地址192.168.1.1&#xff0c;按回车。输入用户名和密码&#xff08;默认均为admin&#xff09;&#xff0c;点击“登录”。…
阅读更多...
最新文章

Copyright @ 2022~2023