cannam@154
|
1 /* Copyright (C) 2007-2009 Xiph.Org Foundation
|
cannam@154
|
2 Copyright (C) 2003-2008 Jean-Marc Valin
|
cannam@154
|
3 Copyright (C) 2007-2008 CSIRO */
|
cannam@154
|
4 /**
|
cannam@154
|
5 @file fixed_generic.h
|
cannam@154
|
6 @brief Generic fixed-point operations
|
cannam@154
|
7 */
|
cannam@154
|
8 /*
|
cannam@154
|
9 Redistribution and use in source and binary forms, with or without
|
cannam@154
|
10 modification, are permitted provided that the following conditions
|
cannam@154
|
11 are met:
|
cannam@154
|
12
|
cannam@154
|
13 - Redistributions of source code must retain the above copyright
|
cannam@154
|
14 notice, this list of conditions and the following disclaimer.
|
cannam@154
|
15
|
cannam@154
|
16 - Redistributions in binary form must reproduce the above copyright
|
cannam@154
|
17 notice, this list of conditions and the following disclaimer in the
|
cannam@154
|
18 documentation and/or other materials provided with the distribution.
|
cannam@154
|
19
|
cannam@154
|
20 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
cannam@154
|
21 ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
cannam@154
|
22 LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
cannam@154
|
23 A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
|
cannam@154
|
24 OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
cannam@154
|
25 EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
cannam@154
|
26 PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
cannam@154
|
27 PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
cannam@154
|
28 LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
cannam@154
|
29 NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
cannam@154
|
30 SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
cannam@154
|
31 */
|
cannam@154
|
32
|
cannam@154
|
33 #ifndef CELT_FIXED_GENERIC_MIPSR1_H
|
cannam@154
|
34 #define CELT_FIXED_GENERIC_MIPSR1_H
|
cannam@154
|
35
|
cannam@154
|
36 #undef MULT16_32_Q15_ADD
|
cannam@154
|
37 static inline int MULT16_32_Q15_ADD(int a, int b, int c, int d) {
|
cannam@154
|
38 int m;
|
cannam@154
|
39 asm volatile("MULT $ac1, %0, %1" : : "r" ((int)a), "r" ((int)b));
|
cannam@154
|
40 asm volatile("madd $ac1, %0, %1" : : "r" ((int)c), "r" ((int)d));
|
cannam@154
|
41 asm volatile("EXTR.W %0,$ac1, %1" : "=r" (m): "i" (15));
|
cannam@154
|
42 return m;
|
cannam@154
|
43 }
|
cannam@154
|
44
|
cannam@154
|
45 #undef MULT16_32_Q15_SUB
|
cannam@154
|
46 static inline int MULT16_32_Q15_SUB(int a, int b, int c, int d) {
|
cannam@154
|
47 int m;
|
cannam@154
|
48 asm volatile("MULT $ac1, %0, %1" : : "r" ((int)a), "r" ((int)b));
|
cannam@154
|
49 asm volatile("msub $ac1, %0, %1" : : "r" ((int)c), "r" ((int)d));
|
cannam@154
|
50 asm volatile("EXTR.W %0,$ac1, %1" : "=r" (m): "i" (15));
|
cannam@154
|
51 return m;
|
cannam@154
|
52 }
|
cannam@154
|
53
|
cannam@154
|
54 #undef MULT16_16_Q15_ADD
|
cannam@154
|
55 static inline int MULT16_16_Q15_ADD(int a, int b, int c, int d) {
|
cannam@154
|
56 int m;
|
cannam@154
|
57 asm volatile("MULT $ac1, %0, %1" : : "r" ((int)a), "r" ((int)b));
|
cannam@154
|
58 asm volatile("madd $ac1, %0, %1" : : "r" ((int)c), "r" ((int)d));
|
cannam@154
|
59 asm volatile("EXTR.W %0,$ac1, %1" : "=r" (m): "i" (15));
|
cannam@154
|
60 return m;
|
cannam@154
|
61 }
|
cannam@154
|
62
|
cannam@154
|
63 #undef MULT16_16_Q15_SUB
|
cannam@154
|
64 static inline int MULT16_16_Q15_SUB(int a, int b, int c, int d) {
|
cannam@154
|
65 int m;
|
cannam@154
|
66 asm volatile("MULT $ac1, %0, %1" : : "r" ((int)a), "r" ((int)b));
|
cannam@154
|
67 asm volatile("msub $ac1, %0, %1" : : "r" ((int)c), "r" ((int)d));
|
cannam@154
|
68 asm volatile("EXTR.W %0,$ac1, %1" : "=r" (m): "i" (15));
|
cannam@154
|
69 return m;
|
cannam@154
|
70 }
|
cannam@154
|
71
|
cannam@154
|
72
|
cannam@154
|
73 #undef MULT16_32_Q16
|
cannam@154
|
74 static inline int MULT16_32_Q16(int a, int b)
|
cannam@154
|
75 {
|
cannam@154
|
76 int c;
|
cannam@154
|
77 asm volatile("MULT $ac1,%0, %1" : : "r" (a), "r" (b));
|
cannam@154
|
78 asm volatile("EXTR.W %0,$ac1, %1" : "=r" (c): "i" (16));
|
cannam@154
|
79 return c;
|
cannam@154
|
80 }
|
cannam@154
|
81
|
cannam@154
|
82 #undef MULT16_32_P16
|
cannam@154
|
83 static inline int MULT16_32_P16(int a, int b)
|
cannam@154
|
84 {
|
cannam@154
|
85 int c;
|
cannam@154
|
86 asm volatile("MULT $ac1, %0, %1" : : "r" (a), "r" (b));
|
cannam@154
|
87 asm volatile("EXTR_R.W %0,$ac1, %1" : "=r" (c): "i" (16));
|
cannam@154
|
88 return c;
|
cannam@154
|
89 }
|
cannam@154
|
90
|
cannam@154
|
91 #undef MULT16_32_Q15
|
cannam@154
|
92 static inline int MULT16_32_Q15(int a, int b)
|
cannam@154
|
93 {
|
cannam@154
|
94 int c;
|
cannam@154
|
95 asm volatile("MULT $ac1, %0, %1" : : "r" (a), "r" (b));
|
cannam@154
|
96 asm volatile("EXTR.W %0,$ac1, %1" : "=r" (c): "i" (15));
|
cannam@154
|
97 return c;
|
cannam@154
|
98 }
|
cannam@154
|
99
|
cannam@154
|
100 #undef MULT32_32_Q31
|
cannam@154
|
101 static inline int MULT32_32_Q31(int a, int b)
|
cannam@154
|
102 {
|
cannam@154
|
103 int r;
|
cannam@154
|
104 asm volatile("MULT $ac1, %0, %1" : : "r" (a), "r" (b));
|
cannam@154
|
105 asm volatile("EXTR.W %0,$ac1, %1" : "=r" (r): "i" (31));
|
cannam@154
|
106 return r;
|
cannam@154
|
107 }
|
cannam@154
|
108
|
cannam@154
|
109 #undef PSHR32
|
cannam@154
|
110 static inline int PSHR32(int a, int shift)
|
cannam@154
|
111 {
|
cannam@154
|
112 int r;
|
cannam@154
|
113 asm volatile ("SHRAV_R.W %0, %1, %2" :"=r" (r): "r" (a), "r" (shift));
|
cannam@154
|
114 return r;
|
cannam@154
|
115 }
|
cannam@154
|
116
|
cannam@154
|
117 #undef MULT16_16_P15
|
cannam@154
|
118 static inline int MULT16_16_P15(int a, int b)
|
cannam@154
|
119 {
|
cannam@154
|
120 int r;
|
cannam@154
|
121 asm volatile ("mul %0, %1, %2" :"=r" (r): "r" (a), "r" (b));
|
cannam@154
|
122 asm volatile ("SHRA_R.W %0, %1, %2" : "+r" (r): "0" (r), "i"(15));
|
cannam@154
|
123 return r;
|
cannam@154
|
124 }
|
cannam@154
|
125
|
cannam@154
|
126 #endif /* CELT_FIXED_GENERIC_MIPSR1_H */
|