[1114] | 1 | using System;
|
---|
| 2 | using System.Collections.Generic;
|
---|
| 3 |
|
---|
| 4 | namespace Oni.Akira
|
---|
| 5 | {
|
---|
| 6 | internal class QuadtreeNode
|
---|
| 7 | {
|
---|
| 8 | public const int ChildCount = 4;
|
---|
| 9 | private QuadtreeNode[] nodes = new QuadtreeNode[ChildCount];
|
---|
| 10 | private OctreeNode[] leafs = new OctreeNode[ChildCount];
|
---|
| 11 | private readonly Vector3 center;
|
---|
| 12 | private readonly float size;
|
---|
| 13 | private readonly OctreeNode.Face face;
|
---|
| 14 | private int index;
|
---|
| 15 |
|
---|
| 16 | public enum Axis
|
---|
| 17 | {
|
---|
| 18 | U = 0,
|
---|
| 19 | V = 1
|
---|
| 20 | }
|
---|
| 21 |
|
---|
| 22 | public struct ChildPosition
|
---|
| 23 | {
|
---|
| 24 | private readonly int index;
|
---|
| 25 |
|
---|
| 26 | public ChildPosition(int index)
|
---|
| 27 | {
|
---|
| 28 | this.index = index;
|
---|
| 29 | }
|
---|
| 30 |
|
---|
| 31 | public int Index => index;
|
---|
| 32 |
|
---|
| 33 | public int U => this[Axis.U];
|
---|
| 34 | public int V => this[Axis.V];
|
---|
| 35 |
|
---|
| 36 | public int this[Axis axis] => ((index >> (int)axis) & 1);
|
---|
| 37 |
|
---|
| 38 | public static IEnumerable<ChildPosition> All
|
---|
| 39 | {
|
---|
| 40 | get
|
---|
| 41 | {
|
---|
| 42 | for (int i = 0; i < 4; i++)
|
---|
| 43 | yield return new ChildPosition(i);
|
---|
| 44 | }
|
---|
| 45 | }
|
---|
| 46 | }
|
---|
| 47 |
|
---|
| 48 | public QuadtreeNode(Vector3 center, float size, OctreeNode.Face face)
|
---|
| 49 | {
|
---|
| 50 | this.center = center;
|
---|
| 51 | this.size = size;
|
---|
| 52 | this.face = face;
|
---|
| 53 | }
|
---|
| 54 |
|
---|
| 55 | public QuadtreeNode[] Nodes => nodes;
|
---|
| 56 | public OctreeNode[] Leafs => leafs;
|
---|
| 57 |
|
---|
| 58 | public void Build(OctreeNode adjacentNode)
|
---|
| 59 | {
|
---|
| 60 | float childSize = size * 0.5f;
|
---|
| 61 |
|
---|
| 62 | foreach (var position in ChildPosition.All)
|
---|
| 63 | {
|
---|
| 64 | var childCenter = GetChildNodeCenter(position);
|
---|
| 65 | var adjacentCenter = OctreeNode.MovePoint(childCenter, face, childSize * 0.5f);
|
---|
| 66 | var childAdjacentNode = adjacentNode.FindLargestOrEqual(adjacentCenter, childSize);
|
---|
| 67 |
|
---|
| 68 | if (childAdjacentNode.IsLeaf)
|
---|
| 69 | {
|
---|
| 70 | leafs[position.Index] = childAdjacentNode;
|
---|
| 71 | }
|
---|
| 72 | else
|
---|
| 73 | {
|
---|
| 74 | var child = new QuadtreeNode(childCenter, childSize, face);
|
---|
| 75 | child.Build(childAdjacentNode);
|
---|
| 76 | nodes[position.Index] = child;
|
---|
| 77 | }
|
---|
| 78 | }
|
---|
| 79 | }
|
---|
| 80 |
|
---|
| 81 | private Vector3 GetChildNodeCenter(ChildPosition position)
|
---|
| 82 | {
|
---|
| 83 | float offset = size * 0.25f;
|
---|
| 84 |
|
---|
| 85 | float u = (position.U == 0) ? -offset : offset;
|
---|
| 86 | float v = (position.V == 0) ? -offset : offset;
|
---|
| 87 |
|
---|
| 88 | var result = center;
|
---|
| 89 |
|
---|
| 90 | if (face.Axis == OctreeNode.Axis.X)
|
---|
| 91 | {
|
---|
| 92 | result.Y += u;
|
---|
| 93 | result.Z += v;
|
---|
| 94 | }
|
---|
| 95 | else if (face.Axis == OctreeNode.Axis.Y)
|
---|
| 96 | {
|
---|
| 97 | result.X += u;
|
---|
| 98 | result.Z += v;
|
---|
| 99 | }
|
---|
| 100 | else
|
---|
| 101 | {
|
---|
| 102 | result.X += u;
|
---|
| 103 | result.Y += v;
|
---|
| 104 | }
|
---|
| 105 |
|
---|
| 106 | return result;
|
---|
| 107 | }
|
---|
| 108 |
|
---|
| 109 | public int Index => index;
|
---|
| 110 |
|
---|
| 111 | public List<QuadtreeNode> GetDfsList()
|
---|
| 112 | {
|
---|
| 113 | var list = new List<QuadtreeNode>();
|
---|
| 114 |
|
---|
| 115 | DfsTraversal(node => {
|
---|
| 116 | node.index = list.Count;
|
---|
| 117 | list.Add(node);
|
---|
| 118 | });
|
---|
| 119 |
|
---|
| 120 | return list;
|
---|
| 121 | }
|
---|
| 122 |
|
---|
| 123 | private void DfsTraversal(Action<QuadtreeNode> action)
|
---|
| 124 | {
|
---|
| 125 | action(this);
|
---|
| 126 |
|
---|
| 127 | foreach (var node in nodes)
|
---|
| 128 | {
|
---|
| 129 | if (node != null)
|
---|
| 130 | node.DfsTraversal(action);
|
---|
| 131 | }
|
---|
| 132 | }
|
---|
| 133 | }
|
---|
| 134 | }
|
---|