111 lines
2.7 KiB
C#
111 lines
2.7 KiB
C#
|
namespace Fusion.Addons.KCC
|
||
|
{
|
||
|
using System.Runtime.CompilerServices;
|
||
|
using UnityEngine;
|
||
|
|
||
|
public static partial class KCCVector3Extensions
|
||
|
{
|
||
|
// PUBLIC METHODS
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static Vector3 OnlyX(this Vector3 vector)
|
||
|
{
|
||
|
vector.y = 0.0f;
|
||
|
vector.z = 0.0f;
|
||
|
return vector;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static Vector3 OnlyY(this Vector3 vector)
|
||
|
{
|
||
|
vector.x = 0.0f;
|
||
|
vector.z = 0.0f;
|
||
|
return vector;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static Vector3 OnlyZ(this Vector3 vector)
|
||
|
{
|
||
|
vector.x = 0.0f;
|
||
|
vector.y = 0.0f;
|
||
|
return vector;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static Vector3 OnlyXY(this Vector3 vector)
|
||
|
{
|
||
|
vector.z = 0.0f;
|
||
|
return vector;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static Vector3 OnlyXZ(this Vector3 vector)
|
||
|
{
|
||
|
vector.y = 0.0f;
|
||
|
return vector;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static Vector3 OnlyYZ(this Vector3 vector)
|
||
|
{
|
||
|
vector.x = 0.0f;
|
||
|
return vector;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static Vector3 XZ0(this Vector3 vector)
|
||
|
{
|
||
|
return new Vector3(vector.x, vector.z, 0.0f);
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static Vector3 X0Y(this Vector3 vector)
|
||
|
{
|
||
|
return new Vector3(vector.x, 0.0f, vector.y);
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static Vector3 ClampToNormalized(this Vector3 vector)
|
||
|
{
|
||
|
if (Vector3.SqrMagnitude(vector) > 1.0f)
|
||
|
{
|
||
|
vector.Normalize();
|
||
|
}
|
||
|
|
||
|
return vector;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static bool IsNaN(this Vector3 vector)
|
||
|
{
|
||
|
return float.IsNaN(vector.x) == true || float.IsNaN(vector.y) == true || float.IsNaN(vector.z) == true;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static bool IsZero(this Vector3 vector)
|
||
|
{
|
||
|
return vector.x == 0.0f && vector.y == 0.0f && vector.z == 0.0f;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static bool IsAlmostZero(this Vector3 vector, float tolerance = 0.01f)
|
||
|
{
|
||
|
return vector.x < tolerance && vector.x > -tolerance
|
||
|
&& vector.y < tolerance && vector.y > -tolerance
|
||
|
&& vector.z < tolerance && vector.z > -tolerance;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static bool IsEqual(this Vector3 vector, Vector3 other)
|
||
|
{
|
||
|
return vector.x == other.x && vector.y == other.y && vector.z == other.z;
|
||
|
}
|
||
|
|
||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||
|
public static bool AlmostEquals(this Vector3 vectorA, Vector3 vectorB, float tolerance = 0.01f)
|
||
|
{
|
||
|
return IsAlmostZero(vectorA - vectorB, tolerance);
|
||
|
}
|
||
|
}
|
||
|
}
|