--- dao/FuldDaekningWorker/src/dk/daoas/fulddaekning/LookupWorker.java	2015/09/28 11:09:33	2718
+++ dao/FuldDaekningWorker/src/main/java/dk/daoas/fulddaekning/LookupWorker.java	2015/10/20 10:36:06	2755
@@ -1,7 +1,7 @@
 package dk.daoas.fulddaekning;
 
 import java.sql.SQLException;
-import java.util.Collection;
+import java.util.ArrayList;
 import java.util.Map;
 import java.util.Queue;
 import java.util.concurrent.BrokenBarrierException;
@@ -10,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;
 
 
 
@@ -35,6 +37,8 @@
 	int workerID;
 	boolean verbose;
 	
+	DistanceFunction dist = new SquareEuclideanDistanceFunction();
+	
 	public LookupWorker(int workerID, 
 				CyclicBarrier barrier, 
 				Queue<Adresse> ikkeDaekkede, 
@@ -60,29 +64,50 @@
 	public void run() {
 		System.out.println( "Worker/" + workerID + " starting");
 
-		while ( ! ikkeDaekkede.isEmpty() ) {
+		try {
+			while ( ! ikkeDaekkede.isEmpty() ) {
 			
-			Adresse qAdresse = ikkeDaekkede.remove();
+				Adresse qAdresse = ikkeDaekkede.remove();
 
-			short ho = qAdresse.ho;
-			KdTree<Adresse> addressTree = hoTrees.get(ho);
+				short ho = qAdresse.ho;
+				KdTree<Adresse> addressTree = hoTrees.get(ho);
 
-			Collection<Adresse> res = addressTree.nearestNeighbourSearch(MAX_RESULTS, qAdresse);
-			if (res.size() > MAX_RESULTS ) {
-				System.out.println("Returnerede mere end MAX_RESULTS> " + res.size() );
-				System.exit(0);
-			}
+				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()) {
-				bedsteAdr = osrmHelper.getNearestViaTable(qAdresse, res);
-				bedsteAfstand = GeoPointHelper.beregnAfstand(qAdresse, bedsteAdr);
+			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.getNearestTableJni(qAdresse, res); 
+
+					if (bedsteAdr2 != null) {
+						bedsteAdr = bedsteAdr2;
+						bedsteAfstand = GeoPointHelper.beregnAfstand(qAdresse, bedsteAdr);
+					} else {
+						logger.info("OSRM returned null for " + qAdresse);
+					}
+				}
 			}
-			
+
 
 			
 
@@ -108,15 +133,22 @@
 				}
 			}
 
+			}
+
+		} catch (Exception e) {
+			logger.log( Level.SEVERE, "Worker/" + workerID, e);
 		}
 
+
+
 		try {
+			logger.info( "Worker/" + workerID + " afventer barrier");
 			barrier.await();
 		} catch (BrokenBarrierException e) {
 			logger.log(Level.SEVERE, e.getMessage(), e);
 			System.exit(-1);
 		} catch(InterruptedException e) {
-			//Do nothing
+			logger.log(Level.SEVERE, e.getMessage(), e);
 		}