Add kd-tree, not yet well tested