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

@@ -25,6 +25,21 @@ void DirectionCosineIeqctJeqc::initializeGlobally()
ppAjOJepEJpEJ = std::static_pointer_cast<EndFrameqc>(frmJ)->ppAjOepEpE(axisJ);
}
FRowDsptr MbD::DirectionCosineIeqctJeqc::ppvaluepEIpt()
{
return ppAijIeJepEIpt;
}
FRowDsptr MbD::DirectionCosineIeqctJeqc::ppvaluepEJpt()
{
return ppAijIeJepEJpt;
}
double MbD::DirectionCosineIeqctJeqc::ppvalueptpt()
{
return ppAijIeJeptpt;
}
void DirectionCosineIeqctJeqc::calcPostDynCorrectorIteration()
{
//"ppAjOIepEIpEI is not longer constant and must be set before any calculation."