src/ODE/ODESolvers/SIBS/polyExtrapolate.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 "SIBS.H"
  28
  29 // * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * //
  30
  31 void Foam::SIBS::polyExtrapolate
  32 (
  33     const label iest,
  34     const scalar xest,
  35     const scalarField& yest,
  36     scalarField& yz,
  37     scalarField& dy,
  38     scalarField& x,
  39     scalarRectangularMatrix& d
  40 ) const
  41 {
  42     label n = yz.size();
  43
  44     x[iest] = xest;
  45
  46     for (register label j=0; j<n; j++)
  47     {
  48         dy[j] = yz[j] = yest[j];
  49     }
  50
  51     if (iest == 0)
  52     {
  53         for (register label j=0; j<n; j++)
  54         {
  55             d[j][0] = yest[j];
  56         }
  57     }
  58     else
  59     {
  60         scalarField c(yest);
  61
  62         for (register label k1=0; k1<iest; k1++)
  63         {
  64             scalar delta = 1.0/(x[iest - k1 - 1] - xest);
  65             scalar f1 = xest*delta;
  66             scalar f2 = x[iest - k1 - 1]*delta;
  67
  68             for (register label j=0; j<n; j++)
  69             {
  70                 scalar q = d[j][k1];
  71                 d[j][k1] = dy[j];
  72                 delta = c[j] - q;
  73                 dy[j] = f1*delta;
  74                 c[j] = f2*delta;
  75                 yz[j] += dy[j];
  76             }
  77         }
  78
  79         for (register label j=0; j<n; j++)
  80         {
  81             d[j][iest] = dy[j];
  82         }
  83     }
  84 }
  85
  86
  87 // ************************************************************************* //