From cd0803a07b5cc6eca175c9fbdf5b39c758d83afd Mon Sep 17 00:00:00 2001
From: Fu Boyu <bfu@insa-10218>
Date: Fri, 14 Apr 2023 16:05:24 +0200
Subject: [PATCH] Dijkstra fini

---
 .../shortestpath/DijkstraAlgorithm.java       | 86 +++++++++++++++++
 .../graphs/algorithm/shortestpath/Label.java  | 65 +++++++++++++
 .../graphs/algorithm/utils/BinaryHeap.java    | 11 ++-
 .../main/java/org/insa/graphs/model/Path.java | 94 ++++++++++++++++---
 4 files changed, 242 insertions(+), 14 deletions(-)
 create mode 100644 be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/Label.java

diff --git a/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/DijkstraAlgorithm.java b/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/DijkstraAlgorithm.java
index bacb8e3..b376afa 100644
--- a/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/DijkstraAlgorithm.java
+++ b/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/DijkstraAlgorithm.java
@@ -1,5 +1,16 @@
 package org.insa.graphs.algorithm.shortestpath;
 
+import java.util.List;
+import java.util.ArrayList;
+import java.util.Collections;
+import org.insa.graphs.algorithm.AbstractSolution;
+import org.insa.graphs.algorithm.utils.BinaryHeap;
+import org.insa.graphs.model.Arc;
+import org.insa.graphs.model.Graph;
+import org.insa.graphs.model.Node;
+import org.insa.graphs.model.Path;
+
+
 public class DijkstraAlgorithm extends ShortestPathAlgorithm {
 
     public DijkstraAlgorithm(ShortestPathData data) {
@@ -11,6 +22,81 @@ public class DijkstraAlgorithm extends ShortestPathAlgorithm {
         final ShortestPathData data = getInputData();
         ShortestPathSolution solution = null;
         // TODO:
+		Graph graph = data.getGraph();
+        List<Node> nodes = graph.getNodes();
+        BinaryHeap<Label> tas = new BinaryHeap<Label>();
+        ArrayList<Label> labels = new ArrayList<Label>();
+        boolean notfini = true;
+		
+		for (Node n : nodes) {
+        	labels.add(new Label(n,null));
+        }
+        
+        Node origin = data.getOrigin();
+        notifyOriginProcessed(origin);
+        labels.get(origin.getId()).setCost(0);
+        tas.insert(labels.get(origin.getId()));
+		
+		Label currentLabel;
+        while (tas.isEmpty() != true && notfini) 
+        {
+        	currentLabel = tas.findMin();
+        	tas.remove(currentLabel);
+        	Node currentNode = currentLabel.getCurrentNode();
+        	if (currentNode == data.getDestination())
+        	{
+        		notfini = false;
+        	}
+        	labels.get(currentNode.getId()).setMark(true);
+        	for (Arc newArc : currentNode.getSuccessors())
+        	{
+        		if (data.isAllowed(newArc))
+        		{
+        			Label destLabel = labels.get(newArc.getDestination().getId());
+        			if (!destLabel.getMark())
+        			{
+        				Node destNode = destLabel.getCurrentNode();
+        				notifyNodeReached(destNode);
+        				Double currentCost = currentLabel.getCost();
+        				Double destCost = destLabel.getCost();
+        				Double arcCost = data.getCost(newArc);
+        				if (destCost > currentCost+ arcCost)
+        				{
+        					
+        					if (destCost != Double.MAX_VALUE) 
+        					{
+        						tas.remove(destLabel);
+        					}
+        					destLabel.setCost(currentCost+arcCost);
+        					destLabel.setFatherArc(newArc);
+        					tas.insert(destLabel);
+        					labels.set(destNode.getId(),destLabel);
+        					
+        				}
+        			}
+        		}
+        	}
+        	notifyNodeMarked(currentNode);
+        }
+        
+        Arc currentArc=labels.get(data.getDestination().getId()).getFatherArc();
+        if (currentArc == null) {
+            solution = new ShortestPathSolution(data, AbstractSolution.Status.INFEASIBLE);
+        }
+        else {
+
+            notifyDestinationReached(data.getDestination());
+            
+            ArrayList<Arc> arcs = new ArrayList<>();
+            while (currentArc != null) {
+                arcs.add(currentArc);
+                Arc newArc=labels.get(currentArc.getOrigin().getId()).getFatherArc();
+                currentArc = newArc;
+            }
+            Collections.reverse(arcs);
+            solution = new ShortestPathSolution(data, AbstractSolution.Status.OPTIMAL, new Path(graph, arcs));
+        }
+		
         return solution;
     }
 
diff --git a/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/Label.java b/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/Label.java
new file mode 100644
index 0000000..54aaa99
--- /dev/null
+++ b/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/shortestpath/Label.java
@@ -0,0 +1,65 @@
+    package org.insa.graphs.algorithm.shortestpath;
+	import org.insa.graphs.model.*;
+
+    public class Label implements Comparable<Label>
+	{
+
+    	private Node currentNode;
+    	private boolean mark;
+    	private double cost;
+    	private Arc fatherArc;
+    		
+    	public Label(Node currentNode, Arc fatherArc) 
+		{
+    		this.currentNode = currentNode;
+    		this.fatherArc = fatherArc;
+    		this.cost = Double.MAX_VALUE;
+    		this.mark = false;
+    	}
+    	
+    	public double getCost() 
+		{
+    		return this.cost;
+    	}
+  
+    	public boolean getMark() 
+		{
+    		return this.mark;
+    	}
+    	
+    	public Arc getFatherArc() 
+		{
+    		return this.fatherArc;
+    	}
+    	
+    	public Node getCurrentNode() 
+		{
+    		return this.currentNode;
+    	}
+    	
+    	public void setCost(double cout) 
+		{
+    		this.cost = cout;
+    	}
+    	
+    	public void setMark(boolean mark) 
+		{
+    		this.mark = mark;
+    	}
+    	
+    	public void setFatherArc(Arc fatherArc) 
+		{
+    		this.fatherArc = fatherArc;
+    	}
+    	
+    	public void setCurrentNode(Node currentNode) 
+		{
+    		this.currentNode = currentNode;
+    	}
+    	
+        public int compareTo(Label label) 
+        {
+            return Double.compare(getCost(), label.getCost());
+        }
+
+    }
\ No newline at end of file
diff --git a/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/utils/BinaryHeap.java b/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/utils/BinaryHeap.java
index 2c1a239..1e8f556 100644
--- a/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/utils/BinaryHeap.java
+++ b/be-graphes-algos/src/main/java/org/insa/graphs/algorithm/utils/BinaryHeap.java
@@ -83,7 +83,6 @@ public class BinaryHeap<E extends Comparable<E>> implements PriorityQueue<E> {
 
         this.arraySet(index, x);
     }
-
     /**
      * Internal method to percolate down in the heap.
      * 
@@ -137,7 +136,15 @@ public class BinaryHeap<E extends Comparable<E>> implements PriorityQueue<E> {
 
     @Override
     public void remove(E x) throws ElementNotFoundException {
-        // TODO:
+        // DONE:
+        int index = array.indexOf(x);
+        if (isEmpty() || index < 0 || index >= this.currentSize) {
+            throw new ElementNotFoundException(x); 
+        }
+        E lastItem = this.array.get(--this.currentSize);
+        this.arraySet(index,lastItem);
+        this.percolateUp(index);
+        this.percolateDown(index);
     }
 
     @Override
diff --git a/be-graphes-model/src/main/java/org/insa/graphs/model/Path.java b/be-graphes-model/src/main/java/org/insa/graphs/model/Path.java
index 6ebdb73..30dd3e0 100644
--- a/be-graphes-model/src/main/java/org/insa/graphs/model/Path.java
+++ b/be-graphes-model/src/main/java/org/insa/graphs/model/Path.java
@@ -30,13 +30,36 @@ public class Path {
      * @throws IllegalArgumentException If the list of nodes is not valid, i.e. two
      *         consecutive nodes in the list are not connected in the graph.
      * 
-     * @deprecated Need to be implemented.
      */
     public static Path createFastestPathFromNodes(Graph graph, List<Node> nodes)
             throws IllegalArgumentException {
-        List<Arc> arcs = new ArrayList<Arc>();
+		List<Arc> arcs = new ArrayList<Arc>();
         // TODO:
-        return new Path(graph, arcs);
+		if (nodes.size() == 1) {
+        	return new Path(graph,nodes.get(0));
+        }else if (nodes.size() == 0) {
+        	return new Path(graph);
+        }
+		
+		if (nodes.size() > 1) {	
+			Arc min = null;
+	        double mintime = Double.MAX_VALUE;			
+	        for (int i = 0; i < nodes.size()-1; i++) {				
+				for(Arc arc : nodes.get(i).getSuccessors()) {
+					if(arc.getMinimumTravelTime() < mintime && arc.getDestination().equals(nodes.get(i+1))) {
+						min = arc;
+						mintime = arc.getMinimumTravelTime();
+					}
+	    	    }
+				if (min == null){
+					throw new IllegalArgumentException();
+				}			
+				arcs.add(min);
+				mintime = Double.MAX_VALUE;
+				min = null;
+	        }
+		}
+		return new Path(graph, arcs);
     }
 
     /**
@@ -51,12 +74,37 @@ public class Path {
      * @throws IllegalArgumentException If the list of nodes is not valid, i.e. two
      *         consecutive nodes in the list are not connected in the graph.
      * 
-     * @deprecated Need to be implemented.
      */
     public static Path createShortestPathFromNodes(Graph graph, List<Node> nodes)
             throws IllegalArgumentException {
         List<Arc> arcs = new ArrayList<Arc>();
         // TODO:
+		if (nodes.size() == 1) {
+        	return new Path(graph,nodes.get(0));
+        }else if (nodes.size() == 0) {
+        	return new Path(graph);
+        }
+		
+		if (nodes.size() > 1) {
+			Arc min = null;
+			float mindistance = Float.MAX_VALUE;
+        
+            for(int i=0; i<nodes.size()-1;i++) {
+				for(Arc arc : nodes.get(i).getSuccessors()) {
+					if(arc.getLength() < mindistance && arc.getDestination().equals(nodes.get(i+1))) {
+						min = arc;	
+						mindistance = arc.getLength();
+					}	
+	    	    }
+				
+				if(min == null) {
+					throw new IllegalArgumentException();
+	    	    }
+				arcs.add(min);
+				mindistance = Float.MAX_VALUE;
+				min = null;
+            }
+		}
         return new Path(graph, arcs);
     }
 
@@ -198,11 +246,24 @@ public class Path {
      * 
      * @return true if the path is valid, false otherwise.
      * 
-     * @deprecated Need to be implemented.
      */
     public boolean isValid() {
         // TODO:
-        return false;
+		if (arcs.size() == 0) {
+            return true;
+        }
+        if (arcs.get(0).getOrigin() != origin){
+            return false;
+		}else if (arcs.size() == 1){
+            return true;
+		}
+
+        for (int i = 1; i < arcs.size(); i++) {
+            if (arcs.get(i-1).getDestination() != arcs.get(i).getOrigin()){
+                return false;
+			}
+        }
+        return true;
     }
 
     /**
@@ -210,11 +271,14 @@ public class Path {
      * 
      * @return Total length of the path (in meters).
      * 
-     * @deprecated Need to be implemented.
      */
     public float getLength() {
         // TODO:
-        return 0;
+		float res = 0;
+        for(Arc arc : this.arcs) {
+        	res+= arc.getLength();
+        }
+        return res;
     }
 
     /**
@@ -225,11 +289,14 @@ public class Path {
      * @return Time (in seconds) required to travel this path at the given speed (in
      *         kilometers-per-hour).
      * 
-     * @deprecated Need to be implemented.
      */
     public double getTravelTime(double speed) {
         // TODO:
-        return 0;
+		double res = 0;
+        for (Arc arc : arcs) {
+            res += arc.getTravelTime(speed);
+        }
+        return res;
     }
 
     /**
@@ -238,11 +305,14 @@ public class Path {
      * 
      * @return Minimum travel time to travel this path (in seconds).
      * 
-     * @deprecated Need to be implemented.
      */
     public double getMinimumTravelTime() {
         // TODO:
-        return 0;
+		double res = 0;
+        for (Arc arc : arcs) {
+            res += arc.getMinimumTravelTime();
+        }
+        return res;
     }
 
 }