List<Body> bodies = new ArrayList<Body>();
List<NCPConstraint> constraints = new ArrayList<NCPConstraint>();
bodies.add(b1); bodies.add(b2); constraints.add(c1); constraints.add(c2);
//run the solver
s.solve(constraints, bodies, 0.0);
System.out.println("("+c1.lambda+","+c2.lambda+")");
//expect solution (1/4,1/4)
assertTrue( Math.abs(-0.25 - c1.lambda) < epsilon );