Added many Joints. Parse asmt file.

MbDCode/ASMTRefPoint.cpp

@@ -0,0 +1,58 @@
+#include "ASMTRefPoint.h"
+#include "CREATE.h"
+
+using namespace MbD;
+
+void MbD::ASMTRefPoint::parseASMT(std::vector<std::string>& lines)
+{
+	size_t pos = lines[0].find_first_not_of("\t");
+	auto leadingTabs = lines[0].substr(0, pos);
+	while (!lines.empty()) {
+		if (lines[0] == (leadingTabs + "Position3D")) {
+			lines.erase(lines.begin());
+			std::istringstream iss(lines[0]);
+			position3D = std::make_shared<FullColumn<double>>();
+			double d;
+			while (iss >> d) {
+				position3D->push_back(d);
+			}
+			lines.erase(lines.begin());
+		}
+		else if (lines[0] == (leadingTabs + "RotationMatrix")) {
+			lines.erase(lines.begin());
+			rotationMatrix = std::make_shared<FullMatrix<double>>(3, 0);
+			for (int i = 0; i < 3; i++)
+			{
+				auto& row = rotationMatrix->at(i);
+				std::istringstream iss(lines[0]);
+				double d;
+				while (iss >> d) {
+					row->push_back(d);
+				}
+				lines.erase(lines.begin());
+			}
+		}
+		else if (lines[0] == (leadingTabs + "Markers")) {
+			lines.erase(lines.begin());
+			markers = std::make_shared<std::vector<std::shared_ptr<ASMTMarker>>>();
+			auto it = std::find(lines.begin(), lines.end(), (leadingTabs.substr(0, leadingTabs.size() - 1) + "RefPoint"));
+			std::vector<std::string> markersLines(lines.begin(), it);
+			while (!markersLines.empty()) {
+				if (markersLines[0] == (leadingTabs + "\tMarker")) {
+					markersLines.erase(markersLines.begin());
+					auto marker = CREATE<ASMTMarker>::With();
+					marker->parseASMT(markersLines);
+					markers->push_back(marker);
+					marker->owner = this;
+				}
+				else {
+					return;
+				}
+			}
+			lines.erase(lines.begin(), it);
+		}
+		else {
+			return;
+		}
+	}
+}