/***************************************************************************
 *   Copyright (c) 2023 Ondsel, Inc.                                       *
 *                                                                         *
 *   This file is part of OndselSolver.                                    *
 *                                                                         *
 *   See LICENSE file for details about copyright.                         *
 ***************************************************************************/
#include <fstream>	

#include "ASMTJoint.h"
#include "Joint.h"

using namespace MbD;

std::shared_ptr<ASMTJoint> MbD::ASMTJoint::With()
{
	auto asmt = std::make_shared<ASMTJoint>();
	asmt->initialize();
	return asmt;
}

void MbD::ASMTJoint::readJointSeries(std::vector<std::string>& lines)
{
	std::string str = lines[0];
	std::string substr = "JointSeries";
	auto pos = str.find(substr);
	assert(pos != std::string::npos);
	str.erase(0, pos + substr.length());
	auto seriesName = readString(str);
	assert(fullName("") == seriesName);
	lines.erase(lines.begin());
	readFXonIs(lines);
	readFYonIs(lines);
	readFZonIs(lines);
	readTXonIs(lines);
	readTYonIs(lines);
	readTZonIs(lines);
}

void MbD::ASMTJoint::storeOnLevel(std::ofstream& os, size_t level)
{
	auto jointType = classname();
	jointType = jointType.substr(4, jointType.size() - 4);	//Remove ASMT in name
	storeOnLevelString(os, level, jointType);
	ASMTItemIJ::storeOnLevel(os, level);
}

void MbD::ASMTJoint::storeOnTimeSeries(std::ofstream& os)
{
	std::string label = typeid(*this).name();
	label = label.substr(15, label.size() - 15);
	os << label << "Series\t" << fullName("") << std::endl;
	ASMTItemIJ::storeOnTimeSeries(os);
}

void MbD::ASMTJoint::createMbD(std::shared_ptr<System> mbdSys, std::shared_ptr<Units> mbdUnits)
{
	ASMTConstraintSet::createMbD(mbdSys, mbdUnits);
	auto mbdJt = std::static_pointer_cast<Joint>(mbdObject);
	mbdSys->addJoint(mbdJt);
}