1/*
2 * CDDL HEADER START
3 *
4 * The contents of this file are subject to the terms of the
5 * Common Development and Distribution License (the "License").
6 * You may not use this file except in compliance with the License.
7 *
8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9 * or http://www.opensolaris.org/os/licensing.
10 * See the License for the specific language governing permissions
11 * and limitations under the License.
12 *
13 * When distributing Covered Code, include this CDDL HEADER in each
14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15 * If applicable, add the following below this CDDL HEADER, with the
16 * fields enclosed by brackets "[]" replaced with your own identifying
17 * information: Portions Copyright [yyyy] [name of copyright owner]
18 *
19 * CDDL HEADER END
20 */
21
22/*
23 * Copyright 2011 Nexenta Systems, Inc.  All rights reserved.
24 */
25/*
26 * Copyright 2006 Sun Microsystems, Inc.  All rights reserved.
27 * Use is subject to license terms.
28 */
29
30#include <sys/isa_defs.h>
31
32#ifdef _LITTLE_ENDIAN
33#define HI(x)	*(1+(int*)x)
34#define LO(x)	*(unsigned*)x
35#else
36#define HI(x)	*(int*)x
37#define LO(x)	*(1+(unsigned*)x)
38#endif
39
40#ifdef __RESTRICT
41#define restrict _Restrict
42#else
43#define restrict
44#endif
45
46extern const double __vlibm_TBL_sincos_hi[], __vlibm_TBL_sincos_lo[];
47extern int __vlibm_rem_pio2m(double *, double *, int, int, int);
48
49static const double
50	zero	= 0.0,
51	one		= 1.0,
52	two24	= 16777216.0,
53	pp1		= -1.666666666605760465276263943134982554676e-0001,
54	pp2		=  8.333261209690963126718376566146180944442e-0003,
55	p1		= -1.666666666666629669805215138920301589656e-0001,
56	p2		=  8.333333332390951295683993455280336376663e-0003,
57	p3		= -1.984126237997976692791551778230098403960e-0004,
58	p4		=  2.753403624854277237649987622848330351110e-0006,
59	qq1		= -4.999999999977710986407023955908711557870e-0001,
60	qq2		=  4.166654863857219350645055881018842089580e-0002,
61	q1		= -4.999999999999931701464060878888294524481e-0001,
62	q2		=  4.166666666394861917535640593963708222319e-0002,
63	q3		= -1.388888552656142867832756687736851681462e-0003,
64	q4		=  2.478519423681460796618128289454530524759e-0005;
65
66void
67__vlibm_vsincos_big(int n, double * restrict x, int stridex,
68	double * restrict ss, int stridess,
69	double * restrict cc, int stridecc, int thresh)
70{
71	for (; n--; x += stridex, ss += stridess, cc += stridecc)
72	{
73		double		ts, tc, tx, tt[3], ty[2], t, w, z, c, s;
74		unsigned	hx, xsb;
75		int			e0, nx, j;
76
77		hx = HI(x);
78		xsb = hx & 0x80000000;
79		hx &= ~0x80000000;
80		if (hx <= thresh || hx >= 0x7ff00000)
81			continue;
82
83		/*
84		 * Argument reduction part.
85		 */
86		e0 = (hx >> 20) - 1046;
87		HI(&tx) = 0x41600000 | (hx & 0xfffff);
88		LO(&tx) = LO(x);
89		tt[0] = (double)((int) tx);
90		tx = (tx - tt[0]) * two24;
91		if (tx != zero)
92		{
93			nx = 2;
94			tt[1] = (double)((int) tx);
95			tt[2] = (tx - tt[1]) * two24;
96			if (tt[2] != zero)
97				nx = 3;
98		}
99		else
100		{
101			nx = 1;
102			tt[1] = tt[2] = zero;
103		}
104		nx = __vlibm_rem_pio2m(tt, ty, e0, nx, 2);
105		if (xsb)
106		{
107			nx = -nx;
108			ty[0] = -ty[0];
109			ty[1] = -ty[1];
110		}
111
112		/* now nx and ty[*] are the quadrant and reduced arg */
113		hx = HI(&ty[0]);
114		xsb = 0;
115		if (hx & 0x80000000)
116		{
117			ty[0] = -ty[0];
118			ty[1] = -ty[1];
119			hx &= ~0x80000000;
120			xsb = 1;
121		}
122		if (hx < 0x3fc40000)
123		{
124			z = ty[0] * ty[0];
125			t = z * (q1 + z * (q2 + z * (q3 + z * q4)));
126			c = one + t;
127			t = z * (p1 + z * (p2 + z * (p3 + z * p4)));
128			s = ty[0] + (ty[1] + ty[0] * t);
129		}
130		else {
131			j = (hx + 0x4000) & 0x7fff8000;
132			HI(&t) = j;
133			LO(&t) = 0;
134			ty[0] = (ty[0] - t) + ty[1];
135			z = ty[0] * ty[0];
136			t = z * (qq1 + z * qq2);
137			w = ty[0] * (one + z * (pp1 + z * pp2));
138			j = ((j - 0x3fc40000) >> 13) & ~3;
139
140			c = __vlibm_TBL_sincos_hi[j+1];
141			tc = __vlibm_TBL_sincos_lo[j+1] - (__vlibm_TBL_sincos_hi[j] * w - c * t);
142			c += tc;
143
144			s = __vlibm_TBL_sincos_hi[j];
145			ts = (__vlibm_TBL_sincos_hi[j+1] * w + s * t) + __vlibm_TBL_sincos_lo[j];
146			s += ts;
147		}
148		if (xsb) {
149			s = -s;
150		}
151
152		switch (nx & 3) {
153		case 0:
154			*ss = s;
155			*cc = c;
156			break;
157
158		case 1:
159			*ss = c;
160			*cc = -s;
161			break;
162
163		case 2:
164			*ss = -s;
165			*cc = -c;
166			break;
167
168		case 3:
169			*ss = -c;
170			*cc = s;
171			break;
172		}
173	}
174}
175