未知点云结构文件转换需求

最新推荐文章于 2024-03-16 22:42:58 发布

moneymyone

最新推荐文章于 2024-03-16 22:42:58 发布

阅读量216

点赞数

分类专栏： C++ 点云文章标签： c++ 开发语言

本文链接：https://blog.csdn.net/moneymyone/article/details/126002201

版权

C++ 同时被 2 个专栏收录

36 篇文章 2 订阅

订阅专栏

点云

6 篇文章 0 订阅

订阅专栏

未知点云结构文件转换需求

需求描述

有一批点云，二进制的，字段非常规类型。
但是可以看出来总共有6个字段，其中两个字段是_，没有具体规定是什么字段。
现在要把这两个不知名的字段去掉，保留剩余4个字段 x y z intensity。

格式转换

还是同理，通过自定义点类型实现点云文件转换。

定义点类型的时候，短横类型设置为int 或者 string对于结果没有影响。

struct MyPointType    //定义点类型结构
{
    PCL_ADD_POINT4D;  //该点类型有4个元素      

    /*尝试新增一个自定义*/  
    unsigned m;    //定义自己新增的类型名称
     //测试了添加这么多个也没问题
    float intensity;
    unsigned k;
    EIGEN_MAKE_ALIGNED_OPERATOR_NEW   //确保new操作符对齐操作 

}EIGEN_ALIGN16;   //强制SSE 对齐

POINT_CLOUD_REGISTER_POINT_STRUCT(MyPointType,    //注册点类型宏
    (float ,x,x)
    (float ,y,y)
    (float ,z,z)
    (unsigned char ,m,m)
    (float ,intensity,intensity)
    (unsigned ,k,k)
    )

主代码如下，可实现对文件夹下所有点云文件的批量转换：

/*
 * @Description: 
 * @version: 1.0.0
 * @Author: qianchengjun
 * @Date: 2022-02-22 14:33:45
 * @LastEditors: qianchengjun
 * @LastEditTime: 2022-02-22 16:49:34
 */
#include <iostream>
#include <string>
#include <vector>
#include <algorithm>
#include <fstream>
#include <stdio.h>
#include <sys/stat.h>
#include <dirent.h>
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
using namespace std;

void ConvertPCD(std::string file)
{
    pcl::PointCloud<MyPointType> cloudsrc;
    pcl::PointCloud<pcl::PointXYZI> cloudtar;

    if (pcl::io::loadPCDFile<MyPointType>(file, cloudsrc) == -1)
    {
        PCL_ERROR("Couldn'n read file! \n");
        return;
    }
    
    std::cout << cloudsrc.points.size() << std::endl;

    for (size_t i = 0; i < cloudsrc.points.size(); i++)
    {
        pcl::PointXYZI pt;
        pt.x = cloudsrc[i].x;
        pt.y = cloudsrc[i].y;
        pt.z = cloudsrc[i].z;
        pt.intensity = cloudsrc[i].intensity;
        cloudtar.push_back(pt);
    }
    std::string newfile = file.replace(file.rfind(".pcd"),4,"_new.pcd");
    pcl::PCDWriter writer;
	writer.write<pcl::PointXYZI> (newfile, cloudtar, true); // 保存文件
}

int main(int argc, char** argv)
{
    //目标文件夹路径
    std::string folder = "/home/qiancj/Documents/M1/Underground_Garage/4.5mleft_head/";
    vector<string> files;
    getFiles(folder.c_str(), files);
    for_each(files.begin(), files.end(), [](const string &file){
        ConvertPCD(file);
        cout << "finish convert file: " << file << endl; });

    return 0;
}