New Kd-tree structure added (work in progress)