/// <summary>
/// Recorrer recursivamente el Quadtree para encontrar los nodos visibles
/// </summary>
private void findVisibleMeshes(TgcFrustum frustum, QuadtreeNode node,
float boxLowerX, float boxLowerY, float boxLowerZ,
float boxUpperX, float boxUpperY, float boxUpperZ)
{
QuadtreeNode[] children = node.children;
//es hoja, cargar todos los meshes
if (children == null)
{
selectLeafMeshes(node);
}
//recursividad sobre hijos
else
{
float midX = FastMath.Abs((boxUpperX - boxLowerX) / 2);
float midZ = FastMath.Abs((boxUpperZ - boxLowerZ) / 2);
//00
testChildVisibility(frustum, children[0], boxLowerX + midX, boxLowerY, boxLowerZ + midZ, boxUpperX, boxUpperY, boxUpperZ);
//01
testChildVisibility(frustum, children[1], boxLowerX + midX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ - midZ);
//10
testChildVisibility(frustum, children[2], boxLowerX, boxLowerY, boxLowerZ + midZ, boxUpperX - midX, boxUpperY, boxUpperZ);
//11
testChildVisibility(frustum, children[3], boxLowerX, boxLowerY, boxLowerZ, boxUpperX - midX, boxUpperY, boxUpperZ - midZ);
}
}
/// <summary>
/// Impresion recursiva
/// </summary>
private void doPrintDebugQuadtree(QuadtreeNode node, int index, StringBuilder sb)
{
String lineas = "";
for (int i = 0; i < index; i++)
{
lineas += "-";
}
if (node.isLeaf())
{
if (node.models.Length > 0)
{
sb.Append(lineas + "Models [" + node.models.Length + "]" + "\n");
}
else
{
sb.Append(lineas + "[0]" + "\n");
}
}
else
{
sb.Append(lineas + "\n");
index++;
for (int i = 0; i < node.children.Length; i++)
{
doPrintDebugQuadtree(node.children[i], index, sb);
}
}
}
private void doCreateQuadtreeDebugBox(QuadtreeNode node, List <TgcDebugBox> debugBoxes,
float boxLowerX, float boxLowerY, float boxLowerZ,
float boxUpperX, float boxUpperY, float boxUpperZ, int step)
{
QuadtreeNode[] children = node.children;
float midX = FastMath.Abs((boxUpperX - boxLowerX) / 2);
float midZ = FastMath.Abs((boxUpperZ - boxLowerZ) / 2);
//Crear caja debug
TgcDebugBox box = createDebugBox(boxLowerX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ, step);
debugBoxes.Add(box);
//es hoja, dibujar caja
if (children == null)
{
}
//recursividad sobre hijos
else
{
step++;
//000
doCreateQuadtreeDebugBox(children[0], debugBoxes, boxLowerX + midX, boxLowerY, boxLowerZ + midZ, boxUpperX, boxUpperY, boxUpperZ, step);
//001
doCreateQuadtreeDebugBox(children[1], debugBoxes, boxLowerX + midX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ - midZ, step);
//100
doCreateQuadtreeDebugBox(children[2], debugBoxes, boxLowerX, boxLowerY, boxLowerZ + midZ, boxUpperX - midX, boxUpperY, boxUpperZ, step);
//101
doCreateQuadtreeDebugBox(children[3], debugBoxes, boxLowerX, boxLowerY, boxLowerZ, boxUpperX - midX, boxUpperY, boxUpperZ - midZ, step);
}
}
/// <summary>
/// Corte de plano Z
/// </summary>
private void doSectorQuadtreeZ(QuadtreeNode parent, Vector3 center, Vector3 size, int step,
List <TgcMesh> meshes, int childIndex)
{
float z = center.Z;
//Crear listas para realizar corte
List <TgcMesh> possitiveList = new List <TgcMesh>();
List <TgcMesh> negativeList = new List <TgcMesh>();
//Z-cut
Plane zCutPlane = new Plane(0, 0, 1, -z);
splitByPlane(zCutPlane, meshes, possitiveList, negativeList);
//obtener lista de children del parent, con iniciacion lazy
if (parent.children == null)
{
parent.children = new QuadtreeNode[4];
}
//crear nodo positivo en parent, segun childIndex
QuadtreeNode posNode = new QuadtreeNode();
parent.children[childIndex] = posNode;
//cargar nodo negativo en parent, segun childIndex
QuadtreeNode negNode = new QuadtreeNode();
parent.children[childIndex + 1] = negNode;
//condicion de corte
if (step > MAX_SECTOR_QUADTREE_RECURSION || meshes.Count < MIN_MESH_PER_LEAVE_THRESHOLD)
{
//cargar hijos de nodo positivo
posNode.models = possitiveList.ToArray();
//cargar hijos de nodo negativo
negNode.models = negativeList.ToArray();
//seguir recursividad
}
else
{
step++;
//recursividad de positivos con plano X, usando resultados positivos
doSectorQuadtreeX(posNode, new Vector3(center.X, center.Y, z + size.Z / 2),
new Vector3(size.X, size.Y, size.Z / 2),
step, possitiveList);
//recursividad de negativos con plano Y, usando resultados negativos
doSectorQuadtreeX(negNode, new Vector3(center.X, center.Y, z - size.Z / 2),
new Vector3(size.X, size.Y, size.Z / 2),
step, negativeList);
}
}
/// <summary>
/// Imprime por consola la generacion del Octree
/// </summary>
private void printDebugQuadtree(QuadtreeNode rootNode)
{
Console.WriteLine("########## Quadtree DEBUG ##########");
StringBuilder sb = new StringBuilder();
doPrintDebugQuadtree(rootNode, 0, sb);
Console.WriteLine(sb.ToString());
Console.WriteLine("########## FIN Quadtree DEBUG ##########");
}
/// <summary>
/// Dibujar meshes que representan los sectores del Quadtree
/// </summary>
public List<TgcDebugBox> createDebugQuadtreeMeshes(QuadtreeNode rootNode, TgcBoundingBox sceneBounds)
{
Vector3 pMax = sceneBounds.PMax;
Vector3 pMin = sceneBounds.PMin;
List<TgcDebugBox> debugBoxes = new List<TgcDebugBox>();
doCreateQuadtreeDebugBox(rootNode, debugBoxes,
pMin.X, pMin.Y, pMin.Z,
pMax.X, pMax.Y, pMax.Z, 0);
return debugBoxes;
}
/// <summary>
/// Hacer visibles todas las meshes de un nodo
/// </summary>
private void selectLeafMeshes(QuadtreeNode node)
{
TgcMesh[] models = node.models;
foreach (TgcMesh m in models)
{
//Me fijo si el mesh esta fuera de la skybox (La misma se construye con el farplane, por eso se usa aca)
if ((CustomFpsCamera.Instance.eye - m.Position).Length() < CustomFpsCamera.FAR_PLANE / 2.2)
{
m.Enabled = true;
}
}
}
/// <summary>
/// Dibujar meshes que representan los sectores del Quadtree
/// </summary>
public List <TgcDebugBox> createDebugQuadtreeMeshes(QuadtreeNode rootNode, TgcBoundingBox sceneBounds)
{
Vector3 pMax = sceneBounds.PMax;
Vector3 pMin = sceneBounds.PMin;
List <TgcDebugBox> debugBoxes = new List <TgcDebugBox>();
doCreateQuadtreeDebugBox(rootNode, debugBoxes,
pMin.X, pMin.Y, pMin.Z,
pMax.X, pMax.Y, pMax.Z, 0);
return(debugBoxes);
}
/// <summary>
/// Crear nuevo Quadtree
/// </summary>
/// <param name="modelos">Modelos a optimizar</param>
/// <param name="sceneBounds">Límites del escenario</param>
public void create(List <TgcMesh> modelos, TgcBoundingBox sceneBounds)
{
this.modelos = modelos;
this.sceneBounds = sceneBounds;
//Crear Quadtree
this.quadtreeRootNode = builder.crearQuadtree(modelos, sceneBounds);
//Deshabilitar todos los mesh inicialmente
foreach (TgcMesh mesh in modelos)
{
mesh.Enabled = false;
}
}
/// <summary>
/// Se fija si los hijos de un nodo no tienen mas hijos y no tienen ningun triangulo
/// </summary>
private bool hasEmptyChilds(QuadtreeNode node)
{
QuadtreeNode[] children = node.children;
for (int i = 0; i < children.Length; i++)
{
QuadtreeNode childNode = children[i];
if (childNode.children != null || childNode.models.Length > 0)
{
return(false);
}
}
return(true);
}
/// <summary>
/// Crear nuevo Quadtree
/// </summary>
/// <param name="modelos">Modelos a optimizar</param>
/// <param name="sceneBounds">Límites del escenario</param>
public void create(List<TgcMesh> modelos, TgcBoundingBox sceneBounds)
{
this.modelos = modelos;
this.sceneBounds = sceneBounds;
//Crear Quadtree
this.quadtreeRootNode = builder.crearQuadtree(modelos, sceneBounds);
//Deshabilitar todos los mesh inicialmente
foreach (TgcMesh mesh in modelos)
{
mesh.Enabled = false;
}
}
/// <summary>
/// Imprime estadisticas del Octree
/// </summary>
private void printEstadisticasQuadtree(QuadtreeNode rootNode)
{
Console.WriteLine("*********** Quadtree Statics ***********");
int minModels = int.MaxValue;
int maxModels = int.MinValue;
obtenerEstadisticas(rootNode, ref minModels, ref maxModels);
Console.WriteLine("Minima cantidad de TgcMeshs en hoja: " + minModels);
Console.WriteLine("Maxima cantidad de TgcMeshs en hoja: " + maxModels);
Console.WriteLine("*********** FIN Quadtree Statics ************");
}
private void testChildCollideability(TgcBoundingBox objeto, QuadtreeNode childNode,
float boxLowerX, float boxLowerY, float boxLowerZ, float boxUpperX, float boxUpperY, float boxUpperZ)
{
//test frustum-box intersection
TgcBoundingBox caja = new TgcBoundingBox(
new Vector3(boxLowerX, boxLowerY, boxLowerZ),
new Vector3(boxUpperX, boxUpperY, boxUpperZ));
TgcCollisionUtils.BoxBoxResult result = TgcCollisionUtils.classifyBoxBox(objeto, caja);
//parte adentro: seguir haciendo testeos con hijos
if (result == TgcCollisionUtils.BoxBoxResult.Encerrando || result == TgcCollisionUtils.BoxBoxResult.Atravesando)
{
findNodesToCollide(objeto, childNode, boxLowerX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ);
}
}
/// <summary>
/// Hacer visibles todas las meshes de un nodo, buscando recursivamente sus hojas
/// </summary>
private void addAllLeafMeshes(QuadtreeNode node)
{
QuadtreeNode[] children = node.children;
//es hoja, cargar todos los meshes
if (children == null)
{
selectLeafMeshes(node);
}
//pedir hojas a hijos
else
{
for (int i = 0; i < children.Length; i++)
{
addAllLeafMeshes(children[i]);
}
}
}
/// <summary>
/// Hacer visible las meshes de un nodo si es visible por el Frustum
/// </summary>
private void testChildVisibility(TgcFrustum frustum, QuadtreeNode childNode,
float boxLowerX, float boxLowerY, float boxLowerZ, float boxUpperX, float boxUpperY, float boxUpperZ)
{
//test frustum-box intersection
TgcBoundingBox caja = new TgcBoundingBox(
new Vector3(boxLowerX, boxLowerY, boxLowerZ),
new Vector3(boxUpperX, boxUpperY, boxUpperZ));
TgcCollisionUtils.FrustumResult c = TgcCollisionUtils.classifyFrustumAABB(frustum, caja);
//complementamente adentro: cargar todos los hijos directamente, sin testeos
if (c == TgcCollisionUtils.FrustumResult.INSIDE)
{
addAllLeafMeshes(childNode);
}
//parte adentro: seguir haciendo testeos con hijos
else if (c == TgcCollisionUtils.FrustumResult.INTERSECT)
{
findVisibleMeshes(frustum, childNode, boxLowerX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ);
}
}
private void obtenerEstadisticas(QuadtreeNode node, ref int minModels, ref int maxModels)
{
if (node.isLeaf())
{
int n = node.models.Length;
if (n < minModels)
{
minModels = n;
}
if (n > maxModels)
{
maxModels = n;
}
}
else
{
for (int i = 0; i < node.children.Length; i++)
{
obtenerEstadisticas(node.children[i], ref minModels, ref maxModels);
}
}
}
/// <summary>
/// Se quitan padres cuyos nodos no tengan ningun triangulo
/// </summary>
private void optimizeSectorQuadtree(QuadtreeNode[] children)
{
if (children == null)
{
return;
}
for (int i = 0; i < children.Length; i++)
{
QuadtreeNode childNode = children[i];
QuadtreeNode[] childNodeChildren = childNode.children;
if (childNodeChildren != null && hasEmptyChilds(childNode))
{
childNode.children = null;
childNode.models = new TgcMesh[0];
}
else
{
optimizeSectorQuadtree(childNodeChildren);
}
}
}
public QuadtreeNode crearQuadtree(List <TgcMesh> TgcMeshs, TgcBoundingBox sceneBounds)
{
QuadtreeNode rootNode = new QuadtreeNode();
//Calcular punto medio y centro
Vector3 midSize = sceneBounds.calculateAxisRadius();
Vector3 center = sceneBounds.calculateBoxCenter();
//iniciar generacion recursiva de octree
doSectorQuadtreeX(rootNode, center, midSize, 0, TgcMeshs);
//podar nodos innecesarios
optimizeSectorQuadtree(rootNode.children);
//imprimir por consola el octree
//printDebugQuadtree(rootNode);
//imprimir estadisticas de debug
//printEstadisticasQuadtree(rootNode);
return(rootNode);
}
public QuadtreeNode crearQuadtree(List<TgcMesh> TgcMeshs, TgcBoundingBox sceneBounds)
{
QuadtreeNode rootNode = new QuadtreeNode();
//Calcular punto medio y centro
Vector3 midSize = sceneBounds.calculateAxisRadius();
Vector3 center = sceneBounds.calculateBoxCenter();
//iniciar generacion recursiva de octree
doSectorQuadtreeX(rootNode, center, midSize, 0, TgcMeshs);
//podar nodos innecesarios
optimizeSectorQuadtree(rootNode.children);
//imprimir por consola el octree
//printDebugQuadtree(rootNode);
//imprimir estadisticas de debug
//printEstadisticasQuadtree(rootNode);
return rootNode;
}
/// <summary>
/// Corte con plano X
/// </summary>
private void doSectorQuadtreeX(QuadtreeNode parent, Vector3 center, Vector3 size,
int step, List <TgcMesh> meshes)
{
float x = center.X;
//Crear listas para realizar corte
List <TgcMesh> possitiveList = new List <TgcMesh>();
List <TgcMesh> negativeList = new List <TgcMesh>();
//X-cut
Plane xCutPlane = new Plane(1, 0, 0, -x);
splitByPlane(xCutPlane, meshes, possitiveList, negativeList);
//recursividad de positivos con plano Z, usando resultados positivos y childIndex 0
doSectorQuadtreeZ(parent, new Vector3(x + size.X / 2, center.Y, center.Z),
new Vector3(size.X / 2, size.Y, size.Z),
step, possitiveList, 0);
//recursividad de negativos con plano Z, usando resultados negativos y childIndex 4
doSectorQuadtreeZ(parent, new Vector3(x - size.X / 2, center.Y, center.Z),
new Vector3(size.X / 2, size.Y, size.Z),
step, negativeList, 2);
}
private void findNodesToCollide(TgcBoundingBox objeto, QuadtreeNode node,
float boxLowerX, float boxLowerY, float boxLowerZ,
float boxUpperX, float boxUpperY, float boxUpperZ)
{
TgcBoundingBox caja = new TgcBoundingBox(
new Vector3(boxLowerX, boxLowerY, boxLowerZ),
new Vector3(boxUpperX, boxUpperY, boxUpperZ));
QuadtreeNode[] children = node.children;
TgcCollisionUtils.BoxBoxResult result = TgcCollisionUtils.classifyBoxBox(objeto, caja);
//es hoja, cargar todos los meshes
if (children == null)
{
collidedNodes.Add(node);
}
//recursividad sobre hijos
else
{
float midX = FastMath.Abs((boxUpperX - boxLowerX) / 2);
float midZ = FastMath.Abs((boxUpperZ - boxLowerZ) / 2);
//00
testChildCollideability(objeto, children[0], boxLowerX + midX, boxLowerY, boxLowerZ + midZ, boxUpperX, boxUpperY, boxUpperZ);
//01
testChildCollideability(objeto, children[1], boxLowerX + midX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ - midZ);
//10
testChildCollideability(objeto, children[2], boxLowerX, boxLowerY, boxLowerZ + midZ, boxUpperX - midX, boxUpperY, boxUpperZ);
//11
testChildCollideability(objeto, children[3], boxLowerX, boxLowerY, boxLowerZ, boxUpperX - midX, boxUpperY, boxUpperZ - midZ);
}
}
/// <summary>
/// Recorrer recursivamente el Quadtree para encontrar los nodos visibles
/// </summary>
private void findVisibleMeshes(TgcFrustum frustum, QuadtreeNode node,
float boxLowerX, float boxLowerY, float boxLowerZ,
float boxUpperX, float boxUpperY, float boxUpperZ)
{
QuadtreeNode[] children = node.children;
//es hoja, cargar todos los meshes
if (children == null)
{
selectLeafMeshes(node);
}
//recursividad sobre hijos
else
{
float midX = FastMath.Abs((boxUpperX - boxLowerX) / 2);
float midZ = FastMath.Abs((boxUpperZ - boxLowerZ) / 2);
//00
testChildVisibility(frustum, children[0], boxLowerX + midX, boxLowerY, boxLowerZ + midZ, boxUpperX, boxUpperY, boxUpperZ);
//01
testChildVisibility(frustum, children[1], boxLowerX + midX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ - midZ);
//10
testChildVisibility(frustum, children[2], boxLowerX, boxLowerY, boxLowerZ + midZ, boxUpperX - midX, boxUpperY, boxUpperZ);
//11
testChildVisibility(frustum, children[3], boxLowerX, boxLowerY, boxLowerZ, boxUpperX - midX, boxUpperY, boxUpperZ - midZ);
}
}
private void findNodesToCollide(TgcBoundingBox objeto, QuadtreeNode node,
float boxLowerX, float boxLowerY, float boxLowerZ,
float boxUpperX, float boxUpperY, float boxUpperZ)
{
TgcBoundingBox caja = new TgcBoundingBox(
new Vector3(boxLowerX, boxLowerY, boxLowerZ),
new Vector3(boxUpperX, boxUpperY, boxUpperZ));
QuadtreeNode[] children = node.children;
TgcCollisionUtils.BoxBoxResult result = TgcCollisionUtils.classifyBoxBox(objeto, caja);
//es hoja, cargar todos los meshes
if (children == null)
{
collidedNodes.Add(node);
}
//recursividad sobre hijos
else
{
float midX = FastMath.Abs((boxUpperX - boxLowerX) / 2);
float midZ = FastMath.Abs((boxUpperZ - boxLowerZ) / 2);
//00
testChildCollideability(objeto, children[0], boxLowerX + midX, boxLowerY, boxLowerZ + midZ, boxUpperX, boxUpperY, boxUpperZ);
//01
testChildCollideability(objeto, children[1], boxLowerX + midX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ - midZ);
//10
testChildCollideability(objeto, children[2], boxLowerX, boxLowerY, boxLowerZ + midZ, boxUpperX - midX, boxUpperY, boxUpperZ);
//11
testChildCollideability(objeto, children[3], boxLowerX, boxLowerY, boxLowerZ, boxUpperX - midX, boxUpperY, boxUpperZ - midZ);
}
}
/// <summary>
/// Hacer visibles todas las meshes de un nodo, buscando recursivamente sus hojas
/// </summary>
private void addAllLeafMeshes(QuadtreeNode node)
{
QuadtreeNode[] children = node.children;
//es hoja, cargar todos los meshes
if (children == null)
{
selectLeafMeshes(node);
}
//pedir hojas a hijos
else
{
for (int i = 0; i < children.Length; i++)
{
addAllLeafMeshes(children[i]);
}
}
}
/// <summary>
/// Imprime estadisticas del Octree
/// </summary>
private void printEstadisticasQuadtree(QuadtreeNode rootNode)
{
Console.WriteLine("*********** Quadtree Statics ***********");
int minModels = int.MaxValue;
int maxModels = int.MinValue;
obtenerEstadisticas(rootNode, ref minModels, ref maxModels);
Console.WriteLine("Minima cantidad de TgcMeshs en hoja: " + minModels);
Console.WriteLine("Maxima cantidad de TgcMeshs en hoja: " + maxModels);
Console.WriteLine("*********** FIN Quadtree Statics ************");
}
/// <summary>
/// Hacer visible las meshes de un nodo si es visible por el Frustum
/// </summary>
private void testChildVisibility(TgcFrustum frustum, QuadtreeNode childNode,
float boxLowerX, float boxLowerY, float boxLowerZ, float boxUpperX, float boxUpperY, float boxUpperZ)
{
//test frustum-box intersection
TgcBoundingBox caja = new TgcBoundingBox(
new Vector3(boxLowerX, boxLowerY, boxLowerZ),
new Vector3(boxUpperX, boxUpperY, boxUpperZ));
TgcCollisionUtils.FrustumResult c = TgcCollisionUtils.classifyFrustumAABB(frustum, caja);
//complementamente adentro: cargar todos los hijos directamente, sin testeos
if (c == TgcCollisionUtils.FrustumResult.INSIDE)
{
addAllLeafMeshes(childNode);
}
//parte adentro: seguir haciendo testeos con hijos
else if (c == TgcCollisionUtils.FrustumResult.INTERSECT)
{
findVisibleMeshes(frustum, childNode, boxLowerX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ);
}
}
private void obtenerEstadisticas(QuadtreeNode node, ref int minModels, ref int maxModels)
{
if (node.isLeaf())
{
int n = node.models.Length;
if (n < minModels)
minModels = n;
if (n > maxModels)
maxModels = n;
}
else
{
for (int i = 0; i < node.children.Length; i++)
{
obtenerEstadisticas(node.children[i], ref minModels, ref maxModels);
}
}
}
/// <summary>
/// Se fija si los hijos de un nodo no tienen mas hijos y no tienen ningun triangulo
/// </summary>
private bool hasEmptyChilds(QuadtreeNode node)
{
QuadtreeNode[] children = node.children;
for (int i = 0; i < children.Length; i++)
{
QuadtreeNode childNode = children[i];
if (childNode.children != null || childNode.models.Length > 0)
{
return false;
}
}
return true;
}
/// <summary>
/// Corte de plano Z
/// </summary>
private void doSectorQuadtreeZ(QuadtreeNode parent, Vector3 center, Vector3 size, int step,
List<TgcMesh> meshes, int childIndex)
{
float z = center.Z;
//Crear listas para realizar corte
List<TgcMesh> possitiveList = new List<TgcMesh>();
List<TgcMesh> negativeList = new List<TgcMesh>();
//Z-cut
Plane zCutPlane = new Plane(0, 0, 1, -z);
splitByPlane(zCutPlane, meshes, possitiveList, negativeList);
//obtener lista de children del parent, con iniciacion lazy
if (parent.children == null)
{
parent.children = new QuadtreeNode[4];
}
//crear nodo positivo en parent, segun childIndex
QuadtreeNode posNode = new QuadtreeNode();
parent.children[childIndex] = posNode;
//cargar nodo negativo en parent, segun childIndex
QuadtreeNode negNode = new QuadtreeNode();
parent.children[childIndex + 1] = negNode;
//condicion de corte
if (step > MAX_SECTOR_QUADTREE_RECURSION || meshes.Count < MIN_MESH_PER_LEAVE_THRESHOLD)
{
//cargar hijos de nodo positivo
posNode.models = possitiveList.ToArray();
//cargar hijos de nodo negativo
negNode.models = negativeList.ToArray();
//seguir recursividad
}
else
{
step++;
//recursividad de positivos con plano X, usando resultados positivos
doSectorQuadtreeX(posNode, new Vector3(center.X, center.Y, z + size.Z / 2),
new Vector3(size.X, size.Y, size.Z / 2),
step, possitiveList);
//recursividad de negativos con plano Y, usando resultados negativos
doSectorQuadtreeX(negNode, new Vector3(center.X, center.Y, z - size.Z / 2),
new Vector3(size.X, size.Y, size.Z / 2),
step, negativeList);
}
}
/// <summary>
/// Corte con plano X
/// </summary>
private void doSectorQuadtreeX(QuadtreeNode parent, Vector3 center, Vector3 size,
int step, List<TgcMesh> meshes)
{
float x = center.X;
//Crear listas para realizar corte
List<TgcMesh> possitiveList = new List<TgcMesh>();
List<TgcMesh> negativeList = new List<TgcMesh>();
//X-cut
Plane xCutPlane = new Plane(1, 0, 0, -x);
splitByPlane(xCutPlane, meshes, possitiveList, negativeList);
//recursividad de positivos con plano Z, usando resultados positivos y childIndex 0
doSectorQuadtreeZ(parent, new Vector3(x + size.X / 2, center.Y, center.Z),
new Vector3(size.X / 2, size.Y, size.Z),
step, possitiveList, 0);
//recursividad de negativos con plano Z, usando resultados negativos y childIndex 4
doSectorQuadtreeZ(parent, new Vector3(x - size.X / 2, center.Y, center.Z),
new Vector3(size.X / 2, size.Y, size.Z),
step, negativeList, 2);
}
/// <summary>
/// Impresion recursiva
/// </summary>
private void doPrintDebugQuadtree(QuadtreeNode node, int index, StringBuilder sb)
{
String lineas = "";
for (int i = 0; i < index; i++)
{
lineas += "-";
}
if (node.isLeaf())
{
if (node.models.Length > 0)
{
sb.Append(lineas + "Models [" + node.models.Length + "]" + "\n");
}
else
{
sb.Append(lineas + "[0]" + "\n");
}
}
else
{
sb.Append(lineas + "\n");
index++;
for (int i = 0; i < node.children.Length; i++)
{
doPrintDebugQuadtree(node.children[i], index, sb);
}
}
}
/// <summary>
/// Hacer visibles todas las meshes de un nodo
/// </summary>
private void selectLeafMeshes(QuadtreeNode node)
{
TgcMesh[] models = node.models;
foreach (TgcMesh m in models)
{
//Me fijo si el mesh esta fuera de la skybox (La misma se construye con el farplane, por eso se usa aca)
if ((CustomFpsCamera.Instance.eye - m.Position).Length() < CustomFpsCamera.FAR_PLANE / 2.2)
{
m.Enabled = true;
}
}
}
private void testChildCollideability(TgcBoundingBox objeto, QuadtreeNode childNode,
float boxLowerX, float boxLowerY, float boxLowerZ, float boxUpperX, float boxUpperY, float boxUpperZ)
{
//test frustum-box intersection
TgcBoundingBox caja = new TgcBoundingBox(
new Vector3(boxLowerX, boxLowerY, boxLowerZ),
new Vector3(boxUpperX, boxUpperY, boxUpperZ));
TgcCollisionUtils.BoxBoxResult result = TgcCollisionUtils.classifyBoxBox(objeto, caja);
//parte adentro: seguir haciendo testeos con hijos
if (result == TgcCollisionUtils.BoxBoxResult.Encerrando || result == TgcCollisionUtils.BoxBoxResult.Atravesando)
{
findNodesToCollide(objeto, childNode, boxLowerX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ);
}
}
/// <summary>
/// Se quitan padres cuyos nodos no tengan ningun triangulo
/// </summary>
private void optimizeSectorQuadtree(QuadtreeNode[] children)
{
if (children == null)
{
return;
}
for (int i = 0; i < children.Length; i++)
{
QuadtreeNode childNode = children[i];
QuadtreeNode[] childNodeChildren = childNode.children;
if (childNodeChildren != null && hasEmptyChilds(childNode))
{
childNode.children = null;
childNode.models = new TgcMesh[0];
}
else
{
optimizeSectorQuadtree(childNodeChildren);
}
}
}
private void doCreateQuadtreeDebugBox(QuadtreeNode node, List<TgcDebugBox> debugBoxes,
float boxLowerX, float boxLowerY, float boxLowerZ,
float boxUpperX, float boxUpperY, float boxUpperZ, int step)
{
QuadtreeNode[] children = node.children;
float midX = FastMath.Abs((boxUpperX - boxLowerX) / 2);
float midZ = FastMath.Abs((boxUpperZ - boxLowerZ) / 2);
//Crear caja debug
TgcDebugBox box = createDebugBox(boxLowerX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ, step);
debugBoxes.Add(box);
//es hoja, dibujar caja
if (children == null)
{
}
//recursividad sobre hijos
else
{
step++;
//000
doCreateQuadtreeDebugBox(children[0], debugBoxes, boxLowerX + midX, boxLowerY, boxLowerZ + midZ, boxUpperX, boxUpperY, boxUpperZ, step);
//001
doCreateQuadtreeDebugBox(children[1], debugBoxes, boxLowerX + midX, boxLowerY, boxLowerZ, boxUpperX, boxUpperY, boxUpperZ - midZ, step);
//100
doCreateQuadtreeDebugBox(children[2], debugBoxes, boxLowerX, boxLowerY, boxLowerZ + midZ, boxUpperX - midX, boxUpperY, boxUpperZ, step);
//101
doCreateQuadtreeDebugBox(children[3], debugBoxes, boxLowerX, boxLowerY, boxLowerZ, boxUpperX - midX, boxUpperY, boxUpperZ - midZ, step);
}
}
/// <summary>
/// Imprime por consola la generacion del Octree
/// </summary>
private void printDebugQuadtree(QuadtreeNode rootNode)
{
Console.WriteLine("########## Quadtree DEBUG ##########");
StringBuilder sb = new StringBuilder();
doPrintDebugQuadtree(rootNode, 0, sb);
Console.WriteLine(sb.ToString());
Console.WriteLine("########## FIN Quadtree DEBUG ##########");
}