feat: add method to clamp Vector3d by magnitude

Author: mrdav30

src/FixedMathSharp/Extensions/Vector3d.Extensions.cs

@@ -20,6 +20,11 @@ public static Vector3d ClampOneInPlace(this Vector3d v)
             return v;
         }
 
+        public static Vector3d ClampMagnitude(this Vector3d value, Fixed64 maxMagnitude)
+        {
+            return Vector3d.ClampMagnitude(value, maxMagnitude);
+        }
+
         /// <summary>
         /// Checks if the distance between two vectors is less than or equal to a specified factor.
         /// </summary>

src/FixedMathSharp/Numerics/Vector3d.cs

@@ -622,6 +622,17 @@ public static Vector3d Clamp(Vector3d value, Vector3d min, Vector3d max)
             );
         }
 
+        public static Vector3d ClampMagnitude(Vector3d value, Fixed64 maxMagnitude)
+        {
+            Fixed64 magnitudeSqr = value.SqrMagnitude;
+            if (magnitudeSqr > maxMagnitude * maxMagnitude)
+            {
+                Fixed64 magnitude = FixedMath.Sqrt(magnitudeSqr); // Get actual magnitude
+                return (value / magnitude) * maxMagnitude; // Scale vector to max magnitude
+            }
+            return value;
+        }
+
         /// <summary>
         /// Determines if two vectors are exactly parallel by checking if their cross product is zero.
         /// </summary>