MBDyn new joints, sine, cosine

2023-12-08 21:39:53 -07:00
parent 98d6d46ebd
commit 56bba4e921
58 changed files with 5895 additions and 1905 deletions
--- a/OndselSolver/MBDynDriveHingeJoint.cpp
+++ b/OndselSolver/MBDynDriveHingeJoint.cpp
@@ -0,0 +1,41 @@
+/***************************************************************************
+ *   Copyright (c) 2023 Ondsel, Inc.                                       *
+ *                                                                         *
+ *   This file is part of OndselSolver.                                    *
+ *                                                                         *
+ *   See LICENSE file for details about copyright.                         *
+ ***************************************************************************/
+
+#include "MBDynDriveHingeJoint.h"
+#include "ASMTMarker.h"
+#include "ASMTJoint.h"
+#include "ASMTRotationalMotion.h"
+#include "ASMTAssembly.h"
+
+using namespace MbD;
+
+void MbD::MBDynDriveHingeJoint::parseMBDyn(std::string line)
+{
+	MBDynJoint::parseMBDyn(line);
+	readFunction(arguments);
+}
+
+void MbD::MBDynDriveHingeJoint::createASMT()
+{
+	mkr1->createASMT();
+	if (mkr2) mkr2->createASMT();
+	auto asmtAsm = asmtAssembly();
+	auto asmtMotion = std::make_shared<ASMTRotationalMotion>();
+	asmtItem = asmtMotion;
+	asmtMotion->setName(name);
+	asmtMotion->setMarkerI(mkr1->asmtItem->fullName(""));
+	asmtMotion->setMarkerJ(mkr2->asmtItem->fullName(""));
+	asmtMotion->setRotationZ(formula);
+	asmtAsm->addMotion(asmtMotion);
+	return;
+}
+
+std::shared_ptr<ASMTJoint> MbD::MBDynDriveHingeJoint::asmtClassNew()
+{
+	return std::make_shared<ASMTJoint>();
+}