Update KDTree.h