* Sphere 1 is at (0,1+a,0), Sphere 2 is at (0,-1-a,0),
* where a is a small number. We expect the distance to
* be 2a, within the error tolerance
*/
public void testSphereSphere2() {
GJK gjk = new GJK();
//small number
double a = 1e-3;
//set up geometries
Sphere s1 = new Sphere(1);
Body b1 = new Body("default", s1);
b1.setPosition(new Vector3(0,1+a,0));
Sphere s2 = new Sphere(1);
Body b2 = new Body("default", s2);
b2.setPosition(new Vector3(0,-1-a,0));
//closest point vectors
Vector3 p1 = new Vector3();
Vector3 p2 = new Vector3();
gjk.run(s1,s2,p1,p2,Double.POSITIVE_INFINITY, epsilon, 31);
double d = p1.sub(p2).norm();
System.out.println("d="+d);
// distance should be 2a within precision