Kd-Tree in progress