hpp-core with KDTree nearest node research