Blame integration/qk.c

Packit 67cb25
/* integration/qk.c
Packit 67cb25
 * 
Packit 67cb25
 * Copyright (C) 1996, 1997, 1998, 1999, 2000, 2007 Brian Gough
Packit 67cb25
 * 
Packit 67cb25
 * This program is free software; you can redistribute it and/or modify
Packit 67cb25
 * it under the terms of the GNU General Public License as published by
Packit 67cb25
 * the Free Software Foundation; either version 3 of the License, or (at
Packit 67cb25
 * your option) any later version.
Packit 67cb25
 * 
Packit 67cb25
 * This program is distributed in the hope that it will be useful, but
Packit 67cb25
 * WITHOUT ANY WARRANTY; without even the implied warranty of
Packit 67cb25
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
Packit 67cb25
 * General Public License for more details.
Packit 67cb25
 * 
Packit 67cb25
 * You should have received a copy of the GNU General Public License
Packit 67cb25
 * along with this program; if not, write to the Free Software
Packit 67cb25
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
Packit 67cb25
 */
Packit 67cb25
Packit 67cb25
#include <config.h>
Packit 67cb25
#include <float.h>
Packit 67cb25
#include <math.h>
Packit 67cb25
#include <gsl/gsl_integration.h>
Packit 67cb25
#include "err.c"
Packit 67cb25
Packit 67cb25
void
Packit 67cb25
gsl_integration_qk (const int n, 
Packit 67cb25
                    const double xgk[], const double wg[], const double wgk[],
Packit 67cb25
                    double fv1[], double fv2[],
Packit 67cb25
                    const gsl_function * f, double a, double b,
Packit 67cb25
                    double *result, double *abserr,
Packit 67cb25
                    double *resabs, double *resasc)
Packit 67cb25
{
Packit 67cb25
Packit 67cb25
  const double center = 0.5 * (a + b);
Packit 67cb25
  const double half_length = 0.5 * (b - a);
Packit 67cb25
  const double abs_half_length = fabs (half_length);
Packit 67cb25
  const double f_center = GSL_FN_EVAL (f, center);
Packit 67cb25
Packit 67cb25
  double result_gauss = 0;
Packit 67cb25
  double result_kronrod = f_center * wgk[n - 1];
Packit 67cb25
Packit 67cb25
  double result_abs = fabs (result_kronrod);
Packit 67cb25
  double result_asc = 0;
Packit 67cb25
  double mean = 0, err = 0;
Packit 67cb25
Packit 67cb25
  int j;
Packit 67cb25
Packit 67cb25
  if (n % 2 == 0)
Packit 67cb25
    {
Packit 67cb25
      result_gauss = f_center * wg[n / 2 - 1];
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  for (j = 0; j < (n - 1) / 2; j++)
Packit 67cb25
    {
Packit 67cb25
      const int jtw = j * 2 + 1;  /* in original fortran j=1,2,3 jtw=2,4,6 */
Packit 67cb25
      const double abscissa = half_length * xgk[jtw];
Packit 67cb25
      const double fval1 = GSL_FN_EVAL (f, center - abscissa);
Packit 67cb25
      const double fval2 = GSL_FN_EVAL (f, center + abscissa);
Packit 67cb25
      const double fsum = fval1 + fval2;
Packit 67cb25
      fv1[jtw] = fval1;
Packit 67cb25
      fv2[jtw] = fval2;
Packit 67cb25
      result_gauss += wg[j] * fsum;
Packit 67cb25
      result_kronrod += wgk[jtw] * fsum;
Packit 67cb25
      result_abs += wgk[jtw] * (fabs (fval1) + fabs (fval2));
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  for (j = 0; j < n / 2; j++)
Packit 67cb25
    {
Packit 67cb25
      int jtwm1 = j * 2;
Packit 67cb25
      const double abscissa = half_length * xgk[jtwm1];
Packit 67cb25
      const double fval1 = GSL_FN_EVAL (f, center - abscissa);
Packit 67cb25
      const double fval2 = GSL_FN_EVAL (f, center + abscissa);
Packit 67cb25
      fv1[jtwm1] = fval1;
Packit 67cb25
      fv2[jtwm1] = fval2;
Packit 67cb25
      result_kronrod += wgk[jtwm1] * (fval1 + fval2);
Packit 67cb25
      result_abs += wgk[jtwm1] * (fabs (fval1) + fabs (fval2));
Packit 67cb25
    };
Packit 67cb25
Packit 67cb25
  mean = result_kronrod * 0.5;
Packit 67cb25
Packit 67cb25
  result_asc = wgk[n - 1] * fabs (f_center - mean);
Packit 67cb25
Packit 67cb25
  for (j = 0; j < n - 1; j++)
Packit 67cb25
    {
Packit 67cb25
      result_asc += wgk[j] * (fabs (fv1[j] - mean) + fabs (fv2[j] - mean));
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  /* scale by the width of the integration region */
Packit 67cb25
Packit 67cb25
  err = (result_kronrod - result_gauss) * half_length;
Packit 67cb25
Packit 67cb25
  result_kronrod *= half_length;
Packit 67cb25
  result_abs *= abs_half_length;
Packit 67cb25
  result_asc *= abs_half_length;
Packit 67cb25
Packit 67cb25
  *result = result_kronrod;
Packit 67cb25
  *resabs = result_abs;
Packit 67cb25
  *resasc = result_asc;
Packit 67cb25
  *abserr = rescale_error (err, result_abs, result_asc);
Packit 67cb25
Packit 67cb25
}