Vector2f r2 = MathUtil.mul(rot2, anchor2);
Vector2f relativeVelocity = new Vector2f(body2.getVelocity());
relativeVelocity.add(MathUtil.cross(r2, body2.getAngularVelocity()));
relativeVelocity.sub(body1.getVelocity());
relativeVelocity.sub(MathUtil.cross(r1, body1.getAngularVelocity()));
/*
* Matrix2f tr1 = new Matrix2f(-body1.getRotation()); relativeVelocity =
* MathUtil.mul(tr1, relativeVelocity);
* relativeVelocity.add(MathUtil.mul(tr1, dp));