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

39
OndselSolver/MBDynReference.cpp
View File

@@ -1,5 +1,4 @@
#include "MBDynReference.h"
#include "MBDynVariables.h"
#include "SymbolicParser.h"
#include "BasicUserFunction.h"
#include "EulerAngles.h"
@@ -17,24 +16,24 @@ void MbD::MBDynReference::parseMBDyn(std::string line)
auto pos = line.find(":");
auto front = line.substr(previousPos, pos - previousPos);
assert(front.find("reference") != 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());
arguments.erase(arguments.begin());
rOfO = readPosition(arguments);
aAOf = readOrientation(arguments);
@@ -42,22 +41,20 @@ void MbD::MBDynReference::parseMBDyn(std::string line)
readOmega(arguments);
}
void MbD::MBDynReference::readVelocity(std::shared_ptr<std::vector<std::string>>& args)
void MbD::MBDynReference::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();
@@ -65,22 +62,20 @@ void MbD::MBDynReference::readVelocity(std::shared_ptr<std::vector<std::string>>
}
}
void MbD::MBDynReference::readOmega(std::shared_ptr<std::vector<std::string>>& args)
void MbD::MBDynReference::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();