Add old kdtree test