A KDTree Library for C++