Update KdTree.java

Made nearest neighbor search work
Apparently looking at lecture slides is a good idea
Who would have guessed