202 lines
		
	
	
		
			6.6 KiB
		
	
	
	
		
			Plaintext
		
	
	
	
	
	
		
		
			
		
	
	
			202 lines
		
	
	
		
			6.6 KiB
		
	
	
	
		
			Plaintext
		
	
	
	
	
	
| 
								 | 
							
								//  Copyright (c) 2006 Xiaogang Zhang
							 | 
						||
| 
								 | 
							
								//  Copyright (c) 2006 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 ensure
							 | 
						||
| 
								 | 
							
								//  that the code continues to work no matter how many digits
							 | 
						||
| 
								 | 
							
								//  type T has.
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#ifndef BOOST_MATH_ELLINT_1_HPP
							 | 
						||
| 
								 | 
							
								#define BOOST_MATH_ELLINT_1_HPP
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#ifdef _MSC_VER
							 | 
						||
| 
								 | 
							
								#pragma once
							 | 
						||
| 
								 | 
							
								#endif
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#include <boost/math/special_functions/math_fwd.hpp>
							 | 
						||
| 
								 | 
							
								#include <boost/math/special_functions/ellint_rf.hpp>
							 | 
						||
| 
								 | 
							
								#include <boost/math/constants/constants.hpp>
							 | 
						||
| 
								 | 
							
								#include <boost/math/policies/error_handling.hpp>
							 | 
						||
| 
								 | 
							
								#include <boost/math/tools/workaround.hpp>
							 | 
						||
| 
								 | 
							
								#include <boost/math/special_functions/round.hpp>
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								// Elliptic integrals (complete and incomplete) of the first kind
							 | 
						||
| 
								 | 
							
								// Carlson, Numerische Mathematik, vol 33, 1 (1979)
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								namespace boost { namespace math {
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								template <class T1, class T2, class Policy>
							 | 
						||
| 
								 | 
							
								typename tools::promote_args<T1, T2>::type ellint_1(T1 k, T2 phi, const Policy& pol);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								namespace detail{
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								template <typename T, typename Policy>
							 | 
						||
| 
								 | 
							
								T ellint_k_imp(T k, const Policy& pol);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								// Elliptic integral (Legendre form) of the first kind
							 | 
						||
| 
								 | 
							
								template <typename T, typename Policy>
							 | 
						||
| 
								 | 
							
								T ellint_f_imp(T phi, T k, const Policy& pol)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    BOOST_MATH_STD_USING
							 | 
						||
| 
								 | 
							
								    using namespace boost::math::tools;
							 | 
						||
| 
								 | 
							
								    using namespace boost::math::constants;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    static const char* function = "boost::math::ellint_f<%1%>(%1%,%1%)";
							 | 
						||
| 
								 | 
							
								    BOOST_MATH_INSTRUMENT_VARIABLE(phi);
							 | 
						||
| 
								 | 
							
								    BOOST_MATH_INSTRUMENT_VARIABLE(k);
							 | 
						||
| 
								 | 
							
								    BOOST_MATH_INSTRUMENT_VARIABLE(function);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if (abs(k) > 1)
							 | 
						||
| 
								 | 
							
								    {
							 | 
						||
| 
								 | 
							
								       return policies::raise_domain_error<T>(function,
							 | 
						||
| 
								 | 
							
								            "Got k = %1%, function requires |k| <= 1", k, pol);
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    bool invert = false;
							 | 
						||
| 
								 | 
							
								    if(phi < 0)
							 | 
						||
| 
								 | 
							
								    {
							 | 
						||
| 
								 | 
							
								       BOOST_MATH_INSTRUMENT_VARIABLE(phi);
							 | 
						||
| 
								 | 
							
								       phi = fabs(phi);
							 | 
						||
| 
								 | 
							
								       invert = true;
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    T result;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if(phi >= tools::max_value<T>())
							 | 
						||
| 
								 | 
							
								    {
							 | 
						||
| 
								 | 
							
								       // Need to handle infinity as a special case:
							 | 
						||
| 
								 | 
							
								       result = policies::raise_overflow_error<T>(function, 0, pol);
							 | 
						||
| 
								 | 
							
								       BOOST_MATH_INSTRUMENT_VARIABLE(result);
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								    else if(phi > 1 / tools::epsilon<T>())
							 | 
						||
| 
								 | 
							
								    {
							 | 
						||
| 
								 | 
							
								       // Phi is so large that phi%pi is necessarily zero (or garbage),
							 | 
						||
| 
								 | 
							
								       // just return the second part of the duplication formula:
							 | 
						||
| 
								 | 
							
								       result = 2 * phi * ellint_k_imp(k, pol) / constants::pi<T>();
							 | 
						||
| 
								 | 
							
								       BOOST_MATH_INSTRUMENT_VARIABLE(result);
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								    else
							 | 
						||
| 
								 | 
							
								    {
							 | 
						||
| 
								 | 
							
								       // Carlson's algorithm works only for |phi| <= pi/2,
							 | 
						||
| 
								 | 
							
								       // use the integrand's periodicity to normalize phi
							 | 
						||
| 
								 | 
							
								       //
							 | 
						||
| 
								 | 
							
								       // Xiaogang's original code used a cast to long long here
							 | 
						||
| 
								 | 
							
								       // but that fails if T has more digits than a long long,
							 | 
						||
| 
								 | 
							
								       // so rewritten to use fmod instead:
							 | 
						||
| 
								 | 
							
								       //
							 | 
						||
| 
								 | 
							
								       BOOST_MATH_INSTRUMENT_CODE("pi/2 = " << constants::pi<T>() / 2);
							 | 
						||
| 
								 | 
							
								       T rphi = boost::math::tools::fmod_workaround(phi, T(constants::half_pi<T>()));
							 | 
						||
| 
								 | 
							
								       BOOST_MATH_INSTRUMENT_VARIABLE(rphi);
							 | 
						||
| 
								 | 
							
								       T m = boost::math::round((phi - rphi) / constants::half_pi<T>());
							 | 
						||
| 
								 | 
							
								       BOOST_MATH_INSTRUMENT_VARIABLE(m);
							 | 
						||
| 
								 | 
							
								       int s = 1;
							 | 
						||
| 
								 | 
							
								       if(boost::math::tools::fmod_workaround(m, T(2)) > 0.5)
							 | 
						||
| 
								 | 
							
								       {
							 | 
						||
| 
								 | 
							
								          m += 1;
							 | 
						||
| 
								 | 
							
								          s = -1;
							 | 
						||
| 
								 | 
							
								          rphi = constants::half_pi<T>() - rphi;
							 | 
						||
| 
								 | 
							
								          BOOST_MATH_INSTRUMENT_VARIABLE(rphi);
							 | 
						||
| 
								 | 
							
								       }
							 | 
						||
| 
								 | 
							
								       T sinp = sin(rphi);
							 | 
						||
| 
								 | 
							
								       sinp *= sinp;
							 | 
						||
| 
								 | 
							
								       T cosp = cos(rphi);
							 | 
						||
| 
								 | 
							
								       cosp *= cosp;
							 | 
						||
| 
								 | 
							
								       BOOST_MATH_INSTRUMENT_VARIABLE(sinp);
							 | 
						||
| 
								 | 
							
								       BOOST_MATH_INSTRUMENT_VARIABLE(cosp);
							 | 
						||
| 
								 | 
							
								       if(sinp > tools::min_value<T>())
							 | 
						||
| 
								 | 
							
								       {
							 | 
						||
| 
								 | 
							
								          //
							 | 
						||
| 
								 | 
							
								          // Use http://dlmf.nist.gov/19.25#E5, note that
							 | 
						||
| 
								 | 
							
								          // c-1 simplifies to cot^2(rphi) which avoid cancellation:
							 | 
						||
| 
								 | 
							
								          //
							 | 
						||
| 
								 | 
							
								          T c = 1 / sinp;
							 | 
						||
| 
								 | 
							
								          result = rphi == 0 ? static_cast<T>(0) : static_cast<T>(s * ellint_rf_imp(T(cosp / sinp), T(c - k * k), c, pol));
							 | 
						||
| 
								 | 
							
								       }
							 | 
						||
| 
								 | 
							
								       else
							 | 
						||
| 
								 | 
							
								          result = s * sin(rphi);
							 | 
						||
| 
								 | 
							
								       BOOST_MATH_INSTRUMENT_VARIABLE(result);
							 | 
						||
| 
								 | 
							
								       if(m != 0)
							 | 
						||
| 
								 | 
							
								       {
							 | 
						||
| 
								 | 
							
								          result += m * ellint_k_imp(k, pol);
							 | 
						||
| 
								 | 
							
								          BOOST_MATH_INSTRUMENT_VARIABLE(result);
							 | 
						||
| 
								 | 
							
								       }
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								    return invert ? T(-result) : result;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								// Complete elliptic integral (Legendre form) of the first kind
							 | 
						||
| 
								 | 
							
								template <typename T, typename Policy>
							 | 
						||
| 
								 | 
							
								T ellint_k_imp(T k, const Policy& pol)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    BOOST_MATH_STD_USING
							 | 
						||
| 
								 | 
							
								    using namespace boost::math::tools;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    static const char* function = "boost::math::ellint_k<%1%>(%1%)";
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if (abs(k) > 1)
							 | 
						||
| 
								 | 
							
								    {
							 | 
						||
| 
								 | 
							
								       return policies::raise_domain_error<T>(function,
							 | 
						||
| 
								 | 
							
								            "Got k = %1%, function requires |k| <= 1", k, pol);
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								    if (abs(k) == 1)
							 | 
						||
| 
								 | 
							
								    {
							 | 
						||
| 
								 | 
							
								       return policies::raise_overflow_error<T>(function, 0, pol);
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    T x = 0;
							 | 
						||
| 
								 | 
							
								    T y = 1 - k * k;
							 | 
						||
| 
								 | 
							
								    T z = 1;
							 | 
						||
| 
								 | 
							
								    T value = ellint_rf_imp(x, y, z, pol);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return value;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								template <typename T, typename Policy>
							 | 
						||
| 
								 | 
							
								inline typename tools::promote_args<T>::type ellint_1(T k, const Policy& pol, const mpl::true_&)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								   typedef typename tools::promote_args<T>::type result_type;
							 | 
						||
| 
								 | 
							
								   typedef typename policies::evaluation<result_type, Policy>::type value_type;
							 | 
						||
| 
								 | 
							
								   return policies::checked_narrowing_cast<result_type, Policy>(detail::ellint_k_imp(static_cast<value_type>(k), pol), "boost::math::ellint_1<%1%>(%1%)");
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								template <class T1, class T2>
							 | 
						||
| 
								 | 
							
								inline typename tools::promote_args<T1, T2>::type ellint_1(T1 k, T2 phi, const mpl::false_&)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								   return boost::math::ellint_1(k, phi, policies::policy<>());
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								// Complete elliptic integral (Legendre form) of the first kind
							 | 
						||
| 
								 | 
							
								template <typename T>
							 | 
						||
| 
								 | 
							
								inline typename tools::promote_args<T>::type ellint_1(T k)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								   return ellint_1(k, policies::policy<>());
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								// Elliptic integral (Legendre form) of the first kind
							 | 
						||
| 
								 | 
							
								template <class T1, class T2, class Policy>
							 | 
						||
| 
								 | 
							
								inline typename tools::promote_args<T1, T2>::type ellint_1(T1 k, T2 phi, const Policy& pol)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								   typedef typename tools::promote_args<T1, T2>::type result_type;
							 | 
						||
| 
								 | 
							
								   typedef typename policies::evaluation<result_type, Policy>::type value_type;
							 | 
						||
| 
								 | 
							
								   return policies::checked_narrowing_cast<result_type, Policy>(detail::ellint_f_imp(static_cast<value_type>(phi), static_cast<value_type>(k), pol), "boost::math::ellint_1<%1%>(%1%,%1%)");
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								template <class T1, class T2>
							 | 
						||
| 
								 | 
							
								inline typename tools::promote_args<T1, T2>::type ellint_1(T1 k, T2 phi)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								   typedef typename policies::is_policy<T2>::type tag_type;
							 | 
						||
| 
								 | 
							
								   return detail::ellint_1(k, phi, tag_type());
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								}} // namespaces
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#endif // BOOST_MATH_ELLINT_1_HPP
							 | 
						||
| 
								 | 
							
								
							 |