Files
solver/OndselSolver/GearJoint.cpp
aiksiongkoh de8759384c Mb dyn half sine and cosine (#42)
* (int) added

* size_t count

* add files

* MBDyn new joints, sine, cosine

* CompoundJoints debugged
2023-12-13 15:52:16 +01:00

49 lines
1.3 KiB
C++

/***************************************************************************
* Copyright (c) 2023 Ondsel, Inc. *
* *
* This file is part of OndselSolver. *
* *
* See LICENSE file for details about copyright. *
***************************************************************************/
#include "GearJoint.h"
#include "CREATE.h"
#include "GearConstraintIJ.h"
#include "System.h"
using namespace MbD;
MbD::GearJoint::GearJoint()
{
}
MbD::GearJoint::GearJoint(const char*)
{
}
//
//void MbD::GearJoint::initializeLocally()
//{
// if (!constraints->empty())
// {
// auto constraint = std::static_pointer_cast<GearConstraintIJ>(constraints->back());
// constraint->initorbitsIJ();
// }
// Joint::initializeLocally();
//}
void MbD::GearJoint::initializeGlobally()
{
if (constraints->empty())
{
auto gearIJ = GearConstraintIJ::With(frmI, frmJ);
gearIJ->radiusI = radiusI;
gearIJ->radiusJ = radiusJ;
gearIJ->setConstant(std::numeric_limits<double>::min());
addConstraint(gearIJ);
this->root()->hasChanged = true;
}
else {
Joint::initializeGlobally();
}
}