資源簡介
按照X,Y,Z的優(yōu)先順序對點云數(shù)據(jù)排序,這是源代碼,自己編譯一下就可以使用了,如果使用過程中有問題的話,可以在下面留言,我看到了會回答大家的。
代碼片段和文件信息
#include
#include
#include
using?namespace?std;
struct?mypoint
{
float?x;
float?y;
float?z;
}parray[5000];
//**********************************************************************************************************定義一個結構體數(shù)組用來存儲點云數(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)
//*************************************************************************************************輸入需要排序的點云文件名
{
PCL_ERROR(“READING?IS?WRONG?\n“);
return(-1);
}
int?m?=?cloud->points.size()?+?1;
//******************************************************************************************************m為排序的個數(shù),在qsort函數(shù)中會被用到
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?<
- 上一篇:單擺運動的數(shù)學模型
- 下一篇:遺傳算法解決TSP問題C++版
評論
共有 條評論