Simplified code in KDTree::findKNN.
Changed kNN list to be kept inorder.
heapSort is called on every addition. Simplified and adds performance to code.