Blame specfunc/lambert.c

Packit 67cb25
/* specfunc/lambert.c
Packit 67cb25
 * 
Packit 67cb25
 * Copyright (C) 2007 Brian Gough
Packit 67cb25
 * Copyright (C) 1996, 1997, 1998, 1999, 2000, 2001 Gerard Jungman
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
/* Author:  G. Jungman */
Packit 67cb25
Packit 67cb25
#include <config.h>
Packit 67cb25
#include <math.h>
Packit 67cb25
#include <gsl/gsl_math.h>
Packit 67cb25
#include <gsl/gsl_errno.h>
Packit 67cb25
#include <gsl/gsl_sf_lambert.h>
Packit 67cb25
Packit 67cb25
/* Started with code donated by K. Briggs; added
Packit 67cb25
 * error estimates, GSL foo, and minor tweaks.
Packit 67cb25
 * Some Lambert-ology from
Packit 67cb25
 *  [Corless, Gonnet, Hare, and Jeffrey, "On Lambert's W Function".]
Packit 67cb25
 */
Packit 67cb25
Packit 67cb25
Packit 67cb25
/* Halley iteration (eqn. 5.12, Corless et al) */
Packit 67cb25
static int
Packit 67cb25
halley_iteration(
Packit 67cb25
  double x,
Packit 67cb25
  double w_initial,
Packit 67cb25
  unsigned int max_iters,
Packit 67cb25
  gsl_sf_result * result
Packit 67cb25
  )
Packit 67cb25
{
Packit 67cb25
  double w = w_initial;
Packit 67cb25
  unsigned int i;
Packit 67cb25
Packit 67cb25
  for(i=0; i
Packit 67cb25
    double tol;
Packit 67cb25
    const double e = exp(w);
Packit 67cb25
    const double p = w + 1.0;
Packit 67cb25
    double t = w*e - x;
Packit 67cb25
    /* printf("FOO: %20.16g  %20.16g\n", w, t); */
Packit 67cb25
Packit 67cb25
    if (w > 0) {
Packit 67cb25
      t = (t/p)/e;  /* Newton iteration */
Packit 67cb25
    } else {
Packit 67cb25
      t /= e*p - 0.5*(p + 1.0)*t/p;  /* Halley iteration */
Packit 67cb25
    };
Packit 67cb25
Packit 67cb25
    w -= t;
Packit 67cb25
Packit 67cb25
    tol = 10 * GSL_DBL_EPSILON * GSL_MAX_DBL(fabs(w), 1.0/(fabs(p)*e));
Packit 67cb25
Packit 67cb25
    if(fabs(t) < tol)
Packit 67cb25
    {
Packit 67cb25
      result->val = w;
Packit 67cb25
      result->err = 2.0*tol;
Packit 67cb25
      return GSL_SUCCESS;
Packit 67cb25
    }
Packit 67cb25
  }
Packit 67cb25
Packit 67cb25
  /* should never get here */
Packit 67cb25
  result->val = w;
Packit 67cb25
  result->err = fabs(w);
Packit 67cb25
  return GSL_EMAXITER;
Packit 67cb25
}
Packit 67cb25
Packit 67cb25
Packit 67cb25
/* series which appears for q near zero;
Packit 67cb25
 * only the argument is different for the different branches
Packit 67cb25
 */
Packit 67cb25
static double
Packit 67cb25
series_eval(double r)
Packit 67cb25
{
Packit 67cb25
  static const double c[12] = {
Packit 67cb25
    -1.0,
Packit 67cb25
     2.331643981597124203363536062168,
Packit 67cb25
    -1.812187885639363490240191647568,
Packit 67cb25
     1.936631114492359755363277457668,
Packit 67cb25
    -2.353551201881614516821543561516,
Packit 67cb25
     3.066858901050631912893148922704,
Packit 67cb25
    -4.175335600258177138854984177460,
Packit 67cb25
     5.858023729874774148815053846119,
Packit 67cb25
    -8.401032217523977370984161688514,
Packit 67cb25
     12.250753501314460424,
Packit 67cb25
    -18.100697012472442755,
Packit 67cb25
     27.029044799010561650
Packit 67cb25
  };
Packit 67cb25
  const double t_8 = c[8] + r*(c[9] + r*(c[10] + r*c[11]));
Packit 67cb25
  const double t_5 = c[5] + r*(c[6] + r*(c[7]  + r*t_8));
Packit 67cb25
  const double t_1 = c[1] + r*(c[2] + r*(c[3]  + r*(c[4] + r*t_5)));
Packit 67cb25
  return c[0] + r*t_1;
Packit 67cb25
}
Packit 67cb25
Packit 67cb25
Packit 67cb25
/*-*-*-*-*-*-*-*-*-*-*-* Functions with Error Codes *-*-*-*-*-*-*-*-*-*-*-*/
Packit 67cb25
Packit 67cb25
int
Packit 67cb25
gsl_sf_lambert_W0_e(double x, gsl_sf_result * result)
Packit 67cb25
{
Packit 67cb25
  const double one_over_E = 1.0/M_E;
Packit 67cb25
  const double q = x + one_over_E;
Packit 67cb25
Packit 67cb25
  if(x == 0.0) {
Packit 67cb25
    result->val = 0.0;
Packit 67cb25
    result->err = 0.0;
Packit 67cb25
    return GSL_SUCCESS;
Packit 67cb25
  }
Packit 67cb25
  else if(q < 0.0) {
Packit 67cb25
    /* Strictly speaking this is an error. But because of the
Packit 67cb25
     * arithmetic operation connecting x and q, I am a little
Packit 67cb25
     * lenient in case of some epsilon overshoot. The following
Packit 67cb25
     * answer is quite accurate in that case. Anyway, we have
Packit 67cb25
     * to return GSL_EDOM.
Packit 67cb25
     */
Packit 67cb25
    result->val = -1.0;
Packit 67cb25
    result->err =  sqrt(-q);
Packit 67cb25
    return GSL_EDOM;
Packit 67cb25
  }
Packit 67cb25
  else if(q == 0.0) {
Packit 67cb25
    result->val = -1.0;
Packit 67cb25
    result->err =  GSL_DBL_EPSILON; /* cannot error is zero, maybe q == 0 by "accident" */
Packit 67cb25
    return GSL_SUCCESS;
Packit 67cb25
  }
Packit 67cb25
  else if(q < 1.0e-03) {
Packit 67cb25
    /* series near -1/E in sqrt(q) */
Packit 67cb25
    const double r = sqrt(q);
Packit 67cb25
    result->val = series_eval(r);
Packit 67cb25
    result->err = 2.0 * GSL_DBL_EPSILON * fabs(result->val);
Packit 67cb25
    return GSL_SUCCESS;
Packit 67cb25
  }
Packit 67cb25
  else {
Packit 67cb25
    static const unsigned int MAX_ITERS = 10;
Packit 67cb25
    double w;
Packit 67cb25
Packit 67cb25
    if (x < 1.0) {
Packit 67cb25
      /* obtain initial approximation from series near x=0;
Packit 67cb25
       * no need for extra care, since the Halley iteration
Packit 67cb25
       * converges nicely on this branch
Packit 67cb25
       */
Packit 67cb25
      const double p = sqrt(2.0 * M_E * q);
Packit 67cb25
      w = -1.0 + p*(1.0 + p*(-1.0/3.0 + p*11.0/72.0)); 
Packit 67cb25
    }
Packit 67cb25
    else {
Packit 67cb25
      /* obtain initial approximation from rough asymptotic */
Packit 67cb25
      w = log(x);
Packit 67cb25
      if(x > 3.0) w -= log(w);
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
    return halley_iteration(x, w, MAX_ITERS, result);
Packit 67cb25
  }
Packit 67cb25
}
Packit 67cb25
Packit 67cb25
Packit 67cb25
int
Packit 67cb25
gsl_sf_lambert_Wm1_e(double x, gsl_sf_result * result)
Packit 67cb25
{
Packit 67cb25
  if(x > 0.0) {
Packit 67cb25
    return gsl_sf_lambert_W0_e(x, result);
Packit 67cb25
  }
Packit 67cb25
  else if(x == 0.0) {
Packit 67cb25
    result->val = 0.0;
Packit 67cb25
    result->err = 0.0;
Packit 67cb25
    return GSL_SUCCESS;
Packit 67cb25
  }
Packit 67cb25
  else {
Packit 67cb25
    static const unsigned int MAX_ITERS = 32;
Packit 67cb25
    const double one_over_E = 1.0/M_E;
Packit 67cb25
    const double q = x + one_over_E;
Packit 67cb25
    double w;
Packit 67cb25
Packit 67cb25
    if (q < 0.0) {
Packit 67cb25
      /* As in the W0 branch above, return some reasonable answer anyway. */
Packit 67cb25
      result->val = -1.0; 
Packit 67cb25
      result->err =  sqrt(-q);
Packit 67cb25
      return GSL_EDOM;
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
    if(x < -1.0e-6) {
Packit 67cb25
      /* Obtain initial approximation from series about q = 0,
Packit 67cb25
       * as long as we're not very close to x = 0.
Packit 67cb25
       * Use full series and try to bail out if q is too small,
Packit 67cb25
       * since the Halley iteration has bad convergence properties
Packit 67cb25
       * in finite arithmetic for q very small, because the
Packit 67cb25
       * increment alternates and p is near zero.
Packit 67cb25
       */
Packit 67cb25
      const double r = -sqrt(q);
Packit 67cb25
      w = series_eval(r);
Packit 67cb25
      if(q < 3.0e-3) {
Packit 67cb25
        /* this approximation is good enough */
Packit 67cb25
        result->val = w;
Packit 67cb25
        result->err = 5.0 * GSL_DBL_EPSILON * fabs(w);
Packit 67cb25
        return GSL_SUCCESS;
Packit 67cb25
      }
Packit 67cb25
    }
Packit 67cb25
    else {
Packit 67cb25
      /* Obtain initial approximation from asymptotic near zero. */
Packit 67cb25
      const double L_1 = log(-x);
Packit 67cb25
      const double L_2 = log(-L_1);
Packit 67cb25
      w = L_1 - L_2 + L_2/L_1;
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
    return halley_iteration(x, w, MAX_ITERS, result);
Packit 67cb25
  }
Packit 67cb25
}
Packit 67cb25
Packit 67cb25
Packit 67cb25
/*-*-*-*-*-*-*-*-*-* Functions w/ Natural Prototypes *-*-*-*-*-*-*-*-*-*-*/
Packit 67cb25
Packit 67cb25
#include "eval.h"
Packit 67cb25
Packit 67cb25
double gsl_sf_lambert_W0(double x)
Packit 67cb25
{
Packit 67cb25
  EVAL_RESULT(gsl_sf_lambert_W0_e(x, &result));
Packit 67cb25
}
Packit 67cb25
Packit 67cb25
double gsl_sf_lambert_Wm1(double x)
Packit 67cb25
{
Packit 67cb25
  EVAL_RESULT(gsl_sf_lambert_Wm1_e(x, &result));
Packit 67cb25
}