1/***********************************************************************
2Copyright (c) 2006-2011, Skype Limited. All rights reserved.
3Copyright (c) 2013       Parrot
4Redistribution and use in source and binary forms, with or without
5modification, are permitted provided that the following conditions
6are met:
7- Redistributions of source code must retain the above copyright notice,
8this list of conditions and the following disclaimer.
9- Redistributions in binary form must reproduce the above copyright
10notice, this list of conditions and the following disclaimer in the
11documentation and/or other materials provided with the distribution.
12- Neither the name of Internet Society, IETF or IETF Trust, nor the
13names of specific contributors, may be used to endorse or promote
14products derived from this software without specific prior written
15permission.
16THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
17AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
20LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26POSSIBILITY OF SUCH DAMAGE.
27***********************************************************************/
28
29#ifndef SILK_MACROS_ARMv5E_H
30#define SILK_MACROS_ARMv5E_H
31
32/* (a32 * (opus_int32)((opus_int16)(b32))) >> 16 output have to be 32bit int */
33#undef silk_SMULWB
34static OPUS_INLINE opus_int32 silk_SMULWB_armv5e(opus_int32 a, opus_int16 b)
35{
36  int res;
37  __asm__(
38      "#silk_SMULWB\n\t"
39      "smulwb %0, %1, %2\n\t"
40      : "=r"(res)
41      : "r"(a), "r"(b)
42  );
43  return res;
44}
45#define silk_SMULWB(a, b) (silk_SMULWB_armv5e(a, b))
46
47/* a32 + (b32 * (opus_int32)((opus_int16)(c32))) >> 16 output have to be 32bit int */
48#undef silk_SMLAWB
49static OPUS_INLINE opus_int32 silk_SMLAWB_armv5e(opus_int32 a, opus_int32 b,
50 opus_int16 c)
51{
52  int res;
53  __asm__(
54      "#silk_SMLAWB\n\t"
55      "smlawb %0, %1, %2, %3\n\t"
56      : "=r"(res)
57      : "r"(b), "r"(c), "r"(a)
58  );
59  return res;
60}
61#define silk_SMLAWB(a, b, c) (silk_SMLAWB_armv5e(a, b, c))
62
63/* (a32 * (b32 >> 16)) >> 16 */
64#undef silk_SMULWT
65static OPUS_INLINE opus_int32 silk_SMULWT_armv5e(opus_int32 a, opus_int32 b)
66{
67  int res;
68  __asm__(
69      "#silk_SMULWT\n\t"
70      "smulwt %0, %1, %2\n\t"
71      : "=r"(res)
72      : "r"(a), "r"(b)
73  );
74  return res;
75}
76#define silk_SMULWT(a, b) (silk_SMULWT_armv5e(a, b))
77
78/* a32 + (b32 * (c32 >> 16)) >> 16 */
79#undef silk_SMLAWT
80static OPUS_INLINE opus_int32 silk_SMLAWT_armv5e(opus_int32 a, opus_int32 b,
81 opus_int32 c)
82{
83  int res;
84  __asm__(
85      "#silk_SMLAWT\n\t"
86      "smlawt %0, %1, %2, %3\n\t"
87      : "=r"(res)
88      : "r"(b), "r"(c), "r"(a)
89  );
90  return res;
91}
92#define silk_SMLAWT(a, b, c) (silk_SMLAWT_armv5e(a, b, c))
93
94/* (opus_int32)((opus_int16)(a3))) * (opus_int32)((opus_int16)(b32)) output have to be 32bit int */
95#undef silk_SMULBB
96static OPUS_INLINE opus_int32 silk_SMULBB_armv5e(opus_int32 a, opus_int32 b)
97{
98  int res;
99  __asm__(
100      "#silk_SMULBB\n\t"
101      "smulbb %0, %1, %2\n\t"
102      : "=r"(res)
103      : "%r"(a), "r"(b)
104  );
105  return res;
106}
107#define silk_SMULBB(a, b) (silk_SMULBB_armv5e(a, b))
108
109/* a32 + (opus_int32)((opus_int16)(b32)) * (opus_int32)((opus_int16)(c32)) output have to be 32bit int */
110#undef silk_SMLABB
111static OPUS_INLINE opus_int32 silk_SMLABB_armv5e(opus_int32 a, opus_int32 b,
112 opus_int32 c)
113{
114  int res;
115  __asm__(
116      "#silk_SMLABB\n\t"
117      "smlabb %0, %1, %2, %3\n\t"
118      : "=r"(res)
119      : "%r"(b), "r"(c), "r"(a)
120  );
121  return res;
122}
123#define silk_SMLABB(a, b, c) (silk_SMLABB_armv5e(a, b, c))
124
125/* (opus_int32)((opus_int16)(a32)) * (b32 >> 16) */
126#undef silk_SMULBT
127static OPUS_INLINE opus_int32 silk_SMULBT_armv5e(opus_int32 a, opus_int32 b)
128{
129  int res;
130  __asm__(
131      "#silk_SMULBT\n\t"
132      "smulbt %0, %1, %2\n\t"
133      : "=r"(res)
134      : "r"(a), "r"(b)
135  );
136  return res;
137}
138#define silk_SMULBT(a, b) (silk_SMULBT_armv5e(a, b))
139
140/* a32 + (opus_int32)((opus_int16)(b32)) * (c32 >> 16) */
141#undef silk_SMLABT
142static OPUS_INLINE opus_int32 silk_SMLABT_armv5e(opus_int32 a, opus_int32 b,
143 opus_int32 c)
144{
145  int res;
146  __asm__(
147      "#silk_SMLABT\n\t"
148      "smlabt %0, %1, %2, %3\n\t"
149      : "=r"(res)
150      : "r"(b), "r"(c), "r"(a)
151  );
152  return res;
153}
154#define silk_SMLABT(a, b, c) (silk_SMLABT_armv5e(a, b, c))
155
156/* add/subtract with output saturated */
157#undef silk_ADD_SAT32
158static OPUS_INLINE opus_int32 silk_ADD_SAT32_armv5e(opus_int32 a, opus_int32 b)
159{
160  int res;
161  __asm__(
162      "#silk_ADD_SAT32\n\t"
163      "qadd %0, %1, %2\n\t"
164      : "=r"(res)
165      : "%r"(a), "r"(b)
166  );
167  return res;
168}
169#define silk_ADD_SAT32(a, b) (silk_ADD_SAT32_armv5e(a, b))
170
171#undef silk_SUB_SAT32
172static OPUS_INLINE opus_int32 silk_SUB_SAT32_armv5e(opus_int32 a, opus_int32 b)
173{
174  int res;
175  __asm__(
176      "#silk_SUB_SAT32\n\t"
177      "qsub %0, %1, %2\n\t"
178      : "=r"(res)
179      : "r"(a), "r"(b)
180  );
181  return res;
182}
183#define silk_SUB_SAT32(a, b) (silk_SUB_SAT32_armv5e(a, b))
184
185#undef silk_CLZ16
186static OPUS_INLINE opus_int32 silk_CLZ16_armv5(opus_int16 in16)
187{
188  int res;
189  __asm__(
190      "#silk_CLZ16\n\t"
191      "clz %0, %1;\n"
192      : "=r"(res)
193      : "r"(in16<<16|0x8000)
194  );
195  return res;
196}
197#define silk_CLZ16(in16) (silk_CLZ16_armv5(in16))
198
199#undef silk_CLZ32
200static OPUS_INLINE opus_int32 silk_CLZ32_armv5(opus_int32 in32)
201{
202  int res;
203  __asm__(
204      "#silk_CLZ32\n\t"
205      "clz %0, %1\n\t"
206      : "=r"(res)
207      : "r"(in32)
208  );
209  return res;
210}
211#define silk_CLZ32(in32) (silk_CLZ32_armv5(in32))
212
213#endif /* SILK_MACROS_ARMv5E_H */
214