1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
|
/* Used by sinf, cosf and sincosf functions. X86-64 version.
Copyright (C) 2018-2021 Free Software Foundation, Inc.
This file is part of the GNU C Library.
The GNU C Library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public
License as published by the Free Software Foundation; either
version 2.1 of the License, or (at your option) any later version.
The GNU C Library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
Lesser General Public License for more details.
You should have received a copy of the GNU Lesser General Public
License along with the GNU C Library; if not, see
<https://www.gnu.org/licenses/>. */
typedef double v2df_t __attribute__ ((vector_size (2 * sizeof (double))));
#ifdef __SSE2_MATH__
typedef float v4sf_t __attribute__ ((vector_size (4 * sizeof (float))));
static inline void
v2df_to_sf (v2df_t v2df, float *f0p, float *f1p)
{
v4sf_t v4sf = __builtin_ia32_cvtpd2ps (v2df);
*f0p = v4sf[0];
*f1p = v4sf[1];
}
#else
static inline void
v2df_to_sf (v2df_t v2df, float *f0p, float *f1p)
{
*f0p = (float) v2df[0];
*f1p = (float) v2df[1];
}
#endif
/* The constants and polynomials for sine and cosine. */
typedef struct
{
double sign[4]; /* Sign of sine in quadrants 0..3. */
double hpi_inv; /* 2 / PI ( * 2^24 if !TOINT_INTRINSICS). */
double hpi; /* PI / 2. */
/* Cosine polynomial: c0, c1, c2, c3, c4.
Sine polynomial: s1, s2, s3. */
double c0, c1;
v2df_t s1c2, s2c3, s3c4;
} sincos_t;
/* Compute the sine and cosine of inputs X and X2 (X squared), using the
polynomial P and store the results in SINP and COSP. N is the quadrant,
if odd the cosine and sine polynomials are swapped. */
static inline void
sincosf_poly (double x, double x2, const sincos_t *p, int n, float *sinp,
float *cosp)
{
v2df_t vx2x2 = { x2, x2 };
v2df_t vxx2 = { x, x2 };
v2df_t vx3x4, vs1c2;
vx3x4 = vx2x2 * vxx2;
vs1c2 = p->s2c3 + vx2x2 * p->s3c4;
/* Swap sin/cos result based on quadrant. */
if (n & 1)
{
float *tmp = cosp;
cosp = sinp;
sinp = tmp;
}
double c1 = p->c0 + x2 * p->c1;
v2df_t vxc1 = { x, c1 };
v2df_t vx5x6 = vx3x4 * vx2x2;
v2df_t vsincos = vxc1 + vx3x4 * p->s1c2;
vsincos = vsincos + vx5x6 * vs1c2;
v2df_to_sf (vsincos, sinp, cosp);
}
/* Return the sine of inputs X and X2 (X squared) using the polynomial P.
N is the quadrant, and if odd the cosine polynomial is used. */
static inline float
sinf_poly (double x, double x2, const sincos_t *p, int n)
{
double x3, x4, x6, x7, s, c, c1, c2, s1;
if ((n & 1) == 0)
{
x3 = x * x2;
s1 = p->s2c3[0] + x2 * p->s3c4[0];
x7 = x3 * x2;
s = x + x3 * p->s1c2[0];
return s + x7 * s1;
}
else
{
x4 = x2 * x2;
c2 = p->s2c3[1] + x2 * p->s3c4[1];
c1 = p->c0 + x2 * p->c1;
x6 = x4 * x2;
c = c1 + x4 * p->s1c2[1];
return c + x6 * c2;
}
}
|
