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

runPosIC, initializeGlobally

Browse Source
This commit is contained in:
Aik-Siong Koh
2023-05-27 21:43:09 -06:00
parent 6a577c052c
commit 9ddbdca742
139 changed files with 2401 additions and 431 deletions
Download Patch File Download Diff File Expand all files Collapse all files

25
MbDCode/DirectionCosineIeqcJeqc.cpp
View File

@@ -14,6 +14,7 @@ DirectionCosineIeqcJeqc::DirectionCosineIeqcJeqc(EndFrmcptr frmi, EndFrmcptr frm
void DirectionCosineIeqcJeqc::initialize()
{
DirectionCosineIeqcJec::initialize();
pAijIeJepEJ = std::make_shared<FullRow<double>>(4);
ppAijIeJepEIpEJ = std::make_shared<FullMatrix<double>>(4, 4);
ppAijIeJepEJpEJ = std::make_shared<FullMatrix<double>>(4, 4);
@@ -27,4 +28,28 @@ void MbD::DirectionCosineIeqcJeqc::initializeGlobally()
void MbD::DirectionCosineIeqcJeqc::calcPostDynCorrectorIteration()
{
DirectionCosineIeqcJec::calcPostDynCorrectorIteration();
pAjOJepEJT = std::static_pointer_cast<EndFrameqc>(frmJ)->pAjOepET(axisJ);
for (size_t i = 0; i < 4; i++)
{
pAijIeJepEJ->at(i) = aAjOIe->dot(pAjOJepEJT->at(i));
}
for (size_t i = 0; i < 4; i++)
{
auto& ppAijIeJepEIipEJ = ppAijIeJepEIpEJ->at(i);
for (size_t j = 0; j < 4; j++)
{
ppAijIeJepEIipEJ->at(j) = pAjOIepEIT->at(i)->dot(pAjOJepEJT->at(j));
}
}
for (size_t i = 0; i < 4; i++)
{
auto& ppAijIeJepEJipEJ = ppAijIeJepEJpEJ->at(i);
auto& ppAjOJepEJipEJ = ppAjOJepEJpEJ->at(i);
for (size_t j = 0; j < 4; j++)
{
ppAijIeJepEJipEJ->at(j) = aAjOIe->dot(ppAjOJepEJipEJ->at(j));
}
}
ppAijIeJepEJpEJ->symLowerWithUpper();
}