Update kdtree.h