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

64
OndselSolver/MBDynStructural.cpp
View File

@@ -1,16 +1,20 @@
#include "MBDynStructural.h"
#include "MBDynVariables.h"
#include "SymbolicParser.h"
#include "BasicUserFunction.h"
#include "EulerAngles.h"
#include "Constant.h"
#include "MBDynReferences.h"
#include "MBDynReference.h"
#include "ASMTPart.h"
#include "ASMTAssembly.h"
using namespace MbD;
void MbD::MBDynStructural::initialize()
MbD::MBDynStructural::MBDynStructural()
{
rOfO = std::make_shared<FullColumn<double>>(3);
aAOf = FullMatrix<double>::identitysptr(3);
vOfO = std::make_shared<FullColumn<double>>(3);
omeOfO = std::make_shared<FullColumn<double>>(3);
}
void MbD::MBDynStructural::parseMBDyn(std::string line)
@@ -20,27 +24,27 @@ void MbD::MBDynStructural::parseMBDyn(std::string line)
auto pos = line.find(":");
auto front = line.substr(previousPos, pos - previousPos);
assert(front.find("structural") != std::string::npos);
auto arguments = std::make_shared<std::vector<std::string>>();
auto arguments = std::vector<std::string>();
std::string argument;
while (true) {
previousPos = pos;
pos = line.find(",", pos + 1);
if (pos != std::string::npos) {
argument = line.substr(previousPos + 1, pos - previousPos - 1);
arguments->push_back(argument);
arguments.push_back(argument);
}
else {
argument = line.substr(previousPos + 1);
arguments->push_back(argument);
arguments.push_back(argument);
break;
}
}
std::istringstream iss(arguments->at(0));
std::istringstream iss(arguments.at(0));
iss >> name;
arguments->erase(arguments->begin());
iss = std::istringstream(arguments->at(0));
arguments.erase(arguments.begin());
iss = std::istringstream(arguments.at(0));
iss >> type;
arguments->erase(arguments->begin());
arguments.erase(arguments.begin());
rOfO = readPosition(arguments);
aAOf = readOrientation(arguments);
@@ -48,22 +52,20 @@ void MbD::MBDynStructural::parseMBDyn(std::string line)
readOmega(arguments);
}
void MbD::MBDynStructural::readVelocity(std::shared_ptr<std::vector<std::string>>& args)
void MbD::MBDynStructural::readVelocity(std::vector<std::string>& args)
{
auto parser = CREATE<SymbolicParser>::With();
parser->variables = mbdynVariables()->variables;
auto parser = std::make_shared<SymbolicParser>();
parser->variables = mbdynVariables();
vOfO = std::make_shared<FullColumn<double>>(3);
auto str = args->at(0);
auto& str = args.at(0);
if (str.find("null") != std::string::npos) {
args->erase(args->begin());
args.erase(args.begin());
return;
}
else {
for (int i = 0; i < 3; i++)
{
str = args->at(0);
args->erase(args->begin());
auto userFunc = CREATE<BasicUserFunction>::With(str, 1.0);
auto userFunc = std::make_shared<BasicUserFunction>(popOffTop(args), 1.0);
parser->parseUserFunction(userFunc);
auto sym = parser->stack->top();
vOfO->at(i) = sym->getValue();
@@ -71,25 +73,35 @@ void MbD::MBDynStructural::readVelocity(std::shared_ptr<std::vector<std::string>
}
}
void MbD::MBDynStructural::readOmega(std::shared_ptr<std::vector<std::string>>& args)
void MbD::MBDynStructural::readOmega(std::vector<std::string>& args)
{
auto parser = CREATE<SymbolicParser>::With();
parser->variables = mbdynVariables()->variables;
auto parser = std::make_shared<SymbolicParser>();
parser->variables = mbdynVariables();
omeOfO = std::make_shared<FullColumn<double>>(3);
auto str = args->at(0);
auto& str = args.at(0);
if (str.find("null") != std::string::npos) {
args->erase(args->begin());
args.erase(args.begin());
return;
}
else {
for (int i = 0; i < 3; i++)
{
str = args->at(0);
args->erase(args->begin());
auto userFunc = CREATE<BasicUserFunction>::With(str, 1.0);
auto userFunc = std::make_shared<BasicUserFunction>(popOffTop(args), 1.0);
parser->parseUserFunction(userFunc);
auto sym = parser->stack->top();
omeOfO->at(i) = sym->getValue();
}
}
}
void MbD::MBDynStructural::createASMT()
{
auto asmtPart = std::make_shared<ASMTPart>();
asmtItem = asmtPart;
asmtPart->setName(name);
asmtPart->setPosition3D(rOfO);
asmtPart->setRotationMatrix(aAOf);
asmtPart->setVelocity3D(vOfO);
asmtPart->setOmega3D(omeOfO);
asmtAssembly()->addPart(asmtPart);
}