kdtree part finished.. i guess