nanoflann is a C++ header-only library for building KD-Trees, optimized for 2D or 3D point clouds...