Replace "inline" with OPUS_INLINE.
[opus.git] / silk / MacroDebug.h
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 */