GitHub repository: quimortiz/dynotree
Primary language: C++
Description: Dynamic Kd-Tree:  Euclidean, SO(2), SO(3), SE(3) and more!