new Vector3(), bi.isFixed()? new Vector3() : bi.state.inverseinertia.multiply(q), new Vector3(), bj.isFixed()? new Vector3() : bj.state.inverseinertia.multiply(q.multiply(-1)),
new Vector3(), q, new Vector3(), q.multiply(-1),
Double.NEGATIVE_INFINITY,
Double.POSITIVE_INFINITY,
null,
q.dot(bi.state.omega)-q.dot(bj.state.omega) - Kcor*(-n1iw.dot(n2jw))*(1/dt), 0 );
// add constraints to return list
iterator.add(linear1);
iterator.add(linear2);