3d Kd Tree Java