GoaLitiuM/FlaxEngine
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Unified

Browse Source
This commit is contained in:
Nejcraft
2021-02-24 14:25:49 +01:00
committed by GitHub
parent b133539c40
commit 5d7940f784
1 changed files with 23 additions and 11 deletions
Download Patch File Download Diff File Expand all files Collapse all files

34
Source/Engine/Core/Math/Vector3.cs
View File

@@ -1001,20 +1001,32 @@ namespace FlaxEngine
/// <param name="max">Max Length</param>
public static Vector3 ClampLength(Vector3 vector, float min, float max)
{
Vector3 retVect = new Vector3(vector.X, vector.Y, vector.Z);
if (retVect.LengthSquared > max * max)
ClampLength(vector, min, max, out Vector3 retVect);
return retVect;
}
/// <summary>
/// Makes sure that Length of the output vector is always below max and above min.
/// </summary>
/// <param name="vector">Input Vector.</param>
/// <param name="min">Min Length</param>
/// <param name="max">Max Length</param>
/// <param name="retVect">The Return Vector</param>
public static void ClampLength(Vector3 vector, float min, float max, out Vector3 retVect)
{
float lenSq = vector.LengthSquared;
if (lenSq > max * max)
{
float scaleFactor = max / (float)Math.Sqrt(retVect.LengthSquared);
retVect.X = retVect.X * scaleFactor;
retVect.Y = retVect.Y * scaleFactor;
retVect.Z = retVect.Z * scaleFactor;
float scaleFactor = max / (float)Math.Sqrt(lenSq);
retVect.X = vector.X * scaleFactor;
retVect.Y = vector.Y * scaleFactor;
retVect.Z = vector.Z * scaleFactor;
}
if (retVect.LengthSquared < min * min)
if (lenSq < min * min)
{
float scaleFactor = min / (float)Math.Sqrt(retVect.LengthSquared);
retVect.X = retVect.X * scaleFactor;
retVect.Y = retVect.Y * scaleFactor;
retVect.Z = retVect.Z * scaleFactor;
float scaleFactor = min / (float)Math.Sqrt(lenSq);
retVect.X = vector.X * scaleFactor;
retVect.Y = vector.Y * scaleFactor;
retVect.Z = vector.Z * scaleFactor;
}
return retVect;
}