public static Box3 GaussPointsFit3(IList <Vector3> points)
{
Box3 result = new Box3(Vector3ex.Zero, Vector3ex.UnitX, Vector3ex.UnitY, Vector3ex.UnitZ, Vector3ex.One);
int count = points.Count;
result.Center = points[0];
for (int i = 1; i < count; i++)
{
result.Center += points[i];
}
float num = 1f / (float)count;
result.Center *= num;
float num2 = 0f;
float num3 = 0f;
float num4 = 0f;
float num5 = 0f;
float num6 = 0f;
float num7 = 0f;
for (int j = 0; j < count; j++)
{
Vector3 vector = points[j] - result.Center;
num2 += vector.x * vector.x;
num3 += vector.x * vector.y;
num4 += vector.x * vector.z;
num5 += vector.y * vector.y;
num6 += vector.y * vector.z;
num7 += vector.z * vector.z;
}
num2 *= num;
num3 *= num;
num4 *= num;
num5 *= num;
num6 *= num;
num7 *= num;
float[,] array = new float[3, 3];
array[0, 0] = num2;
array[0, 1] = num3;
array[0, 2] = num4;
array[1, 0] = num3;
array[1, 1] = num5;
array[1, 2] = num6;
array[2, 0] = num4;
array[2, 1] = num6;
array[2, 2] = num7;
float[,] symmetricSquareMatrix = array;
EigenData eigenData = EigenDecomposition.Solve(symmetricSquareMatrix, true);
result.Extents.x = eigenData.GetEigenvalue(0);
result.Axis0 = eigenData.GetEigenvector3(0);
result.Extents.y = eigenData.GetEigenvalue(1);
result.Axis1 = eigenData.GetEigenvector3(1);
result.Extents.z = eigenData.GetEigenvalue(2);
result.Axis2 = eigenData.GetEigenvector3(2);
return(result);
}
public static Box2 GaussPointsFit2(IList <Vector2> points)
{
Box2 result = new Box2(Vector2ex.Zero, Vector2ex.UnitX, Vector2ex.UnitY, Vector2ex.One);
int count = points.Count;
result.Center = points[0];
for (int i = 1; i < count; i++)
{
result.Center += points[i];
}
float num = 1f / (float)count;
result.Center *= num;
float num2 = 0f;
float num3 = 0f;
float num4 = 0f;
for (int j = 0; j < count; j++)
{
Vector2 vector = points[j] - result.Center;
num2 += vector.x * vector.x;
num3 += vector.x * vector.y;
num4 += vector.y * vector.y;
}
num2 *= num;
num3 *= num;
num4 *= num;
float[,] array = new float[2, 2];
array[0, 0] = num2;
array[0, 1] = num3;
array[1, 0] = num3;
array[1, 1] = num4;
float[,] symmetricSquareMatrix = array;
EigenData eigenData = EigenDecomposition.Solve(symmetricSquareMatrix, true);
result.Extents.x = eigenData.GetEigenvalue(0);
result.Extents.y = eigenData.GetEigenvalue(1);
result.Axis0 = eigenData.GetEigenvector2(0);
result.Axis1 = eigenData.GetEigenvector2(1);
return(result);
}
