Added many Joints. Parse asmt file.

2023-07-16 22:00:07 -06:00
parent 718b17a2cf
commit 80bb812075
220 changed files with 5845 additions and 189 deletions
--- a/MbDCode/CylSphJoint.cpp
+++ b/MbDCode/CylSphJoint.cpp
@@ -0,0 +1,28 @@
+#include "CylSphJoint.h"
+#include "CREATE.h"
+#include "DistancexyConstraintIJ.h"
+#include "System.h"
+
+using namespace MbD;
+
+MbD::CylSphJoint::CylSphJoint()
+{
+}
+
+MbD::CylSphJoint::CylSphJoint(const char* str) : CompoundJoint(str)
+{
+}
+
+void MbD::CylSphJoint::initializeGlobally()
+{
+	if (constraints->empty())
+	{
+		auto distxyIJ = CREATE<DistancexyConstraintIJ>::With(frmI, frmJ);
+		distxyIJ->setConstant(distanceIJ);
+		addConstraint(distxyIJ);
+		this->root()->hasChanged = true;
+	}
+	else {
+		CompoundJoint::initializeGlobally();
+	}
+}