读取PCD文件的XYZ与RGB信息

最新推荐文章于 2024-12-20 14:00:43 发布

Escape_X1n

最新推荐文章于 2024-12-20 14:00:43 发布

阅读量5.1k

点赞数 1

分类专栏： PnP/Slam 文章标签： PCL PCD

本文链接：https://blog.youkuaiyun.com/qq_28467367/article/details/93780686

版权

PnP/Slam 专栏收录该内容

9 篇文章

订阅专栏

读取pcl::PointXYZRGB中的RGB信息：

pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud (new pcl::PointCloud<pcl::PointXYZRGB>);

unpack rgb into r/g/b：
（1）

int r = cloud->points[i].r;
int g = cloud->points[i].g;
int b = cloud->points[i].b;

（2）

unsigned long rgb = *reinterpret_cast<int*>(&cloud->points[i].rgb);
int r = (rgb >> 16) & 0x0000ff;
int g = (rgb >> 8)  & 0x0000ff;
int b = (rgb)       & 0x0000ff;

备注：

typedef signed char int8_t;
typedef unsigned char uint8_t;

typedef int int16_t;
typedef unsigned int uint16_t;

typedef long int32_t;
typedef unsigned long uint32_t;

typedef long long int64_t;
typedef unsigned long long uint64_t;

代码如下：

#include <iostream>
#include <fstream>
#include <pcl/point_types.h>
#include <pcl/io/pcd_io.h>
#include <pcl/visualization/cloud_viewer.h>
#include <pcl/visualization/pcl_visualizer.h>
#include <pcl/filters/statistical_outlier_removal.h>
#include <pcl/filters/voxel_grid.h>

using namespace std;

int main(int argc, char *argv[])
{
//  pcl::PointXYZRGBA也可
    pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZRGB>);
    // Fill in the cloud data
    //    pcl::io::loadPCDFile<pcl::PointXYZRGB>("result1.pcd", *cloud);
    if (pcl::io::loadPCDFile<pcl::PointXYZRGB>("result.pcd", *cloud) == -1)
    {
        PCL_ERROR("Couldn't read file chuli.pcd\n");
        return (-1);
    }
    int N=cloud->points.size();
    cout <<N<<endl;
//    cout << "Loaded "
//     << cloud->width * cloud->height
//     << " data points from test_file.pcd ."
//     << endl;
    ofstream fout("result.txt");

    for (size_t i = 0; i < N; i++)
    {
//        fout <<cloud->points[i].x
//             << " " << cloud->points[i].y
//             << " " << cloud->points[i].z
//             << " " << int(cloud->points[i].r)
//             << " " << int(cloud->points[i].g)
//             << " " << int(cloud->points[i].b)
//             << " " << int(cloud->points[i].a)
//             << endl;
        if(i==0||i==N-1)
        {
            printf("%f %f %f %d %d %d %d\n",
                   cloud->points[i].x,
                   cloud->points[i].y,
                   cloud->points[i].z,
                   cloud->points[i].r,
                   cloud->points[i].g,
                   cloud->points[i].b,
                   cloud->points[i].a);
//            unsigned long rgb = *reinterpret_cast<int*>(&cloud->points[i].rgb);
//            int r = (rgb >> 16) & 0x0000ff;
//            int g = (rgb >> 8)  & 0x0000ff;
//            int b = (rgb)       & 0x0000ff;
//            cout<<r<< " "<<g<< " "<<b<<endl;
        }

//        cout<<cloud->points[i].getArray3fMap()<<endl;
//        cout<<cloud->points[i].getVector3fMap()<<endl;
//        cout<<cloud->points[i].getRGBVector3i()<<endl;
//        cout<<cloud->points[i].getRGBAVector4i()<<endl;

    }
    fout.close();
    cout << "trans has done!!!" << endl;
    //可视化1——————————
//    pcl::visualization::CloudViewer viewer("pcd viewer");
//    viewer.showCloud(cloud);
    //可视化2——————————
//    pcl::visualization::PCLVisualizer viewer("Cloud viewer");
//
//    viewer.setCameraPosition(0,0,-3.0,0,-1,0);
//    viewer.addCoordinateSystem(0.3);
//
//    viewer.addPointCloud(cloud);
//    while(!viewer.wasStopped())
//        viewer.spinOnce(100);
//    cin.get();
    return 0;
}