feat: improved heuristic on accuracy

Metaphoriker · Oct 1, 2024 · 838dec2 · 838dec2
1 parent 4c376c5
commit 838dec2
Showing 1 changed file with 7 additions and 6 deletions.
diff --git a/pathetic-model/src/main/java/org/patheloper/model/pathing/Node.java b/pathetic-model/src/main/java/org/patheloper/model/pathing/Node.java
@@ -74,12 +74,13 @@ private double heuristic() {
     double perpendicularWeight = heuristicWeights.getPerpendicularWeight();
     double heightWeight = heuristicWeights.getHeightWeight();
 
-    // Ensure the combined heuristic is consistent
-    return Math.max(
-        manhattanDistance * manhattanWeight,
-        octileDistance * octileWeight
-            + perpendicularDistance * perpendicularWeight
-            + heightDifference * heightWeight);
+    double directionalPenalty = Math.abs(this.position.getBlockY() - start.getBlockY());
+
+    return (manhattanDistance * manhattanWeight)
+        + (octileDistance * octileWeight)
+        + (perpendicularDistance * perpendicularWeight)
+        + (heightDifference * heightWeight)
+        + (directionalPenalty * 0.5);
   }
 
   private double calculatePerpendicularDistance() {