public override void solve() { if (RodConstraint.distanceBetweenSquared(PointA, PointB) != _distanceSquared) { pointToPointSolve(); } }
protected PointToPointConstraint(PointMass A, PointMass B, double distance = 0) { PointA = A; PointB = B; if (distance == 0) { _distance = RodConstraint.distanceBetween(PointA, PointB); } else { _distance = distance; } _distanceSquared = _distance * _distance; Constraint.activeObjects.Add(this); }