Buenas,
Les dejo el link a una implementación de OctTree (una de las pocas que encontramos fáciles de integrar y de usar).
https://nomis80.org/code/octree.html
La documentación está bastante completa, pero cualquier duda me pueden escribir por eva.
Suerte!