KDTree implementation for fast nearest-neighbor search on variable-sized points, based on nanoflann - View it on GitHub