C++ PCL 点云合并与去重代码示例

下面是一个基于 PCL 库的 C++ 代码示例，用于将两个点云指针内的点云数据进行合并，并删除重复的数据：

#include <iostream>
#include <pcl/point_types.h>
#include <pcl/point_cloud.h>
#include <pcl/filters/voxel_grid.h>
#include <pcl/filters/filter.h>

int main()
{
    // 创建点云对象
    pcl::PointCloud<pcl::PointXYZ>::Ptr cloud1(new pcl::PointCloud<pcl::PointXYZ>);
    pcl::PointCloud<pcl::PointXYZ>::Ptr cloud2(new pcl::PointCloud<pcl::PointXYZ>);
    pcl::PointCloud<pcl::PointXYZ>::Ptr mergedCloud(new pcl::PointCloud<pcl::PointXYZ>);

    // 假设 cloud1 和 cloud2 已经被填充了点云数据

    // 合并点云数据
    *mergedCloud = *cloud1 + *cloud2;

    // 删除重复的点
    std::vector<int> indices;
    pcl::removeNaNFromPointCloud(*mergedCloud, *mergedCloud, indices);

    // 打印合并后的点云数据
    std::cout << "Merged cloud size: " << mergedCloud->size() << std::endl;
    for (const auto& point : mergedCloud->points)
    {
        std::cout << "x: " << point.x << ", y: " << point.y << ", z: " << point.z << std::endl;
    }

    return 0;
}

在上述代码中，我们首先创建了三个点云对象：cloud1、cloud2 和 mergedCloud。然后，我们假设 cloud1 和 cloud2 已经被填充了点云数据。

接下来，我们使用运算符重载将 cloud1 和 cloud2 中的点云数据合并到 mergedCloud 中。然后，我们使用 pcl::removeNaNFromPointCloud 函数删除 mergedCloud 中的重复点。

最后，我们打印合并后的点云数据，以验证合并和删除重复点的结果。

请注意，此代码示例仅适用于 PCL 库的 1.10 版本及以上。如果您使用的是较早的版本，请根据相应版本的 PCL 文档进行调整。