public RevoluteJoint(Body body1, Body body2, Vector2 anchor) { this._body1 = body1; this._body2 = body2; //Matrix rotation1 localAnchor1 = body1.GetLocalPosition(anchor); localAnchor2 = body2.GetLocalPosition(anchor); accumulatedImpulse = Vector2.Zero; relaxation = 1f; }