125c28e83SPiotr Jasiukajtis /*
225c28e83SPiotr Jasiukajtis * CDDL HEADER START
325c28e83SPiotr Jasiukajtis *
425c28e83SPiotr Jasiukajtis * The contents of this file are subject to the terms of the
525c28e83SPiotr Jasiukajtis * Common Development and Distribution License (the "License").
625c28e83SPiotr Jasiukajtis * You may not use this file except in compliance with the License.
725c28e83SPiotr Jasiukajtis *
825c28e83SPiotr Jasiukajtis * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
925c28e83SPiotr Jasiukajtis * or http://www.opensolaris.org/os/licensing.
1025c28e83SPiotr Jasiukajtis * See the License for the specific language governing permissions
1125c28e83SPiotr Jasiukajtis * and limitations under the License.
1225c28e83SPiotr Jasiukajtis *
1325c28e83SPiotr Jasiukajtis * When distributing Covered Code, include this CDDL HEADER in each
1425c28e83SPiotr Jasiukajtis * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
1525c28e83SPiotr Jasiukajtis * If applicable, add the following below this CDDL HEADER, with the
1625c28e83SPiotr Jasiukajtis * fields enclosed by brackets "[]" replaced with your own identifying
1725c28e83SPiotr Jasiukajtis * information: Portions Copyright [yyyy] [name of copyright owner]
1825c28e83SPiotr Jasiukajtis *
1925c28e83SPiotr Jasiukajtis * CDDL HEADER END
2025c28e83SPiotr Jasiukajtis */
2125c28e83SPiotr Jasiukajtis /*
2225c28e83SPiotr Jasiukajtis * Copyright 2011 Nexenta Systems, Inc. All rights reserved.
2325c28e83SPiotr Jasiukajtis */
2425c28e83SPiotr Jasiukajtis /*
2525c28e83SPiotr Jasiukajtis * Copyright 2005 Sun Microsystems, Inc. All rights reserved.
2625c28e83SPiotr Jasiukajtis * Use is subject to license terms.
2725c28e83SPiotr Jasiukajtis */
2825c28e83SPiotr Jasiukajtis
29*ddc0e0b5SRichard Lowe #pragma weak __cos = cos
3025c28e83SPiotr Jasiukajtis
3125c28e83SPiotr Jasiukajtis /* INDENT OFF */
3225c28e83SPiotr Jasiukajtis /*
3325c28e83SPiotr Jasiukajtis * cos(x)
3425c28e83SPiotr Jasiukajtis * Accurate Table look-up algorithm by K.C. Ng, May, 1995.
3525c28e83SPiotr Jasiukajtis *
3625c28e83SPiotr Jasiukajtis * Algorithm: see sincos.c
3725c28e83SPiotr Jasiukajtis */
3825c28e83SPiotr Jasiukajtis
3925c28e83SPiotr Jasiukajtis #include "libm.h"
4025c28e83SPiotr Jasiukajtis
4125c28e83SPiotr Jasiukajtis static const double sc[] = {
4225c28e83SPiotr Jasiukajtis /* ONE = */ 1.0,
4325c28e83SPiotr Jasiukajtis /* NONE = */ -1.0,
4425c28e83SPiotr Jasiukajtis /*
4525c28e83SPiotr Jasiukajtis * |sin(x) - (x+pp1*x^3+pp2*x^5)| <= 2^-58.79 for |x| < 0.008
4625c28e83SPiotr Jasiukajtis */
4725c28e83SPiotr Jasiukajtis /* PP1 = */ -0.166666666666316558867252052378889521480627858683055567,
4825c28e83SPiotr Jasiukajtis /* PP2 = */ .008333315652997472323564894248466758248475374977974017927,
4925c28e83SPiotr Jasiukajtis /*
5025c28e83SPiotr Jasiukajtis * |(sin(x) - (x+p1*x^3+...+p4*x^9)|
5125c28e83SPiotr Jasiukajtis * |------------------------------ | <= 2^-57.63 for |x| < 0.1953125
5225c28e83SPiotr Jasiukajtis * | x |
5325c28e83SPiotr Jasiukajtis */
5425c28e83SPiotr Jasiukajtis /* P1 = */ -1.666666666666629669805215138920301589656e-0001,
5525c28e83SPiotr Jasiukajtis /* P2 = */ 8.333333332390951295683993455280336376663e-0003,
5625c28e83SPiotr Jasiukajtis /* P3 = */ -1.984126237997976692791551778230098403960e-0004,
5725c28e83SPiotr Jasiukajtis /* P4 = */ 2.753403624854277237649987622848330351110e-0006,
5825c28e83SPiotr Jasiukajtis /*
5925c28e83SPiotr Jasiukajtis * |cos(x) - (1+qq1*x^2+qq2*x^4)| <= 2^-55.99 for |x| <= 0.008 (0x3f80624d)
6025c28e83SPiotr Jasiukajtis */
6125c28e83SPiotr Jasiukajtis /* QQ1 = */ -0.4999999999975492381842911981948418542742729,
6225c28e83SPiotr Jasiukajtis /* QQ2 = */ 0.041666542904352059294545209158357640398771740,
6325c28e83SPiotr Jasiukajtis /* Q1 = */ -0.5,
6425c28e83SPiotr Jasiukajtis /* Q2 = */ 4.166666666500350703680945520860748617445e-0002,
6525c28e83SPiotr Jasiukajtis /* Q3 = */ -1.388888596436972210694266290577848696006e-0003,
6625c28e83SPiotr Jasiukajtis /* Q4 = */ 2.478563078858589473679519517892953492192e-0005,
6725c28e83SPiotr Jasiukajtis /* PIO2_H = */ 1.570796326794896557999,
6825c28e83SPiotr Jasiukajtis /* PIO2_L = */ 6.123233995736765886130e-17,
6925c28e83SPiotr Jasiukajtis /* PIO2_L0 = */ 6.123233995727922165564e-17,
7025c28e83SPiotr Jasiukajtis /* PIO2_L1 = */ 8.843720566135701120255e-29,
7125c28e83SPiotr Jasiukajtis /* PI3O2_H = */ 4.712388980384689673997,
7225c28e83SPiotr Jasiukajtis /* PI3O2_L = */ 1.836970198721029765839e-16,
7325c28e83SPiotr Jasiukajtis /* PI3O2_L0 = */ 1.836970198720396133587e-16,
7425c28e83SPiotr Jasiukajtis /* PI3O2_L1 = */ 6.336322524749201142226e-29,
7525c28e83SPiotr Jasiukajtis /* PI5O2_H = */ 7.853981633974482789995,
7625c28e83SPiotr Jasiukajtis /* PI5O2_L = */ 3.061616997868382943065e-16,
7725c28e83SPiotr Jasiukajtis /* PI5O2_L0 = */ 3.061616997861941598865e-16,
7825c28e83SPiotr Jasiukajtis /* PI5O2_L1 = */ 6.441344200433640781982e-28,
7925c28e83SPiotr Jasiukajtis };
8025c28e83SPiotr Jasiukajtis /* INDENT ON */
8125c28e83SPiotr Jasiukajtis
8225c28e83SPiotr Jasiukajtis #define ONE sc[0]
8325c28e83SPiotr Jasiukajtis #define PP1 sc[2]
8425c28e83SPiotr Jasiukajtis #define PP2 sc[3]
8525c28e83SPiotr Jasiukajtis #define P1 sc[4]
8625c28e83SPiotr Jasiukajtis #define P2 sc[5]
8725c28e83SPiotr Jasiukajtis #define P3 sc[6]
8825c28e83SPiotr Jasiukajtis #define P4 sc[7]
8925c28e83SPiotr Jasiukajtis #define QQ1 sc[8]
9025c28e83SPiotr Jasiukajtis #define QQ2 sc[9]
9125c28e83SPiotr Jasiukajtis #define Q1 sc[10]
9225c28e83SPiotr Jasiukajtis #define Q2 sc[11]
9325c28e83SPiotr Jasiukajtis #define Q3 sc[12]
9425c28e83SPiotr Jasiukajtis #define Q4 sc[13]
9525c28e83SPiotr Jasiukajtis #define PIO2_H sc[14]
9625c28e83SPiotr Jasiukajtis #define PIO2_L sc[15]
9725c28e83SPiotr Jasiukajtis #define PIO2_L0 sc[16]
9825c28e83SPiotr Jasiukajtis #define PIO2_L1 sc[17]
9925c28e83SPiotr Jasiukajtis #define PI3O2_H sc[18]
10025c28e83SPiotr Jasiukajtis #define PI3O2_L sc[19]
10125c28e83SPiotr Jasiukajtis #define PI3O2_L0 sc[20]
10225c28e83SPiotr Jasiukajtis #define PI3O2_L1 sc[21]
10325c28e83SPiotr Jasiukajtis #define PI5O2_H sc[22]
10425c28e83SPiotr Jasiukajtis #define PI5O2_L sc[23]
10525c28e83SPiotr Jasiukajtis #define PI5O2_L0 sc[24]
10625c28e83SPiotr Jasiukajtis #define PI5O2_L1 sc[25]
10725c28e83SPiotr Jasiukajtis
10825c28e83SPiotr Jasiukajtis extern const double _TBL_sincos[], _TBL_sincosx[];
10925c28e83SPiotr Jasiukajtis
11025c28e83SPiotr Jasiukajtis double
cos(double x)11125c28e83SPiotr Jasiukajtis cos(double x) {
11225c28e83SPiotr Jasiukajtis double z, y[2], w, s, v, p, q;
11325c28e83SPiotr Jasiukajtis int i, j, n, hx, ix, lx;
11425c28e83SPiotr Jasiukajtis
11525c28e83SPiotr Jasiukajtis hx = ((int *)&x)[HIWORD];
11625c28e83SPiotr Jasiukajtis lx = ((int *)&x)[LOWORD];
11725c28e83SPiotr Jasiukajtis ix = hx & ~0x80000000;
11825c28e83SPiotr Jasiukajtis
11925c28e83SPiotr Jasiukajtis if (ix <= 0x3fc50000) { /* |x| < 10.5/64 = 0.164062500 */
12025c28e83SPiotr Jasiukajtis if (ix < 0x3e400000) { /* |x| < 2**-27 */
12125c28e83SPiotr Jasiukajtis if ((int)x == 0)
12225c28e83SPiotr Jasiukajtis return (ONE);
12325c28e83SPiotr Jasiukajtis }
12425c28e83SPiotr Jasiukajtis z = x * x;
12525c28e83SPiotr Jasiukajtis if (ix < 0x3f800000) /* |x| < 0.008 */
12625c28e83SPiotr Jasiukajtis w = z * (QQ1 + z * QQ2);
12725c28e83SPiotr Jasiukajtis else
12825c28e83SPiotr Jasiukajtis w = z * ((Q1 + z * Q2) + (z * z) * (Q3 + z * Q4));
12925c28e83SPiotr Jasiukajtis return (ONE + w);
13025c28e83SPiotr Jasiukajtis }
13125c28e83SPiotr Jasiukajtis
13225c28e83SPiotr Jasiukajtis /* for 0.164062500 < x < M, */
13325c28e83SPiotr Jasiukajtis n = ix >> 20;
13425c28e83SPiotr Jasiukajtis if (n < 0x402) { /* x < 8 */
13525c28e83SPiotr Jasiukajtis i = (((ix >> 12) & 0xff) | 0x100) >> (0x401 - n);
13625c28e83SPiotr Jasiukajtis j = i - 10;
13725c28e83SPiotr Jasiukajtis x = fabs(x);
13825c28e83SPiotr Jasiukajtis v = x - _TBL_sincosx[j];
13925c28e83SPiotr Jasiukajtis if (((j - 81) ^ (j - 101)) < 0) {
14025c28e83SPiotr Jasiukajtis /* near pi/2, cos(pi/2-x)=sin(x) */
14125c28e83SPiotr Jasiukajtis p = PIO2_H - x;
14225c28e83SPiotr Jasiukajtis i = ix - 0x3ff921fb;
14325c28e83SPiotr Jasiukajtis x = p + PIO2_L;
14425c28e83SPiotr Jasiukajtis if ((i | ((lx - 0x54442D00) & 0xffffff00)) == 0) {
14525c28e83SPiotr Jasiukajtis /* very close to pi/2 */
14625c28e83SPiotr Jasiukajtis x = p + PIO2_L0;
14725c28e83SPiotr Jasiukajtis return (x + PIO2_L1);
14825c28e83SPiotr Jasiukajtis }
14925c28e83SPiotr Jasiukajtis z = x * x;
15025c28e83SPiotr Jasiukajtis if (((ix - 0x3ff92000) >> 12) == 0) {
15125c28e83SPiotr Jasiukajtis /* |pi/2-x|<2**-8 */
15225c28e83SPiotr Jasiukajtis w = PIO2_L + (z * x) * (PP1 + z * PP2);
15325c28e83SPiotr Jasiukajtis } else {
15425c28e83SPiotr Jasiukajtis w = PIO2_L + (z * x) * ((P1 + z * P2) +
15525c28e83SPiotr Jasiukajtis (z * z) * (P3 + z * P4));
15625c28e83SPiotr Jasiukajtis }
15725c28e83SPiotr Jasiukajtis return (p + w);
15825c28e83SPiotr Jasiukajtis }
15925c28e83SPiotr Jasiukajtis s = v * v;
16025c28e83SPiotr Jasiukajtis if (((j - 282) ^ (j - 302)) < 0) {
16125c28e83SPiotr Jasiukajtis /* near 3/2pi, cos(x-3/2pi)=sin(x) */
16225c28e83SPiotr Jasiukajtis p = x - PI3O2_H;
16325c28e83SPiotr Jasiukajtis i = ix - 0x4012D97C;
16425c28e83SPiotr Jasiukajtis x = p - PI3O2_L;
16525c28e83SPiotr Jasiukajtis if ((i | ((lx - 0x7f332100) & 0xffffff00)) == 0) {
16625c28e83SPiotr Jasiukajtis /* very close to 3/2pi */
16725c28e83SPiotr Jasiukajtis x = p - PI3O2_L0;
16825c28e83SPiotr Jasiukajtis return (x - PI3O2_L1);
16925c28e83SPiotr Jasiukajtis }
17025c28e83SPiotr Jasiukajtis z = x * x;
17125c28e83SPiotr Jasiukajtis if (((ix - 0x4012D800) >> 9) == 0) {
17225c28e83SPiotr Jasiukajtis /* |x-3/2pi|<2**-8 */
17325c28e83SPiotr Jasiukajtis w = (z * x) * (PP1 + z * PP2) - PI3O2_L;
17425c28e83SPiotr Jasiukajtis } else {
17525c28e83SPiotr Jasiukajtis w = (z * x) * ((P1 + z * P2) + (z * z)
17625c28e83SPiotr Jasiukajtis * (P3 + z * P4)) - PI3O2_L;
17725c28e83SPiotr Jasiukajtis }
17825c28e83SPiotr Jasiukajtis return (p + w);
17925c28e83SPiotr Jasiukajtis }
18025c28e83SPiotr Jasiukajtis if (((j - 483) ^ (j - 503)) < 0) {
18125c28e83SPiotr Jasiukajtis /* near 5pi/2, cos(5pi/2-x)=sin(x) */
18225c28e83SPiotr Jasiukajtis p = PI5O2_H - x;
18325c28e83SPiotr Jasiukajtis i = ix - 0x401F6A7A;
18425c28e83SPiotr Jasiukajtis x = p + PI5O2_L;
18525c28e83SPiotr Jasiukajtis if ((i | ((lx - 0x29553800) & 0xffffff00)) == 0) {
18625c28e83SPiotr Jasiukajtis /* very close to pi/2 */
18725c28e83SPiotr Jasiukajtis x = p + PI5O2_L0;
18825c28e83SPiotr Jasiukajtis return (x + PI5O2_L1);
18925c28e83SPiotr Jasiukajtis }
19025c28e83SPiotr Jasiukajtis z = x * x;
19125c28e83SPiotr Jasiukajtis if (((ix - 0x401F6A7A) >> 7) == 0) {
19225c28e83SPiotr Jasiukajtis /* |pi/2-x|<2**-8 */
19325c28e83SPiotr Jasiukajtis w = PI5O2_L + (z * x) * (PP1 + z * PP2);
19425c28e83SPiotr Jasiukajtis } else {
19525c28e83SPiotr Jasiukajtis w = PI5O2_L + (z * x) * ((P1 + z * P2) +
19625c28e83SPiotr Jasiukajtis (z * z) * (P3 + z * P4));
19725c28e83SPiotr Jasiukajtis }
19825c28e83SPiotr Jasiukajtis return (p + w);
19925c28e83SPiotr Jasiukajtis }
20025c28e83SPiotr Jasiukajtis j <<= 1;
20125c28e83SPiotr Jasiukajtis w = _TBL_sincos[j];
20225c28e83SPiotr Jasiukajtis z = _TBL_sincos[j+1];
20325c28e83SPiotr Jasiukajtis p = v + (v * s) * (PP1 + s * PP2);
20425c28e83SPiotr Jasiukajtis q = s * (QQ1 + s * QQ2);
20525c28e83SPiotr Jasiukajtis return (z - (w * p - z * q));
20625c28e83SPiotr Jasiukajtis }
20725c28e83SPiotr Jasiukajtis
20825c28e83SPiotr Jasiukajtis if (ix >= 0x7ff00000) /* cos(Inf or NaN) is NaN */
20925c28e83SPiotr Jasiukajtis return (x / x);
21025c28e83SPiotr Jasiukajtis
21125c28e83SPiotr Jasiukajtis /* argument reduction needed */
21225c28e83SPiotr Jasiukajtis n = __rem_pio2(x, y);
21325c28e83SPiotr Jasiukajtis switch (n & 3) {
21425c28e83SPiotr Jasiukajtis case 0:
21525c28e83SPiotr Jasiukajtis return (__k_cos(y[0], y[1]));
21625c28e83SPiotr Jasiukajtis case 1:
21725c28e83SPiotr Jasiukajtis return (-__k_sin(y[0], y[1]));
21825c28e83SPiotr Jasiukajtis case 2:
21925c28e83SPiotr Jasiukajtis return (-__k_cos(y[0], y[1]));
22025c28e83SPiotr Jasiukajtis default:
22125c28e83SPiotr Jasiukajtis return (__k_sin(y[0], y[1]));
22225c28e83SPiotr Jasiukajtis }
22325c28e83SPiotr Jasiukajtis }
224