• 大小: 2KB
    文件类型: .cpp
    金币: 2
    下载: 1 次
    发布日期: 2021-06-18
  • 语言: C/C++
  • 标签: PCL  C++  点云排序  

资源简介

按照X,Y,Z的优先顺序对点云数据排序,这是源代码,自己编译一下就可以使用了,如果使用过程中有问题的话,可以在下面留言,我看到了会回答大家的。

资源截图

代码片段和文件信息

#include
#include
#include
using namespace std;
struct mypoint
{
float x;
float y;
float z;
}parray[5000];
//**********************************************************************************************************定义一个结构体数组用来存储点云数据
int cmp(const void *arg1 const void *arg2);
int main()
{
pcl::PointCloud::Ptr cloud(new pcl::PointCloud);
if (pcl::io::loadPCDFile(“no_repeat.pcd“ *cloud) == -1)
//*************************************************************************************************输入需要排序的点云文件名
{
PCL_ERROR(“READING IS WRONG \n“);
return(-1);
}
int m = cloud->points.size() + 1;
//******************************************************************************************************m为排序的个数,在qsort函数中会被用到
for (int i = 0; i < cloud->points.size(); i++)
{
parray[i].x = cloud->points[i].x;
parray[i].y = cloud->points[i].y;
parray[i].y = cloud->points[i].z;
}
qsort(parray m sizeof(mypoint) cmp);
for (int i = 0; i < m-1; i++)
{
cout << parray[i].x << “ “ << parray[i].y << “ “ << parray[i].z << end

评论

共有 条评论