3d点云文件保存 pcd和ply

最新推荐文章于 2025-06-18 21:17:25 发布

原创最新推荐文章于 2025-06-18 21:17:25 发布 · 4k 阅读

3 ·

CC 4.0 BY-SA版权

PCL 专栏收录该内容

12 篇文章

订阅专栏

本文详细介绍了一种从深度图像创建点云数据的方法，并演示了如何使用PCL库将点云数据保存为PLY和PCD文件格式。通过遍历深度图像的每一个像素，将深度信息转换为三维坐标，并结合RGB信息，生成点云数据。最终，利用PCL库的I/O功能将点云数据存储，便于后续的处理和分析。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

#include <pcl/io/ply_io.h>
#include <pcl/visualization/cloud_viewer.h>
#include <pcl/common/centroid.h>
#include <pcl/common/distances.h>
#include <pcl/common/eigen.h>
#include <pcl/common/gaussian.h>
#include <pcl/common/transforms.h>
#include <pcl/io/io.h>  
#include <pcl/io/pcd_io.h> 

 PointCloud<PointXYZRGB>::Ptr cloud(new PointCloud<PointXYZRGB>);
for (int j = 0; j < depth.rows; ++j)
 {
     for (int i = 0; i < depth.cols; ++i)
      {
           auto d = depth.at<cv::Vec3f>(j, i)[2];
                 if (d == INFINITY || d == 0 || d > 5)
                    continue;
                PointXYZRGB p;
                p.z = -d*1000; // Zc = baseline * f / (d + doffs)
                p.x = depth.at<Vec3f>(j, i)[0] * 1000; //XC to the right, Yc down as positive
                p.y = -depth.at<Vec3f>(j, i)[1] * 1000;

                //RGB
                p.b = src_RGB.ptr<uchar>(j)[i * 3];
                p.g = src_RGB.ptr<uchar>(j)[i * 3 + 1];
                p.r = src_RGB.ptr<uchar>(j)[i * 3 + 2];

                cloud->points.push_back(p);
            }
        }

        cloud->height = depth.rows;
        cloud->width = depth.cols;
        cloud->points.resize(cloud->height * cloud->width);
        
        
                pcl::io::savePLYFile("test1.ply", *cloud);
        pcl::io::savePCDFile("../image/cloud.pcd", *cloud);