117303c62SDavid Schultz /*- 217303c62SDavid Schultz * Copyright (c) 2008 David Schultz <das@FreeBSD.ORG> 317303c62SDavid Schultz * All rights reserved. 417303c62SDavid Schultz * 517303c62SDavid Schultz * Redistribution and use in source and binary forms, with or without 617303c62SDavid Schultz * modification, are permitted provided that the following conditions 717303c62SDavid Schultz * are met: 817303c62SDavid Schultz * 1. Redistributions of source code must retain the above copyright 917303c62SDavid Schultz * notice, this list of conditions and the following disclaimer. 1017303c62SDavid Schultz * 2. Redistributions in binary form must reproduce the above copyright 1117303c62SDavid Schultz * notice, this list of conditions and the following disclaimer in the 1217303c62SDavid Schultz * documentation and/or other materials provided with the distribution. 1317303c62SDavid Schultz * 1417303c62SDavid Schultz * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1517303c62SDavid Schultz * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1617303c62SDavid Schultz * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1717303c62SDavid Schultz * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1817303c62SDavid Schultz * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1917303c62SDavid Schultz * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2017303c62SDavid Schultz * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2117303c62SDavid Schultz * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2217303c62SDavid Schultz * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2317303c62SDavid Schultz * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2417303c62SDavid Schultz * SUCH DAMAGE. 2517303c62SDavid Schultz * 2617303c62SDavid Schultz * $FreeBSD$ 2717303c62SDavid Schultz */ 2817303c62SDavid Schultz 2917303c62SDavid Schultz #include <float.h> 3017303c62SDavid Schultz 3117303c62SDavid Schultz #include "fpmath.h" 3217303c62SDavid Schultz 3317303c62SDavid Schultz #define BIAS (LDBL_MAX_EXP - 1) 3417303c62SDavid Schultz #define MANH_SIZE (LDBL_MANH_SIZE + 1) 3517303c62SDavid Schultz 3617303c62SDavid Schultz /* Approximation thresholds. */ 3717303c62SDavid Schultz #define ASIN_LINEAR (BIAS - 56) /* 2**-56 */ 3817303c62SDavid Schultz #define ACOS_CONST (BIAS - 113) /* 2**-113 */ 3917303c62SDavid Schultz #define ATAN_CONST (BIAS + 113) /* 2**113 */ 4017303c62SDavid Schultz #define ATAN_LINEAR (BIAS - 56) /* 2**-56 */ 4117303c62SDavid Schultz 4217303c62SDavid Schultz /* 0.95 */ 4317303c62SDavid Schultz #define THRESH ((0xe666666666666666ULL>>(64-(MANH_SIZE-1)))|LDBL_NBIT) 4417303c62SDavid Schultz 4517303c62SDavid Schultz /* Constants shared by the long double inverse trig functions. */ 4617303c62SDavid Schultz #define pS0 _ItL_pS0 4717303c62SDavid Schultz #define pS1 _ItL_pS1 4817303c62SDavid Schultz #define pS2 _ItL_pS2 4917303c62SDavid Schultz #define pS3 _ItL_pS3 5017303c62SDavid Schultz #define pS4 _ItL_pS4 5117303c62SDavid Schultz #define pS5 _ItL_pS5 5217303c62SDavid Schultz #define pS6 _ItL_pS6 5317303c62SDavid Schultz #define pS7 _ItL_pS7 5417303c62SDavid Schultz #define pS8 _ItL_pS8 5517303c62SDavid Schultz #define pS9 _ItL_pS9 5617303c62SDavid Schultz #define qS1 _ItL_qS1 5717303c62SDavid Schultz #define qS2 _ItL_qS2 5817303c62SDavid Schultz #define qS3 _ItL_qS3 5917303c62SDavid Schultz #define qS4 _ItL_qS4 6017303c62SDavid Schultz #define qS5 _ItL_qS5 6117303c62SDavid Schultz #define qS6 _ItL_qS6 6217303c62SDavid Schultz #define qS7 _ItL_qS7 6317303c62SDavid Schultz #define qS8 _ItL_qS8 6417303c62SDavid Schultz #define qS9 _ItL_qS9 6517303c62SDavid Schultz #define atanhi _ItL_atanhi 6617303c62SDavid Schultz #define atanlo _ItL_atanlo 6717303c62SDavid Schultz #define aT _ItL_aT 6817303c62SDavid Schultz #define pi_lo _ItL_pi_lo 6917303c62SDavid Schultz 7017303c62SDavid Schultz #define pio2_hi atanhi[3] 7117303c62SDavid Schultz #define pio2_lo atanlo[3] 7217303c62SDavid Schultz #define pio4_hi atanhi[1] 7317303c62SDavid Schultz 7417303c62SDavid Schultz /* Constants shared by the long double inverse trig functions. */ 7517303c62SDavid Schultz extern const long double pS0, pS1, pS2, pS3, pS4, pS5, pS6, pS7, pS8, pS9; 7617303c62SDavid Schultz extern const long double qS1, qS2, qS3, qS4, qS5, qS6, qS7, qS8, qS9; 7717303c62SDavid Schultz extern const long double atanhi[], atanlo[], aT[]; 7817303c62SDavid Schultz extern const long double pi_lo; 7917303c62SDavid Schultz 8017303c62SDavid Schultz static inline long double 8117303c62SDavid Schultz P(long double x) 8217303c62SDavid Schultz { 8317303c62SDavid Schultz 8417303c62SDavid Schultz return (x * (pS0 + x * (pS1 + x * (pS2 + x * (pS3 + x * \ 8517303c62SDavid Schultz (pS4 + x * (pS5 + x * (pS6 + x * (pS7 + x * (pS8 + x * \ 8617303c62SDavid Schultz pS9)))))))))); 8717303c62SDavid Schultz } 8817303c62SDavid Schultz 8917303c62SDavid Schultz static inline long double 9017303c62SDavid Schultz Q(long double x) 9117303c62SDavid Schultz { 9217303c62SDavid Schultz 9317303c62SDavid Schultz return (1.0 + x * (qS1 + x * (qS2 + x * (qS3 + x * (qS4 + x * \ 9417303c62SDavid Schultz (qS5 + x * (qS6 + x * (qS7 + x * (qS8 + x * qS9))))))))); 9517303c62SDavid Schultz } 9617303c62SDavid Schultz 9717303c62SDavid Schultz static inline long double 9817303c62SDavid Schultz T_even(long double x) 9917303c62SDavid Schultz { 10017303c62SDavid Schultz 10117303c62SDavid Schultz return (aT[0] + x * (aT[2] + x * (aT[4] + x * (aT[6] + x * \ 10217303c62SDavid Schultz (aT[8] + x * (aT[10] + x * (aT[12] + x * (aT[14] + x * \ 10317303c62SDavid Schultz (aT[16] + x * (aT[18] + x * (aT[20] + x * aT[22]))))))))))); 10417303c62SDavid Schultz } 10517303c62SDavid Schultz 10617303c62SDavid Schultz static inline long double 10717303c62SDavid Schultz T_odd(long double x) 10817303c62SDavid Schultz { 10917303c62SDavid Schultz 11017303c62SDavid Schultz return (aT[1] + x * (aT[3] + x * (aT[5] + x * (aT[7] + x * \ 11117303c62SDavid Schultz (aT[9] + x * (aT[11] + x * (aT[13] + x * (aT[15] + x * \ 11217303c62SDavid Schultz (aT[17] + x * (aT[19] + x * (aT[21] + x * aT[23]))))))))))); 11317303c62SDavid Schultz } 114