public static Vector3 UnitCross(ref Vector3 vector, ref Vector3 value)
{
Vector3 result = new Vector3(vector.y * value.z - vector.z * value.y, vector.z * value.x - vector.x * value.z, vector.x * value.y - vector.y * value.x);
Vector3ex.Normalize(ref result, 1E-05f);
return(result);
}
public static bool CreateInscribed(Vector3 v0, Vector3 v1, Vector3 v2, Vector3 v3, out Sphere3 sphere)
{
Vector3 vector = v1 - v0;
Vector3 vector2 = v2 - v0;
Vector3 vector3 = v3 - v0;
Vector3 value = v2 - v1;
Vector3 vector4 = v3 - v1;
Vector3 vector5 = vector4.Cross(value);
Vector3 vector6 = vector2.Cross(vector3);
Vector3 vector7 = vector3.Cross(vector);
Vector3 vector8 = vector.Cross(vector2);
if (Mathf.Abs(Vector3ex.Normalize(ref vector5, 1E-05f)) < 1E-05f)
{
sphere = default(Sphere3);
return(false);
}
if (Mathf.Abs(Vector3ex.Normalize(ref vector6, 1E-05f)) < 1E-05f)
{
sphere = default(Sphere3);
return(false);
}
if (Mathf.Abs(Vector3ex.Normalize(ref vector7, 1E-05f)) < 1E-05f)
{
sphere = default(Sphere3);
return(false);
}
if (Mathf.Abs(Vector3ex.Normalize(ref vector8, 1E-05f)) < 1E-05f)
{
sphere = default(Sphere3);
return(false);
}
float[,] array = new float[3, 3];
array[0, 0] = vector6.x - vector5.x;
array[0, 1] = vector6.y - vector5.y;
array[0, 2] = vector6.z - vector5.z;
array[1, 0] = vector7.x - vector5.x;
array[1, 1] = vector7.y - vector5.y;
array[1, 2] = vector7.z - vector5.z;
array[2, 0] = vector8.x - vector5.x;
array[2, 1] = vector8.y - vector5.y;
array[2, 2] = vector8.z - vector5.z;
float[,] a = array;
float[] b = new float[]
{
0f,
0f,
-vector8.Dot(vector3)
};
Vector3 vector9;
if (LinearSystem.Solve3(a, b, out vector9, 1E-05f))
{
sphere.Center = v3 + vector9;
sphere.Radius = Mathf.Abs(vector5.Dot(vector9));
return(true);
}
sphere = default(Sphere3);
return(false);
}
public void UpdateEdge(int edgeIndex)
{
Vector3 vector = (this._edges[edgeIndex].Point1 = this._vertices[(edgeIndex + 1) % this._vertices.Length]) - (this._edges[edgeIndex].Point0 = this._vertices[edgeIndex]);
this._edges[edgeIndex].Length = Vector3ex.Normalize(ref vector, 1E-05f);
this._edges[edgeIndex].Direction = vector;
this._edges[edgeIndex].Normal = this._plane.Normal.Cross(vector);
}
public void UpdateEdges()
{
int num = this._vertices.Length;
int num2 = num - 1;
for (int i = 0; i < num; i++)
{
Vector3 vector = (this._edges[num2].Point1 = this._vertices[i]) - (this._edges[num2].Point0 = this._vertices[num2]);
this._edges[num2].Length = Vector3ex.Normalize(ref vector, 1E-05f);
this._edges[num2].Direction = vector;
this._edges[num2].Normal = this._plane.Normal.Cross(vector);
num2 = i;
}
}
public static Rectangle3 CreateFromCWPoints(Vector3 p0, Vector3 p1, Vector3 p2, Vector3 p3)
{
Vector3 vector = p2 - p1;
Vector3 vector2 = p1 - p0;
Rectangle3 result;
result.Center = (p0 + p2) * 0.5f;
result.Extents.x = Vector3ex.Normalize(ref vector, 1E-05f) * 0.5f;
result.Extents.y = Vector3ex.Normalize(ref vector2, 1E-05f) * 0.5f;
result.Axis0 = vector;
result.Axis1 = vector2;
result.Normal = vector.Cross(vector2);
return(result);
}
public float AngleBetweenPlaneAndLine(Vector3 direction)
{
Vector3ex.Normalize(ref direction, 1E-05f);
float num = this.Normal.Dot(direction);
if (num > 1f)
{
num = 1f;
}
else if (num < -1f)
{
num = -1f;
}
return(1.57079637f - Mathf.Acos(num));
}
public static float AngleRad(this Vector3 vector, Vector3 target)
{
Vector3ex.Normalize(ref vector, 1E-05f);
Vector3ex.Normalize(ref target, 1E-05f);
float num = vector.x * target.x + vector.y * target.y + vector.z * target.z;
if (num > 1f)
{
num = 1f;
}
else if (num < -1f)
{
num = -1f;
}
return(Mathf.Acos(num));
}
public static float SignedAngleRad(this Vector3 vector, Vector3 target, Vector3 normal)
{
Vector3ex.Normalize(ref vector, 1E-05f);
Vector3ex.Normalize(ref target, 1E-05f);
float num = vector.x * target.x + vector.y * target.y + vector.z * target.z;
if (num > 1f)
{
num = 1f;
}
else if (num < -1f)
{
num = -1f;
}
float num2 = Mathf.Acos(num);
Vector3 value = vector.Cross(target);
if (normal.Dot(value) < 0f)
{
num2 = -num2;
}
return(num2);
}
