public void TestCollisionTree()
{
var random = new Random(0);
Vector3[] points = Enumerable.Range(0, 100)
.Select(idx => {
float x = (float)random.NextDouble();
float y = (float)random.NextDouble();
float z = (float)random.NextDouble();
return(new Vector3(x, y, z));
})
.ToArray();
var tree = CollisionTree.Make(points);
var sphere = new BoundingSphere(new Vector3(0.3f, 0.1f, 0.5f), 0.5f);
var indices = tree.GetPointsInSphere(sphere);
Assert.IsTrue(indices.Count > 0 && indices.Count < points.Length);
var indexSet = new HashSet <int>(indices);
for (int idx = 0; idx < points.Length; ++idx)
{
bool expectedIsInSphere = sphere.Contains(ref points[idx]) == ContainmentType.Contains;
bool actualIsInSphere = indexSet.Contains(idx);
Assert.AreEqual(expectedIsInSphere, actualIsInSphere);
}
}
private ScatteringFormFactorCalculator(Vector3[] vertexPositions, Quad[] faces, int[] surfaceMap)
{
if (faces.Length != surfaceMap.Length)
{
throw new ArgumentException("face count mismatch");
}
foreach (var face in faces)
{
if (face.IsDegeneratedIntoTriangle)
{
throw new NotImplementedException("ScatteringFormFactorCalculator only supports Quad faces");
}
}
this.vertexPositions = vertexPositions;
this.faces = faces;
this.surfaceMap = surfaceMap;
vertexCount = vertexPositions.Length;
receiverCollisionTree = CollisionTree.Make(vertexPositions);
connectedComponentLabels = ConnectedComponentLabels.Make(vertexCount, faces);
}
public void Start()
{
_Tree = new CollisionTree();
Instance = this;
ResetCollisionMap();
}
