public void Initialize(Body bA, Body bB, Vec2 anchor) { BodyA = bA; BodyB = bB; BodyA.GetLocalPointToOut(anchor, LocalAnchorA); BodyB.GetLocalPointToOut(anchor, LocalAnchorB); ReferenceAngle = BodyB.Angle - BodyA.Angle; }