Mat22.mulToOut(b2.getTransform().R, r2, r2);
d.x = b2.m_sweep.c.x + r2.x - b1.m_sweep.c.x - r1.x;
d.y = b2.m_sweep.c.y + r2.y - b1.m_sweep.c.y - r1.y;
float length = d.normalize();
float C = length - m_length;
C = MathUtils.clamp(C, -Settings.maxLinearCorrection, Settings.maxLinearCorrection);
float impulse = -m_mass * C;
m_u.set(d);