Fixed gScore with MaxValue due to Vector Angle returning NaN

2023-04-23 13:41:22 +02:00
parent bc39785f6f
commit 97a057a3d4
2 changed files with 3 additions and 3 deletions
--- a/Pathfinding/Pathfinder.cs
+++ b/Pathfinding/Pathfinder.cs
@ -205,6 +205,8 @@ public class Pathfinder
            double v1L = Math.Sqrt(v1.x * v1.x + v1.y * v1.y);
            double v2L = Math.Sqrt(v2.x * v2.x + v2.y * v2.y);
            double ang = Math.Acos(dotProd / (v1L * v2L));
+            if (ang.Equals(double.NaN))
+                return 0;
            double angle = Utils.RadiansToDegrees(ang);
            return angle;
        }