Add prototype of kd tree. Very WIP.