PCL 点云添加随机噪声并保存

ops/2024/10/9 6:48:42/

目录

一、概述

1.1原理

1.2实现步骤

1.3应用场景

二、代码实现

2.1关键函数

2.1.1 添加随机噪声实现

2.1.2 可视化函数

2.2完整代码

三、实现效果


PCL点云算法汇总及实战案例汇总的目录地址链接:

PCL点云算法与项目实战案例汇总(长期更新)


一、概述

        给点云随机添加噪声 是一种常用的数据增强方法,可以模拟传感器测量时的误差。与高斯噪声不同,随机噪声指的是在某个范围内生成均匀分布的随机数,并将其添加到点云的坐标上。这样可以在点云的每个点周围生成随机扰动,以评估算法的鲁棒性。

1.1原理

        随机噪声是一种均匀分布的噪声,它在给定范围内随机生成值,并将这些值添加到点云的坐标上。公式如下:

                                                       𝑥noisy=𝑥+random(𝑎,𝑏)

        random(𝑎,𝑏)表示在范围 [a,b] 内生成的随机数。

1.2实现步骤

  1. 读取点云数据。
  2. 为点云中的每个点随机添加噪声。
  3. 保存带噪声的点云数据。
  4. 可视化原始点云和带噪声的点云。

1.3应用场景

  1. 测试算法鲁棒性:评估点云处理算法在噪声环境下的表现。
  2. 模拟传感器误差:随机噪声可以用于模拟传感器测量误差。
  3. 数据增强:增加点云数据的多样性,以提高机器学习模型的泛化能力。

二、代码实现

2.1关键函数

2.1.1 添加随机噪声实现

通过为每个点的坐标添加随机噪声,生成带有随机噪声的点云。

#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
#include <random>// 添加随机噪声函数
pcl::PointCloud<pcl::PointXYZ>::Ptr addRandomNoise(pcl::PointCloud<pcl::PointXYZ>::Ptr cloud,  // 输入点云float noise_min,                            // 噪声范围的最小值float noise_max                             // 噪声范围的最大值
)
{// 随机数生成器std::default_random_engine generator;std::uniform_real_distribution<float> distribution(noise_min, noise_max);  // 均匀分布// 创建带有噪声的点云pcl::PointCloud<pcl::PointXYZ>::Ptr noisy_cloud(new pcl::PointCloud<pcl::PointXYZ>(*cloud));  // 拷贝原始点云for (auto& point : noisy_cloud->points){point.x += distribution(generator);  // 为x坐标添加随机噪声point.y += distribution(generator);  // 为y坐标添加随机噪声point.z += distribution(generator);  // 为z坐标添加随机噪声}return noisy_cloud;  // 返回带噪声的点云
}

2.1.2 可视化函数

使用 PCL 可视化库展示原始点云和添加噪声后的点云。

#include <pcl/visualization/pcl_visualizer.h>// 可视化原始点云和添加噪声后的点云
void visualizePointClouds(pcl::PointCloud<pcl::PointXYZ>::Ptr cloud,          // 原始点云pcl::PointCloud<pcl::PointXYZ>::Ptr noisy_cloud     // 添加噪声后的点云
)
{// 创建可视化器pcl::visualization::PCLVisualizer::Ptr viewer(new pcl::visualization::PCLVisualizer("Noisy Point Cloud Viewer"));// 创建视口1,显示原始点云int vp_1;viewer->createViewPort(0.0, 0.0, 0.5, 1.0, vp_1);  // 创建左侧窗口viewer->setBackgroundColor(1.0, 1.0, 1.0, vp_1);   // 设置白色背景viewer->addText("Original Point Cloud", 10, 10, "vp1_text", vp_1);  // 添加标题// 设置原始点云的颜色为红色pcl::visualization::PointCloudColorHandlerCustom<pcl::PointXYZ> cloud_color_handler(cloud, 255, 0, 0);  // 红色viewer->addPointCloud<pcl::PointXYZ>(cloud, cloud_color_handler, "original_cloud", vp_1);  // 添加原始点云// 创建视口2,显示添加噪声后的点云int vp_2;viewer->createViewPort(0.5, 0.0, 1.0, 1.0, vp_2);  // 创建右侧窗口viewer->setBackgroundColor(0.98, 0.98, 0.98, vp_2);  // 设置浅灰色背景viewer->addText("Noisy Point Cloud", 10, 10, "vp2_text", vp_2);  // 添加标题// 设置带噪声点云的颜色为绿色pcl::visualization::PointCloudColorHandlerCustom<pcl::PointXYZ> noisy_cloud_color_handler(noisy_cloud, 0, 255, 0);  // 绿色viewer->addPointCloud<pcl::PointXYZ>(noisy_cloud, noisy_cloud_color_handler, "noisy_cloud", vp_2);  // 添加带噪声点云// 设置点的大小(可选)viewer->setPointCloudRenderingProperties(pcl::visualization::PCL_VISUALIZER_POINT_SIZE, 2, "original_cloud", vp_1);viewer->setPointCloudRenderingProperties(pcl::visualization::PCL_VISUALIZER_POINT_SIZE, 2, "noisy_cloud", vp_2);// 启动可视化循环while (!viewer->wasStopped()){viewer->spinOnce(100);  // 刷新可视化器}
}

2.2完整代码

// C++头文件
#include <iostream>
// PCL头文件
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
#include <pcl/visualization/pcl_visualizer.h>
#include <random>  // 随机数生成// 添加随机噪声函数
pcl::PointCloud<pcl::PointXYZ>::Ptr addRandomNoise(pcl::PointCloud<pcl::PointXYZ>::Ptr cloud,  // 输入点云float noise_min,                            // 噪声范围的最小值float noise_max                             // 噪声范围的最大值
)
{// 随机数生成器std::default_random_engine generator;std::uniform_real_distribution<float> distribution(noise_min, noise_max);  // 均匀分布// 创建带有噪声的点云pcl::PointCloud<pcl::PointXYZ>::Ptr noisy_cloud(new pcl::PointCloud<pcl::PointXYZ>(*cloud));  // 拷贝原始点云for (auto& point : noisy_cloud->points){point.x += distribution(generator);  // 为x坐标添加随机噪声point.y += distribution(generator);  // 为y坐标添加随机噪声point.z += distribution(generator);  // 为z坐标添加随机噪声}return noisy_cloud;  // 返回带噪声的点云
}// 可视化原始点云和添加噪声后的点云
void visualizePointClouds(pcl::PointCloud<pcl::PointXYZ>::Ptr cloud,          // 原始点云pcl::PointCloud<pcl::PointXYZ>::Ptr noisy_cloud     // 添加噪声后的点云
)
{// 创建可视化器pcl::visualization::PCLVisualizer::Ptr viewer(new pcl::visualization::PCLVisualizer("Noisy Point Cloud Viewer"));// 创建视口1,显示原始点云int vp_1;viewer->createViewPort(0.0, 0.0, 0.5, 1.0, vp_1);  // 创建左侧窗口viewer->setBackgroundColor(1.0, 1.0, 1.0, vp_1);   // 设置白色背景viewer->addText("Original Point Cloud", 10, 10, "vp1_text", vp_1);  // 添加标题// 设置原始点云的颜色为红色pcl::visualization::PointCloudColorHandlerCustom<pcl::PointXYZ> cloud_color_handler(cloud, 255, 0, 0);  // 红色viewer->addPointCloud<pcl::PointXYZ>(cloud, cloud_color_handler, "original_cloud", vp_1);  // 添加原始点云// 创建视口2,显示添加噪声后的点云int vp_2;viewer->createViewPort(0.5, 0.0, 1.0, 1.0, vp_2);  // 创建右侧窗口viewer->setBackgroundColor(0.98, 0.98, 0.98, vp_2);  // 设置浅灰色背景viewer->addText("Noisy Point Cloud", 10, 10, "vp2_text", vp_2);  // 添加标题// 设置带噪声点云的颜色为绿色pcl::visualization::PointCloudColorHandlerCustom<pcl::PointXYZ> noisy_cloud_color_handler(noisy_cloud, 0, 255, 0);  // 绿色viewer->addPointCloud<pcl::PointXYZ>(noisy_cloud, noisy_cloud_color_handler, "noisy_cloud", vp_2);  // 添加带噪声点云// 设置点的大小(可选)viewer->setPointCloudRenderingProperties(pcl::visualization::PCL_VISUALIZER_POINT_SIZE, 2, "original_cloud", vp_1);viewer->setPointCloudRenderingProperties(pcl::visualization::PCL_VISUALIZER_POINT_SIZE, 2, "noisy_cloud", vp_2);// 启动可视化循环while (!viewer->wasStopped()){viewer->spinOnce(100);  // 刷新可视化器}
}// 保存噪声点云到文件
void saveNoisyPointCloud(pcl::PointCloud<pcl::PointXYZ>::Ptr noisy_cloud, const std::string& filename)
{pcl::io::savePCDFileBinary(filename, *noisy_cloud);  // 保存为二进制 PCD 格式std::cout << "带噪声的点云已保存至: " << filename << std::endl;
}int main(int argc, char** argv)
{// ------------------------------读取点云数据---------------------------------pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>);if (pcl::io::loadPCDFile("bunny.pcd", *cloud) < 0){PCL_ERROR("Could not read file\n");return (-1);  // 返回错误}// -------------------------------添加随机噪声---------------------------------float noise_min = -0.01f;  // 噪声最小值float noise_max = 0.01f;   // 噪声最大值pcl::PointCloud<pcl::PointXYZ>::Ptr noisy_cloud = addRandomNoise(cloud, noise_min, noise_max);  // 添加噪声// -------------------------------保存噪声点云---------------------------------//saveNoisyPointCloud(noisy_cloud, "random_noisy_bunny.pcd");  // 保存带噪声的点云// ------------------------------可视化原始点云和带噪声的点云---------------------------------visualizePointClouds(cloud, noisy_cloud);  // 调用可视化函数return 0;
}

三、实现效果


http://www.ppmy.cn/ops/123043.html

相关文章

【C++】:lambda表达式的高级应用

欢迎来到 破晓的历程的 博客 ⛺️不负时光&#xff0c;不负己✈️ 引言 今天 我们来见见lambda表达式的高级用法 用法1&#xff1a;自定义删除器 有些类型的delete方法并不符合自身的析构方法&#xff0c;这时我们就需要自定义删除器。 unique_ptr<FILE> ptr1(fopen…

数据结构——排序(插入排序)

目录 一、插入排序 二、直接插入排序 基本概念&#xff1a; 工作原理&#xff1a; 示例&#xff1a; 代码实现 三、希尔排序 &#xff08;一&#xff09;基本概念 &#xff08;二&#xff09;工作原理 &#xff08;三&#xff09;示例 &#xff08;四&#xff09;代码实…

Vue3入门 - provide和inject组合使用

在Vue3中&#xff0c;provide和inject是用于实现依赖注入的一对API。它们允许在组件树中传递和接收数据&#xff0c;而不需要通过每一层显式地传递props。在<script setup>语法中&#xff0c;provide可以用来提供一个值&#xff0c;而inject可以用来接收一个已经提供的值…

QD1-P7 HTML常用标签:div和span

本节学习&#xff1a;div 和 span 标签。 本节视频 www.bilibili.com/video/BV1n64y1U7oj?p7 ‍ 一、div 标签 用途 ​<div>​ 标签在 HTML 中是一个通用 容器 &#xff0c;用于将 HTML 文档中的内容分组并在文档中划分区域。<div> ​元素本身不具有特定的含…

CSMA/CD协议整理

CSMA/CD协议&#xff0c;即载波监听多路访问/冲突检测技术&#xff0c;是以太网中解决数据包冲突的关键机制。以下是对CSMA/CD协议进行冲突检测的详细解释和介绍&#xff1a; 一、CSMA/CD协议概述 CSMA/CD协议的核心思想是“先听后发&#xff0c;边发边听&#xff0c;冲突停发…

mysql join的使用

MySQL 支持以下 JOIN 语法用于 SELECT 语句和多表 DELETE 和 UPDATE 语句中的 table_references 部分&#xff1a; table_references: 查询中涉及的一个或多个表的引用&#xff0c;可以是简单表名或 JOIN 表达式的组合。 escaped_table_reference [, escaped_table_referenc…

EXCEL_光标百分比

Public Sub InitCells()Dim iSheet As LongFor iSheet Sheets.Count To 1 Step -1Sheets(iSheet).ActivateActiveWindow.Zoom 85ActiveWindow.ScrollRow 1ActiveWindow.ScrollColumn 1Sheets(iSheet).Range("A1").ActivateNext iSheetEnd Sub对日项目中的文档满天…

【算法】- 查找 - 多路查找树(B树)

文章目录 前言一、多路查找树&#xff08;B树&#xff09;二、2-3树的查找2-3树查找代码 三、2-3树的插入2-3树代码 2-3树代码总结 前言 上次我们学了如何用平衡二叉树来插入和查找。这些算法都是在内存中进行&#xff0c;若我们要操作的数据非常大&#xff0c;大到内存没办法处…