3d点云文件保存 pcd和ply

#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);

 

  • 0
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 3
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 3
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值