8a1e27d2c7
Based on the principles, algorithms, data structures and notation
presented in the book:
Featherstone, R. (2008).
Rigid body dynamics algorithms.
Springer.
This development is sponsored by Carnegie Wave Energy Ltd.
99 lines
2.5 KiB
C
99 lines
2.5 KiB
C
/*---------------------------------------------------------------------------*\
|
|
========= |
|
|
\\ / F ield | OpenFOAM: The Open Source CFD Toolbox
|
|
\\ / O peration |
|
|
\\ / A nd | Copyright (C) 2016 OpenFOAM Foundation
|
|
\\/ M anipulation |
|
|
-------------------------------------------------------------------------------
|
|
License
|
|
This file is part of OpenFOAM.
|
|
|
|
OpenFOAM is free software: you can redistribute it and/or modify it
|
|
under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
OpenFOAM is distributed in the hope that it will be useful, but WITHOUT
|
|
ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
|
for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with OpenFOAM. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
\*---------------------------------------------------------------------------*/
|
|
|
|
#include "Ry.H"
|
|
#include "rigidBodyModel.H"
|
|
#include "addToRunTimeSelectionTable.H"
|
|
|
|
// * * * * * * * * * * * * * * Static Data Members * * * * * * * * * * * * * //
|
|
|
|
namespace Foam
|
|
{
|
|
namespace RBD
|
|
{
|
|
namespace joints
|
|
{
|
|
defineTypeNameAndDebug(Ry, 0);
|
|
|
|
addToRunTimeSelectionTable
|
|
(
|
|
joint,
|
|
Ry,
|
|
dictionary
|
|
);
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
// * * * * * * * * * * * * * * * * Constructors * * * * * * * * * * * * * * //
|
|
|
|
Foam::RBD::joints::Ry::Ry(const rigidBodyModel& model)
|
|
:
|
|
joint(model, 1)
|
|
{
|
|
S_[0] = spatialVector(0, 1, 0, 0, 0, 0);
|
|
}
|
|
|
|
|
|
Foam::RBD::joints::Ry::Ry(const rigidBodyModel& model, const dictionary& dict)
|
|
:
|
|
joint(model, 1)
|
|
{
|
|
S_[0] = spatialVector(0, 1, 0, 0, 0, 0);
|
|
}
|
|
|
|
|
|
Foam::autoPtr<Foam::RBD::joint> Foam::RBD::joints::Ry::clone() const
|
|
{
|
|
return autoPtr<joint>(new Ry(*this));
|
|
}
|
|
|
|
|
|
// * * * * * * * * * * * * * * * * Destructor * * * * * * * * * * * * * * * //
|
|
|
|
Foam::RBD::joints::Ry::~Ry()
|
|
{}
|
|
|
|
|
|
// * * * * * * * * * * * * * * Member Functions * * * * * * * * * * * * * * //
|
|
|
|
void Foam::RBD::joints::Ry::jcalc
|
|
(
|
|
joint::XSvc& J,
|
|
const scalarField& q,
|
|
const scalarField& w,
|
|
const scalarField& qDot
|
|
) const
|
|
{
|
|
J.X = Xry(q[qIndex_]);
|
|
J.S1 = S_[0];
|
|
J.v = Zero;
|
|
J.v.wy() = qDot[qIndex_];
|
|
J.c = Zero;
|
|
}
|
|
|
|
|
|
// ************************************************************************* //
|