Added spherical trigonometric calculation of nearest and furthest points for k-D tree separation colocation constraint.
Minor changes to code for testing.