src/dynamicMesh/meshMotion/solidBodyMotion/SKA/SKA.C

   1 /*---------------------------------------------------------------------------*\
   2   =========                 |
   3   \\      /  F ield         | OpenFOAM: The Open Source CFD Toolbox
   4    \\    /   O peration     |
   5     \\  /    A nd           | Copyright held by original author
   6      \\/     M anipulation  |
   7 -------------------------------------------------------------------------------
   8 License
   9     This file is part of OpenFOAM.
  10
  11     OpenFOAM is free software; you can redistribute it and/or modify it
  12     under the terms of the GNU General Public License as published by the
  13     Free Software Foundation; either version 2 of the License, or (at your
  14     option) any later version.
  15
  16     OpenFOAM is distributed in the hope that it will be useful, but WITHOUT
  17     ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  18     FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  19     for more details.
  20
  21     You should have received a copy of the GNU General Public License
  22     along with OpenFOAM; if not, write to the Free Software Foundation,
  23     Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
  24
  25 \*---------------------------------------------------------------------------*/
  26
  27 #include "SKA.H"
  28 #include "addToRunTimeSelectionTable.H"
  29 #include "Tuple2.H"
  30 #include "IFstream.H"
  31 #include "interpolateXY.H"
  32 #include "mathematicalConstants.H"
  33
  34 using namespace Foam::mathematicalConstant;
  35
  36 // * * * * * * * * * * * * * * Static Data Members * * * * * * * * * * * * * //
  37
  38 namespace Foam
  39 {
  40 namespace solidBodyMotionFunctions
  41 {
  42     defineTypeNameAndDebug(SKA, 0);
  43     addToRunTimeSelectionTable(solidBodyMotionFunction, SKA, dictionary);
  44 };
  45 };
  46
  47
  48 // * * * * * * * * * * * * * Private Member Functions  * * * * * * * * * * * //
  49
  50 Foam::septernion
  51 Foam::solidBodyMotionFunctions::SKA::calcTransformation(const scalar t) const
  52 {
  53     if (t < times_[0])
  54     {
  55         FatalErrorIn
  56         (
  57             "solidBodyMotionFunctions::SKA::transformation()"
  58         )   << "current time (" << t
  59             << ") is less than the minimum in the data table ("
  60             << times_[0] << ')'
  61             << exit(FatalError);
  62     }
  63
  64     if (t > times_[times_.size()-1])
  65     {
  66         FatalErrorIn
  67         (
  68             "solidBodyMotionFunctions::SKA::transformation()"
  69         )   << "current time (" << t
  70             << ") is greater than the maximum in the data table ("
  71             << times_[times_.size()-1] << ')'
  72             << exit(FatalError);
  73     }
  74
  75     translationRotationVectors TRV = interpolateXY
  76     (
  77         t,
  78         times_,
  79         values_
  80     );
  81
  82     // Convert the rotational motion from deg to rad
  83     TRV[1] *= pi/180.0;
  84
  85     quaternion R(TRV[1].x(), TRV[1].y(), TRV[1].z());
  86     septernion TR(septernion(CofG_ + TRV[0])*R*septernion(-CofG_));
  87
  88     return TR;
  89 }
  90
  91
  92 // * * * * * * * * * * * * * * * * Constructors  * * * * * * * * * * * * * * //
  93
  94 Foam::solidBodyMotionFunctions::SKA::SKA
  95 (
  96     const dictionary& SBMFCoeffs,
  97     const Time& runTime
  98 )
  99 :
 100     solidBodyMotionFunction(SBMFCoeffs, runTime)
 101 {
 102     read(SBMFCoeffs);
 103 }
 104
 105
 106 // * * * * * * * * * * * * * * * * Destructors * * * * * * * * * * * * * * * //
 107
 108 Foam::solidBodyMotionFunctions::SKA::~SKA()
 109 {}
 110
 111
 112 // * * * * * * * * * * * * * * Member Functions  * * * * * * * * * * * * * * //
 113
 114 Foam::septernion Foam::solidBodyMotionFunctions::SKA::transformation() const
 115 {
 116     scalar t = time_.value();
 117
 118     septernion TR = calcTransformation(t);
 119
 120     Info<< "solidBodyMotionFunctions::SKA::transformation(): "
 121         << "Time = " << t << " transformation: " << TR << endl;
 122
 123     return TR;
 124 }
 125
 126
 127 Foam::septernion Foam::solidBodyMotionFunctions::SKA::velocity() const
 128 {
 129     // Velocity is calculated as a difference
 130     scalar t = time_.value();
 131     scalar dt = time_.deltaT().value();
 132
 133     return (calcTransformation(t + dt) - calcTransformation(t))/dt;
 134 }
 135
 136
 137 bool Foam::solidBodyMotionFunctions::SKA::read(const dictionary& SBMFCoeffs)
 138 {
 139     solidBodyMotionFunction::read(SBMFCoeffs);
 140
 141     // If the timeDataFileName has changed read the file
 142
 143     fileName newTimeDataFileName(SBMFCoeffs_.lookup("timeDataFileName"));
 144
 145     if (newTimeDataFileName != timeDataFileName_)
 146     {
 147         timeDataFileName_ = newTimeDataFileName;
 148
 149         IFstream dataStream(timeDataFileName_);
 150
 151         if (dataStream.good())
 152         {
 153             List<Tuple2<scalar, translationRotationVectors> > timeValues
 154             (
 155                 dataStream
 156             );
 157
 158             times_.setSize(timeValues.size());
 159             values_.setSize(timeValues.size());
 160
 161             forAll(timeValues, i)
 162             {
 163                 times_[i] = timeValues[i].first();
 164                 values_[i] = timeValues[i].second();
 165             }
 166         }
 167         else
 168         {
 169             FatalErrorIn
 170             (
 171                 "solidBodyMotionFunctions::SKA::read(const dictionary&)"
 172             )   << "Cannot open time data file " << timeDataFileName_
 173                 << exit(FatalError);
 174         }
 175     }
 176
 177     SBMFCoeffs_.lookup("CofG") >> CofG_;
 178
 179     return true;
 180 }
 181
 182
 183 // ************************************************************************* //