112188b77SDavid Schultz /*- 25e53a4f9SPedro F. Giffuni * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 35e53a4f9SPedro F. Giffuni * 412188b77SDavid Schultz * Copyright (c) 2011 David Schultz <das@FreeBSD.ORG> 512188b77SDavid Schultz * All rights reserved. 612188b77SDavid Schultz * 712188b77SDavid Schultz * Redistribution and use in source and binary forms, with or without 812188b77SDavid Schultz * modification, are permitted provided that the following conditions 912188b77SDavid Schultz * are met: 1012188b77SDavid Schultz * 1. Redistributions of source code must retain the above copyright 1112188b77SDavid Schultz * notice, this list of conditions and the following disclaimer. 1212188b77SDavid Schultz * 2. Redistributions in binary form must reproduce the above copyright 1312188b77SDavid Schultz * notice, this list of conditions and the following disclaimer in the 1412188b77SDavid Schultz * documentation and/or other materials provided with the distribution. 1512188b77SDavid Schultz * 1612188b77SDavid Schultz * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1712188b77SDavid Schultz * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1812188b77SDavid Schultz * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1912188b77SDavid Schultz * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 2012188b77SDavid Schultz * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2112188b77SDavid Schultz * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2212188b77SDavid Schultz * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2312188b77SDavid Schultz * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2412188b77SDavid Schultz * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2512188b77SDavid Schultz * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2612188b77SDavid Schultz * SUCH DAMAGE. 2712188b77SDavid Schultz */ 2812188b77SDavid Schultz 2912188b77SDavid Schultz #include <sys/cdefs.h> 3012188b77SDavid Schultz __FBSDID("$FreeBSD$"); 3112188b77SDavid Schultz 3212188b77SDavid Schultz #include <complex.h> 3312188b77SDavid Schultz 3412188b77SDavid Schultz #include "math.h" 3512188b77SDavid Schultz #include "math_private.h" 3612188b77SDavid Schultz 3712188b77SDavid Schultz static const uint32_t k = 1799; /* constant for reduction */ 3812188b77SDavid Schultz static const double kln2 = 1246.97177782734161156; /* k * ln2 */ 3912188b77SDavid Schultz 4012188b77SDavid Schultz /* 4112188b77SDavid Schultz * Compute exp(x), scaled to avoid spurious overflow. An exponent is 4212188b77SDavid Schultz * returned separately in 'expt'. 4312188b77SDavid Schultz * 4412188b77SDavid Schultz * Input: ln(DBL_MAX) <= x < ln(2 * DBL_MAX / DBL_MIN_DENORM) ~= 1454.91 4512188b77SDavid Schultz * Output: 2**1023 <= y < 2**1024 4612188b77SDavid Schultz */ 4712188b77SDavid Schultz static double 4812188b77SDavid Schultz __frexp_exp(double x, int *expt) 4912188b77SDavid Schultz { 5012188b77SDavid Schultz double exp_x; 5112188b77SDavid Schultz uint32_t hx; 5212188b77SDavid Schultz 5312188b77SDavid Schultz /* 5412188b77SDavid Schultz * We use exp(x) = exp(x - kln2) * 2**k, carefully chosen to 5512188b77SDavid Schultz * minimize |exp(kln2) - 2**k|. We also scale the exponent of 5612188b77SDavid Schultz * exp_x to MAX_EXP so that the result can be multiplied by 5712188b77SDavid Schultz * a tiny number without losing accuracy due to denormalization. 5812188b77SDavid Schultz */ 5912188b77SDavid Schultz exp_x = exp(x - kln2); 6012188b77SDavid Schultz GET_HIGH_WORD(hx, exp_x); 6112188b77SDavid Schultz *expt = (hx >> 20) - (0x3ff + 1023) + k; 6212188b77SDavid Schultz SET_HIGH_WORD(exp_x, (hx & 0xfffff) | ((0x3ff + 1023) << 20)); 6312188b77SDavid Schultz return (exp_x); 6412188b77SDavid Schultz } 6512188b77SDavid Schultz 6612188b77SDavid Schultz /* 6712188b77SDavid Schultz * __ldexp_exp(x, expt) and __ldexp_cexp(x, expt) compute exp(x) * 2**expt. 6812188b77SDavid Schultz * They are intended for large arguments (real part >= ln(DBL_MAX)) 6912188b77SDavid Schultz * where care is needed to avoid overflow. 7012188b77SDavid Schultz * 7112188b77SDavid Schultz * The present implementation is narrowly tailored for our hyperbolic and 7212188b77SDavid Schultz * exponential functions. We assume expt is small (0 or -1), and the caller 7312188b77SDavid Schultz * has filtered out very large x, for which overflow would be inevitable. 7412188b77SDavid Schultz */ 7512188b77SDavid Schultz 7612188b77SDavid Schultz double 7712188b77SDavid Schultz __ldexp_exp(double x, int expt) 7812188b77SDavid Schultz { 7912188b77SDavid Schultz double exp_x, scale; 8012188b77SDavid Schultz int ex_expt; 8112188b77SDavid Schultz 8212188b77SDavid Schultz exp_x = __frexp_exp(x, &ex_expt); 8312188b77SDavid Schultz expt += ex_expt; 8412188b77SDavid Schultz INSERT_WORDS(scale, (0x3ff + expt) << 20, 0); 8512188b77SDavid Schultz return (exp_x * scale); 8612188b77SDavid Schultz } 8712188b77SDavid Schultz 8812188b77SDavid Schultz double complex 8912188b77SDavid Schultz __ldexp_cexp(double complex z, int expt) 9012188b77SDavid Schultz { 91*fcce470cSStefan Eßer double c, exp_x, s, scale1, scale2, x, y; 9212188b77SDavid Schultz int ex_expt, half_expt; 9312188b77SDavid Schultz 9412188b77SDavid Schultz x = creal(z); 9512188b77SDavid Schultz y = cimag(z); 9612188b77SDavid Schultz exp_x = __frexp_exp(x, &ex_expt); 9712188b77SDavid Schultz expt += ex_expt; 9812188b77SDavid Schultz 9912188b77SDavid Schultz /* 10012188b77SDavid Schultz * Arrange so that scale1 * scale2 == 2**expt. We use this to 10112188b77SDavid Schultz * compensate for scalbn being horrendously slow. 10212188b77SDavid Schultz */ 10312188b77SDavid Schultz half_expt = expt / 2; 10412188b77SDavid Schultz INSERT_WORDS(scale1, (0x3ff + half_expt) << 20, 0); 10512188b77SDavid Schultz half_expt = expt - half_expt; 10612188b77SDavid Schultz INSERT_WORDS(scale2, (0x3ff + half_expt) << 20, 0); 10712188b77SDavid Schultz 108*fcce470cSStefan Eßer sincos(y, &s, &c); 109*fcce470cSStefan Eßer return (CMPLX(c * exp_x * scale1 * scale2, 110*fcce470cSStefan Eßer s * exp_x * scale1 * scale2)); 11112188b77SDavid Schultz } 112