CompoundJoints debugged

This commit is contained in:
Aik-Siong Koh
2023-12-12 14:49:58 -07:00
parent 56bba4e921
commit 2bb83b82c0
32 changed files with 1078 additions and 311 deletions

View File

@@ -21,7 +21,10 @@ std::shared_ptr<ConstVelConstraintIJ> MbD::ConstVelConstraintIJ::With(EndFrmsptr
{
assert(frmi->isEndFrameqc());
assert(frmj->isEndFrameqc());
return std::make_shared<ConstVelConstraintIqcJqc>(frmi, frmj);
auto constVelCon = std::make_shared<ConstVelConstraintIqcJqc>(frmi, frmj);
constVelCon->initA01IeJe();
constVelCon->initA10IeJe();
return constVelCon;
}
void ConstVelConstraintIJ::calcPostDynCorrectorIteration()