#include #include #include #include #include #include namespace SCTL_NAMESPACE { template inline Real atoreal(const char* str) { // Warning: does not do correct rounding int i = 0; Real sign = 1.0; for (; str[i] != '\0'; i++) { char c = str[i]; if (c == '-') sign = -sign; if (c >= '0' && c <= '9') break; } Real val = 0.0; for (; str[i] != '\0'; i++) { char c = str[i]; if (c >= '0' && c <= '9') val = val * 10 + (c - '0'); else break; } if (str[i] == '.') { i++; Real exp = 1.0; exp /= 10; for (; str[i] != '\0'; i++) { char c = str[i]; if (c >= '0' && c <= '9') val = val + (c - '0') * exp; else break; exp /= 10; } } return sign * val; } template inline Real const_pi_generic() { static Real pi = atoreal("3.1415926535897932384626433832795028841"); return pi; } template inline Real const_e_generic() { static Real e = atoreal("2.7182818284590452353602874713526624977"); return e; } template inline Real fabs_generic(const Real a) { if (a >= 0.0) return a; else return -a; } template inline Real sqrt_generic(const Real a) { Real b = ::sqrt((double)a); if (a > 0) { b = (b + a / b) * 0.5; b = (b + a / b) * 0.5; } return b; } template inline Real sin_generic(const Real a) { const int N = 200; static std::vector theta; static std::vector sinval; static std::vector cosval; if (theta.size() == 0) { #pragma omp critical(QUAD_SIN) if (theta.size() == 0) { sinval.resize(N); cosval.resize(N); Real t = 1.0; std::vector theta_(N); for (int i = 0; i < N; i++) { theta_[i] = t; t = t * 0.5; } sinval[N - 1] = theta_[N - 1]; cosval[N - 1] = 1.0 - sinval[N - 1] * sinval[N - 1] / 2; for (int i = N - 2; i >= 0; i--) { sinval[i] = 2.0 * sinval[i + 1] * cosval[i + 1]; cosval[i] = sqrt(1.0 - sinval[i] * sinval[i]); } theta_.swap(theta); } } Real t = (a < 0.0 ? -a : a); Real sval = 0.0; Real cval = 1.0; for (int i = 0; i < N; i++) { while (theta[i] <= t) { Real sval_ = sval * cosval[i] + cval * sinval[i]; Real cval_ = cval * cosval[i] - sval * sinval[i]; sval = sval_; cval = cval_; t = t - theta[i]; } } return (a < 0.0 ? -sval : sval); } template inline Real cos_generic(const Real a) { const int N = 200; static std::vector theta; static std::vector sinval; static std::vector cosval; if (theta.size() == 0) { #pragma omp critical(QUAD_COS) if (theta.size() == 0) { sinval.resize(N); cosval.resize(N); Real t = 1.0; std::vector theta_(N); for (int i = 0; i < N; i++) { theta_[i] = t; t = t * 0.5; } sinval[N - 1] = theta_[N - 1]; cosval[N - 1] = 1.0 - sinval[N - 1] * sinval[N - 1] / 2; for (int i = N - 2; i >= 0; i--) { sinval[i] = 2.0 * sinval[i + 1] * cosval[i + 1]; cosval[i] = sqrt(1.0 - sinval[i] * sinval[i]); } theta_.swap(theta); } } Real t = (a < 0.0 ? -a : a); Real sval = 0.0; Real cval = 1.0; for (int i = 0; i < N; i++) { while (theta[i] <= t) { Real sval_ = sval * cosval[i] + cval * sinval[i]; Real cval_ = cval * cosval[i] - sval * sinval[i]; sval = sval_; cval = cval_; t = t - theta[i]; } } return cval; } template inline Real exp_generic(const Real a) { const int N = 200; static std::vector theta0; static std::vector theta1; static std::vector expval0; static std::vector expval1; if (theta0.size() == 0) { #pragma omp critical(QUAD_EXP) if (theta0.size() == 0) { std::vector theta0_(N); theta1.resize(N); expval0.resize(N); expval1.resize(N); theta0_[0] = 1.0; theta1[0] = 1.0; expval0[0] = const_e(); expval1[0] = const_e(); for (int i = 1; i < N; i++) { theta0_[i] = theta0_[i - 1] * 0.5; theta1[i] = theta1[i - 1] * 2.0; expval0[i] = sqrt(expval0[i - 1]); expval1[i] = expval1[i - 1] * expval1[i - 1]; } theta0.swap(theta0_); } } Real t = (a < 0.0 ? -a : a); Real eval = 1.0; for (int i = N - 1; i > 0; i--) { while (theta1[i] <= t) { eval = eval * expval1[i]; t = t - theta1[i]; } } for (int i = 0; i < N; i++) { while (theta0[i] <= t) { eval = eval * expval0[i]; t = t - theta0[i]; } } eval = eval * (1.0 + t); return (a < 0.0 ? 1.0 / eval : eval); } template inline Real log_generic(const Real a) { Real y0 = ::log((double)a); y0 = y0 + (a / exp(y0) - 1.0); y0 = y0 + (a / exp(y0) - 1.0); return y0; } template inline Real pow_generic(const Real b, const Real e) { if (e == 0) return 1; if (b == 0) return 0; if (b < 0) { Long e_ = (Long)e; SCTL_ASSERT(e == (Real)e_); return exp(log(-b) * e) * (e_ % 2 ? (Real)-1 : (Real)1.0); } return exp(log(b) * e); } template inline std::ostream& ostream_insertion_generic(std::ostream& output, const Real q_) { // int width=output.width(); output << std::setw(1); Real q = q_; if (q < 0.0) { output << "-"; q = -q; } else if (q > 0) { output << " "; } else { output << " "; output << "0.0"; return output; } int exp = 0; static const Real ONETENTH = (Real)1 / 10; while (q < 1.0 && abs(exp) < 10000) { q = q * 10; exp--; } while (q >= 10 && abs(exp) < 10000) { q = q * ONETENTH; exp++; } for (int i = 0; i < 34; i++) { output << (int)q; if (i == 0) output << "."; q = (q - int(q)) * 10; if (q == 0 && i > 0) break; } if (exp > 0) { std::cout << "e+" << exp; } else if (exp < 0) { std::cout << "e" << exp; } return output; } } // end namespace namespace SCTL_NAMESPACE { //template <> inline long double const_pi() { return const_pi_generic(); } //template <> inline long double const_e() { return const_e_generic(); } template <> inline long double fabs(const long double a) { return fabs_generic(a); } template <> inline long double sqrt(const long double a) { return sqrt_generic(a); } template <> inline long double sin(const long double a) { return sin_generic(a); } template <> inline long double cos(const long double a) { return cos_generic(a); } template <> inline long double exp(const long double a) { return exp_generic(a); } //template <> inline long double log(const long double a) { return log_generic(a); } //template <> inline long double pow(const long double b, const long double e) { return pow_generic(b, e); } } // end namespace #ifdef SCTL_QUAD_T namespace SCTL_NAMESPACE { template <> inline QuadReal const_pi() { return const_pi_generic(); } template <> inline QuadReal const_e() { return const_e_generic(); } template <> inline QuadReal fabs(const QuadReal a) { return fabs_generic(a); } template <> inline QuadReal sqrt(const QuadReal a) { return sqrt_generic(a); } template <> inline QuadReal sin(const QuadReal a) { return sin_generic(a); } template <> inline QuadReal cos(const QuadReal a) { return cos_generic(a); } template <> inline QuadReal exp(const QuadReal a) { return exp_generic(a); } template <> inline QuadReal log(const QuadReal a) { return log_generic(a); } template <> inline QuadReal pow(const QuadReal b, const QuadReal e) { return pow_generic(b, e); } inline std::ostream& operator<<(std::ostream& output, const QuadReal q) { return ostream_insertion_generic(output, q); } } // end namespace inline std::ostream& operator<<(std::ostream& output, const SCTL_QUAD_T q) { return SCTL_NAMESPACE::ostream_insertion_generic(output, q); } #endif // SCTL_QUAD_T //namespace SCTL_NAMESPACE { //template inline unsigned int pow(const unsigned int b, const unsigned int e) { // unsigned int r = 1; // for (unsigned int i = 0; i < e; i++) r *= b; // return r; //} //}