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

MatrixSolver NewtonRaphson

Browse Source
This commit is contained in:
Aik-Siong Koh
2023-05-20 17:55:13 -06:00
parent c147f2a33d
commit 6a577c052c
168 changed files with 2429 additions and 325 deletions
Download Patch File Download Diff File Expand all files Collapse all files

34
MbDCode/MarkerFrame.cpp
View File

@@ -10,11 +10,9 @@ using namespace MbD;
MarkerFrame::MarkerFrame()
{
initialize();
}
MarkerFrame::MarkerFrame(const char* str) : CartesianFrame(str) {
initialize();
}
void MarkerFrame::initialize()
@@ -26,6 +24,26 @@ void MarkerFrame::initialize()
this->addEndFrame(endFrm);
}
void MarkerFrame::initializeLocally()
{
pprOmOpEpE = EulerParameters<double>::ppApEpEtimesColumn(rpmp);
ppAOmpEpE = EulerParameters<double>::ppApEpEtimesMatrix(aApm);
std::for_each(endFrames->begin(), endFrames->end(), [](const auto& endFrame) { endFrame->initializeLocally(); });
}
void MarkerFrame::initializeGlobally()
{
std::for_each(endFrames->begin(), endFrames->end(), [](const auto& endFrame) { endFrame->initializeGlobally(); });
}
void MbD::MarkerFrame::postInput()
{
}
void MbD::MarkerFrame::calcPostDynCorrectorIteration()
{
}
void MarkerFrame::setPartFrame(PartFrame* partFrm)
{
partFrame = partFrm;
@@ -49,15 +67,3 @@ void MarkerFrame::addEndFrame(EndFrmcptr endFrm)
endFrm->setMarkerFrame(this);
endFrames->push_back(endFrm);
}
void MarkerFrame::initializeLocally()
{
pprOmOpEpE = EulerParameters::ppApEpEtimesColumn(rpmp);
ppAOmpEpE = EulerParameters::ppApEpEtimesMatrix(aApm);
std::for_each(endFrames->begin(), endFrames->end(), [](const auto& endFrame) { endFrame->initializeLocally(); });
}
void MarkerFrame::initializeGlobally()
{
std::for_each(endFrames->begin(), endFrames->end(), [](const auto& endFrame) { endFrame->initializeGlobally(); });
}