small optimisation to KdTree.java and PointSET.java