#include "QuadTree.h"QuadNode*InitQuadNode()
{
QuadNode*node = newQuadNode;
node->Box.maxX = 0;
node->Box.maxY = 0;
node->Box.minX = 0;
node->Box.minY = 0;for (int i = 0; i < 4; i ++)
{
node->children[i] =NULL;
}
node->nChildCount = 0;
node->nShpCount = 0;
node->pShapeObj =NULL;returnnode;
}void CreateQuadTree(int depth,GeoLayer *poLayer,QuadTree*pQuadTree)
{
pQuadTree->depth =depth;
GeoEnvelope env;//整个图层的MBR
poLayer->GetExtent(&env);
MapRect rect;
rect.minX=env.MinX;
rect.minY=env.MinY;
rect.maxX=env.MaxX;
rect.maxY=env.MaxY;//创建各个分支
CreateQuadBranch(depth,rect,&(pQuadTree->root));int nCount = poLayer->GetFeatureCount();
GeoFeature**pFeatureClass = new GeoFeature*[nCount];for (int i = 0; i < poLayer->GetFeatureCount(); i ++)
{
pFeatureClass[i]= poLayer->GetFeature(i);
}//插入各个要素
GeoEnvelope envObj; //空间对象的MBR//#pragma omp parallel for
for (int i = 0; i < nCount; i ++)
{
pFeatureClass[i]->GetGeometry()->getEnvelope(&envObj);
rect.minX=envObj.MinX;
rect.minY=envObj.MinY;
rect.maxX=envObj.MaxX;
rect.maxY=envObj.MaxY;
InsertQuad(i,rect,pQuadTree->root);
}//DelFalseNode(pQuadTree->root);
}void CreateQuadBranch(int depth,MapRect &rect,QuadNode**node)
{if (depth != 0)
{*node = InitQuadNode(); //创建树根
QuadNode *pNode = *node;
pNode->Box =rect;
pNode->nChildCount = 4;
MapRect boxs[4];
pNode->Box.Split(boxs,boxs+1,boxs+2,boxs+3);for (int i = 0; i < 4; i ++)
{//创建四个节点并插入相应的MBR
pNode->children[i] =InitQuadNode();
pNode->children[i]->Box =boxs[i];
CreateQuadBranch(depth-1,boxs[i],&(pNode->children[i]));
}
}
}void BuildQuadTree(GeoLayer *poLayer,QuadTree*pQuadTree)
{
assert(poLayer);
GeoEnvelope env;//整个图层的MBR
poLayer->GetExtent(&env);
pQuadTree->root =InitQuadNode();
QuadNode* rootNode = pQuadTree->root;
rootNode->Box.minX =env.MinX;
rootNode->Box.minY =env.MinY;
rootNode->Box.maxX =env.MaxX;
rootNode->Box.maxY =env.MaxY;//设置树的深度( 根据等比数列的求和公式)//pQuadTree->depth = log(poLayer->GetFeatureCount()*3/8.0+1)/log(4.0);
int nCount = poLayer->GetFeatureCount();
MapRect rect;
GeoEnvelope envObj;//空间对象的MBR
for (int i = 0; i < nCount; i ++)
{
poLayer->GetFeature(i)->GetGeometry()->getEnvelope(&envObj);
rect.minX=envObj.MinX;
rect.minY=envObj.MinY;
rect.maxX=envObj.MaxX;
rect.maxY=envObj.MaxY;
InsertQuad2(i,rect,rootNode);
}
DelFalseNode(pQuadTree->root);
}void SearchQuadTree(QuadNode* node,MapRect &queryRect,vector&ItemSearched)
{
assert(node);//int coreNum = omp_get_num_procs();//vector * pResArr = new vector[coreNum];
if (NULL !=node)
{for (int i = 0; i < node->nShpCount; i ++)
{if (queryRect.Contains(node->pShapeObj[i].Box)|| queryRect.Intersects(node->pShapeObj[i].Box))
{
ItemSearched.push_back(node->pShapeObj[i].nID);
}
}//并行搜索四个孩子节点
/*#pragma omp parallel sections
{
#pragma omp section
if ((node->children[0] != NULL) &&
(node->children[0]->Box.Contains(queryRect)
|| node->children[0]->Box.Intersects(queryRect)))
{
int tid = omp_get_thread_num();
SearchQuadTree(node->children[0],queryRect,pResArr[tid]);
}
#pragma omp section
if ((node->children[1] != NULL) &&
(node->children[1]->Box.Contains(queryRect)
|| node->children[1]->Box.Intersects(queryRect)))
{
int tid = omp_get_thread_num();
SearchQuadTree(node->children[1],queryRect,pResArr[tid]);
}
#pragma omp section
if ((node->children[2] != NULL) &&
(node->children[2]->Box.Contains(queryRect)
|| node->children[2]->Box.Intersects(queryRect)))
{
int tid = omp_get_thread_num();
SearchQuadTree(node->children[2],queryRect,pResArr[tid]);
}
#pragma omp section
if ((node->children[3] != NULL) &&
(node->children[3]->Box.Contains(queryRect)
|| node->children[3]->Box.Intersects(queryRect)))
{
int tid = omp_get_thread_num();
SearchQuadTree(node->children[3],queryRect,pResArr[tid]);
}
}*/
for (int i = 0; i < 4; i ++)
{if ((node->children[i] != NULL) &&(node->children[i]->Box.Contains(queryRect)|| node->children[i]->Box.Intersects(queryRect)))
{
SearchQuadTree(node->children[i],queryRect,ItemSearched);//node = node->children[i];//非递归
}
}
}/*for (int i = 0 ; i < coreNum; i ++)
{
ItemSearched.insert(ItemSearched.end(),pResArr[i].begin(),pResArr[i].end());
}*/}void SearchQuadTreePara(vector resNodes,MapRect &queryRect,vector&ItemSearched)
{int coreNum =omp_get_num_procs();
omp_set_num_threads(coreNum);
vector* searchArrs = new vector[coreNum];for (int i = 0; i < coreNum; i ++)
{
searchArrs[i].clear();
}#pragma omp parallel for
for (int i = 0; i < resNodes.size(); i ++)
{int tid =omp_get_thread_num();for (int j = 0; j < resNodes[i]->nShpCount; j ++)
{if (queryRect.Contains(resNodes[i]->pShapeObj[j].Box)|| queryRect.Intersects(resNodes[i]->pShapeObj[j].Box))
{
searchArrs[tid].push_back(resNodes[i]->pShapeObj[j].nID);
}
}
}for (int i = 0; i < coreNum; i ++)
{
ItemSearched.insert(ItemSearched.end(),
searchArrs[i].begin(),searchArrs[i].end());
}delete[] searchArrs;
searchArrs=NULL;
}void PtSearchQTree(QuadNode* node,double cx,double cy,vector&ItemSearched)
{
assert(node);if (node->nShpCount >0) //节点
{for (int i = 0; i < node->nShpCount; i ++)
{if (node->pShapeObj[i].Box.IsPointInRect(cx,cy))
{
ItemSearched.push_back(node->pShapeObj[i].nID);
}
}
}else if (node->nChildCount >0) //节点
{for (int i = 0; i < 4; i ++)
{if (node->children[i]->Box.IsPointInRect(cx,cy))
{
PtSearchQTree(node->children[i],cx,cy,ItemSearched);
}
}
}//找出重复元素的位置
sort(ItemSearched.begin(),ItemSearched.end()); //先排序,默认升序
vector::iterator unique_iter =unique(ItemSearched.begin(),ItemSearched.end());
ItemSearched.erase(unique_iter,ItemSearched.end());
}void Insert(long key, MapRect &itemRect,QuadNode*pNode)
{
QuadNode*node = pNode; //保留根节点副本
SHPMBRInfo pShpInfo;//节点有孩子
if (0 < node->nChildCount)
{for (int i = 0; i < 4; i ++)
{//如果包含或相交,则将节点插入到此节点
if (node->children[i]->Box.Contains(itemRect)|| node->children[i]->Box.Intersects(itemRect))
{//node = node->children[i];
Insert(key,itemRect,node->children[i]);
}
}
}//如果当前节点存在一个子节点时
else if (1 == node->nShpCount)
{
MapRect boxs[4];
node->Box.Split(boxs,boxs+1,boxs+2,boxs+3);//创建四个节点并插入相应的MBR
node->children[UR] =InitQuadNode();
node->children[UL] =InitQuadNode();
node->children[LL] =InitQuadNode();
node->children[LR] =InitQuadNode();
node->children[UR]->Box = boxs[0];
node->children[UL]->Box = boxs[1];
node->children[LL]->Box = boxs[2];
node->children[LR]->Box = boxs[3];
node->nChildCount = 4;for (int i = 0; i < 4; i ++)
{//将当前节点中的要素移动到相应的子节点中
for (int j = 0; j < node->nShpCount; j ++)
{if (node->children[i]->Box.Contains(node->pShapeObj[j].Box)|| node->children[i]->Box.Intersects(node->pShapeObj[j].Box))
{
node->children[i]->nShpCount += 1;
node->children[i]->pShapeObj =(SHPMBRInfo*)malloc(node->children[i]->nShpCount*sizeof(SHPMBRInfo));
memcpy(node->children[i]->pShapeObj,&(node->pShapeObj[j]),sizeof(SHPMBRInfo));free(node->pShapeObj);
node->pShapeObj =NULL;
node->nShpCount = 0;
}
}
}for (int i = 0; i < 4; i ++)
{//如果包含或相交,则将节点插入到此节点
if (node->children[i]->Box.Contains(itemRect)|| node->children[i]->Box.Intersects(itemRect))
{if (node->children[i]->nShpCount == 0) //如果之前没有节点
{
node->children[i]->nShpCount += 1;
node->pShapeObj =(SHPMBRInfo*)malloc(sizeof(SHPMBRInfo)*node->children[i]->nShpCount);
}else if (node->children[i]->nShpCount > 0)
{
node->children[i]->nShpCount += 1;
node->children[i]->pShapeObj =(SHPMBRInfo*)realloc(node->children[i]->pShapeObj,sizeof(SHPMBRInfo)*node->children[i]->nShpCount);
}
pShpInfo.Box=itemRect;
pShpInfo.nID=key;
memcpy(node->children[i]->pShapeObj,&pShpInfo,sizeof(SHPMBRInfo));
}
}
}//当前节点没有空间对象
else if (0 == node->nShpCount)
{
node->nShpCount += 1;
node->pShapeObj =(SHPMBRInfo*)malloc(sizeof(SHPMBRInfo)*node->nShpCount);
pShpInfo.Box=itemRect;
pShpInfo.nID=key;
memcpy(node->pShapeObj,&pShpInfo,sizeof(SHPMBRInfo));
}
}void InsertQuad(long key,MapRect &itemRect,QuadNode*pNode)
{
assert(pNode!=NULL);if (!IsQuadLeaf(pNode)) //非叶子节点
{int nCorver = 0; //跨越的子节点个数
int iIndex = -1; //被哪个子节点完全包含的索引号
for (int i = 0; i < 4; i ++)
{if (pNode->children[i]->Box.Contains(itemRect)&& pNode->Box.Contains(itemRect))
{
nCorver+= 1;
iIndex=i;
}
}//如果被某一个子节点包含,则进入该子节点
if (/*pNode->Box.Contains(itemRect) ||
pNode->Box.Intersects(itemRect)*/1 <=nCorver)
{
InsertQuad(key,itemRect,pNode->children[iIndex]);
}//如果跨越了多个子节点,直接放在这个节点中
else if (nCorver == 0)
{if (pNode->nShpCount == 0) //如果之前没有节点
{
pNode->nShpCount += 1;
pNode->pShapeObj =(SHPMBRInfo*)malloc(sizeof(SHPMBRInfo)*pNode->nShpCount);
}else{
pNode->nShpCount += 1;
pNode->pShapeObj =(SHPMBRInfo*)realloc(pNode->pShapeObj,sizeof(SHPMBRInfo)*pNode->nShpCount);
}
SHPMBRInfo pShpInfo;
pShpInfo.Box=itemRect;
pShpInfo.nID=key;
memcpy(pNode->pShapeObj+pNode->nShpCount-1,&pShpInfo,sizeof(SHPMBRInfo));
}
}//如果是叶子节点,直接放进去
else if(IsQuadLeaf(pNode))
{if (pNode->nShpCount == 0) //如果之前没有节点
{
pNode->nShpCount += 1;
pNode->pShapeObj =(SHPMBRInfo*)malloc(sizeof(SHPMBRInfo)*pNode->nShpCount);
}else{
pNode->nShpCount += 1;
pNode->pShapeObj =(SHPMBRInfo*)realloc(pNode->pShapeObj,sizeof(SHPMBRInfo)*pNode->nShpCount);
}
SHPMBRInfo pShpInfo;
pShpInfo.Box=itemRect;
pShpInfo.nID=key;
memcpy(pNode->pShapeObj+pNode->nShpCount-1,&pShpInfo,sizeof(SHPMBRInfo));
}
}void InsertQuad2(long key,MapRect &itemRect,QuadNode*pNode)
{
QuadNode*node = pNode; //保留根节点副本
SHPMBRInfo pShpInfo;//节点有孩子
if (0 < node->nChildCount)
{for (int i = 0; i < 4; i ++)
{//如果包含或相交,则将节点插入到此节点
if (node->children[i]->Box.Contains(itemRect)|| node->children[i]->Box.Intersects(itemRect))
{//node = node->children[i];
Insert(key,itemRect,node->children[i]);
}
}
}//如果当前节点存在一个子节点时
else if (0 == node->nChildCount)
{
MapRect boxs[4];
node->Box.Split(boxs,boxs+1,boxs+2,boxs+3);int cnt = -1;for (int i = 0; i < 4; i ++)
{//如果包含或相交,则将节点插入到此节点
if(boxs[i].Contains(itemRect))
{
cnt=i;
}
}//如果有一个矩形包含此对象,则创建四个孩子节点
if (cnt > -1)
{for (int i = 0; i < 4; i ++)
{//创建四个节点并插入相应的MBR
node->children[i] =InitQuadNode();
node->children[i]->Box =boxs[i];
}
node->nChildCount = 4;
InsertQuad2(key,itemRect,node->children[cnt]); //递归
}//如果都不包含,则直接将对象插入此节点
if (cnt == -1)
{if (node->nShpCount == 0) //如果之前没有节点
{
node->nShpCount += 1;
node->pShapeObj =(SHPMBRInfo*)malloc(sizeof(SHPMBRInfo)*node->nShpCount);
}else if (node->nShpCount > 0)
{
node->nShpCount += 1;
node->pShapeObj =(SHPMBRInfo*)realloc(node->pShapeObj,sizeof(SHPMBRInfo)*node->nShpCount);
}
pShpInfo.Box=itemRect;
pShpInfo.nID=key;
memcpy(node->pShapeObj,&pShpInfo,sizeof(SHPMBRInfo));
}
}//当前节点没有空间对象
/*else if (0 == node->nShpCount)
{
node->nShpCount += 1;
node->pShapeObj =
(SHPMBRInfo*)malloc(sizeof(SHPMBRInfo)*node->nShpCount);
pShpInfo.Box = itemRect;
pShpInfo.nID = key;
memcpy(node->pShapeObj,&pShpInfo,sizeof(SHPMBRInfo));
}*/}bool IsQuadLeaf(QuadNode*node)
{if (NULL ==node)
{return 1;
}for (int i = 0; i < 4; i ++)
{if (node->children[i] !=NULL)
{return 0;
}
}return 1;
}bool DelFalseNode(QuadNode*node)
{//如果没有子节点且没有要素
if (node->nChildCount ==0 && node->nShpCount == 0)
{
ReleaseQuadTree(&node);
}//如果有子节点
else if (node->nChildCount > 0)
{for (int i = 0; i < 4; i ++)
{
DelFalseNode(node->children[i]);
}
}return 1;
}void TraversalQuadTree(QuadNode* quadTree,vector&resVec)
{
QuadNode*node =quadTree;int i = 0;if (NULL !=node)
{//将本节点中的空间对象存储数组中
for (i = 0; i < node->nShpCount; i ++)
{
resVec.push_back((node->pShapeObj+i)->nID);
}//遍历孩子节点
for (i = 0; i < node->nChildCount; i ++)
{if (node->children[i] !=NULL)
{
TraversalQuadTree(node->children[i],resVec);
}
}
}
}void TraversalQuadTree(QuadNode* quadTree,vector&arrNode)
{
dequenodeQueue;if (quadTree !=NULL)
{
nodeQueue.push_back(quadTree);while (!nodeQueue.empty())
{
QuadNode* queueHead = nodeQueue.at(0); //取队列头结点
arrNode.push_back(queueHead);
nodeQueue.pop_front();for (int i = 0; i < 4; i ++)
{if (queueHead->children[i] !=NULL)
{
nodeQueue.push_back(queueHead->children[i]);
}
}
}
}
}void ReleaseQuadTree(QuadNode**quadTree)
{int i = 0;
QuadNode* node = *quadTree;if (NULL ==node)
{return;
}else{for (i = 0; i < 4; i ++)
{
ReleaseQuadTree(&node->children[i]);
}free(node);
node=NULL;
}
node=NULL;
}long CalByteQuadTree(QuadNode* quadTree,long&nSize)
{if (quadTree !=NULL)
{
nSize+= sizeof(QuadNode)+quadTree->nChildCount*sizeof(SHPMBRInfo);for (int i = 0; i < 4; i ++)
{if (quadTree->children[i] !=NULL)
{
nSize+= CalByteQuadTree(quadTree->children[i],nSize);
}
}
}return 1;
}