k dimensions tree Template kd-tree implement of c++ search a radius range search k nearest neighborhoods references https://en.wikipedia.org/wiki/K-d_tree build : cd to [workspaceFolder] mkdir build cd build cmake .. make