Started implementing KDTree(3)