117303c62SDavid Schultz /*-
2*4d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause
35e53a4f9SPedro F. Giffuni *
417303c62SDavid Schultz * Copyright (c) 2008 David Schultz <das@FreeBSD.ORG>
517303c62SDavid Schultz * All rights reserved.
617303c62SDavid Schultz *
717303c62SDavid Schultz * Redistribution and use in source and binary forms, with or without
817303c62SDavid Schultz * modification, are permitted provided that the following conditions
917303c62SDavid Schultz * are met:
1017303c62SDavid Schultz * 1. Redistributions of source code must retain the above copyright
1117303c62SDavid Schultz * notice, this list of conditions and the following disclaimer.
1217303c62SDavid Schultz * 2. Redistributions in binary form must reproduce the above copyright
1317303c62SDavid Schultz * notice, this list of conditions and the following disclaimer in the
1417303c62SDavid Schultz * documentation and/or other materials provided with the distribution.
1517303c62SDavid Schultz *
1617303c62SDavid Schultz * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1717303c62SDavid Schultz * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1817303c62SDavid Schultz * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1917303c62SDavid Schultz * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2017303c62SDavid Schultz * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2117303c62SDavid Schultz * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2217303c62SDavid Schultz * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2317303c62SDavid Schultz * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2417303c62SDavid Schultz * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2517303c62SDavid Schultz * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2617303c62SDavid Schultz * SUCH DAMAGE.
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
P(long double x)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
Q(long double x)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
T_even(long double x)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
T_odd(long double x)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