nanoflann: a C++ header-only fork of FLANN, a library for KD-trees