Matrix2f rot2 = new Matrix2f(body2.getRotation());
Matrix2f rot1T = rot1.transpose();
Matrix2f rot2T = rot2.transpose();
Vector2f a1 = new Vector2f(body2.getPosition());
a1.sub(body1.getPosition());
localAnchor1 = MathUtil.mul(rot1T,a1);
Vector2f a2 = new Vector2f(body1.getPosition());
a2.sub(body2.getPosition());
localAnchor2 = MathUtil.mul(rot2T,a2);