void COctreeTriangleSelector::constructOctree(SOctreeNode* node)
{
++NodeCount;
node->Box.reset(node->Triangles[0].pointA);
// get bounding box
const UINT32 cnt = node->Triangles.size();
for (UINT32 i = 0; i<cnt; ++i)
{
node->Box.addInternalPoint(node->Triangles[i].pointA);
node->Box.addInternalPoint(node->Triangles[i].pointB);
node->Box.addInternalPoint(node->Triangles[i].pointC);
}
const Vector3& middle = node->Box.getCenter();
//Vector3 edges[8];
const Vector3* edges;
//node->Box.getEdges(edges);
//注意环绕顺序，Sapphire右手坐标系
edges = node->Box.getAllCorners();
AxisAlignedBox box;
vector<triangle3df>::type keepTriangles;
// 计算子节点
//if (!node->Box.isEmpty() && (SINT32)node->Triangles.size() > MinimalPolysPerNode)
if (!node->Box.isNull() && !node->Box.isInfinite() && (SINT32)node->Triangles.size() > MinimalPolysPerNode)
for (SINT32 ch = 0; ch<8; ++ch)
{
box.reset(middle);
box.addInternalPoint(edges[ch]);
node->Child[ch] = new SOctreeNode();
for (SINT32 i = 0; i<(SINT32)node->Triangles.size(); ++i)
{
if (node->Triangles[i].isTotalInsideBox(box))
{
node->Child[ch]->Triangles.push_back(node->Triangles[i]);
//node->Triangles.erase(i);
//--i;
}
else
{
keepTriangles.push_back(node->Triangles[i]);
}
}
//memcpy(node->Triangles.pointer(), keepTriangles.pointer(),
//sizeof(triangle3df)*keepTriangles.size());
std::copy(node->Triangles.begin(), node->Triangles.begin() + node->Triangles.size(), keepTriangles.begin());
//memcpy(node->Triangles.begin()._Ptr, keepTriangles.begin()._Ptr,
//sizeof(triangle3df)*keepTriangles.size());
//node->Triangles.set_used(keepTriangles.size());
//keepTriangles.set_used(0);
if (node->Child[ch]->Triangles.empty())
{
delete node->Child[ch];
node->Child[ch] = 0;
}
else
constructOctree(node->Child[ch]);
}
}
