Files
UmaViewer/Assets/Scripts/umamusume/Gallop/DereScript/IK/Helper.cs
T
2023-01-20 07:13:54 +08:00

63 lines
1.9 KiB
C#

using UnityEngine;
namespace IK
{
public static class Helper
{
public static readonly Vector3 AxisRight = Vector3.right;
public static readonly Vector3 AxisUp = Vector3.up;
public static readonly Vector3 AxisForward = Vector3.forward;
public const float SqrEpsilon = 1E-12f;
public const float DotSmall = 0.999999f;
public static readonly Quaternion QuaternionIdentity = Quaternion.identity;
public static Quaternion MakeQuaternion(float x, float y, float z)
{
float w = Mathf.Cos(x / 2f);
float x2 = Mathf.Sin(x / 2f);
float w2 = Mathf.Cos(y / 2f);
float y2 = Mathf.Sin(y / 2f);
float w3 = Mathf.Cos(z / 2f);
float z2 = Mathf.Sin(z / 2f);
Quaternion quaternion = default(Quaternion);
quaternion.x = x2;
quaternion.y = 0f;
quaternion.z = 0f;
quaternion.w = w;
Quaternion quaternion2 = default(Quaternion);
quaternion2.x = 0f;
quaternion2.y = y2;
quaternion2.z = 0f;
quaternion2.w = w2;
Quaternion quaternion3 = default(Quaternion);
quaternion3.x = 0f;
quaternion3.y = 0f;
quaternion3.z = z2;
quaternion3.w = w3;
return quaternion2 * quaternion * quaternion3;
}
public static void FindBestAxisVectors(Vector3 dir, out Vector3 axis1, out Vector3 axis2)
{
float num = Mathf.Abs(dir.x);
float num2 = Mathf.Abs(dir.y);
float num3 = Mathf.Abs(dir.z);
if (num2 > num && num2 > num3)
{
axis1 = AxisRight;
}
else
{
axis1 = AxisUp;
}
axis1 = Vector3.Normalize(axis1 - dir * Vector3.Dot(axis1, dir));
axis2 = Vector3.Cross(axis1, dir);
}
}
}