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

crank_slider.mbd MBDyn file working

Browse Source
This commit is contained in:
Aik-Siong Koh
2023-10-13 13:01:39 -06:00
parent e4e98755db
commit 84cb979354
95 changed files with 2693 additions and 558 deletions
Download Patch File Download Diff File Expand all files Collapse all files

18
OndselSolver/ASMTGeneralMotion.cpp
View File

@@ -30,7 +30,7 @@ void MbD::ASMTGeneralMotion::parseASMT(std::vector<std::string>& lines)
void MbD::ASMTGeneralMotion::readrIJI(std::vector<std::string>& lines)
{
rIJI = std::make_shared<std::vector<std::string>>(3);
rIJI = std::make_shared<FullColumn<std::string>>(3);
assert(lines[0].find("rIJI1") != std::string::npos);
lines.erase(lines.begin());
@@ -48,7 +48,7 @@ void MbD::ASMTGeneralMotion::readrIJI(std::vector<std::string>& lines)
void MbD::ASMTGeneralMotion::readangIJJ(std::vector<std::string>& lines)
{
angIJJ = std::make_shared<std::vector<std::string>>(3);
angIJJ = std::make_shared<FullColumn<std::string>>(3);
assert(lines[0].find("angIJJ1") != std::string::npos);
lines.erase(lines.begin());
@@ -80,7 +80,7 @@ std::shared_ptr<Joint> MbD::ASMTGeneralMotion::mbdClassNew()
void MbD::ASMTGeneralMotion::createMbD(std::shared_ptr<System> mbdSys, std::shared_ptr<Units> mbdUnits)
{
ASMTMotion::createMbD(mbdSys, mbdUnits);
auto parser = CREATE<SymbolicParser>::With();
auto parser = std::make_shared<SymbolicParser>();
parser->owner = this;
auto geoTime = owner->root()->geoTime();
parser->variables->insert(std::make_pair("time", geoTime));
@@ -88,21 +88,21 @@ void MbD::ASMTGeneralMotion::createMbD(std::shared_ptr<System> mbdSys, std::shar
auto fullMotion = std::static_pointer_cast<FullMotion>(mbdObject);
//rIJI
userFunc = CREATE<BasicUserFunction>::With(rIJI->at(0), 1.0);
userFunc = std::make_shared<BasicUserFunction>(rIJI->at(0), 1.0);
parser->parseUserFunction(userFunc);
auto geoX = parser->stack->top();
geoX = Symbolic::times(geoX, std::make_shared<Constant>(1.0 / mbdUnits->length));
geoX->createMbD(mbdSys, mbdUnits);
auto xBlk = geoX->simplified(geoX);
userFunc = CREATE<BasicUserFunction>::With(rIJI->at(1), 1.0);
userFunc = std::make_shared<BasicUserFunction>(rIJI->at(1), 1.0);
parser->parseUserFunction(userFunc);
auto geoY = parser->stack->top();
geoY = Symbolic::times(geoY, std::make_shared<Constant>(1.0 / mbdUnits->length));
geoY->createMbD(mbdSys, mbdUnits);
auto yBlk = geoY->simplified(geoY);
userFunc = CREATE<BasicUserFunction>::With(rIJI->at(2), 1.0);
userFunc = std::make_shared<BasicUserFunction>(rIJI->at(2), 1.0);
parser->parseUserFunction(userFunc);
auto geoZ = parser->stack->top();
geoZ = Symbolic::times(geoZ, std::make_shared<Constant>(1.0 / mbdUnits->length));
@@ -113,21 +113,21 @@ void MbD::ASMTGeneralMotion::createMbD(std::shared_ptr<System> mbdSys, std::shar
fullMotion->frIJI = std::make_shared<FullColumn<Symsptr>>(xyzBlkList);
//angIJJ
userFunc = CREATE<BasicUserFunction>::With(angIJJ->at(0), 1.0);
userFunc = std::make_shared<BasicUserFunction>(angIJJ->at(0), 1.0);
parser->parseUserFunction(userFunc);
auto geoPhi = parser->stack->top();
geoPhi = Symbolic::times(geoPhi, std::make_shared<Constant>(1.0 / mbdUnits->angle));
geoPhi->createMbD(mbdSys, mbdUnits);
auto phiBlk = geoPhi->simplified(geoPhi);
userFunc = CREATE<BasicUserFunction>::With(angIJJ->at(1), 1.0);
userFunc = std::make_shared<BasicUserFunction>(angIJJ->at(1), 1.0);
parser->parseUserFunction(userFunc);
auto geoThe = parser->stack->top();
geoThe = Symbolic::times(geoThe, std::make_shared<Constant>(1.0 / mbdUnits->angle));
geoThe->createMbD(mbdSys, mbdUnits);
auto theBlk = geoThe->simplified(geoThe);
userFunc = CREATE<BasicUserFunction>::With(angIJJ->at(2), 1.0);
userFunc = std::make_shared<BasicUserFunction>(angIJJ->at(2), 1.0);
parser->parseUserFunction(userFunc);
auto geoPsi = parser->stack->top();
geoPsi = Symbolic::times(geoPsi, std::make_shared<Constant>(1.0 / mbdUnits->angle));