|
1 /*********************************************************************** |
|
2 Copyright (c) 2006-2011, Skype Limited. All rights reserved. |
|
3 Copyright (C) 2012 Xiph.Org Foundation |
|
4 Redistribution and use in source and binary forms, with or without |
|
5 modification, are permitted provided that the following conditions |
|
6 are met: |
|
7 - Redistributions of source code must retain the above copyright notice, |
|
8 this list of conditions and the following disclaimer. |
|
9 - Redistributions in binary form must reproduce the above copyright |
|
10 notice, this list of conditions and the following disclaimer in the |
|
11 documentation and/or other materials provided with the distribution. |
|
12 - Neither the name of Internet Society, IETF or IETF Trust, nor the |
|
13 names of specific contributors, may be used to endorse or promote |
|
14 products derived from this software without specific prior written |
|
15 permission. |
|
16 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
|
17 AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
|
18 IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
|
19 ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
|
20 LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
|
21 CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
|
22 SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
|
23 INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
|
24 CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
|
25 ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
|
26 POSSIBILITY OF SUCH DAMAGE. |
|
27 ***********************************************************************/ |
|
28 |
|
29 #ifndef MACRO_DEBUG_H |
|
30 #define MACRO_DEBUG_H |
|
31 |
|
32 /* Redefine macro functions with extensive assertion in DEBUG mode. |
|
33 As functions can't be undefined, this file can't work with SigProcFIX_MacroCount.h */ |
|
34 |
|
35 #if ( defined (FIXED_DEBUG) || ( 0 && defined (_DEBUG) ) ) && !defined (silk_MACRO_COUNT) |
|
36 |
|
37 #undef silk_ADD16 |
|
38 #define silk_ADD16(a,b) silk_ADD16_((a), (b), __FILE__, __LINE__) |
|
39 static OPUS_INLINE opus_int16 silk_ADD16_(opus_int16 a, opus_int16 b, char *file, int line){ |
|
40 opus_int16 ret; |
|
41 |
|
42 ret = a + b; |
|
43 if ( ret != silk_ADD_SAT16( a, b ) ) |
|
44 { |
|
45 fprintf (stderr, "silk_ADD16(%d, %d) in %s: line %d\n", a, b, file, line); |
|
46 #ifdef FIXED_DEBUG_ASSERT |
|
47 silk_assert( 0 ); |
|
48 #endif |
|
49 } |
|
50 return ret; |
|
51 } |
|
52 |
|
53 #undef silk_ADD32 |
|
54 #define silk_ADD32(a,b) silk_ADD32_((a), (b), __FILE__, __LINE__) |
|
55 static OPUS_INLINE opus_int32 silk_ADD32_(opus_int32 a, opus_int32 b, char *file, int line){ |
|
56 opus_int32 ret; |
|
57 |
|
58 ret = a + b; |
|
59 if ( ret != silk_ADD_SAT32( a, b ) ) |
|
60 { |
|
61 fprintf (stderr, "silk_ADD32(%d, %d) in %s: line %d\n", a, b, file, line); |
|
62 #ifdef FIXED_DEBUG_ASSERT |
|
63 silk_assert( 0 ); |
|
64 #endif |
|
65 } |
|
66 return ret; |
|
67 } |
|
68 |
|
69 #undef silk_ADD64 |
|
70 #define silk_ADD64(a,b) silk_ADD64_((a), (b), __FILE__, __LINE__) |
|
71 static OPUS_INLINE opus_int64 silk_ADD64_(opus_int64 a, opus_int64 b, char *file, int line){ |
|
72 opus_int64 ret; |
|
73 |
|
74 ret = a + b; |
|
75 if ( ret != silk_ADD_SAT64( a, b ) ) |
|
76 { |
|
77 fprintf (stderr, "silk_ADD64(%lld, %lld) in %s: line %d\n", (long long)a, (long long)b, file, line); |
|
78 #ifdef FIXED_DEBUG_ASSERT |
|
79 silk_assert( 0 ); |
|
80 #endif |
|
81 } |
|
82 return ret; |
|
83 } |
|
84 |
|
85 #undef silk_SUB16 |
|
86 #define silk_SUB16(a,b) silk_SUB16_((a), (b), __FILE__, __LINE__) |
|
87 static OPUS_INLINE opus_int16 silk_SUB16_(opus_int16 a, opus_int16 b, char *file, int line){ |
|
88 opus_int16 ret; |
|
89 |
|
90 ret = a - b; |
|
91 if ( ret != silk_SUB_SAT16( a, b ) ) |
|
92 { |
|
93 fprintf (stderr, "silk_SUB16(%d, %d) in %s: line %d\n", a, b, file, line); |
|
94 #ifdef FIXED_DEBUG_ASSERT |
|
95 silk_assert( 0 ); |
|
96 #endif |
|
97 } |
|
98 return ret; |
|
99 } |
|
100 |
|
101 #undef silk_SUB32 |
|
102 #define silk_SUB32(a,b) silk_SUB32_((a), (b), __FILE__, __LINE__) |
|
103 static OPUS_INLINE opus_int32 silk_SUB32_(opus_int32 a, opus_int32 b, char *file, int line){ |
|
104 opus_int32 ret; |
|
105 |
|
106 ret = a - b; |
|
107 if ( ret != silk_SUB_SAT32( a, b ) ) |
|
108 { |
|
109 fprintf (stderr, "silk_SUB32(%d, %d) in %s: line %d\n", a, b, file, line); |
|
110 #ifdef FIXED_DEBUG_ASSERT |
|
111 silk_assert( 0 ); |
|
112 #endif |
|
113 } |
|
114 return ret; |
|
115 } |
|
116 |
|
117 #undef silk_SUB64 |
|
118 #define silk_SUB64(a,b) silk_SUB64_((a), (b), __FILE__, __LINE__) |
|
119 static OPUS_INLINE opus_int64 silk_SUB64_(opus_int64 a, opus_int64 b, char *file, int line){ |
|
120 opus_int64 ret; |
|
121 |
|
122 ret = a - b; |
|
123 if ( ret != silk_SUB_SAT64( a, b ) ) |
|
124 { |
|
125 fprintf (stderr, "silk_SUB64(%lld, %lld) in %s: line %d\n", (long long)a, (long long)b, file, line); |
|
126 #ifdef FIXED_DEBUG_ASSERT |
|
127 silk_assert( 0 ); |
|
128 #endif |
|
129 } |
|
130 return ret; |
|
131 } |
|
132 |
|
133 #undef silk_ADD_SAT16 |
|
134 #define silk_ADD_SAT16(a,b) silk_ADD_SAT16_((a), (b), __FILE__, __LINE__) |
|
135 static OPUS_INLINE opus_int16 silk_ADD_SAT16_( opus_int16 a16, opus_int16 b16, char *file, int line) { |
|
136 opus_int16 res; |
|
137 res = (opus_int16)silk_SAT16( silk_ADD32( (opus_int32)(a16), (b16) ) ); |
|
138 if ( res != silk_SAT16( (opus_int32)a16 + (opus_int32)b16 ) ) |
|
139 { |
|
140 fprintf (stderr, "silk_ADD_SAT16(%d, %d) in %s: line %d\n", a16, b16, file, line); |
|
141 #ifdef FIXED_DEBUG_ASSERT |
|
142 silk_assert( 0 ); |
|
143 #endif |
|
144 } |
|
145 return res; |
|
146 } |
|
147 |
|
148 #undef silk_ADD_SAT32 |
|
149 #define silk_ADD_SAT32(a,b) silk_ADD_SAT32_((a), (b), __FILE__, __LINE__) |
|
150 static OPUS_INLINE opus_int32 silk_ADD_SAT32_(opus_int32 a32, opus_int32 b32, char *file, int line){ |
|
151 opus_int32 res; |
|
152 res = ((((opus_uint32)(a32) + (opus_uint32)(b32)) & 0x80000000) == 0 ? \ |
|
153 ((((a32) & (b32)) & 0x80000000) != 0 ? silk_int32_MIN : (a32)+(b32)) : \ |
|
154 ((((a32) | (b32)) & 0x80000000) == 0 ? silk_int32_MAX : (a32)+(b32)) ); |
|
155 if ( res != silk_SAT32( (opus_int64)a32 + (opus_int64)b32 ) ) |
|
156 { |
|
157 fprintf (stderr, "silk_ADD_SAT32(%d, %d) in %s: line %d\n", a32, b32, file, line); |
|
158 #ifdef FIXED_DEBUG_ASSERT |
|
159 silk_assert( 0 ); |
|
160 #endif |
|
161 } |
|
162 return res; |
|
163 } |
|
164 |
|
165 #undef silk_ADD_SAT64 |
|
166 #define silk_ADD_SAT64(a,b) silk_ADD_SAT64_((a), (b), __FILE__, __LINE__) |
|
167 static OPUS_INLINE opus_int64 silk_ADD_SAT64_( opus_int64 a64, opus_int64 b64, char *file, int line) { |
|
168 opus_int64 res; |
|
169 int fail = 0; |
|
170 res = ((((a64) + (b64)) & 0x8000000000000000LL) == 0 ? \ |
|
171 ((((a64) & (b64)) & 0x8000000000000000LL) != 0 ? silk_int64_MIN : (a64)+(b64)) : \ |
|
172 ((((a64) | (b64)) & 0x8000000000000000LL) == 0 ? silk_int64_MAX : (a64)+(b64)) ); |
|
173 if( res != a64 + b64 ) { |
|
174 /* Check that we saturated to the correct extreme value */ |
|
175 if ( !(( res == silk_int64_MAX && ( ( a64 >> 1 ) + ( b64 >> 1 ) > ( silk_int64_MAX >> 3 ) ) ) || |
|
176 ( res == silk_int64_MIN && ( ( a64 >> 1 ) + ( b64 >> 1 ) < ( silk_int64_MIN >> 3 ) ) ) ) ) |
|
177 { |
|
178 fail = 1; |
|
179 } |
|
180 } else { |
|
181 /* Saturation not necessary */ |
|
182 fail = res != a64 + b64; |
|
183 } |
|
184 if ( fail ) |
|
185 { |
|
186 fprintf (stderr, "silk_ADD_SAT64(%lld, %lld) in %s: line %d\n", (long long)a64, (long long)b64, file, line); |
|
187 #ifdef FIXED_DEBUG_ASSERT |
|
188 silk_assert( 0 ); |
|
189 #endif |
|
190 } |
|
191 return res; |
|
192 } |
|
193 |
|
194 #undef silk_SUB_SAT16 |
|
195 #define silk_SUB_SAT16(a,b) silk_SUB_SAT16_((a), (b), __FILE__, __LINE__) |
|
196 static OPUS_INLINE opus_int16 silk_SUB_SAT16_( opus_int16 a16, opus_int16 b16, char *file, int line ) { |
|
197 opus_int16 res; |
|
198 res = (opus_int16)silk_SAT16( silk_SUB32( (opus_int32)(a16), (b16) ) ); |
|
199 if ( res != silk_SAT16( (opus_int32)a16 - (opus_int32)b16 ) ) |
|
200 { |
|
201 fprintf (stderr, "silk_SUB_SAT16(%d, %d) in %s: line %d\n", a16, b16, file, line); |
|
202 #ifdef FIXED_DEBUG_ASSERT |
|
203 silk_assert( 0 ); |
|
204 #endif |
|
205 } |
|
206 return res; |
|
207 } |
|
208 |
|
209 #undef silk_SUB_SAT32 |
|
210 #define silk_SUB_SAT32(a,b) silk_SUB_SAT32_((a), (b), __FILE__, __LINE__) |
|
211 static OPUS_INLINE opus_int32 silk_SUB_SAT32_( opus_int32 a32, opus_int32 b32, char *file, int line ) { |
|
212 opus_int32 res; |
|
213 res = ((((opus_uint32)(a32)-(opus_uint32)(b32)) & 0x80000000) == 0 ? \ |
|
214 (( (a32) & ((b32)^0x80000000) & 0x80000000) ? silk_int32_MIN : (a32)-(b32)) : \ |
|
215 ((((a32)^0x80000000) & (b32) & 0x80000000) ? silk_int32_MAX : (a32)-(b32)) ); |
|
216 if ( res != silk_SAT32( (opus_int64)a32 - (opus_int64)b32 ) ) |
|
217 { |
|
218 fprintf (stderr, "silk_SUB_SAT32(%d, %d) in %s: line %d\n", a32, b32, file, line); |
|
219 #ifdef FIXED_DEBUG_ASSERT |
|
220 silk_assert( 0 ); |
|
221 #endif |
|
222 } |
|
223 return res; |
|
224 } |
|
225 |
|
226 #undef silk_SUB_SAT64 |
|
227 #define silk_SUB_SAT64(a,b) silk_SUB_SAT64_((a), (b), __FILE__, __LINE__) |
|
228 static OPUS_INLINE opus_int64 silk_SUB_SAT64_( opus_int64 a64, opus_int64 b64, char *file, int line ) { |
|
229 opus_int64 res; |
|
230 int fail = 0; |
|
231 res = ((((a64)-(b64)) & 0x8000000000000000LL) == 0 ? \ |
|
232 (( (a64) & ((b64)^0x8000000000000000LL) & 0x8000000000000000LL) ? silk_int64_MIN : (a64)-(b64)) : \ |
|
233 ((((a64)^0x8000000000000000LL) & (b64) & 0x8000000000000000LL) ? silk_int64_MAX : (a64)-(b64)) ); |
|
234 if( res != a64 - b64 ) { |
|
235 /* Check that we saturated to the correct extreme value */ |
|
236 if( !(( res == silk_int64_MAX && ( ( a64 >> 1 ) + ( b64 >> 1 ) > ( silk_int64_MAX >> 3 ) ) ) || |
|
237 ( res == silk_int64_MIN && ( ( a64 >> 1 ) + ( b64 >> 1 ) < ( silk_int64_MIN >> 3 ) ) ) )) |
|
238 { |
|
239 fail = 1; |
|
240 } |
|
241 } else { |
|
242 /* Saturation not necessary */ |
|
243 fail = res != a64 - b64; |
|
244 } |
|
245 if ( fail ) |
|
246 { |
|
247 fprintf (stderr, "silk_SUB_SAT64(%lld, %lld) in %s: line %d\n", (long long)a64, (long long)b64, file, line); |
|
248 #ifdef FIXED_DEBUG_ASSERT |
|
249 silk_assert( 0 ); |
|
250 #endif |
|
251 } |
|
252 return res; |
|
253 } |
|
254 |
|
255 #undef silk_MUL |
|
256 #define silk_MUL(a,b) silk_MUL_((a), (b), __FILE__, __LINE__) |
|
257 static OPUS_INLINE opus_int32 silk_MUL_(opus_int32 a32, opus_int32 b32, char *file, int line){ |
|
258 opus_int32 ret; |
|
259 opus_int64 ret64; |
|
260 ret = a32 * b32; |
|
261 ret64 = (opus_int64)a32 * (opus_int64)b32; |
|
262 if ( (opus_int64)ret != ret64 ) |
|
263 { |
|
264 fprintf (stderr, "silk_MUL(%d, %d) in %s: line %d\n", a32, b32, file, line); |
|
265 #ifdef FIXED_DEBUG_ASSERT |
|
266 silk_assert( 0 ); |
|
267 #endif |
|
268 } |
|
269 return ret; |
|
270 } |
|
271 |
|
272 #undef silk_MUL_uint |
|
273 #define silk_MUL_uint(a,b) silk_MUL_uint_((a), (b), __FILE__, __LINE__) |
|
274 static OPUS_INLINE opus_uint32 silk_MUL_uint_(opus_uint32 a32, opus_uint32 b32, char *file, int line){ |
|
275 opus_uint32 ret; |
|
276 ret = a32 * b32; |
|
277 if ( (opus_uint64)ret != (opus_uint64)a32 * (opus_uint64)b32 ) |
|
278 { |
|
279 fprintf (stderr, "silk_MUL_uint(%u, %u) in %s: line %d\n", a32, b32, file, line); |
|
280 #ifdef FIXED_DEBUG_ASSERT |
|
281 silk_assert( 0 ); |
|
282 #endif |
|
283 } |
|
284 return ret; |
|
285 } |
|
286 |
|
287 #undef silk_MLA |
|
288 #define silk_MLA(a,b,c) silk_MLA_((a), (b), (c), __FILE__, __LINE__) |
|
289 static OPUS_INLINE opus_int32 silk_MLA_(opus_int32 a32, opus_int32 b32, opus_int32 c32, char *file, int line){ |
|
290 opus_int32 ret; |
|
291 ret = a32 + b32 * c32; |
|
292 if ( (opus_int64)ret != (opus_int64)a32 + (opus_int64)b32 * (opus_int64)c32 ) |
|
293 { |
|
294 fprintf (stderr, "silk_MLA(%d, %d, %d) in %s: line %d\n", a32, b32, c32, file, line); |
|
295 #ifdef FIXED_DEBUG_ASSERT |
|
296 silk_assert( 0 ); |
|
297 #endif |
|
298 } |
|
299 return ret; |
|
300 } |
|
301 |
|
302 #undef silk_MLA_uint |
|
303 #define silk_MLA_uint(a,b,c) silk_MLA_uint_((a), (b), (c), __FILE__, __LINE__) |
|
304 static OPUS_INLINE opus_int32 silk_MLA_uint_(opus_uint32 a32, opus_uint32 b32, opus_uint32 c32, char *file, int line){ |
|
305 opus_uint32 ret; |
|
306 ret = a32 + b32 * c32; |
|
307 if ( (opus_int64)ret != (opus_int64)a32 + (opus_int64)b32 * (opus_int64)c32 ) |
|
308 { |
|
309 fprintf (stderr, "silk_MLA_uint(%d, %d, %d) in %s: line %d\n", a32, b32, c32, file, line); |
|
310 #ifdef FIXED_DEBUG_ASSERT |
|
311 silk_assert( 0 ); |
|
312 #endif |
|
313 } |
|
314 return ret; |
|
315 } |
|
316 |
|
317 #undef silk_SMULWB |
|
318 #define silk_SMULWB(a,b) silk_SMULWB_((a), (b), __FILE__, __LINE__) |
|
319 static OPUS_INLINE opus_int32 silk_SMULWB_(opus_int32 a32, opus_int32 b32, char *file, int line){ |
|
320 opus_int32 ret; |
|
321 ret = (a32 >> 16) * (opus_int32)((opus_int16)b32) + (((a32 & 0x0000FFFF) * (opus_int32)((opus_int16)b32)) >> 16); |
|
322 if ( (opus_int64)ret != ((opus_int64)a32 * (opus_int16)b32) >> 16 ) |
|
323 { |
|
324 fprintf (stderr, "silk_SMULWB(%d, %d) in %s: line %d\n", a32, b32, file, line); |
|
325 #ifdef FIXED_DEBUG_ASSERT |
|
326 silk_assert( 0 ); |
|
327 #endif |
|
328 } |
|
329 return ret; |
|
330 } |
|
331 |
|
332 #undef silk_SMLAWB |
|
333 #define silk_SMLAWB(a,b,c) silk_SMLAWB_((a), (b), (c), __FILE__, __LINE__) |
|
334 static OPUS_INLINE opus_int32 silk_SMLAWB_(opus_int32 a32, opus_int32 b32, opus_int32 c32, char *file, int line){ |
|
335 opus_int32 ret; |
|
336 ret = silk_ADD32( a32, silk_SMULWB( b32, c32 ) ); |
|
337 if ( silk_ADD32( a32, silk_SMULWB( b32, c32 ) ) != silk_ADD_SAT32( a32, silk_SMULWB( b32, c32 ) ) ) |
|
338 { |
|
339 fprintf (stderr, "silk_SMLAWB(%d, %d, %d) in %s: line %d\n", a32, b32, c32, file, line); |
|
340 #ifdef FIXED_DEBUG_ASSERT |
|
341 silk_assert( 0 ); |
|
342 #endif |
|
343 } |
|
344 return ret; |
|
345 } |
|
346 |
|
347 #undef silk_SMULWT |
|
348 #define silk_SMULWT(a,b) silk_SMULWT_((a), (b), __FILE__, __LINE__) |
|
349 static OPUS_INLINE opus_int32 silk_SMULWT_(opus_int32 a32, opus_int32 b32, char *file, int line){ |
|
350 opus_int32 ret; |
|
351 ret = (a32 >> 16) * (b32 >> 16) + (((a32 & 0x0000FFFF) * (b32 >> 16)) >> 16); |
|
352 if ( (opus_int64)ret != ((opus_int64)a32 * (b32 >> 16)) >> 16 ) |
|
353 { |
|
354 fprintf (stderr, "silk_SMULWT(%d, %d) in %s: line %d\n", a32, b32, file, line); |
|
355 #ifdef FIXED_DEBUG_ASSERT |
|
356 silk_assert( 0 ); |
|
357 #endif |
|
358 } |
|
359 return ret; |
|
360 } |
|
361 |
|
362 #undef silk_SMLAWT |
|
363 #define silk_SMLAWT(a,b,c) silk_SMLAWT_((a), (b), (c), __FILE__, __LINE__) |
|
364 static OPUS_INLINE opus_int32 silk_SMLAWT_(opus_int32 a32, opus_int32 b32, opus_int32 c32, char *file, int line){ |
|
365 opus_int32 ret; |
|
366 ret = a32 + ((b32 >> 16) * (c32 >> 16)) + (((b32 & 0x0000FFFF) * ((c32 >> 16)) >> 16)); |
|
367 if ( (opus_int64)ret != (opus_int64)a32 + (((opus_int64)b32 * (c32 >> 16)) >> 16) ) |
|
368 { |
|
369 fprintf (stderr, "silk_SMLAWT(%d, %d, %d) in %s: line %d\n", a32, b32, c32, file, line); |
|
370 #ifdef FIXED_DEBUG_ASSERT |
|
371 silk_assert( 0 ); |
|
372 #endif |
|
373 } |
|
374 return ret; |
|
375 } |
|
376 |
|
377 #undef silk_SMULL |
|
378 #define silk_SMULL(a,b) silk_SMULL_((a), (b), __FILE__, __LINE__) |
|
379 static OPUS_INLINE opus_int64 silk_SMULL_(opus_int64 a64, opus_int64 b64, char *file, int line){ |
|
380 opus_int64 ret64; |
|
381 int fail = 0; |
|
382 ret64 = a64 * b64; |
|
383 if( b64 != 0 ) { |
|
384 fail = a64 != (ret64 / b64); |
|
385 } else if( a64 != 0 ) { |
|
386 fail = b64 != (ret64 / a64); |
|
387 } |
|
388 if ( fail ) |
|
389 { |
|
390 fprintf (stderr, "silk_SMULL(%lld, %lld) in %s: line %d\n", (long long)a64, (long long)b64, file, line); |
|
391 #ifdef FIXED_DEBUG_ASSERT |
|
392 silk_assert( 0 ); |
|
393 #endif |
|
394 } |
|
395 return ret64; |
|
396 } |
|
397 |
|
398 /* no checking needed for silk_SMULBB */ |
|
399 #undef silk_SMLABB |
|
400 #define silk_SMLABB(a,b,c) silk_SMLABB_((a), (b), (c), __FILE__, __LINE__) |
|
401 static OPUS_INLINE opus_int32 silk_SMLABB_(opus_int32 a32, opus_int32 b32, opus_int32 c32, char *file, int line){ |
|
402 opus_int32 ret; |
|
403 ret = a32 + (opus_int32)((opus_int16)b32) * (opus_int32)((opus_int16)c32); |
|
404 if ( (opus_int64)ret != (opus_int64)a32 + (opus_int64)b32 * (opus_int16)c32 ) |
|
405 { |
|
406 fprintf (stderr, "silk_SMLABB(%d, %d, %d) in %s: line %d\n", a32, b32, c32, file, line); |
|
407 #ifdef FIXED_DEBUG_ASSERT |
|
408 silk_assert( 0 ); |
|
409 #endif |
|
410 } |
|
411 return ret; |
|
412 } |
|
413 |
|
414 /* no checking needed for silk_SMULBT */ |
|
415 #undef silk_SMLABT |
|
416 #define silk_SMLABT(a,b,c) silk_SMLABT_((a), (b), (c), __FILE__, __LINE__) |
|
417 static OPUS_INLINE opus_int32 silk_SMLABT_(opus_int32 a32, opus_int32 b32, opus_int32 c32, char *file, int line){ |
|
418 opus_int32 ret; |
|
419 ret = a32 + ((opus_int32)((opus_int16)b32)) * (c32 >> 16); |
|
420 if ( (opus_int64)ret != (opus_int64)a32 + (opus_int64)b32 * (c32 >> 16) ) |
|
421 { |
|
422 fprintf (stderr, "silk_SMLABT(%d, %d, %d) in %s: line %d\n", a32, b32, c32, file, line); |
|
423 #ifdef FIXED_DEBUG_ASSERT |
|
424 silk_assert( 0 ); |
|
425 #endif |
|
426 } |
|
427 return ret; |
|
428 } |
|
429 |
|
430 /* no checking needed for silk_SMULTT */ |
|
431 #undef silk_SMLATT |
|
432 #define silk_SMLATT(a,b,c) silk_SMLATT_((a), (b), (c), __FILE__, __LINE__) |
|
433 static OPUS_INLINE opus_int32 silk_SMLATT_(opus_int32 a32, opus_int32 b32, opus_int32 c32, char *file, int line){ |
|
434 opus_int32 ret; |
|
435 ret = a32 + (b32 >> 16) * (c32 >> 16); |
|
436 if ( (opus_int64)ret != (opus_int64)a32 + (b32 >> 16) * (c32 >> 16) ) |
|
437 { |
|
438 fprintf (stderr, "silk_SMLATT(%d, %d, %d) in %s: line %d\n", a32, b32, c32, file, line); |
|
439 #ifdef FIXED_DEBUG_ASSERT |
|
440 silk_assert( 0 ); |
|
441 #endif |
|
442 } |
|
443 return ret; |
|
444 } |
|
445 |
|
446 #undef silk_SMULWW |
|
447 #define silk_SMULWW(a,b) silk_SMULWW_((a), (b), __FILE__, __LINE__) |
|
448 static OPUS_INLINE opus_int32 silk_SMULWW_(opus_int32 a32, opus_int32 b32, char *file, int line){ |
|
449 opus_int32 ret, tmp1, tmp2; |
|
450 opus_int64 ret64; |
|
451 int fail = 0; |
|
452 |
|
453 ret = silk_SMULWB( a32, b32 ); |
|
454 tmp1 = silk_RSHIFT_ROUND( b32, 16 ); |
|
455 tmp2 = silk_MUL( a32, tmp1 ); |
|
456 |
|
457 fail |= (opus_int64)tmp2 != (opus_int64) a32 * (opus_int64) tmp1; |
|
458 |
|
459 tmp1 = ret; |
|
460 ret = silk_ADD32( tmp1, tmp2 ); |
|
461 fail |= silk_ADD32( tmp1, tmp2 ) != silk_ADD_SAT32( tmp1, tmp2 ); |
|
462 |
|
463 ret64 = silk_RSHIFT64( silk_SMULL( a32, b32 ), 16 ); |
|
464 fail |= (opus_int64)ret != ret64; |
|
465 |
|
466 if ( fail ) |
|
467 { |
|
468 fprintf (stderr, "silk_SMULWT(%d, %d) in %s: line %d\n", a32, b32, file, line); |
|
469 #ifdef FIXED_DEBUG_ASSERT |
|
470 silk_assert( 0 ); |
|
471 #endif |
|
472 } |
|
473 |
|
474 return ret; |
|
475 } |
|
476 |
|
477 #undef silk_SMLAWW |
|
478 #define silk_SMLAWW(a,b,c) silk_SMLAWW_((a), (b), (c), __FILE__, __LINE__) |
|
479 static OPUS_INLINE opus_int32 silk_SMLAWW_(opus_int32 a32, opus_int32 b32, opus_int32 c32, char *file, int line){ |
|
480 opus_int32 ret, tmp; |
|
481 |
|
482 tmp = silk_SMULWW( b32, c32 ); |
|
483 ret = silk_ADD32( a32, tmp ); |
|
484 if ( ret != silk_ADD_SAT32( a32, tmp ) ) |
|
485 { |
|
486 fprintf (stderr, "silk_SMLAWW(%d, %d, %d) in %s: line %d\n", a32, b32, c32, file, line); |
|
487 #ifdef FIXED_DEBUG_ASSERT |
|
488 silk_assert( 0 ); |
|
489 #endif |
|
490 } |
|
491 return ret; |
|
492 } |
|
493 |
|
494 /* Multiply-accumulate macros that allow overflow in the addition (ie, no asserts in debug mode) */ |
|
495 #undef silk_MLA_ovflw |
|
496 #define silk_MLA_ovflw(a32, b32, c32) ((a32) + ((b32) * (c32))) |
|
497 #undef silk_SMLABB_ovflw |
|
498 #define silk_SMLABB_ovflw(a32, b32, c32) ((a32) + ((opus_int32)((opus_int16)(b32))) * (opus_int32)((opus_int16)(c32))) |
|
499 |
|
500 /* no checking needed for silk_SMULL |
|
501 no checking needed for silk_SMLAL |
|
502 no checking needed for silk_SMLALBB |
|
503 no checking needed for SigProcFIX_CLZ16 |
|
504 no checking needed for SigProcFIX_CLZ32*/ |
|
505 |
|
506 #undef silk_DIV32 |
|
507 #define silk_DIV32(a,b) silk_DIV32_((a), (b), __FILE__, __LINE__) |
|
508 static OPUS_INLINE opus_int32 silk_DIV32_(opus_int32 a32, opus_int32 b32, char *file, int line){ |
|
509 if ( b32 == 0 ) |
|
510 { |
|
511 fprintf (stderr, "silk_DIV32(%d, %d) in %s: line %d\n", a32, b32, file, line); |
|
512 #ifdef FIXED_DEBUG_ASSERT |
|
513 silk_assert( 0 ); |
|
514 #endif |
|
515 } |
|
516 return a32 / b32; |
|
517 } |
|
518 |
|
519 #undef silk_DIV32_16 |
|
520 #define silk_DIV32_16(a,b) silk_DIV32_16_((a), (b), __FILE__, __LINE__) |
|
521 static OPUS_INLINE opus_int32 silk_DIV32_16_(opus_int32 a32, opus_int32 b32, char *file, int line){ |
|
522 int fail = 0; |
|
523 fail |= b32 == 0; |
|
524 fail |= b32 > silk_int16_MAX; |
|
525 fail |= b32 < silk_int16_MIN; |
|
526 if ( fail ) |
|
527 { |
|
528 fprintf (stderr, "silk_DIV32_16(%d, %d) in %s: line %d\n", a32, b32, file, line); |
|
529 #ifdef FIXED_DEBUG_ASSERT |
|
530 silk_assert( 0 ); |
|
531 #endif |
|
532 } |
|
533 return a32 / b32; |
|
534 } |
|
535 |
|
536 /* no checking needed for silk_SAT8 |
|
537 no checking needed for silk_SAT16 |
|
538 no checking needed for silk_SAT32 |
|
539 no checking needed for silk_POS_SAT32 |
|
540 no checking needed for silk_ADD_POS_SAT8 |
|
541 no checking needed for silk_ADD_POS_SAT16 |
|
542 no checking needed for silk_ADD_POS_SAT32 |
|
543 no checking needed for silk_ADD_POS_SAT64 */ |
|
544 |
|
545 #undef silk_LSHIFT8 |
|
546 #define silk_LSHIFT8(a,b) silk_LSHIFT8_((a), (b), __FILE__, __LINE__) |
|
547 static OPUS_INLINE opus_int8 silk_LSHIFT8_(opus_int8 a, opus_int32 shift, char *file, int line){ |
|
548 opus_int8 ret; |
|
549 int fail = 0; |
|
550 ret = a << shift; |
|
551 fail |= shift < 0; |
|
552 fail |= shift >= 8; |
|
553 fail |= (opus_int64)ret != ((opus_int64)a) << shift; |
|
554 if ( fail ) |
|
555 { |
|
556 fprintf (stderr, "silk_LSHIFT8(%d, %d) in %s: line %d\n", a, shift, file, line); |
|
557 #ifdef FIXED_DEBUG_ASSERT |
|
558 silk_assert( 0 ); |
|
559 #endif |
|
560 } |
|
561 return ret; |
|
562 } |
|
563 |
|
564 #undef silk_LSHIFT16 |
|
565 #define silk_LSHIFT16(a,b) silk_LSHIFT16_((a), (b), __FILE__, __LINE__) |
|
566 static OPUS_INLINE opus_int16 silk_LSHIFT16_(opus_int16 a, opus_int32 shift, char *file, int line){ |
|
567 opus_int16 ret; |
|
568 int fail = 0; |
|
569 ret = a << shift; |
|
570 fail |= shift < 0; |
|
571 fail |= shift >= 16; |
|
572 fail |= (opus_int64)ret != ((opus_int64)a) << shift; |
|
573 if ( fail ) |
|
574 { |
|
575 fprintf (stderr, "silk_LSHIFT16(%d, %d) in %s: line %d\n", a, shift, file, line); |
|
576 #ifdef FIXED_DEBUG_ASSERT |
|
577 silk_assert( 0 ); |
|
578 #endif |
|
579 } |
|
580 return ret; |
|
581 } |
|
582 |
|
583 #undef silk_LSHIFT32 |
|
584 #define silk_LSHIFT32(a,b) silk_LSHIFT32_((a), (b), __FILE__, __LINE__) |
|
585 static OPUS_INLINE opus_int32 silk_LSHIFT32_(opus_int32 a, opus_int32 shift, char *file, int line){ |
|
586 opus_int32 ret; |
|
587 int fail = 0; |
|
588 ret = a << shift; |
|
589 fail |= shift < 0; |
|
590 fail |= shift >= 32; |
|
591 fail |= (opus_int64)ret != ((opus_int64)a) << shift; |
|
592 if ( fail ) |
|
593 { |
|
594 fprintf (stderr, "silk_LSHIFT32(%d, %d) in %s: line %d\n", a, shift, file, line); |
|
595 #ifdef FIXED_DEBUG_ASSERT |
|
596 silk_assert( 0 ); |
|
597 #endif |
|
598 } |
|
599 return ret; |
|
600 } |
|
601 |
|
602 #undef silk_LSHIFT64 |
|
603 #define silk_LSHIFT64(a,b) silk_LSHIFT64_((a), (b), __FILE__, __LINE__) |
|
604 static OPUS_INLINE opus_int64 silk_LSHIFT64_(opus_int64 a, opus_int shift, char *file, int line){ |
|
605 opus_int64 ret; |
|
606 int fail = 0; |
|
607 ret = a << shift; |
|
608 fail |= shift < 0; |
|
609 fail |= shift >= 64; |
|
610 fail |= (ret>>shift) != ((opus_int64)a); |
|
611 if ( fail ) |
|
612 { |
|
613 fprintf (stderr, "silk_LSHIFT64(%lld, %d) in %s: line %d\n", (long long)a, shift, file, line); |
|
614 #ifdef FIXED_DEBUG_ASSERT |
|
615 silk_assert( 0 ); |
|
616 #endif |
|
617 } |
|
618 return ret; |
|
619 } |
|
620 |
|
621 #undef silk_LSHIFT_ovflw |
|
622 #define silk_LSHIFT_ovflw(a,b) silk_LSHIFT_ovflw_((a), (b), __FILE__, __LINE__) |
|
623 static OPUS_INLINE opus_int32 silk_LSHIFT_ovflw_(opus_int32 a, opus_int32 shift, char *file, int line){ |
|
624 if ( (shift < 0) || (shift >= 32) ) /* no check for overflow */ |
|
625 { |
|
626 fprintf (stderr, "silk_LSHIFT_ovflw(%d, %d) in %s: line %d\n", a, shift, file, line); |
|
627 #ifdef FIXED_DEBUG_ASSERT |
|
628 silk_assert( 0 ); |
|
629 #endif |
|
630 } |
|
631 return a << shift; |
|
632 } |
|
633 |
|
634 #undef silk_LSHIFT_uint |
|
635 #define silk_LSHIFT_uint(a,b) silk_LSHIFT_uint_((a), (b), __FILE__, __LINE__) |
|
636 static OPUS_INLINE opus_uint32 silk_LSHIFT_uint_(opus_uint32 a, opus_int32 shift, char *file, int line){ |
|
637 opus_uint32 ret; |
|
638 ret = a << shift; |
|
639 if ( (shift < 0) || ((opus_int64)ret != ((opus_int64)a) << shift)) |
|
640 { |
|
641 fprintf (stderr, "silk_LSHIFT_uint(%u, %d) in %s: line %d\n", a, shift, file, line); |
|
642 #ifdef FIXED_DEBUG_ASSERT |
|
643 silk_assert( 0 ); |
|
644 #endif |
|
645 } |
|
646 return ret; |
|
647 } |
|
648 |
|
649 #undef silk_RSHIFT8 |
|
650 #define silk_RSHITF8(a,b) silk_RSHIFT8_((a), (b), __FILE__, __LINE__) |
|
651 static OPUS_INLINE opus_int8 silk_RSHIFT8_(opus_int8 a, opus_int32 shift, char *file, int line){ |
|
652 if ( (shift < 0) || (shift>=8) ) |
|
653 { |
|
654 fprintf (stderr, "silk_RSHITF8(%d, %d) in %s: line %d\n", a, shift, file, line); |
|
655 #ifdef FIXED_DEBUG_ASSERT |
|
656 silk_assert( 0 ); |
|
657 #endif |
|
658 } |
|
659 return a >> shift; |
|
660 } |
|
661 |
|
662 #undef silk_RSHIFT16 |
|
663 #define silk_RSHITF16(a,b) silk_RSHIFT16_((a), (b), __FILE__, __LINE__) |
|
664 static OPUS_INLINE opus_int16 silk_RSHIFT16_(opus_int16 a, opus_int32 shift, char *file, int line){ |
|
665 if ( (shift < 0) || (shift>=16) ) |
|
666 { |
|
667 fprintf (stderr, "silk_RSHITF16(%d, %d) in %s: line %d\n", a, shift, file, line); |
|
668 #ifdef FIXED_DEBUG_ASSERT |
|
669 silk_assert( 0 ); |
|
670 #endif |
|
671 } |
|
672 return a >> shift; |
|
673 } |
|
674 |
|
675 #undef silk_RSHIFT32 |
|
676 #define silk_RSHIFT32(a,b) silk_RSHIFT32_((a), (b), __FILE__, __LINE__) |
|
677 static OPUS_INLINE opus_int32 silk_RSHIFT32_(opus_int32 a, opus_int32 shift, char *file, int line){ |
|
678 if ( (shift < 0) || (shift>=32) ) |
|
679 { |
|
680 fprintf (stderr, "silk_RSHITF32(%d, %d) in %s: line %d\n", a, shift, file, line); |
|
681 #ifdef FIXED_DEBUG_ASSERT |
|
682 silk_assert( 0 ); |
|
683 #endif |
|
684 } |
|
685 return a >> shift; |
|
686 } |
|
687 |
|
688 #undef silk_RSHIFT64 |
|
689 #define silk_RSHIFT64(a,b) silk_RSHIFT64_((a), (b), __FILE__, __LINE__) |
|
690 static OPUS_INLINE opus_int64 silk_RSHIFT64_(opus_int64 a, opus_int64 shift, char *file, int line){ |
|
691 if ( (shift < 0) || (shift>=64) ) |
|
692 { |
|
693 fprintf (stderr, "silk_RSHITF64(%lld, %lld) in %s: line %d\n", (long long)a, (long long)shift, file, line); |
|
694 #ifdef FIXED_DEBUG_ASSERT |
|
695 silk_assert( 0 ); |
|
696 #endif |
|
697 } |
|
698 return a >> shift; |
|
699 } |
|
700 |
|
701 #undef silk_RSHIFT_uint |
|
702 #define silk_RSHIFT_uint(a,b) silk_RSHIFT_uint_((a), (b), __FILE__, __LINE__) |
|
703 static OPUS_INLINE opus_uint32 silk_RSHIFT_uint_(opus_uint32 a, opus_int32 shift, char *file, int line){ |
|
704 if ( (shift < 0) || (shift>32) ) |
|
705 { |
|
706 fprintf (stderr, "silk_RSHIFT_uint(%u, %d) in %s: line %d\n", a, shift, file, line); |
|
707 #ifdef FIXED_DEBUG_ASSERT |
|
708 silk_assert( 0 ); |
|
709 #endif |
|
710 } |
|
711 return a >> shift; |
|
712 } |
|
713 |
|
714 #undef silk_ADD_LSHIFT |
|
715 #define silk_ADD_LSHIFT(a,b,c) silk_ADD_LSHIFT_((a), (b), (c), __FILE__, __LINE__) |
|
716 static OPUS_INLINE int silk_ADD_LSHIFT_(int a, int b, int shift, char *file, int line){ |
|
717 opus_int16 ret; |
|
718 ret = a + (b << shift); |
|
719 if ( (shift < 0) || (shift>15) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) << shift)) ) |
|
720 { |
|
721 fprintf (stderr, "silk_ADD_LSHIFT(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); |
|
722 #ifdef FIXED_DEBUG_ASSERT |
|
723 silk_assert( 0 ); |
|
724 #endif |
|
725 } |
|
726 return ret; /* shift >= 0 */ |
|
727 } |
|
728 |
|
729 #undef silk_ADD_LSHIFT32 |
|
730 #define silk_ADD_LSHIFT32(a,b,c) silk_ADD_LSHIFT32_((a), (b), (c), __FILE__, __LINE__) |
|
731 static OPUS_INLINE opus_int32 silk_ADD_LSHIFT32_(opus_int32 a, opus_int32 b, opus_int32 shift, char *file, int line){ |
|
732 opus_int32 ret; |
|
733 ret = a + (b << shift); |
|
734 if ( (shift < 0) || (shift>31) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) << shift)) ) |
|
735 { |
|
736 fprintf (stderr, "silk_ADD_LSHIFT32(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); |
|
737 #ifdef FIXED_DEBUG_ASSERT |
|
738 silk_assert( 0 ); |
|
739 #endif |
|
740 } |
|
741 return ret; /* shift >= 0 */ |
|
742 } |
|
743 |
|
744 #undef silk_ADD_LSHIFT_uint |
|
745 #define silk_ADD_LSHIFT_uint(a,b,c) silk_ADD_LSHIFT_uint_((a), (b), (c), __FILE__, __LINE__) |
|
746 static OPUS_INLINE opus_uint32 silk_ADD_LSHIFT_uint_(opus_uint32 a, opus_uint32 b, opus_int32 shift, char *file, int line){ |
|
747 opus_uint32 ret; |
|
748 ret = a + (b << shift); |
|
749 if ( (shift < 0) || (shift>32) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) << shift)) ) |
|
750 { |
|
751 fprintf (stderr, "silk_ADD_LSHIFT_uint(%u, %u, %d) in %s: line %d\n", a, b, shift, file, line); |
|
752 #ifdef FIXED_DEBUG_ASSERT |
|
753 silk_assert( 0 ); |
|
754 #endif |
|
755 } |
|
756 return ret; /* shift >= 0 */ |
|
757 } |
|
758 |
|
759 #undef silk_ADD_RSHIFT |
|
760 #define silk_ADD_RSHIFT(a,b,c) silk_ADD_RSHIFT_((a), (b), (c), __FILE__, __LINE__) |
|
761 static OPUS_INLINE int silk_ADD_RSHIFT_(int a, int b, int shift, char *file, int line){ |
|
762 opus_int16 ret; |
|
763 ret = a + (b >> shift); |
|
764 if ( (shift < 0) || (shift>15) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) >> shift)) ) |
|
765 { |
|
766 fprintf (stderr, "silk_ADD_RSHIFT(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); |
|
767 #ifdef FIXED_DEBUG_ASSERT |
|
768 silk_assert( 0 ); |
|
769 #endif |
|
770 } |
|
771 return ret; /* shift > 0 */ |
|
772 } |
|
773 |
|
774 #undef silk_ADD_RSHIFT32 |
|
775 #define silk_ADD_RSHIFT32(a,b,c) silk_ADD_RSHIFT32_((a), (b), (c), __FILE__, __LINE__) |
|
776 static OPUS_INLINE opus_int32 silk_ADD_RSHIFT32_(opus_int32 a, opus_int32 b, opus_int32 shift, char *file, int line){ |
|
777 opus_int32 ret; |
|
778 ret = a + (b >> shift); |
|
779 if ( (shift < 0) || (shift>31) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) >> shift)) ) |
|
780 { |
|
781 fprintf (stderr, "silk_ADD_RSHIFT32(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); |
|
782 #ifdef FIXED_DEBUG_ASSERT |
|
783 silk_assert( 0 ); |
|
784 #endif |
|
785 } |
|
786 return ret; /* shift > 0 */ |
|
787 } |
|
788 |
|
789 #undef silk_ADD_RSHIFT_uint |
|
790 #define silk_ADD_RSHIFT_uint(a,b,c) silk_ADD_RSHIFT_uint_((a), (b), (c), __FILE__, __LINE__) |
|
791 static OPUS_INLINE opus_uint32 silk_ADD_RSHIFT_uint_(opus_uint32 a, opus_uint32 b, opus_int32 shift, char *file, int line){ |
|
792 opus_uint32 ret; |
|
793 ret = a + (b >> shift); |
|
794 if ( (shift < 0) || (shift>32) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) >> shift)) ) |
|
795 { |
|
796 fprintf (stderr, "silk_ADD_RSHIFT_uint(%u, %u, %d) in %s: line %d\n", a, b, shift, file, line); |
|
797 #ifdef FIXED_DEBUG_ASSERT |
|
798 silk_assert( 0 ); |
|
799 #endif |
|
800 } |
|
801 return ret; /* shift > 0 */ |
|
802 } |
|
803 |
|
804 #undef silk_SUB_LSHIFT32 |
|
805 #define silk_SUB_LSHIFT32(a,b,c) silk_SUB_LSHIFT32_((a), (b), (c), __FILE__, __LINE__) |
|
806 static OPUS_INLINE opus_int32 silk_SUB_LSHIFT32_(opus_int32 a, opus_int32 b, opus_int32 shift, char *file, int line){ |
|
807 opus_int32 ret; |
|
808 ret = a - (b << shift); |
|
809 if ( (shift < 0) || (shift>31) || ((opus_int64)ret != (opus_int64)a - (((opus_int64)b) << shift)) ) |
|
810 { |
|
811 fprintf (stderr, "silk_SUB_LSHIFT32(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); |
|
812 #ifdef FIXED_DEBUG_ASSERT |
|
813 silk_assert( 0 ); |
|
814 #endif |
|
815 } |
|
816 return ret; /* shift >= 0 */ |
|
817 } |
|
818 |
|
819 #undef silk_SUB_RSHIFT32 |
|
820 #define silk_SUB_RSHIFT32(a,b,c) silk_SUB_RSHIFT32_((a), (b), (c), __FILE__, __LINE__) |
|
821 static OPUS_INLINE opus_int32 silk_SUB_RSHIFT32_(opus_int32 a, opus_int32 b, opus_int32 shift, char *file, int line){ |
|
822 opus_int32 ret; |
|
823 ret = a - (b >> shift); |
|
824 if ( (shift < 0) || (shift>31) || ((opus_int64)ret != (opus_int64)a - (((opus_int64)b) >> shift)) ) |
|
825 { |
|
826 fprintf (stderr, "silk_SUB_RSHIFT32(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); |
|
827 #ifdef FIXED_DEBUG_ASSERT |
|
828 silk_assert( 0 ); |
|
829 #endif |
|
830 } |
|
831 return ret; /* shift > 0 */ |
|
832 } |
|
833 |
|
834 #undef silk_RSHIFT_ROUND |
|
835 #define silk_RSHIFT_ROUND(a,b) silk_RSHIFT_ROUND_((a), (b), __FILE__, __LINE__) |
|
836 static OPUS_INLINE opus_int32 silk_RSHIFT_ROUND_(opus_int32 a, opus_int32 shift, char *file, int line){ |
|
837 opus_int32 ret; |
|
838 ret = shift == 1 ? (a >> 1) + (a & 1) : ((a >> (shift - 1)) + 1) >> 1; |
|
839 /* the marco definition can't handle a shift of zero */ |
|
840 if ( (shift <= 0) || (shift>31) || ((opus_int64)ret != ((opus_int64)a + ((opus_int64)1 << (shift - 1))) >> shift) ) |
|
841 { |
|
842 fprintf (stderr, "silk_RSHIFT_ROUND(%d, %d) in %s: line %d\n", a, shift, file, line); |
|
843 #ifdef FIXED_DEBUG_ASSERT |
|
844 silk_assert( 0 ); |
|
845 #endif |
|
846 } |
|
847 return ret; |
|
848 } |
|
849 |
|
850 #undef silk_RSHIFT_ROUND64 |
|
851 #define silk_RSHIFT_ROUND64(a,b) silk_RSHIFT_ROUND64_((a), (b), __FILE__, __LINE__) |
|
852 static OPUS_INLINE opus_int64 silk_RSHIFT_ROUND64_(opus_int64 a, opus_int32 shift, char *file, int line){ |
|
853 opus_int64 ret; |
|
854 /* the marco definition can't handle a shift of zero */ |
|
855 if ( (shift <= 0) || (shift>=64) ) |
|
856 { |
|
857 fprintf (stderr, "silk_RSHIFT_ROUND64(%lld, %d) in %s: line %d\n", (long long)a, shift, file, line); |
|
858 #ifdef FIXED_DEBUG_ASSERT |
|
859 silk_assert( 0 ); |
|
860 #endif |
|
861 } |
|
862 ret = shift == 1 ? (a >> 1) + (a & 1) : ((a >> (shift - 1)) + 1) >> 1; |
|
863 return ret; |
|
864 } |
|
865 |
|
866 /* silk_abs is used on floats also, so doesn't work... */ |
|
867 /*#undef silk_abs |
|
868 static OPUS_INLINE opus_int32 silk_abs(opus_int32 a){ |
|
869 silk_assert(a != 0x80000000); |
|
870 return (((a) > 0) ? (a) : -(a)); // Be careful, silk_abs returns wrong when input equals to silk_intXX_MIN |
|
871 }*/ |
|
872 |
|
873 #undef silk_abs_int64 |
|
874 #define silk_abs_int64(a) silk_abs_int64_((a), __FILE__, __LINE__) |
|
875 static OPUS_INLINE opus_int64 silk_abs_int64_(opus_int64 a, char *file, int line){ |
|
876 if ( a == silk_int64_MIN ) |
|
877 { |
|
878 fprintf (stderr, "silk_abs_int64(%lld) in %s: line %d\n", (long long)a, file, line); |
|
879 #ifdef FIXED_DEBUG_ASSERT |
|
880 silk_assert( 0 ); |
|
881 #endif |
|
882 } |
|
883 return (((a) > 0) ? (a) : -(a)); /* Be careful, silk_abs returns wrong when input equals to silk_intXX_MIN */ |
|
884 } |
|
885 |
|
886 #undef silk_abs_int32 |
|
887 #define silk_abs_int32(a) silk_abs_int32_((a), __FILE__, __LINE__) |
|
888 static OPUS_INLINE opus_int32 silk_abs_int32_(opus_int32 a, char *file, int line){ |
|
889 if ( a == silk_int32_MIN ) |
|
890 { |
|
891 fprintf (stderr, "silk_abs_int32(%d) in %s: line %d\n", a, file, line); |
|
892 #ifdef FIXED_DEBUG_ASSERT |
|
893 silk_assert( 0 ); |
|
894 #endif |
|
895 } |
|
896 return silk_abs(a); |
|
897 } |
|
898 |
|
899 #undef silk_CHECK_FIT8 |
|
900 #define silk_CHECK_FIT8(a) silk_CHECK_FIT8_((a), __FILE__, __LINE__) |
|
901 static OPUS_INLINE opus_int8 silk_CHECK_FIT8_( opus_int64 a, char *file, int line ){ |
|
902 opus_int8 ret; |
|
903 ret = (opus_int8)a; |
|
904 if ( (opus_int64)ret != a ) |
|
905 { |
|
906 fprintf (stderr, "silk_CHECK_FIT8(%lld) in %s: line %d\n", (long long)a, file, line); |
|
907 #ifdef FIXED_DEBUG_ASSERT |
|
908 silk_assert( 0 ); |
|
909 #endif |
|
910 } |
|
911 return( ret ); |
|
912 } |
|
913 |
|
914 #undef silk_CHECK_FIT16 |
|
915 #define silk_CHECK_FIT16(a) silk_CHECK_FIT16_((a), __FILE__, __LINE__) |
|
916 static OPUS_INLINE opus_int16 silk_CHECK_FIT16_( opus_int64 a, char *file, int line ){ |
|
917 opus_int16 ret; |
|
918 ret = (opus_int16)a; |
|
919 if ( (opus_int64)ret != a ) |
|
920 { |
|
921 fprintf (stderr, "silk_CHECK_FIT16(%lld) in %s: line %d\n", (long long)a, file, line); |
|
922 #ifdef FIXED_DEBUG_ASSERT |
|
923 silk_assert( 0 ); |
|
924 #endif |
|
925 } |
|
926 return( ret ); |
|
927 } |
|
928 |
|
929 #undef silk_CHECK_FIT32 |
|
930 #define silk_CHECK_FIT32(a) silk_CHECK_FIT32_((a), __FILE__, __LINE__) |
|
931 static OPUS_INLINE opus_int32 silk_CHECK_FIT32_( opus_int64 a, char *file, int line ){ |
|
932 opus_int32 ret; |
|
933 ret = (opus_int32)a; |
|
934 if ( (opus_int64)ret != a ) |
|
935 { |
|
936 fprintf (stderr, "silk_CHECK_FIT32(%lld) in %s: line %d\n", (long long)a, file, line); |
|
937 #ifdef FIXED_DEBUG_ASSERT |
|
938 silk_assert( 0 ); |
|
939 #endif |
|
940 } |
|
941 return( ret ); |
|
942 } |
|
943 |
|
944 /* no checking for silk_NSHIFT_MUL_32_32 |
|
945 no checking for silk_NSHIFT_MUL_16_16 |
|
946 no checking needed for silk_min |
|
947 no checking needed for silk_max |
|
948 no checking needed for silk_sign |
|
949 */ |
|
950 |
|
951 #endif |
|
952 #endif /* MACRO_DEBUG_H */ |