src/ODE/ODESolvers/SIBS/polyExtrapolate.C

   1 /*---------------------------------------------------------------------------*\
   2   =========                 |
   3   \\      /  F ield         | foam-extend: Open Source CFD
   4    \\    /   O peration     | Version:     3.2
   5     \\  /    A nd           | Web:         http://www.foam-extend.org
   6      \\/     M anipulation  | For copyright notice see file Copyright
   7 -------------------------------------------------------------------------------
   8 License
   9     This file is part of foam-extend.
  10
  11     foam-extend 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 3 of the License, or (at your
  14     option) any later version.
  15
  16     foam-extend is distributed in the hope that it will be useful, but
  17     WITHOUT ANY WARRANTY; without even the implied warranty of
  18     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  19     General Public License for more details.
  20
  21     You should have received a copy of the GNU General Public License
  22     along with foam-extend.  If not, see <http://www.gnu.org/licenses/>.
  23
  24 \*---------------------------------------------------------------------------*/
  25
  26 #include "SIBS.H"
  27
  28 // * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * //
  29
  30 void Foam::SIBS::polyExtrapolate
  31 (
  32     const label iest,
  33     const scalar xest,
  34     const scalarField& yest,
  35     scalarField& yz,
  36     scalarField& dy,
  37     scalarField& x,
  38     scalarRectangularMatrix& d
  39 ) const
  40 {
  41     label n = yz.size();
  42
  43     x[iest] = xest;
  44
  45     for (register label j=0; j<n; j++)
  46     {
  47         dy[j] = yz[j] = yest[j];
  48     }
  49
  50     if (iest == 0)
  51     {
  52         for (register label j=0; j<n; j++)
  53         {
  54             d[j][0] = yest[j];
  55         }
  56     }
  57     else
  58     {
  59         scalarField c(yest);
  60
  61         for (register label k1=0; k1<iest; k1++)
  62         {
  63             scalar delta = 1.0/(x[iest - k1 - 1] - xest);
  64             scalar f1 = xest*delta;
  65             scalar f2 = x[iest - k1 - 1]*delta;
  66
  67             for (register label j=0; j<n; j++)
  68             {
  69                 scalar q = d[j][k1];
  70                 d[j][k1] = dy[j];
  71                 delta = c[j] - q;
  72                 dy[j] = f1*delta;
  73                 c[j] = f2*delta;
  74                 yz[j] += dy[j];
  75             }
  76         }
  77
  78         for (register label j=0; j<n; j++)
  79         {
  80             d[j][iest] = dy[j];
  81         }
  82     }
  83 }
  84
  85
  86 // ************************************************************************* //