add DistanceConstraintIJ and AngleConstraintIJ

This commit is contained in:
Aik-Siong Koh
2023-07-08 23:20:27 -06:00
parent cb27f2344b
commit 718b17a2cf
134 changed files with 4218 additions and 556 deletions

View File

@@ -102,7 +102,7 @@ void QuasiIntegrator::checkForDiscontinuity()
epsilon = std::abs(t) * epsilon;
tstartNew = ((direction * t) + epsilon) / direction;
}
system->partsJointsMotionsForcesTorquesDo([&](std::shared_ptr<Item> item) { tstartNew = item->checkForDynDiscontinuityBetween(tprevious, tstartNew); });
system->partsJointsMotionsForcesTorquesDo([&](std::shared_ptr<Item> item) { tstartNew = item->checkForDynDiscontinuityBetweenand(tprevious, tstartNew); });
if ((direction * tstartNew) > (direction * t)) {
//"No discontinuity in step"
return;