KD-Tree in progres