namespace ShrimpleCharacterController;

public static class Vector3Extensions
{
	/// <summary>
	/// Move a vector3 towards a goal by a fixed distance
	/// </summary>
	/// <param name="value"></param>
	/// <param name="target"></param>
	/// <param name="travelSpeed"></param>
	/// <returns></returns>
	public static Vector3 MoveTowards( this Vector3 value, Vector3 target, float travelSpeed )
	{
		var difference = target - value;
		var distance = difference.Length;
		var normal = difference.Normal;

		if ( distance <= travelSpeed || distance == 0f )
		{
			return target;
		}

		return value + normal * travelSpeed;
	}

	/// <summary>
	/// Project a vector along a plane (normal) and scale it back to its original length
	/// </summary>
	/// <param name="value"></param>
	/// <param name="normal"></param>
	/// <returns></returns>
	public static Vector3 ProjectAndScale( this Vector3 value, Vector3 normal )
	{
		var length = value.Length;
		value = Vector3.VectorPlaneProject( value, normal ).Normal;
		value *= length;

		return value;
	}
}