Still working on KdTree. Recursive search crashes more and more often as the size of the tree increases. Added KdTree test script