1 /* --------------------------------------------------------------  */
2 /* (C)Copyright 2001,2008,                                         */
3 /* International Business Machines Corporation,                    */
4 /* Sony Computer Entertainment, Incorporated,                      */
5 /* Toshiba Corporation,                                            */
6 /*                                                                 */
7 /* All Rights Reserved.                                            */
8 /*                                                                 */
9 /* Redistribution and use in source and binary forms, with or      */
10 /* without modification, are permitted provided that the           */
11 /* following conditions are met:                                   */
12 /*                                                                 */
13 /* - Redistributions of source code must retain the above copyright*/
14 /*   notice, this list of conditions and the following disclaimer. */
15 /*                                                                 */
16 /* - Redistributions in binary form must reproduce the above       */
17 /*   copyright notice, this list of conditions and the following   */
18 /*   disclaimer in the documentation and/or other materials        */
19 /*   provided with the distribution.                               */
20 /*                                                                 */
21 /* - Neither the name of IBM Corporation nor the names of its      */
22 /*   contributors may be used to endorse or promote products       */
23 /*   derived from this software without specific prior written     */
24 /*   permission.                                                   */
25 /*                                                                 */
26 /* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND          */
27 /* CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,     */
28 /* INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF        */
29 /* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE        */
30 /* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR            */
31 /* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,    */
32 /* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT    */
33 /* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;    */
34 /* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)        */
35 /* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN       */
36 /* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR    */
37 /* OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,  */
38 /* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.              */
39 /* --------------------------------------------------------------  */
40 /* PROLOG END TAG zYx                                              */
41 #ifdef __SPU__
42 
43 #ifndef _COSD2_H_
44 #define _COSD2_H_	1
45 
46 #include <spu_intrinsics.h>
47 
48 #include "cos_sin.h"
49 
50 /*
51  * FUNCTION
52  *	vector double _cosd2(vector double angle)
53  *
54  * DESCRIPTION
55  *	_cosd2 computes the cosine of a vector of angles (expressed
56  *	in radians) to an accuracy of a double precision floating point.
57  */
_cosd2(vector double angle)58 static __inline vector double _cosd2(vector double angle)
59 {
60   vec_int4    octant;
61   vec_ullong2 select;
62   vec_double2 cos, sin;
63   vec_double2 toggle_sign, answer;
64 
65   /* Range reduce the input angle x into the range -PI/4 to PI/4
66    * by performing simple modulus.
67    */
68   MOD_PI_OVER_FOUR(angle, octant);
69 
70   /* Compute the cosine and sine of the range reduced input.
71    */
72   COMPUTE_COS_SIN(angle, cos, sin);
73 
74   /* For each SIMD element, select which result (cos or sin) to use
75    * with a sign correction depending upon the octant of the original
76    * angle (Maclaurin series).
77    *
78    *   octants      angles     select  sign toggle
79    *   -------   ------------  ------  -----------
80    *     0          0 to 45     cos        no
81    *    1,2        45 to 135    sin        yes
82    *    3,4       135 to 225    cos        yes
83    *    5,6       225 to 315    sin        no
84    *     7        315 to 360    cos        no
85    */
86   octant = spu_shuffle(octant, octant, ((vec_uchar16) { 0,1, 2, 3, 0,1, 2, 3, 8,9,10,11, 8,9,10,11 }));
87 
88   toggle_sign = (vec_double2)spu_sl(spu_and(spu_add(octant, 2), 4), ((vec_uint4) { 29,32,29,32 }));
89   select = (vec_ullong2)spu_cmpeq(spu_and(octant, 2), 0);
90 
91   answer = spu_xor(spu_sel(sin, cos, select), toggle_sign);
92 
93   return (answer);
94 }
95 
96 #endif /* _COSD2_H_ */
97 #endif /* __SPU__ */
98