1dce5f3abSSteve Kargl /*-
2*2d3b0a68SSteve Kargl * Copyright (c) 2017,2023 Steven G. Kargl
3dce5f3abSSteve Kargl * All rights reserved.
4dce5f3abSSteve Kargl *
5dce5f3abSSteve Kargl * Redistribution and use in source and binary forms, with or without
6dce5f3abSSteve Kargl * modification, are permitted provided that the following conditions
7dce5f3abSSteve Kargl * are met:
8dce5f3abSSteve Kargl * 1. Redistributions of source code must retain the above copyright
9dce5f3abSSteve Kargl * notice unmodified, this list of conditions, and the following
10dce5f3abSSteve Kargl * disclaimer.
11dce5f3abSSteve Kargl * 2. Redistributions in binary form must reproduce the above copyright
12dce5f3abSSteve Kargl * notice, this list of conditions and the following disclaimer in the
13dce5f3abSSteve Kargl * documentation and/or other materials provided with the distribution.
14dce5f3abSSteve Kargl *
15dce5f3abSSteve Kargl * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16dce5f3abSSteve Kargl * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17dce5f3abSSteve Kargl * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18dce5f3abSSteve Kargl * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19dce5f3abSSteve Kargl * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20dce5f3abSSteve Kargl * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21dce5f3abSSteve Kargl * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22dce5f3abSSteve Kargl * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23dce5f3abSSteve Kargl * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24dce5f3abSSteve Kargl * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25dce5f3abSSteve Kargl */
26dce5f3abSSteve Kargl
27dce5f3abSSteve Kargl /*
28dce5f3abSSteve Kargl * See ../src/s_sinpi.c for implementation details.
29dce5f3abSSteve Kargl */
30dce5f3abSSteve Kargl
31dce5f3abSSteve Kargl #define INLINE_KERNEL_SINDF
32dce5f3abSSteve Kargl #define INLINE_KERNEL_COSDF
33dce5f3abSSteve Kargl
34dce5f3abSSteve Kargl #include "math.h"
35dce5f3abSSteve Kargl #include "math_private.h"
36dce5f3abSSteve Kargl #include "k_cosf.c"
37dce5f3abSSteve Kargl #include "k_sinf.c"
38dce5f3abSSteve Kargl
39dce5f3abSSteve Kargl #define __kernel_cospif(x) (__kernel_cosdf(M_PI * (x)))
40dce5f3abSSteve Kargl #define __kernel_sinpif(x) (__kernel_sindf(M_PI * (x)))
41dce5f3abSSteve Kargl
42dce5f3abSSteve Kargl static const float
43dce5f3abSSteve Kargl pi_hi = 3.14160156e+00F, /* 0x40491000 */
44dce5f3abSSteve Kargl pi_lo = -8.90890988e-06F; /* 0xb715777a */
45dce5f3abSSteve Kargl
46dce5f3abSSteve Kargl volatile static const float vzero = 0;
47dce5f3abSSteve Kargl
48dce5f3abSSteve Kargl float
sinpif(float x)49dce5f3abSSteve Kargl sinpif(float x)
50dce5f3abSSteve Kargl {
51dce5f3abSSteve Kargl float ax, hi, lo, s;
52dce5f3abSSteve Kargl uint32_t hx, ix, j0;
53dce5f3abSSteve Kargl
54dce5f3abSSteve Kargl GET_FLOAT_WORD(hx, x);
55dce5f3abSSteve Kargl ix = hx & 0x7fffffff;
56dce5f3abSSteve Kargl SET_FLOAT_WORD(ax, ix);
57dce5f3abSSteve Kargl
58dce5f3abSSteve Kargl if (ix < 0x3f800000) { /* |x| < 1 */
59dce5f3abSSteve Kargl if (ix < 0x3e800000) { /* |x| < 0.25 */
60dce5f3abSSteve Kargl if (ix < 0x38800000) { /* |x| < 0x1p-14 */
61dce5f3abSSteve Kargl if (x == 0)
62dce5f3abSSteve Kargl return (x);
63dce5f3abSSteve Kargl SET_FLOAT_WORD(hi, hx & 0xffff0000);
64dce5f3abSSteve Kargl hi *= 0x1p23F;
65dce5f3abSSteve Kargl lo = x * 0x1p23F - hi;
66dce5f3abSSteve Kargl s = (pi_lo + pi_hi) * lo + pi_lo * hi +
67dce5f3abSSteve Kargl pi_hi * hi;
68dce5f3abSSteve Kargl return (s * 0x1p-23F);
69dce5f3abSSteve Kargl }
70dce5f3abSSteve Kargl
71dce5f3abSSteve Kargl s = __kernel_sinpif(ax);
72dce5f3abSSteve Kargl return ((hx & 0x80000000) ? -s : s);
73dce5f3abSSteve Kargl }
74dce5f3abSSteve Kargl
75dce5f3abSSteve Kargl if (ix < 0x3f000000) /* |x| < 0.5 */
76dce5f3abSSteve Kargl s = __kernel_cospif(0.5F - ax);
77dce5f3abSSteve Kargl else if (ix < 0x3f400000) /* |x| < 0.75 */
78dce5f3abSSteve Kargl s = __kernel_cospif(ax - 0.5F);
79dce5f3abSSteve Kargl else
80dce5f3abSSteve Kargl s = __kernel_sinpif(1 - ax);
81dce5f3abSSteve Kargl return ((hx & 0x80000000) ? -s : s);
82dce5f3abSSteve Kargl }
83dce5f3abSSteve Kargl
84dce5f3abSSteve Kargl if (ix < 0x4b000000) { /* 1 <= |x| < 0x1p23 */
85*2d3b0a68SSteve Kargl FFLOORF(x, j0, ix); /* Integer part of ax. */
86dce5f3abSSteve Kargl ax -= x;
87dce5f3abSSteve Kargl GET_FLOAT_WORD(ix, ax);
88dce5f3abSSteve Kargl
89dce5f3abSSteve Kargl if (ix == 0)
90dce5f3abSSteve Kargl s = 0;
91dce5f3abSSteve Kargl else {
92dce5f3abSSteve Kargl if (ix < 0x3f000000) { /* |x| < 0.5 */
93dce5f3abSSteve Kargl if (ix < 0x3e800000) /* |x| < 0.25 */
94dce5f3abSSteve Kargl s = __kernel_sinpif(ax);
95dce5f3abSSteve Kargl else
96dce5f3abSSteve Kargl s = __kernel_cospif(0.5F - ax);
97dce5f3abSSteve Kargl } else {
98dce5f3abSSteve Kargl if (ix < 0x3f400000) /* |x| < 0.75 */
99dce5f3abSSteve Kargl s = __kernel_cospif(ax - 0.5F);
100dce5f3abSSteve Kargl else
101dce5f3abSSteve Kargl s = __kernel_sinpif(1 - ax);
102dce5f3abSSteve Kargl }
103dce5f3abSSteve Kargl
104dce5f3abSSteve Kargl j0 = (uint32_t)x;
105dce5f3abSSteve Kargl s = (j0 & 1) ? -s : s;
106dce5f3abSSteve Kargl }
107dce5f3abSSteve Kargl return ((hx & 0x80000000) ? -s : s);
108dce5f3abSSteve Kargl }
109dce5f3abSSteve Kargl
110dce5f3abSSteve Kargl /* x = +-inf or nan. */
111dce5f3abSSteve Kargl if (ix >= 0x7f800000)
112dce5f3abSSteve Kargl return (vzero / vzero);
113dce5f3abSSteve Kargl
114dce5f3abSSteve Kargl /*
115dce5f3abSSteve Kargl * |x| >= 0x1p23 is always an integer, so return +-0.
116dce5f3abSSteve Kargl */
117dce5f3abSSteve Kargl return (copysignf(0, x));
118dce5f3abSSteve Kargl }
119