initialize method
Initialize the bodies, anchors, and reference angle using a world anchor point.
Implementation
void initialize(A bodyA, B bodyB, Vector2 anchor) {
this.bodyA = bodyA;
this.bodyB = bodyB;
localAnchorA.setFrom(bodyA.localPoint(anchor));
localAnchorB.setFrom(bodyB.localPoint(anchor));
referenceAngle = bodyB.angle - bodyA.angle;
}