kdTree is now rigorously tested.