Implementace vytváření k-D Tree

Implementoval jsem k-dimezionální stromovou strukturu pro ICP.

Nutné:
- test
- implementace vyhledávání nejbližšího souseda