67 lines
1.4 KiB
C++
67 lines
1.4 KiB
C++
|
#include "SG_baseDataType.h"
|
|||
|
|
#include "SG_baseAlgo_Export.h"
|
|||
|
|
#include <vector>
|
|||
|
|
#include <corecrt_math_defines.h>
|
|||
|
|
#include <cmath>
|
|||
|
|
|
|||
|
|
void _seedClustering(
|
|||
|
|
std::vector< SVzNL3DPosition>& a_cluster,
|
|||
|
|
std::vector< SVzNL3DPosition>& pts,
|
|||
|
|
double clusterDist)
|
|||
|
|
{
|
|||
|
|
int i = 0;
|
|||
|
|
while (1)
|
|||
|
|
{
|
|||
|
|
if (i >= a_cluster.size())
|
|||
|
|
break;
|
|||
|
|
|
|||
|
|
SVzNL3DPosition a_seed = a_cluster[i];
|
|||
|
|
for (int i = 0, i_max = pts.size(); i < i_max; i++)
|
|||
|
|
{
|
|||
|
|
if (pts[i].nPointIdx < 0)
|
|||
|
|
continue;
|
|||
|
|
double dist = sqrt(pow(a_seed.pt3D.x - pts[i].pt3D.x, 2) + pow(a_seed.pt3D.y - pts[i].pt3D.y, 2));
|
|||
|
|
if (dist < clusterDist)
|
|||
|
|
{
|
|||
|
|
a_cluster.push_back(pts[i]);
|
|||
|
|
pts[i].nPointIdx = -1;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
i++;
|
|||
|
|
}
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void sg_pointClustering(
|
|||
|
|
std::vector< SVzNL3DPosition>& pts,
|
|||
|
|
double clusterDist,
|
|||
|
|
std::vector<std::vector< SVzNL3DPosition>>& objClusters //result
|
|||
|
|
)
|
|||
|
|
{
|
|||
|
|
int ptSize = pts.size();
|
|||
|
|
if (ptSize == 0)
|
|||
|
|
return;
|
|||
|
|
while(pts.size() > 0)
|
|||
|
|
{
|
|||
|
|
SVzNL3DPosition a_pt = pts[0];
|
|||
|
|
|
|||
|
|
//<2F>½<EFBFBD>һ<EFBFBD><D2BB>cluster
|
|||
|
|
std::vector< SVzNL3DPosition> a_cluster;
|
|||
|
|
a_cluster.push_back(a_pt);
|
|||
|
|
pts[0].nPointIdx = -1; //<2F><>ֹ<EFBFBD>ظ<EFBFBD><D8B8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
_seedClustering(
|
|||
|
|
a_cluster,
|
|||
|
|
pts,
|
|||
|
|
clusterDist);
|
|||
|
|
objClusters.push_back(a_cluster); //<2F><><EFBFBD><EFBFBD>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
//<2F><>pts<74>д<EFBFBD><D0B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ĵ<EFBFBD>ȥ<EFBFBD><C8A5>
|
|||
|
|
int m_max = pts.size();
|
|||
|
|
for (int m = m_max - 1; m >= 0; m--) //<2F>Ӻ<EFBFBD><D3BA><EFBFBD>ǰ<EFBFBD><C7B0><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ɾ<EFBFBD><C9BE><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӱ<EFBFBD><D3B0>ѭ<EFBFBD><D1AD>
|
|||
|
|
{
|
|||
|
|
if(pts[m].nPointIdx < 0)
|
|||
|
|
pts.erase(pts.begin() + m);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
;
|