feat(astar): compare total cost

be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/Label.java

@@ -33,8 +33,21 @@ public class Label implements Comparable<Label> {
     return pathCost;
   }
 
+  public float getTotalCost() {
+    // will be overriden for A*
+    return pathCost;
+  }
+
   public int compareTo(Label other) {
+    final float difference = this.getTotalCost() - other.getTotalCost();
+    final boolean equal = Math.abs(difference) < 1.0;
+    if (equal) {
+      return 0;
+      //TODO
+    }
+
     // TODO ensure this works properly
-    return (int)(this.pathCost - other.pathCost);
+    // return (int)(this.pathCost - other.pathCost);
+    return this.pathCost - other.pathCost < 0 ? -1 : 1;
   }
 }

be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/LabelStar.java

@@ -0,0 +1,19 @@
+package org.insa.graphs.algorithm.shortestpath;
+
+import org.insa.graphs.model.Node;
+import org.insa.graphs.model.Point;
+
+public class LabelStar extends Label {
+  private float distanceToDestination;
+
+  public LabelStar(Node node, Node destination) {
+    super(node);
+    // precision was never an answer
+    distanceToDestination = (float) Point.distance(node.getPoint(), destination.getPoint());
+  }
+
+  @Override
+  public float getTotalCost() {
+    return this.getCost() + distanceToDestination; 
+  }
+}