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);
		}
	}
}