fix: throws "not associated with a rigid body" when steps with tiny s…

…ize shapes
notgiven688 · May 30, 2024 · 9b53043 · 9b53043
1 parent bbc6c41
commit 9b53043
Showing 1 changed file with 2 additions and 3 deletions.
diff --git a/src/Jitter2/LinearMath/JMatrix.cs b/src/Jitter2/LinearMath/JMatrix.cs
@@ -334,8 +334,9 @@ public readonly float Determinant()
     public static bool Inverse(in JMatrix matrix, out JMatrix result)
     {
         float det = matrix.Determinant();
+        float idet = 1.0f / det;
 
-        if (float.IsNaN(det) || float.IsInfinity(det))
+        if (float.IsNaN(det) || float.IsInfinity(det) || float.IsNaN(idet) || float.IsInfinity(idet))
         {
             result = new JMatrix();
             return false;
@@ -353,8 +354,6 @@ public static bool Inverse(in JMatrix matrix, out JMatrix result)
         float num32 = matrix.M12 * matrix.M31 - matrix.M32 * matrix.M11;
         float num33 = matrix.M11 * matrix.M22 - matrix.M21 * matrix.M12;
 
-        float idet = 1.0f / det;
-
         result.M11 = num11 * idet;
         result.M12 = num12 * idet;
         result.M13 = num13 * idet;