kindred/solver
1
0
Fork 0
Code Issues 10 Pull Requests 1 Actions Packages Projects Releases Wiki Activity

runPosIC, VelIC, AccIC numerically correct

Browse Source
This commit is contained in:
Aik-Siong Koh
2023-06-24 23:08:29 -06:00
parent 371b13a9e0
commit c30ee64b89
110 changed files with 2171 additions and 129 deletions
Download Patch File Download Diff File Expand all files Collapse all files

19
MbDCode/DirectionCosineIeqctJeqc.cpp
View File

@@ -44,3 +44,22 @@ double MbD::DirectionCosineIeqctJeqc::pvaluept()
{
return pAijIeJept;
}
void MbD::DirectionCosineIeqctJeqc::preAccIC()
{
//| ppAjOIepEITpt ppAjOIeptpt ppAjOIepEITpti pAjOIept |
Item::preAccIC();
auto pAjOIept = std::static_pointer_cast<EndFrameqct>(frmI)->pAjOept(axisI);
auto ppAjOIepEITpt = std::static_pointer_cast<EndFrameqct>(frmI)->ppAjOepETpt(axisI);
auto ppAjOIeptpt = std::static_pointer_cast<EndFrameqct>(frmI)->ppAjOeptpt(axisI);
for (int i = 0; i < 4; i++)
{
auto& ppAjOIepEITpti = ppAjOIepEITpt->at(i);
ppAijIeJepEIpt->atiput(i, ppAjOIepEITpti->dot(aAjOJe));
}
for (int i = 0; i < 4; i++)
{
ppAijIeJepEJpt->atiput(i, pAjOIept->dot(pAjOJepEJT->at(i)));
}
ppAijIeJeptpt = ppAjOIeptpt->dot(aAjOJe);
}