-
大小: 2KB文件類型: .cpp金幣: 2下載: 1 次發(fā)布日期: 2021-06-18
- 語(yǔ)言: C/C++
- 標(biāo)簽: PCL??C++??點(diǎn)云排序??
資源簡(jiǎn)介
按照X,Y,Z的優(yōu)先順序?qū)c(diǎn)云數(shù)據(jù)排序,這是源代碼,自己編譯一下就可以使用了,如果使用過(guò)程中有問題的話,可以在下面留言,我看到了會(huì)回答大家的。
代碼片段和文件信息
#include
#include
#include
using?namespace?std;
struct?mypoint
{
float?x;
float?y;
float?z;
}parray[5000];
//**********************************************************************************************************定義一個(gè)結(jié)構(gòu)體數(shù)組用來(lái)存儲(chǔ)點(diǎn)云數(shù)據(jù)
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)
//*************************************************************************************************輸入需要排序的點(diǎn)云文件名
{
PCL_ERROR(“READING?IS?WRONG?\n“);
return(-1);
}
int?m?=?cloud->points.size()?+?1;
//******************************************************************************************************m為排序的個(gè)數(shù),在qsort函數(shù)中會(huì)被用到
for?(int?i?=?0;?i?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? {
cout?<
評(píng)論
共有 條評(píng)論