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

Mb dyn half sine and cosine (#42)

Browse Source 
* (int) added

* size_t count

* add files

* MBDyn new joints, sine, cosine

* CompoundJoints debugged
This commit is contained in:
aiksiongkoh
2023-12-13 07:52:16 -07:00
committed by GitHub
parent 87ed8700e2
commit de8759384c
101 changed files with 7993 additions and 625 deletions
Download Patch File Download Diff File Expand all files Collapse all files

17
OndselSolver/ASMTGeneralMotion.cpp
View File

@@ -69,7 +69,12 @@ void MbD::ASMTGeneralMotion::readRotationOrder(std::vector<std::string>& lines)
{
assert(lines[0].find("RotationOrder") != std::string::npos);
lines.erase(lines.begin());
rotationOrder = readString(lines[0]);
std::istringstream iss(lines[0]);
rotationOrder = std::make_shared<std::vector<int>>();
int i;
while (iss >> i) {
rotationOrder->push_back(i);
}
lines.erase(lines.begin());
}
@@ -137,15 +142,7 @@ void MbD::ASMTGeneralMotion::createMbD(std::shared_ptr<System> mbdSys, std::shar
auto xyzRotBlkList = std::initializer_list<Symsptr>{ phiBlk, theBlk, psiBlk };
auto fangIJJ = std::make_shared<EulerAngles<Symsptr>>(xyzRotBlkList);
std::istringstream iss(rotationOrder);
auto rotOrder = std::make_shared<FullColumn<int>>();
int order;
for (int i = 0; i < 3; i++)
{
iss >> order;
rotOrder->push_back(order);
}
fangIJJ->rotOrder = rotOrder;
fangIJJ->rotOrder = rotationOrder;
fullMotion->fangIJJ = fangIJJ;
}