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 544 #undef silk_LSHIFT8 545 #define silk_LSHIFT8(a,b) silk_LSHIFT8_((a), (b), __FILE__, __LINE__) 546 static OPUS_INLINE opus_int8 silk_LSHIFT8_(opus_int8 a, opus_int32 shift, char *file, int line){ 547 opus_int8 ret; 548 int fail = 0; 549 ret = a << shift; 550 fail |= shift < 0; 551 fail |= shift >= 8; 552 fail |= (opus_int64)ret != ((opus_int64)a) << shift; 553 if ( fail ) 554 { 555 fprintf (stderr, "silk_LSHIFT8(%d, %d) in %s: line %d\n", a, shift, file, line); 556 #ifdef FIXED_DEBUG_ASSERT 557 silk_assert( 0 ); 558 #endif 559 } 560 return ret; 561 } 562 563 #undef silk_LSHIFT16 564 #define silk_LSHIFT16(a,b) silk_LSHIFT16_((a), (b), __FILE__, __LINE__) 565 static OPUS_INLINE opus_int16 silk_LSHIFT16_(opus_int16 a, opus_int32 shift, char *file, int line){ 566 opus_int16 ret; 567 int fail = 0; 568 ret = a << shift; 569 fail |= shift < 0; 570 fail |= shift >= 16; 571 fail |= (opus_int64)ret != ((opus_int64)a) << shift; 572 if ( fail ) 573 { 574 fprintf (stderr, "silk_LSHIFT16(%d, %d) in %s: line %d\n", a, shift, file, line); 575 #ifdef FIXED_DEBUG_ASSERT 576 silk_assert( 0 ); 577 #endif 578 } 579 return ret; 580 } 581 582 #undef silk_LSHIFT32 583 #define silk_LSHIFT32(a,b) silk_LSHIFT32_((a), (b), __FILE__, __LINE__) 584 static OPUS_INLINE opus_int32 silk_LSHIFT32_(opus_int32 a, opus_int32 shift, char *file, int line){ 585 opus_int32 ret; 586 int fail = 0; 587 ret = a << shift; 588 fail |= shift < 0; 589 fail |= shift >= 32; 590 fail |= (opus_int64)ret != ((opus_int64)a) << shift; 591 if ( fail ) 592 { 593 fprintf (stderr, "silk_LSHIFT32(%d, %d) in %s: line %d\n", a, shift, file, line); 594 #ifdef FIXED_DEBUG_ASSERT 595 silk_assert( 0 ); 596 #endif 597 } 598 return ret; 599 } 600 601 #undef silk_LSHIFT64 602 #define silk_LSHIFT64(a,b) silk_LSHIFT64_((a), (b), __FILE__, __LINE__) 603 static OPUS_INLINE opus_int64 silk_LSHIFT64_(opus_int64 a, opus_int shift, char *file, int line){ 604 opus_int64 ret; 605 int fail = 0; 606 ret = a << shift; 607 fail |= shift < 0; 608 fail |= shift >= 64; 609 fail |= (ret>>shift) != ((opus_int64)a); 610 if ( fail ) 611 { 612 fprintf (stderr, "silk_LSHIFT64(%lld, %d) in %s: line %d\n", (long long)a, shift, file, line); 613 #ifdef FIXED_DEBUG_ASSERT 614 silk_assert( 0 ); 615 #endif 616 } 617 return ret; 618 } 619 620 #undef silk_LSHIFT_ovflw 621 #define silk_LSHIFT_ovflw(a,b) silk_LSHIFT_ovflw_((a), (b), __FILE__, __LINE__) 622 static OPUS_INLINE opus_int32 silk_LSHIFT_ovflw_(opus_int32 a, opus_int32 shift, char *file, int line){ 623 if ( (shift < 0) || (shift >= 32) ) /* no check for overflow */ 624 { 625 fprintf (stderr, "silk_LSHIFT_ovflw(%d, %d) in %s: line %d\n", a, shift, file, line); 626 #ifdef FIXED_DEBUG_ASSERT 627 silk_assert( 0 ); 628 #endif 629 } 630 return a << shift; 631 } 632 633 #undef silk_LSHIFT_uint 634 #define silk_LSHIFT_uint(a,b) silk_LSHIFT_uint_((a), (b), __FILE__, __LINE__) 635 static OPUS_INLINE opus_uint32 silk_LSHIFT_uint_(opus_uint32 a, opus_int32 shift, char *file, int line){ 636 opus_uint32 ret; 637 ret = a << shift; 638 if ( (shift < 0) || ((opus_int64)ret != ((opus_int64)a) << shift)) 639 { 640 fprintf (stderr, "silk_LSHIFT_uint(%u, %d) in %s: line %d\n", a, shift, file, line); 641 #ifdef FIXED_DEBUG_ASSERT 642 silk_assert( 0 ); 643 #endif 644 } 645 return ret; 646 } 647 648 #undef silk_RSHIFT8 649 #define silk_RSHITF8(a,b) silk_RSHIFT8_((a), (b), __FILE__, __LINE__) 650 static OPUS_INLINE opus_int8 silk_RSHIFT8_(opus_int8 a, opus_int32 shift, char *file, int line){ 651 if ( (shift < 0) || (shift>=8) ) 652 { 653 fprintf (stderr, "silk_RSHITF8(%d, %d) in %s: line %d\n", a, shift, file, line); 654 #ifdef FIXED_DEBUG_ASSERT 655 silk_assert( 0 ); 656 #endif 657 } 658 return a >> shift; 659 } 660 661 #undef silk_RSHIFT16 662 #define silk_RSHITF16(a,b) silk_RSHIFT16_((a), (b), __FILE__, __LINE__) 663 static OPUS_INLINE opus_int16 silk_RSHIFT16_(opus_int16 a, opus_int32 shift, char *file, int line){ 664 if ( (shift < 0) || (shift>=16) ) 665 { 666 fprintf (stderr, "silk_RSHITF16(%d, %d) in %s: line %d\n", a, shift, file, line); 667 #ifdef FIXED_DEBUG_ASSERT 668 silk_assert( 0 ); 669 #endif 670 } 671 return a >> shift; 672 } 673 674 #undef silk_RSHIFT32 675 #define silk_RSHIFT32(a,b) silk_RSHIFT32_((a), (b), __FILE__, __LINE__) 676 static OPUS_INLINE opus_int32 silk_RSHIFT32_(opus_int32 a, opus_int32 shift, char *file, int line){ 677 if ( (shift < 0) || (shift>=32) ) 678 { 679 fprintf (stderr, "silk_RSHITF32(%d, %d) in %s: line %d\n", a, shift, file, line); 680 #ifdef FIXED_DEBUG_ASSERT 681 silk_assert( 0 ); 682 #endif 683 } 684 return a >> shift; 685 } 686 687 #undef silk_RSHIFT64 688 #define silk_RSHIFT64(a,b) silk_RSHIFT64_((a), (b), __FILE__, __LINE__) 689 static OPUS_INLINE opus_int64 silk_RSHIFT64_(opus_int64 a, opus_int64 shift, char *file, int line){ 690 if ( (shift < 0) || (shift>=64) ) 691 { 692 fprintf (stderr, "silk_RSHITF64(%lld, %lld) in %s: line %d\n", (long long)a, (long long)shift, file, line); 693 #ifdef FIXED_DEBUG_ASSERT 694 silk_assert( 0 ); 695 #endif 696 } 697 return a >> shift; 698 } 699 700 #undef silk_RSHIFT_uint 701 #define silk_RSHIFT_uint(a,b) silk_RSHIFT_uint_((a), (b), __FILE__, __LINE__) 702 static OPUS_INLINE opus_uint32 silk_RSHIFT_uint_(opus_uint32 a, opus_int32 shift, char *file, int line){ 703 if ( (shift < 0) || (shift>32) ) 704 { 705 fprintf (stderr, "silk_RSHIFT_uint(%u, %d) in %s: line %d\n", a, shift, file, line); 706 #ifdef FIXED_DEBUG_ASSERT 707 silk_assert( 0 ); 708 #endif 709 } 710 return a >> shift; 711 } 712 713 #undef silk_ADD_LSHIFT 714 #define silk_ADD_LSHIFT(a,b,c) silk_ADD_LSHIFT_((a), (b), (c), __FILE__, __LINE__) 715 static OPUS_INLINE int silk_ADD_LSHIFT_(int a, int b, int shift, char *file, int line){ 716 opus_int16 ret; 717 ret = a + (b << shift); 718 if ( (shift < 0) || (shift>15) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) << shift)) ) 719 { 720 fprintf (stderr, "silk_ADD_LSHIFT(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); 721 #ifdef FIXED_DEBUG_ASSERT 722 silk_assert( 0 ); 723 #endif 724 } 725 return ret; /* shift >= 0 */ 726 } 727 728 #undef silk_ADD_LSHIFT32 729 #define silk_ADD_LSHIFT32(a,b,c) silk_ADD_LSHIFT32_((a), (b), (c), __FILE__, __LINE__) 730 static OPUS_INLINE opus_int32 silk_ADD_LSHIFT32_(opus_int32 a, opus_int32 b, opus_int32 shift, char *file, int line){ 731 opus_int32 ret; 732 ret = a + (b << shift); 733 if ( (shift < 0) || (shift>31) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) << shift)) ) 734 { 735 fprintf (stderr, "silk_ADD_LSHIFT32(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); 736 #ifdef FIXED_DEBUG_ASSERT 737 silk_assert( 0 ); 738 #endif 739 } 740 return ret; /* shift >= 0 */ 741 } 742 743 #undef silk_ADD_LSHIFT_uint 744 #define silk_ADD_LSHIFT_uint(a,b,c) silk_ADD_LSHIFT_uint_((a), (b), (c), __FILE__, __LINE__) 745 static OPUS_INLINE opus_uint32 silk_ADD_LSHIFT_uint_(opus_uint32 a, opus_uint32 b, opus_int32 shift, char *file, int line){ 746 opus_uint32 ret; 747 ret = a + (b << shift); 748 if ( (shift < 0) || (shift>32) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) << shift)) ) 749 { 750 fprintf (stderr, "silk_ADD_LSHIFT_uint(%u, %u, %d) in %s: line %d\n", a, b, shift, file, line); 751 #ifdef FIXED_DEBUG_ASSERT 752 silk_assert( 0 ); 753 #endif 754 } 755 return ret; /* shift >= 0 */ 756 } 757 758 #undef silk_ADD_RSHIFT 759 #define silk_ADD_RSHIFT(a,b,c) silk_ADD_RSHIFT_((a), (b), (c), __FILE__, __LINE__) 760 static OPUS_INLINE int silk_ADD_RSHIFT_(int a, int b, int shift, char *file, int line){ 761 opus_int16 ret; 762 ret = a + (b >> shift); 763 if ( (shift < 0) || (shift>15) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) >> shift)) ) 764 { 765 fprintf (stderr, "silk_ADD_RSHIFT(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); 766 #ifdef FIXED_DEBUG_ASSERT 767 silk_assert( 0 ); 768 #endif 769 } 770 return ret; /* shift > 0 */ 771 } 772 773 #undef silk_ADD_RSHIFT32 774 #define silk_ADD_RSHIFT32(a,b,c) silk_ADD_RSHIFT32_((a), (b), (c), __FILE__, __LINE__) 775 static OPUS_INLINE opus_int32 silk_ADD_RSHIFT32_(opus_int32 a, opus_int32 b, opus_int32 shift, char *file, int line){ 776 opus_int32 ret; 777 ret = a + (b >> shift); 778 if ( (shift < 0) || (shift>31) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) >> shift)) ) 779 { 780 fprintf (stderr, "silk_ADD_RSHIFT32(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); 781 #ifdef FIXED_DEBUG_ASSERT 782 silk_assert( 0 ); 783 #endif 784 } 785 return ret; /* shift > 0 */ 786 } 787 788 #undef silk_ADD_RSHIFT_uint 789 #define silk_ADD_RSHIFT_uint(a,b,c) silk_ADD_RSHIFT_uint_((a), (b), (c), __FILE__, __LINE__) 790 static OPUS_INLINE opus_uint32 silk_ADD_RSHIFT_uint_(opus_uint32 a, opus_uint32 b, opus_int32 shift, char *file, int line){ 791 opus_uint32 ret; 792 ret = a + (b >> shift); 793 if ( (shift < 0) || (shift>32) || ((opus_int64)ret != (opus_int64)a + (((opus_int64)b) >> shift)) ) 794 { 795 fprintf (stderr, "silk_ADD_RSHIFT_uint(%u, %u, %d) in %s: line %d\n", a, b, shift, file, line); 796 #ifdef FIXED_DEBUG_ASSERT 797 silk_assert( 0 ); 798 #endif 799 } 800 return ret; /* shift > 0 */ 801 } 802 803 #undef silk_SUB_LSHIFT32 804 #define silk_SUB_LSHIFT32(a,b,c) silk_SUB_LSHIFT32_((a), (b), (c), __FILE__, __LINE__) 805 static OPUS_INLINE opus_int32 silk_SUB_LSHIFT32_(opus_int32 a, opus_int32 b, opus_int32 shift, char *file, int line){ 806 opus_int32 ret; 807 ret = a - (b << shift); 808 if ( (shift < 0) || (shift>31) || ((opus_int64)ret != (opus_int64)a - (((opus_int64)b) << shift)) ) 809 { 810 fprintf (stderr, "silk_SUB_LSHIFT32(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); 811 #ifdef FIXED_DEBUG_ASSERT 812 silk_assert( 0 ); 813 #endif 814 } 815 return ret; /* shift >= 0 */ 816 } 817 818 #undef silk_SUB_RSHIFT32 819 #define silk_SUB_RSHIFT32(a,b,c) silk_SUB_RSHIFT32_((a), (b), (c), __FILE__, __LINE__) 820 static OPUS_INLINE opus_int32 silk_SUB_RSHIFT32_(opus_int32 a, opus_int32 b, opus_int32 shift, char *file, int line){ 821 opus_int32 ret; 822 ret = a - (b >> shift); 823 if ( (shift < 0) || (shift>31) || ((opus_int64)ret != (opus_int64)a - (((opus_int64)b) >> shift)) ) 824 { 825 fprintf (stderr, "silk_SUB_RSHIFT32(%d, %d, %d) in %s: line %d\n", a, b, shift, file, line); 826 #ifdef FIXED_DEBUG_ASSERT 827 silk_assert( 0 ); 828 #endif 829 } 830 return ret; /* shift > 0 */ 831 } 832 833 #undef silk_RSHIFT_ROUND 834 #define silk_RSHIFT_ROUND(a,b) silk_RSHIFT_ROUND_((a), (b), __FILE__, __LINE__) 835 static OPUS_INLINE opus_int32 silk_RSHIFT_ROUND_(opus_int32 a, opus_int32 shift, char *file, int line){ 836 opus_int32 ret; 837 ret = shift == 1 ? (a >> 1) + (a & 1) : ((a >> (shift - 1)) + 1) >> 1; 838 /* the marco definition can't handle a shift of zero */ 839 if ( (shift <= 0) || (shift>31) || ((opus_int64)ret != ((opus_int64)a + ((opus_int64)1 << (shift - 1))) >> shift) ) 840 { 841 fprintf (stderr, "silk_RSHIFT_ROUND(%d, %d) in %s: line %d\n", a, shift, file, line); 842 #ifdef FIXED_DEBUG_ASSERT 843 silk_assert( 0 ); 844 #endif 845 } 846 return ret; 847 } 848 849 #undef silk_RSHIFT_ROUND64 850 #define silk_RSHIFT_ROUND64(a,b) silk_RSHIFT_ROUND64_((a), (b), __FILE__, __LINE__) 851 static OPUS_INLINE opus_int64 silk_RSHIFT_ROUND64_(opus_int64 a, opus_int32 shift, char *file, int line){ 852 opus_int64 ret; 853 /* the marco definition can't handle a shift of zero */ 854 if ( (shift <= 0) || (shift>=64) ) 855 { 856 fprintf (stderr, "silk_RSHIFT_ROUND64(%lld, %d) in %s: line %d\n", (long long)a, shift, file, line); 857 #ifdef FIXED_DEBUG_ASSERT 858 silk_assert( 0 ); 859 #endif 860 } 861 ret = shift == 1 ? (a >> 1) + (a & 1) : ((a >> (shift - 1)) + 1) >> 1; 862 return ret; 863 } 864 865 /* silk_abs is used on floats also, so doesn't work... */ 866 /*#undef silk_abs 867 static OPUS_INLINE opus_int32 silk_abs(opus_int32 a){ 868 silk_assert(a != 0x80000000); 869 return (((a) > 0) ? (a) : -(a)); // Be careful, silk_abs returns wrong when input equals to silk_intXX_MIN 870 }*/ 871 872 #undef silk_abs_int64 873 #define silk_abs_int64(a) silk_abs_int64_((a), __FILE__, __LINE__) 874 static OPUS_INLINE opus_int64 silk_abs_int64_(opus_int64 a, char *file, int line){ 875 if ( a == silk_int64_MIN ) 876 { 877 fprintf (stderr, "silk_abs_int64(%lld) in %s: line %d\n", (long long)a, file, line); 878 #ifdef FIXED_DEBUG_ASSERT 879 silk_assert( 0 ); 880 #endif 881 } 882 return (((a) > 0) ? (a) : -(a)); /* Be careful, silk_abs returns wrong when input equals to silk_intXX_MIN */ 883 } 884 885 #undef silk_abs_int32 886 #define silk_abs_int32(a) silk_abs_int32_((a), __FILE__, __LINE__) 887 static OPUS_INLINE opus_int32 silk_abs_int32_(opus_int32 a, char *file, int line){ 888 if ( a == silk_int32_MIN ) 889 { 890 fprintf (stderr, "silk_abs_int32(%d) in %s: line %d\n", a, file, line); 891 #ifdef FIXED_DEBUG_ASSERT 892 silk_assert( 0 ); 893 #endif 894 } 895 return silk_abs(a); 896 } 897 898 #undef silk_CHECK_FIT8 899 #define silk_CHECK_FIT8(a) silk_CHECK_FIT8_((a), __FILE__, __LINE__) 900 static OPUS_INLINE opus_int8 silk_CHECK_FIT8_( opus_int64 a, char *file, int line ){ 901 opus_int8 ret; 902 ret = (opus_int8)a; 903 if ( (opus_int64)ret != a ) 904 { 905 fprintf (stderr, "silk_CHECK_FIT8(%lld) in %s: line %d\n", (long long)a, file, line); 906 #ifdef FIXED_DEBUG_ASSERT 907 silk_assert( 0 ); 908 #endif 909 } 910 return( ret ); 911 } 912 913 #undef silk_CHECK_FIT16 914 #define silk_CHECK_FIT16(a) silk_CHECK_FIT16_((a), __FILE__, __LINE__) 915 static OPUS_INLINE opus_int16 silk_CHECK_FIT16_( opus_int64 a, char *file, int line ){ 916 opus_int16 ret; 917 ret = (opus_int16)a; 918 if ( (opus_int64)ret != a ) 919 { 920 fprintf (stderr, "silk_CHECK_FIT16(%lld) in %s: line %d\n", (long long)a, file, line); 921 #ifdef FIXED_DEBUG_ASSERT 922 silk_assert( 0 ); 923 #endif 924 } 925 return( ret ); 926 } 927 928 #undef silk_CHECK_FIT32 929 #define silk_CHECK_FIT32(a) silk_CHECK_FIT32_((a), __FILE__, __LINE__) 930 static OPUS_INLINE opus_int32 silk_CHECK_FIT32_( opus_int64 a, char *file, int line ){ 931 opus_int32 ret; 932 ret = (opus_int32)a; 933 if ( (opus_int64)ret != a ) 934 { 935 fprintf (stderr, "silk_CHECK_FIT32(%lld) in %s: line %d\n", (long long)a, file, line); 936 #ifdef FIXED_DEBUG_ASSERT 937 silk_assert( 0 ); 938 #endif 939 } 940 return( ret ); 941 } 942 943 /* no checking for silk_NSHIFT_MUL_32_32 944 no checking for silk_NSHIFT_MUL_16_16 945 no checking needed for silk_min 946 no checking needed for silk_max 947 no checking needed for silk_sign 948 */ 949 950 #endif 951 #endif /* MACRO_DEBUG_H */ 952
