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

@@ -28,8 +28,9 @@ void TranslationConstraintIqcJc::calcPostDynCorrectorIteration()
void TranslationConstraintIqcJc::useEquationNumbers()
{
iqXI = std::static_pointer_cast<EndFrameqc>(frmI)->iqX();
iqEI = std::static_pointer_cast<EndFrameqc>(frmI)->iqE();
auto frmIeqc = std::static_pointer_cast<EndFrameqc>(frmI);
iqXI = frmIeqc->iqX();
iqEI = frmIeqc->iqE();
}
void TranslationConstraintIqcJc::fillPosICError(FColDsptr col)