--- dao/FuldDaekningWorker/src/main/java/dk/daoas/fulddaekning/LookupWorker.java	2015/09/29 07:48:48	2725
+++ dao/FuldDaekningWorker/src/main/java/dk/daoas/fulddaekning/LookupWorker.java	2015/11/07 18:02:56	2770
@@ -1,9 +1,8 @@
 package dk.daoas.fulddaekning;
 
 import java.sql.SQLException;
-import java.util.Collection;
+import java.util.ArrayList;
 import java.util.Map;
-import java.util.NoSuchElementException;
 import java.util.Queue;
 import java.util.concurrent.BrokenBarrierException;
 import java.util.concurrent.CyclicBarrier;
@@ -11,13 +10,15 @@
 import java.util.logging.Level;
 import java.util.logging.Logger;
 
-import com.jwetherell.algorithms.data_structures.KdTree;
-
+import ags.utils.dataStructures.MaxHeap;
+import ags.utils.dataStructures.trees.thirdGenKD.DistanceFunction;
+import ags.utils.dataStructures.trees.thirdGenKD.KdTree;
+import ags.utils.dataStructures.trees.thirdGenKD.SquareEuclideanDistanceFunction;
 import dk.daoas.fulddaekning.osrm.OSRMHelper;
 
 public class LookupWorker implements Runnable {
 
-	static final int MAX_RESULTS = 100;
+	static final int MAX_RESULTS = 99;
 
 
 
@@ -36,6 +37,8 @@
 	int workerID;
 	boolean verbose;
 	
+	DistanceFunction dist = new SquareEuclideanDistanceFunction();
+	
 	public LookupWorker(int workerID, 
 				CyclicBarrier barrier, 
 				Queue<Adresse> ikkeDaekkede, 
@@ -69,28 +72,43 @@
 				short ho = qAdresse.ho;
 				KdTree<Adresse> addressTree = hoTrees.get(ho);
 
-				Collection<Adresse> res = addressTree.nearestNeighbourSearch(MAX_RESULTS, qAdresse);
-				if (res.size() > MAX_RESULTS ) {
+				MaxHeap<Adresse> res = addressTree.findNearestNeighbors(qAdresse.xyz, MAX_RESULTS, dist);
+				//Collection<Adresse> res = addressTree.nearestNeighbourSearch(MAX_RESULTS, qAdresse);
+				int size = res.size();
+				if (size > MAX_RESULTS ) {
 					System.out.println("Returnerede mere end MAX_RESULTS> " + res.size() );
 					System.exit(0);
 				}
+				
+				ArrayList<Adresse> adrList = new ArrayList<Adresse>();
 
+				for (int i=0; i<size; i++) {
+					Adresse a = res.getMax();
+					adrList.add(a);
+					res.removeMax();
+				}
+				Adresse bedsteAdr = adrList.get(size-1); //da det er en max-heap er det elementet med størst distance der er først og dermed den sidste der er tættest
+				double bedsteAfstand = GeoPointHelper.beregnAfstand(qAdresse, bedsteAdr);
 
-			Adresse bedsteAdr = res.iterator().next(); //Tag første element
-			double bedsteAfstand = GeoPointHelper.beregnAfstand(qAdresse, bedsteAdr);
-			
-			//Hvis at den er inden for afstand, så prøver vi at lave findNærmste på vej distancen
-			if (bedsteAfstand <= consts.getMaxDistance()) {
-				Adresse bedsteAdr2 = osrmHelper.getNearestViaTable(qAdresse, res); 
-
-				if (bedsteAdr2 != null) {
-					bedsteAdr = bedsteAdr2;
-					bedsteAfstand = GeoPointHelper.beregnAfstand(qAdresse, bedsteAdr);
-				} else {
-					logger.info("NearestViaTable returned null for " + qAdresse);
+
+			if ( LookupMain.use_osrm == true) {
+				//Hvis at den er inden for afstand, så prøver vi at lave findNærmste på vej distancen
+				if (bedsteAfstand <= consts.getMaxDistance()) {
+					//Adresse bedsteAdr2 = osrmHelper.getNearestViarouteHttp(qAdresse, res); 
+					//Adresse bedsteAdr2 = osrmHelper.getNearestViarouteJni(qAdresse, res); 
+					//Adresse bedsteAdr2 = osrmHelper.getNearestTableHttp(qAdresse, adrList); 
+					Adresse bedsteAdr2 = osrmHelper.getNearestTableHttpExperimental(qAdresse, adrList); 
+					//Adresse bedsteAdr2 = osrmHelper.getNearestTableJni(qAdresse, res); 
+
+					if (bedsteAdr2 != null) {
+						bedsteAdr = bedsteAdr2;
+						bedsteAfstand = GeoPointHelper.beregnAfstand(qAdresse, bedsteAdr);
+					} else {
+						logger.info("OSRM returned null for " + qAdresse);
+					}
 				}
 			}
-			
+