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

目录

一、概述

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;
}

三、实现效果

点云高斯噪声指的是点云数据中存在高斯分布的噪声。点云是由大量的点组成的三维空间数据,常用于三维重建、环境感知等领域。然而,在采集和处理点云数据的过程中,由于传感器的精度限制、环境干扰等因素,很容易导致点云数据中存在噪声。 高斯噪声是一种常见的噪声类型,其特点是具有高斯分布概率密度函数。在点云中,高斯噪声会使得原本清晰的点云轮廓模糊不清,使得点云的形状、边界等细节不再清晰可辨,对后续的数据处理与分析造成困扰。 针对点云高斯噪声的处理方法多种多样。其中一种常用的方法是通过滤波算法点云数据进行降噪。滤波算法可以基于点云数据的特点,如点密度、法线信息等,来去除高斯噪声。例如,平滑滤波算法可基于点的邻域信息对点云数据进行平滑处理,从而减少噪声的影响,提高数据的质量。 另外,也可以通过先验知识对点云数据进行处理。例如,在特定应用场景下,可以根据场景的几何约束或其他先验信息,去除认为是噪声的点。同时,还可以采用数据修复技术对局部缺失的点进行恢复,从而提高点云的完整性与质量。 综上所述,点云高斯噪声是指点云数据中存在的以高斯分布特征的噪声。通过采用适当的滤波算法和先验知识,可以有效降低或消除点云数据中的高斯噪声,提高数据的准确性与可用性。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值