// angular axis where relative velocity must be zero
Vector3 q = n1iw.cross(n2jw);
angular1.assign(
bi, bj,
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 );