private void RaycastFilledCellsHelper(Ray ray, Grid3D <T> brick, List <T> blackList, PriorityQueue <Vector3i, float> out_found, int x, int y, int z, int width, int height, int depth)
{
float distance;
if (!CollisionUtil.IntersectsBounds(ray, x, y, z, x + width, y + height, z + depth, out distance))
{
return;
}
if (width == 1 && height == 1 && depth == 1) // Work for all empty lists
{
if (!blackList.Contains(brick.GetValue(x, y, z)))
{
out_found.Enqueue(new Vector3i(x, y, z), BrickConstants.LARGE_FLOAT - distance);
}
}
else
{
int newWidth = (width + 1) / 2;
int newHeight = (height + 1) / 2;
int newDepth = (depth + 1) / 2;
RaycastFilledCellsHelper(ray, brick, blackList, out_found, x, y, z, newWidth, newHeight, newDepth);
RaycastFilledCellsHelper(ray, brick, blackList, out_found, x + newWidth, y, z, newWidth, newHeight, newDepth);
RaycastFilledCellsHelper(ray, brick, blackList, out_found, x, y + newHeight, z, newWidth, newHeight, newDepth);
RaycastFilledCellsHelper(ray, brick, blackList, out_found, x, y, z + newDepth, newWidth, newHeight, newDepth);
RaycastFilledCellsHelper(ray, brick, blackList, out_found, x + newWidth, y + newHeight, z, newWidth, newHeight, newDepth);
RaycastFilledCellsHelper(ray, brick, blackList, out_found, x + newWidth, y, z + newDepth, newWidth, newHeight, newDepth);
RaycastFilledCellsHelper(ray, brick, blackList, out_found, x, y + newHeight, z + newDepth, newWidth, newHeight, newDepth);
RaycastFilledCellsHelper(ray, brick, blackList, out_found, x + newWidth, y + newHeight, z + newDepth, newWidth, newHeight, newDepth);
}
}
private void RaycastFilledCellsBFHelper(Ray ray, Grid3D <T> brick, List <T> blackList, PriorityQueue <Vector3i, float> out_found, float x, float y, float z, int width, int height, int depth)
{
for (int i = 0; i < width; ++i)
{
for (int j = 0; j < height; ++j)
{
for (int k = 0; k < depth; ++k)
{
if (!blackList.Contains(brick.GetValue(i, j, k)))
{
float distance;
if (!CollisionUtil.IntersectsBounds(ray, x + i, y + j, z + k, x + i + 1, y + j + 1, z + k + 1, out distance))
{
continue;
}
out_found.Enqueue(new Vector3i(i, j, k), BrickConstants.LARGE_FLOAT - distance);
}
}
}
}
}