303 lines
		
	
	
		
			8.9 KiB
		
	
	
	
		
			Plaintext
		
	
	
	
	
	
			
		
		
	
	
			303 lines
		
	
	
		
			8.9 KiB
		
	
	
	
		
			Plaintext
		
	
	
	
	
	
//  Copyright (c) 2006 Xiaogang Zhang, 2015 John Maddock
 | 
						|
//  Use, modification and distribution are subject to the
 | 
						|
//  Boost Software License, Version 1.0. (See accompanying file
 | 
						|
//  LICENSE_1_0.txt or copy at http://www.boost.org/LICENSE_1_0.txt)
 | 
						|
//
 | 
						|
//  History:
 | 
						|
//  XZ wrote the original of this file as part of the Google
 | 
						|
//  Summer of Code 2006.  JM modified it to fit into the
 | 
						|
//  Boost.Math conceptual framework better, and to correctly
 | 
						|
//  handle the p < 0 case.
 | 
						|
//  Updated 2015 to use Carlson's latest methods.
 | 
						|
//
 | 
						|
 | 
						|
#ifndef BOOST_MATH_ELLINT_RJ_HPP
 | 
						|
#define BOOST_MATH_ELLINT_RJ_HPP
 | 
						|
 | 
						|
#ifdef _MSC_VER
 | 
						|
#pragma once
 | 
						|
#endif
 | 
						|
 | 
						|
#include <boost/math/special_functions/math_fwd.hpp>
 | 
						|
#include <boost/math/tools/config.hpp>
 | 
						|
#include <boost/math/policies/error_handling.hpp>
 | 
						|
#include <boost/math/special_functions/ellint_rc.hpp>
 | 
						|
#include <boost/math/special_functions/ellint_rf.hpp>
 | 
						|
#include <boost/math/special_functions/ellint_rd.hpp>
 | 
						|
 | 
						|
// Carlson's elliptic integral of the third kind
 | 
						|
// R_J(x, y, z, p) = 1.5 * \int_{0}^{\infty} (t+p)^{-1} [(t+x)(t+y)(t+z)]^{-1/2} dt
 | 
						|
// Carlson, Numerische Mathematik, vol 33, 1 (1979)
 | 
						|
 | 
						|
namespace boost { namespace math { namespace detail{
 | 
						|
 | 
						|
template <typename T, typename Policy>
 | 
						|
T ellint_rc1p_imp(T y, const Policy& pol)
 | 
						|
{
 | 
						|
   using namespace boost::math;
 | 
						|
   // Calculate RC(1, 1 + x)
 | 
						|
   BOOST_MATH_STD_USING
 | 
						|
 | 
						|
  static const char* function = "boost::math::ellint_rc<%1%>(%1%,%1%)";
 | 
						|
 | 
						|
   if(y == -1)
 | 
						|
   {
 | 
						|
      return policies::raise_domain_error<T>(function,
 | 
						|
         "Argument y must not be zero but got %1%", y, pol);
 | 
						|
   }
 | 
						|
 | 
						|
   // for 1 + y < 0, the integral is singular, return Cauchy principal value
 | 
						|
   T result;
 | 
						|
   if(y < -1)
 | 
						|
   {
 | 
						|
      result = sqrt(1 / -y) * detail::ellint_rc_imp(T(-y), T(-1 - y), pol);
 | 
						|
   }
 | 
						|
   else if(y == 0)
 | 
						|
   {
 | 
						|
      result = 1;
 | 
						|
   }
 | 
						|
   else if(y > 0)
 | 
						|
   {
 | 
						|
      result = atan(sqrt(y)) / sqrt(y);
 | 
						|
   }
 | 
						|
   else
 | 
						|
   {
 | 
						|
      if(y > -0.5)
 | 
						|
      {
 | 
						|
         T arg = sqrt(-y);
 | 
						|
         result = (boost::math::log1p(arg) - boost::math::log1p(-arg)) / (2 * sqrt(-y));
 | 
						|
      }
 | 
						|
      else
 | 
						|
      {
 | 
						|
         result = log((1 + sqrt(-y)) / sqrt(1 + y)) / sqrt(-y);
 | 
						|
      }
 | 
						|
   }
 | 
						|
   return result;
 | 
						|
}
 | 
						|
 | 
						|
template <typename T, typename Policy>
 | 
						|
T ellint_rj_imp(T x, T y, T z, T p, const Policy& pol)
 | 
						|
{
 | 
						|
   BOOST_MATH_STD_USING
 | 
						|
 | 
						|
   static const char* function = "boost::math::ellint_rj<%1%>(%1%,%1%,%1%)";
 | 
						|
 | 
						|
   if(x < 0)
 | 
						|
   {
 | 
						|
      return policies::raise_domain_error<T>(function,
 | 
						|
         "Argument x must be non-negative, but got x = %1%", x, pol);
 | 
						|
   }
 | 
						|
   if(y < 0)
 | 
						|
   {
 | 
						|
      return policies::raise_domain_error<T>(function,
 | 
						|
         "Argument y must be non-negative, but got y = %1%", y, pol);
 | 
						|
   }
 | 
						|
   if(z < 0)
 | 
						|
   {
 | 
						|
      return policies::raise_domain_error<T>(function,
 | 
						|
         "Argument z must be non-negative, but got z = %1%", z, pol);
 | 
						|
   }
 | 
						|
   if(p == 0)
 | 
						|
   {
 | 
						|
      return policies::raise_domain_error<T>(function,
 | 
						|
         "Argument p must not be zero, but got p = %1%", p, pol);
 | 
						|
   }
 | 
						|
   if(x + y == 0 || y + z == 0 || z + x == 0)
 | 
						|
   {
 | 
						|
      return policies::raise_domain_error<T>(function,
 | 
						|
         "At most one argument can be zero, "
 | 
						|
         "only possible result is %1%.", std::numeric_limits<T>::quiet_NaN(), pol);
 | 
						|
   }
 | 
						|
 | 
						|
   // for p < 0, the integral is singular, return Cauchy principal value
 | 
						|
   if(p < 0)
 | 
						|
   {
 | 
						|
      //
 | 
						|
      // We must ensure that x < y < z.
 | 
						|
      // Since the integral is symmetrical in x, y and z
 | 
						|
      // we can just permute the values:
 | 
						|
      //
 | 
						|
      if(x > y)
 | 
						|
         std::swap(x, y);
 | 
						|
      if(y > z)
 | 
						|
         std::swap(y, z);
 | 
						|
      if(x > y)
 | 
						|
         std::swap(x, y);
 | 
						|
 | 
						|
      BOOST_ASSERT(x <= y);
 | 
						|
      BOOST_ASSERT(y <= z);
 | 
						|
 | 
						|
      T q = -p;
 | 
						|
      p = (z * (x + y + q) - x * y) / (z + q);
 | 
						|
 | 
						|
      BOOST_ASSERT(p >= 0);
 | 
						|
 | 
						|
      T value = (p - z) * ellint_rj_imp(x, y, z, p, pol);
 | 
						|
      value -= 3 * ellint_rf_imp(x, y, z, pol);
 | 
						|
      value += 3 * sqrt((x * y * z) / (x * y + p * q)) * ellint_rc_imp(T(x * y + p * q), T(p * q), pol);
 | 
						|
      value /= (z + q);
 | 
						|
      return value;
 | 
						|
   }
 | 
						|
 | 
						|
   //
 | 
						|
   // Special cases from http://dlmf.nist.gov/19.20#iii
 | 
						|
   //
 | 
						|
   if(x == y)
 | 
						|
   {
 | 
						|
      if(x == z)
 | 
						|
      {
 | 
						|
         if(x == p)
 | 
						|
         {
 | 
						|
            // All values equal:
 | 
						|
            return 1 / (x * sqrt(x));
 | 
						|
         }
 | 
						|
         else
 | 
						|
         {
 | 
						|
            // x = y = z:
 | 
						|
            return 3 * (ellint_rc_imp(x, p, pol) - 1 / sqrt(x)) / (x - p);
 | 
						|
         }
 | 
						|
      }
 | 
						|
      else
 | 
						|
      {
 | 
						|
         // x = y only, permute so y = z:
 | 
						|
         using std::swap;
 | 
						|
         swap(x, z);
 | 
						|
         if(y == p)
 | 
						|
         {
 | 
						|
            return ellint_rd_imp(x, y, y, pol);
 | 
						|
         }
 | 
						|
         else if((std::max)(y, p) / (std::min)(y, p) > 1.2)
 | 
						|
         {
 | 
						|
            return 3 * (ellint_rc_imp(x, y, pol) - ellint_rc_imp(x, p, pol)) / (p - y);
 | 
						|
         }
 | 
						|
         // Otherwise fall through to normal method, special case above will suffer too much cancellation...
 | 
						|
      }
 | 
						|
   }
 | 
						|
   if(y == z)
 | 
						|
   {
 | 
						|
      if(y == p)
 | 
						|
      {
 | 
						|
         // y = z = p:
 | 
						|
         return ellint_rd_imp(x, y, y, pol);
 | 
						|
      }
 | 
						|
      else if((std::max)(y, p) / (std::min)(y, p) > 1.2)
 | 
						|
      {
 | 
						|
         // y = z:
 | 
						|
         return 3 * (ellint_rc_imp(x, y, pol) - ellint_rc_imp(x, p, pol)) / (p - y);
 | 
						|
      }
 | 
						|
      // Otherwise fall through to normal method, special case above will suffer too much cancellation...
 | 
						|
   }
 | 
						|
   if(z == p)
 | 
						|
   {
 | 
						|
      return ellint_rd_imp(x, y, z, pol);
 | 
						|
   }
 | 
						|
 | 
						|
   T xn = x;
 | 
						|
   T yn = y;
 | 
						|
   T zn = z;
 | 
						|
   T pn = p;
 | 
						|
   T An = (x + y + z + 2 * p) / 5;
 | 
						|
   T A0 = An;
 | 
						|
   T delta = (p - x) * (p - y) * (p - z);
 | 
						|
   T Q = pow(tools::epsilon<T>() / 5, -T(1) / 8) * (std::max)((std::max)(fabs(An - x), fabs(An - y)), (std::max)(fabs(An - z), fabs(An - p)));
 | 
						|
 | 
						|
   unsigned n;
 | 
						|
   T lambda;
 | 
						|
   T Dn;
 | 
						|
   T En;
 | 
						|
   T rx, ry, rz, rp;
 | 
						|
   T fmn = 1; // 4^-n
 | 
						|
   T RC_sum = 0;
 | 
						|
 | 
						|
   for(n = 0; n < policies::get_max_series_iterations<Policy>(); ++n)
 | 
						|
   {
 | 
						|
      rx = sqrt(xn);
 | 
						|
      ry = sqrt(yn);
 | 
						|
      rz = sqrt(zn);
 | 
						|
      rp = sqrt(pn);
 | 
						|
      Dn = (rp + rx) * (rp + ry) * (rp + rz);
 | 
						|
      En = delta / Dn;
 | 
						|
      En /= Dn;
 | 
						|
      if((En < -0.5) && (En > -1.5))
 | 
						|
      {
 | 
						|
         //
 | 
						|
         // Occationally En ~ -1, we then have no means of calculating
 | 
						|
         // RC(1, 1+En) without terrible cancellation error, so we
 | 
						|
         // need to get to 1+En directly.  By substitution we have
 | 
						|
         //
 | 
						|
         // 1+E_0 = 1 + (p-x)*(p-y)*(p-z)/((sqrt(p) + sqrt(x))*(sqrt(p)+sqrt(y))*(sqrt(p)+sqrt(z)))^2
 | 
						|
         //       = 2*sqrt(p)*(p+sqrt(x) * (sqrt(y)+sqrt(z)) + sqrt(y)*sqrt(z)) / ((sqrt(p) + sqrt(x))*(sqrt(p) + sqrt(y)*(sqrt(p)+sqrt(z))))
 | 
						|
         //
 | 
						|
         // And since this is just an application of the duplication formula for RJ, the same
 | 
						|
         // expression works for 1+En if we use x,y,z,p_n etc.
 | 
						|
         // This branch is taken only once or twice at the start of iteration,
 | 
						|
         // after than En reverts to it's usual very small values.
 | 
						|
         //
 | 
						|
         T b = 2 * rp * (pn + rx * (ry + rz) + ry * rz) / Dn;
 | 
						|
         RC_sum += fmn / Dn * detail::ellint_rc_imp(T(1), b, pol);
 | 
						|
      }
 | 
						|
      else
 | 
						|
      {
 | 
						|
         RC_sum += fmn / Dn * ellint_rc1p_imp(En, pol);
 | 
						|
      }
 | 
						|
      lambda = rx * ry + rx * rz + ry * rz;
 | 
						|
 | 
						|
      // From here on we move to n+1:
 | 
						|
      An = (An + lambda) / 4;
 | 
						|
      fmn /= 4;
 | 
						|
 | 
						|
      if(fmn * Q < An)
 | 
						|
         break;
 | 
						|
 | 
						|
      xn = (xn + lambda) / 4;
 | 
						|
      yn = (yn + lambda) / 4;
 | 
						|
      zn = (zn + lambda) / 4;
 | 
						|
      pn = (pn + lambda) / 4;
 | 
						|
      delta /= 64;
 | 
						|
   }
 | 
						|
 | 
						|
   T X = fmn * (A0 - x) / An;
 | 
						|
   T Y = fmn * (A0 - y) / An;
 | 
						|
   T Z = fmn * (A0 - z) / An;
 | 
						|
   T P = (-X - Y - Z) / 2;
 | 
						|
   T E2 = X * Y + X * Z + Y * Z - 3 * P * P;
 | 
						|
   T E3 = X * Y * Z + 2 * E2 * P + 4 * P * P * P;
 | 
						|
   T E4 = (2 * X * Y * Z + E2 * P + 3 * P * P * P) * P;
 | 
						|
   T E5 = X * Y * Z * P * P;
 | 
						|
   T result = fmn * pow(An, T(-3) / 2) *
 | 
						|
      (1 - 3 * E2 / 14 + E3 / 6 + 9 * E2 * E2 / 88 - 3 * E4 / 22 - 9 * E2 * E3 / 52 + 3 * E5 / 26 - E2 * E2 * E2 / 16
 | 
						|
      + 3 * E3 * E3 / 40 + 3 * E2 * E4 / 20 + 45 * E2 * E2 * E3 / 272 - 9 * (E3 * E4 + E2 * E5) / 68);
 | 
						|
 | 
						|
   result += 6 * RC_sum;
 | 
						|
   return result;
 | 
						|
}
 | 
						|
 | 
						|
} // namespace detail
 | 
						|
 | 
						|
template <class T1, class T2, class T3, class T4, class Policy>
 | 
						|
inline typename tools::promote_args<T1, T2, T3, T4>::type 
 | 
						|
   ellint_rj(T1 x, T2 y, T3 z, T4 p, const Policy& pol)
 | 
						|
{
 | 
						|
   typedef typename tools::promote_args<T1, T2, T3, T4>::type result_type;
 | 
						|
   typedef typename policies::evaluation<result_type, Policy>::type value_type;
 | 
						|
   return policies::checked_narrowing_cast<result_type, Policy>(
 | 
						|
      detail::ellint_rj_imp(
 | 
						|
         static_cast<value_type>(x),
 | 
						|
         static_cast<value_type>(y),
 | 
						|
         static_cast<value_type>(z),
 | 
						|
         static_cast<value_type>(p),
 | 
						|
         pol), "boost::math::ellint_rj<%1%>(%1%,%1%,%1%,%1%)");
 | 
						|
}
 | 
						|
 | 
						|
template <class T1, class T2, class T3, class T4>
 | 
						|
inline typename tools::promote_args<T1, T2, T3, T4>::type 
 | 
						|
   ellint_rj(T1 x, T2 y, T3 z, T4 p)
 | 
						|
{
 | 
						|
   return ellint_rj(x, y, z, p, policies::policy<>());
 | 
						|
}
 | 
						|
 | 
						|
}} // namespaces
 | 
						|
 | 
						|
#endif // BOOST_MATH_ELLINT_RJ_HPP
 | 
						|
 |