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);
}
