Update kdtree.c