Added many Joints. Parse asmt file.

This commit is contained in:
Aik-Siong Koh
2023-07-16 22:00:07 -06:00
parent 718b17a2cf
commit 80bb812075
220 changed files with 5845 additions and 189 deletions

34
MbDCode/FullMotion.cpp Normal file
View File

@@ -0,0 +1,34 @@
#include "FullMotion.h"
#include "CREATE.h"
#include "System.h"
using namespace MbD;
MbD::FullMotion::FullMotion()
{
}
MbD::FullMotion::FullMotion(const char* str)
{
}
void MbD::FullMotion::initializeGlobally()
{
if (constraints->empty()) {
initMotions();
addConstraint(CREATE<TranslationConstraintIJ>::ConstraintWith(frmI, frmJ, 0));
addConstraint(CREATE<TranslationConstraintIJ>::ConstraintWith(frmI, frmJ, 1));
addConstraint(CREATE<TranslationConstraintIJ>::ConstraintWith(frmI, frmJ, 2));
addConstraint(CREATE<DirectionCosineConstraintIJ>::ConstraintWith(frmI, frmJ, 1, 0));
addConstraint(CREATE<DirectionCosineConstraintIJ>::ConstraintWith(frmI, frmJ, 2, 0));
addConstraint(CREATE<DirectionCosineConstraintIJ>::ConstraintWith(frmI, frmJ, 2, 1));
this->root()->hasChanged = true;
}
else {
PrescribedMotion::initializeGlobally();
}
}
void MbD::FullMotion::initMotions()
{
}