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

22
MbDCode/AtPointConstraintIqctJqc.cpp
View File

@@ -38,3 +38,25 @@ void MbD::AtPointConstraintIqctJqc::preVelIC()
AtPointConstraintIJ::preVelIC();
pGpt = std::static_pointer_cast<DispCompIeqctJeqcO>(riIeJeO)->priIeJeOpt;
}
void MbD::AtPointConstraintIqctJqc::fillVelICError(FColDsptr col)
{
col->atiminusNumber(iG, pGpt);
}
void MbD::AtPointConstraintIqctJqc::fillAccICIterError(FColDsptr col)
{
AtPointConstraintIqcJqc::fillAccICIterError(col);
auto efrmIqc = std::static_pointer_cast<EndFrameqc>(frmI);
auto qEdotI = efrmIqc->qEdot();
double sum = (ppGpEIpt->timesFullColumn(qEdotI)) * 2.0;
sum += ppGptpt;
col->atiplusNumber(iG, sum);
}
void MbD::AtPointConstraintIqctJqc::preAccIC()
{
AtPointConstraintIJ::preAccIC();
ppGpEIpt = std::static_pointer_cast<DispCompIeqctJeqcO>(riIeJeO)->ppriIeJeOpEIpt;
ppGptpt = std::static_pointer_cast<DispCompIeqctJeqcO>(riIeJeO)->ppriIeJeOptpt;
}