1 /*****************************************************************************
2 *
3 * Copyright (c) 2008-2010, CoreCodec, Inc.
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions are met:
8 * * Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * * Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 * * Neither the name of CoreCodec, Inc. nor the
14 * names of its contributors may be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY CoreCodec, Inc. ``AS IS'' AND ANY
18 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
19 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
20 * DISCLAIMED. IN NO EVENT SHALL CoreCodec, Inc. BE LIABLE FOR ANY
21 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
22 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
23 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
24 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
26 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 ****************************************************************************/
29
30 #include "corec/corec.h"
31
32 #define PI 3.14159265358979324
33
34 NOINLINE double floor(double i);
ceil(double i)35 NOINLINE double ceil(double i)
36 {
37 if (i<0)
38 return -floor(-i);
39 else
40 {
41 double d = floor(i);
42 if (d!=i)
43 d+=1.0;
44 return d;
45 }
46 }
47
floor(double i)48 NOINLINE double floor(double i)
49 {
50 if (i<0)
51 return -ceil(-i);
52 else
53 return (double)(int)i;
54 }
55
sin(double i)56 NOINLINE double sin(double i)
57 {
58 int n,k;
59 double j,sum;
60 int sign = 0;
61
62 if (i<0)
63 {
64 sign = 1;
65 i = -i;
66 }
67
68 i *= 1.0/(2*PI);
69 i -= floor(i);
70 if (i>=0.5)
71 {
72 i -= 0.5;
73 sign ^= 1;
74 }
75
76 i *= 2*PI;
77 k = 1;
78 j = sum = i;
79 for (n=3;n<14;n+=2)
80 {
81 k *= (n-1)*n;
82 j *= i*i;
83 if (n & 2)
84 sum -= j/k;
85 else
86 sum += j/k;
87 }
88
89 return sign ? -sum:sum;
90 }
91
cos(double i)92 NOINLINE double cos(double i)
93 {
94 return sin(i+PI/2);
95 }
96