1 /* Copyright (C) 2003-2008 Jean-Marc Valin 2 Copyright (C) 2007-2012 Xiph.Org Foundation */ 3 /** 4 @file fixed_debug.h 5 @brief Fixed-point operations with debugging 6 */ 7 /* 8 Redistribution and use in source and binary forms, with or without 9 modification, are permitted provided that the following conditions 10 are met: 11 12 - Redistributions of source code must retain the above copyright 13 notice, this list of conditions and the following disclaimer. 14 15 - Redistributions in binary form must reproduce the above copyright 16 notice, this list of conditions and the following disclaimer in the 17 documentation and/or other materials provided with the distribution. 18 19 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 20 ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 21 LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 22 A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER 23 OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 24 EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 25 PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 26 PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 27 LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 28 NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 29 SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #ifndef FIXED_DEBUG_H 33 #define FIXED_DEBUG_H 34 35 #include <stdio.h> 36 #include "opus_defines.h" 37 38 #ifdef CELT_C 39 OPUS_EXPORT opus_int64 celt_mips=0; 40 #else 41 extern opus_int64 celt_mips; 42 #endif 43 44 #define MULT16_16SU(a,b) ((opus_val32)(opus_val16)(a)*(opus_val32)(opus_uint16)(b)) 45 #define MULT32_32_Q31(a,b) ADD32(ADD32(SHL32(MULT16_16(SHR32((a),16),SHR((b),16)),1), SHR32(MULT16_16SU(SHR32((a),16),((b)&0x0000ffff)),15)), SHR32(MULT16_16SU(SHR32((b),16),((a)&0x0000ffff)),15)) 46 47 /** 16x32 multiplication, followed by a 16-bit shift right. Results fits in 32 bits */ 48 #define MULT16_32_Q16(a,b) ADD32(MULT16_16((a),SHR32((b),16)), SHR32(MULT16_16SU((a),((b)&0x0000ffff)),16)) 49 50 #define MULT16_32_P16(a,b) MULT16_32_PX(a,b,16) 51 52 #define QCONST16(x,bits) ((opus_val16)(.5+(x)*(((opus_val32)1)<<(bits)))) 53 #define QCONST32(x,bits) ((opus_val32)(.5+(x)*(((opus_val32)1)<<(bits)))) 54 55 #define VERIFY_SHORT(x) ((x)<=32767&&(x)>=-32768) 56 #define VERIFY_INT(x) ((x)<=2147483647LL&&(x)>=-2147483648LL) 57 #define VERIFY_UINT(x) ((x)<=(2147483647LLU<<1)) 58 59 #define SHR(a,b) SHR32(a,b) 60 #define PSHR(a,b) PSHR32(a,b) 61 62 static OPUS_INLINE short NEG16(int x) 63 { 64 int res; 65 if (!VERIFY_SHORT(x)) 66 { 67 fprintf (stderr, "NEG16: input is not short: %d\n", (int)x); 68 #ifdef FIXED_DEBUG_ASSERT 69 celt_assert(0); 70 #endif 71 } 72 res = -x; 73 if (!VERIFY_SHORT(res)) 74 { 75 fprintf (stderr, "NEG16: output is not short: %d\n", (int)res); 76 #ifdef FIXED_DEBUG_ASSERT 77 celt_assert(0); 78 #endif 79 } 80 celt_mips++; 81 return res; 82 } 83 static OPUS_INLINE int NEG32(opus_int64 x) 84 { 85 opus_int64 res; 86 if (!VERIFY_INT(x)) 87 { 88 fprintf (stderr, "NEG16: input is not int: %d\n", (int)x); 89 #ifdef FIXED_DEBUG_ASSERT 90 celt_assert(0); 91 #endif 92 } 93 res = -x; 94 if (!VERIFY_INT(res)) 95 { 96 fprintf (stderr, "NEG16: output is not int: %d\n", (int)res); 97 #ifdef FIXED_DEBUG_ASSERT 98 celt_assert(0); 99 #endif 100 } 101 celt_mips+=2; 102 return res; 103 } 104 105 #define EXTRACT16(x) EXTRACT16_(x, __FILE__, __LINE__) 106 static OPUS_INLINE short EXTRACT16_(int x, char *file, int line) 107 { 108 int res; 109 if (!VERIFY_SHORT(x)) 110 { 111 fprintf (stderr, "EXTRACT16: input is not short: %d in %s: line %d\n", x, file, line); 112 #ifdef FIXED_DEBUG_ASSERT 113 celt_assert(0); 114 #endif 115 } 116 res = x; 117 celt_mips++; 118 return res; 119 } 120 121 #define EXTEND32(x) EXTEND32_(x, __FILE__, __LINE__) 122 static OPUS_INLINE int EXTEND32_(int x, char *file, int line) 123 { 124 int res; 125 if (!VERIFY_SHORT(x)) 126 { 127 fprintf (stderr, "EXTEND32: input is not short: %d in %s: line %d\n", x, file, line); 128 #ifdef FIXED_DEBUG_ASSERT 129 celt_assert(0); 130 #endif 131 } 132 res = x; 133 celt_mips++; 134 return res; 135 } 136 137 #define SHR16(a, shift) SHR16_(a, shift, __FILE__, __LINE__) 138 static OPUS_INLINE short SHR16_(int a, int shift, char *file, int line) 139 { 140 int res; 141 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(shift)) 142 { 143 fprintf (stderr, "SHR16: inputs are not short: %d >> %d in %s: line %d\n", a, shift, file, line); 144 #ifdef FIXED_DEBUG_ASSERT 145 celt_assert(0); 146 #endif 147 } 148 res = a>>shift; 149 if (!VERIFY_SHORT(res)) 150 { 151 fprintf (stderr, "SHR16: output is not short: %d in %s: line %d\n", res, file, line); 152 #ifdef FIXED_DEBUG_ASSERT 153 celt_assert(0); 154 #endif 155 } 156 celt_mips++; 157 return res; 158 } 159 #define SHL16(a, shift) SHL16_(a, shift, __FILE__, __LINE__) 160 static OPUS_INLINE short SHL16_(int a, int shift, char *file, int line) 161 { 162 int res; 163 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(shift)) 164 { 165 fprintf (stderr, "SHL16: inputs are not short: %d %d in %s: line %d\n", a, shift, file, line); 166 #ifdef FIXED_DEBUG_ASSERT 167 celt_assert(0); 168 #endif 169 } 170 res = a<<shift; 171 if (!VERIFY_SHORT(res)) 172 { 173 fprintf (stderr, "SHL16: output is not short: %d in %s: line %d\n", res, file, line); 174 #ifdef FIXED_DEBUG_ASSERT 175 celt_assert(0); 176 #endif 177 } 178 celt_mips++; 179 return res; 180 } 181 182 static OPUS_INLINE int SHR32(opus_int64 a, int shift) 183 { 184 opus_int64 res; 185 if (!VERIFY_INT(a) || !VERIFY_SHORT(shift)) 186 { 187 fprintf (stderr, "SHR32: inputs are not int: %d %d\n", (int)a, shift); 188 #ifdef FIXED_DEBUG_ASSERT 189 celt_assert(0); 190 #endif 191 } 192 res = a>>shift; 193 if (!VERIFY_INT(res)) 194 { 195 fprintf (stderr, "SHR32: output is not int: %d\n", (int)res); 196 #ifdef FIXED_DEBUG_ASSERT 197 celt_assert(0); 198 #endif 199 } 200 celt_mips+=2; 201 return res; 202 } 203 #define SHL32(a, shift) SHL32_(a, shift, __FILE__, __LINE__) 204 static OPUS_INLINE int SHL32_(opus_int64 a, int shift, char *file, int line) 205 { 206 opus_int64 res; 207 if (!VERIFY_INT(a) || !VERIFY_SHORT(shift)) 208 { 209 fprintf (stderr, "SHL32: inputs are not int: %lld %d in %s: line %d\n", a, shift, file, line); 210 #ifdef FIXED_DEBUG_ASSERT 211 celt_assert(0); 212 #endif 213 } 214 res = a<<shift; 215 if (!VERIFY_INT(res)) 216 { 217 fprintf (stderr, "SHL32: output is not int: %lld<<%d = %lld in %s: line %d\n", a, shift, res, file, line); 218 #ifdef FIXED_DEBUG_ASSERT 219 celt_assert(0); 220 #endif 221 } 222 celt_mips+=2; 223 return res; 224 } 225 226 #define PSHR32(a,shift) (celt_mips--,SHR32(ADD32((a),(((opus_val32)(1)<<((shift))>>1))),shift)) 227 #define VSHR32(a, shift) (((shift)>0) ? SHR32(a, shift) : SHL32(a, -(shift))) 228 229 #define ROUND16(x,a) (celt_mips--,EXTRACT16(PSHR32((x),(a)))) 230 #define HALF16(x) (SHR16(x,1)) 231 #define HALF32(x) (SHR32(x,1)) 232 233 //#define SHR(a,shift) ((a) >> (shift)) 234 //#define SHL(a,shift) ((a) << (shift)) 235 236 #define ADD16(a, b) ADD16_(a, b, __FILE__, __LINE__) 237 static OPUS_INLINE short ADD16_(int a, int b, char *file, int line) 238 { 239 int res; 240 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 241 { 242 fprintf (stderr, "ADD16: inputs are not short: %d %d in %s: line %d\n", a, b, file, line); 243 #ifdef FIXED_DEBUG_ASSERT 244 celt_assert(0); 245 #endif 246 } 247 res = a+b; 248 if (!VERIFY_SHORT(res)) 249 { 250 fprintf (stderr, "ADD16: output is not short: %d+%d=%d in %s: line %d\n", a,b,res, file, line); 251 #ifdef FIXED_DEBUG_ASSERT 252 celt_assert(0); 253 #endif 254 } 255 celt_mips++; 256 return res; 257 } 258 259 #define SUB16(a, b) SUB16_(a, b, __FILE__, __LINE__) 260 static OPUS_INLINE short SUB16_(int a, int b, char *file, int line) 261 { 262 int res; 263 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 264 { 265 fprintf (stderr, "SUB16: inputs are not short: %d %d in %s: line %d\n", a, b, file, line); 266 #ifdef FIXED_DEBUG_ASSERT 267 celt_assert(0); 268 #endif 269 } 270 res = a-b; 271 if (!VERIFY_SHORT(res)) 272 { 273 fprintf (stderr, "SUB16: output is not short: %d in %s: line %d\n", res, file, line); 274 #ifdef FIXED_DEBUG_ASSERT 275 celt_assert(0); 276 #endif 277 } 278 celt_mips++; 279 return res; 280 } 281 282 #define ADD32(a, b) ADD32_(a, b, __FILE__, __LINE__) 283 static OPUS_INLINE int ADD32_(opus_int64 a, opus_int64 b, char *file, int line) 284 { 285 opus_int64 res; 286 if (!VERIFY_INT(a) || !VERIFY_INT(b)) 287 { 288 fprintf (stderr, "ADD32: inputs are not int: %d %d in %s: line %d\n", (int)a, (int)b, file, line); 289 #ifdef FIXED_DEBUG_ASSERT 290 celt_assert(0); 291 #endif 292 } 293 res = a+b; 294 if (!VERIFY_INT(res)) 295 { 296 fprintf (stderr, "ADD32: output is not int: %d in %s: line %d\n", (int)res, file, line); 297 #ifdef FIXED_DEBUG_ASSERT 298 celt_assert(0); 299 #endif 300 } 301 celt_mips+=2; 302 return res; 303 } 304 305 #define SUB32(a, b) SUB32_(a, b, __FILE__, __LINE__) 306 static OPUS_INLINE int SUB32_(opus_int64 a, opus_int64 b, char *file, int line) 307 { 308 opus_int64 res; 309 if (!VERIFY_INT(a) || !VERIFY_INT(b)) 310 { 311 fprintf (stderr, "SUB32: inputs are not int: %d %d in %s: line %d\n", (int)a, (int)b, file, line); 312 #ifdef FIXED_DEBUG_ASSERT 313 celt_assert(0); 314 #endif 315 } 316 res = a-b; 317 if (!VERIFY_INT(res)) 318 { 319 fprintf (stderr, "SUB32: output is not int: %d in %s: line %d\n", (int)res, file, line); 320 #ifdef FIXED_DEBUG_ASSERT 321 celt_assert(0); 322 #endif 323 } 324 celt_mips+=2; 325 return res; 326 } 327 328 #undef UADD32 329 #define UADD32(a, b) UADD32_(a, b, __FILE__, __LINE__) 330 static OPUS_INLINE unsigned int UADD32_(opus_uint64 a, opus_uint64 b, char *file, int line) 331 { 332 opus_uint64 res; 333 if (!VERIFY_UINT(a) || !VERIFY_UINT(b)) 334 { 335 fprintf (stderr, "UADD32: inputs are not uint32: %llu %llu in %s: line %d\n", a, b, file, line); 336 #ifdef FIXED_DEBUG_ASSERT 337 celt_assert(0); 338 #endif 339 } 340 res = a+b; 341 if (!VERIFY_UINT(res)) 342 { 343 fprintf (stderr, "UADD32: output is not uint32: %llu in %s: line %d\n", res, file, line); 344 #ifdef FIXED_DEBUG_ASSERT 345 celt_assert(0); 346 #endif 347 } 348 celt_mips+=2; 349 return res; 350 } 351 352 #undef USUB32 353 #define USUB32(a, b) USUB32_(a, b, __FILE__, __LINE__) 354 static OPUS_INLINE unsigned int USUB32_(opus_uint64 a, opus_uint64 b, char *file, int line) 355 { 356 opus_uint64 res; 357 if (!VERIFY_UINT(a) || !VERIFY_UINT(b)) 358 { 359 fprintf (stderr, "USUB32: inputs are not uint32: %llu %llu in %s: line %d\n", a, b, file, line); 360 #ifdef FIXED_DEBUG_ASSERT 361 celt_assert(0); 362 #endif 363 } 364 if (a<b) 365 { 366 fprintf (stderr, "USUB32: inputs underflow: %llu < %llu in %s: line %d\n", a, b, file, line); 367 #ifdef FIXED_DEBUG_ASSERT 368 celt_assert(0); 369 #endif 370 } 371 res = a-b; 372 if (!VERIFY_UINT(res)) 373 { 374 fprintf (stderr, "USUB32: output is not uint32: %llu - %llu = %llu in %s: line %d\n", a, b, res, file, line); 375 #ifdef FIXED_DEBUG_ASSERT 376 celt_assert(0); 377 #endif 378 } 379 celt_mips+=2; 380 return res; 381 } 382 383 /* result fits in 16 bits */ 384 static OPUS_INLINE short MULT16_16_16(int a, int b) 385 { 386 int res; 387 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 388 { 389 fprintf (stderr, "MULT16_16_16: inputs are not short: %d %d\n", a, b); 390 #ifdef FIXED_DEBUG_ASSERT 391 celt_assert(0); 392 #endif 393 } 394 res = a*b; 395 if (!VERIFY_SHORT(res)) 396 { 397 fprintf (stderr, "MULT16_16_16: output is not short: %d\n", res); 398 #ifdef FIXED_DEBUG_ASSERT 399 celt_assert(0); 400 #endif 401 } 402 celt_mips++; 403 return res; 404 } 405 406 #define MULT16_16(a, b) MULT16_16_(a, b, __FILE__, __LINE__) 407 static OPUS_INLINE int MULT16_16_(int a, int b, char *file, int line) 408 { 409 opus_int64 res; 410 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 411 { 412 fprintf (stderr, "MULT16_16: inputs are not short: %d %d in %s: line %d\n", a, b, file, line); 413 #ifdef FIXED_DEBUG_ASSERT 414 celt_assert(0); 415 #endif 416 } 417 res = ((opus_int64)a)*b; 418 if (!VERIFY_INT(res)) 419 { 420 fprintf (stderr, "MULT16_16: output is not int: %d in %s: line %d\n", (int)res, file, line); 421 #ifdef FIXED_DEBUG_ASSERT 422 celt_assert(0); 423 #endif 424 } 425 celt_mips++; 426 return res; 427 } 428 429 #define MAC16_16(c,a,b) (celt_mips-=2,ADD32((c),MULT16_16((a),(b)))) 430 431 #define MULT16_32_QX(a, b, Q) MULT16_32_QX_(a, b, Q, __FILE__, __LINE__) 432 static OPUS_INLINE int MULT16_32_QX_(int a, opus_int64 b, int Q, char *file, int line) 433 { 434 opus_int64 res; 435 if (!VERIFY_SHORT(a) || !VERIFY_INT(b)) 436 { 437 fprintf (stderr, "MULT16_32_Q%d: inputs are not short+int: %d %d in %s: line %d\n", Q, (int)a, (int)b, file, line); 438 #ifdef FIXED_DEBUG_ASSERT 439 celt_assert(0); 440 #endif 441 } 442 if (ABS32(b)>=((opus_val32)(1)<<(15+Q))) 443 { 444 fprintf (stderr, "MULT16_32_Q%d: second operand too large: %d %d in %s: line %d\n", Q, (int)a, (int)b, file, line); 445 #ifdef FIXED_DEBUG_ASSERT 446 celt_assert(0); 447 #endif 448 } 449 res = (((opus_int64)a)*(opus_int64)b) >> Q; 450 if (!VERIFY_INT(res)) 451 { 452 fprintf (stderr, "MULT16_32_Q%d: output is not int: %d*%d=%d in %s: line %d\n", Q, (int)a, (int)b,(int)res, file, line); 453 #ifdef FIXED_DEBUG_ASSERT 454 celt_assert(0); 455 #endif 456 } 457 if (Q==15) 458 celt_mips+=3; 459 else 460 celt_mips+=4; 461 return res; 462 } 463 464 #define MULT16_32_PX(a, b, Q) MULT16_32_PX_(a, b, Q, __FILE__, __LINE__) 465 static OPUS_INLINE int MULT16_32_PX_(int a, opus_int64 b, int Q, char *file, int line) 466 { 467 opus_int64 res; 468 if (!VERIFY_SHORT(a) || !VERIFY_INT(b)) 469 { 470 fprintf (stderr, "MULT16_32_P%d: inputs are not short+int: %d %d in %s: line %d\n\n", Q, (int)a, (int)b, file, line); 471 #ifdef FIXED_DEBUG_ASSERT 472 celt_assert(0); 473 #endif 474 } 475 if (ABS32(b)>=((opus_int64)(1)<<(15+Q))) 476 { 477 fprintf (stderr, "MULT16_32_Q%d: second operand too large: %d %d in %s: line %d\n\n", Q, (int)a, (int)b,file, line); 478 #ifdef FIXED_DEBUG_ASSERT 479 celt_assert(0); 480 #endif 481 } 482 res = ((((opus_int64)a)*(opus_int64)b) + (((opus_val32)(1)<<Q)>>1))>> Q; 483 if (!VERIFY_INT(res)) 484 { 485 fprintf (stderr, "MULT16_32_P%d: output is not int: %d*%d=%d in %s: line %d\n\n", Q, (int)a, (int)b,(int)res, file, line); 486 #ifdef FIXED_DEBUG_ASSERT 487 celt_assert(0); 488 #endif 489 } 490 if (Q==15) 491 celt_mips+=4; 492 else 493 celt_mips+=5; 494 return res; 495 } 496 497 #define MULT16_32_Q15(a,b) MULT16_32_QX(a,b,15) 498 #define MAC16_32_Q15(c,a,b) (celt_mips-=2,ADD32((c),MULT16_32_Q15((a),(b)))) 499 500 static OPUS_INLINE int SATURATE(int a, int b) 501 { 502 if (a>b) 503 a=b; 504 if (a<-b) 505 a = -b; 506 celt_mips+=3; 507 return a; 508 } 509 510 static OPUS_INLINE opus_int16 SATURATE16(opus_int32 a) 511 { 512 celt_mips+=3; 513 if (a>32767) 514 return 32767; 515 else if (a<-32768) 516 return -32768; 517 else return a; 518 } 519 520 static OPUS_INLINE int MULT16_16_Q11_32(int a, int b) 521 { 522 opus_int64 res; 523 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 524 { 525 fprintf (stderr, "MULT16_16_Q11: inputs are not short: %d %d\n", a, b); 526 #ifdef FIXED_DEBUG_ASSERT 527 celt_assert(0); 528 #endif 529 } 530 res = ((opus_int64)a)*b; 531 res >>= 11; 532 if (!VERIFY_INT(res)) 533 { 534 fprintf (stderr, "MULT16_16_Q11: output is not short: %d*%d=%d\n", (int)a, (int)b, (int)res); 535 #ifdef FIXED_DEBUG_ASSERT 536 celt_assert(0); 537 #endif 538 } 539 celt_mips+=3; 540 return res; 541 } 542 static OPUS_INLINE short MULT16_16_Q13(int a, int b) 543 { 544 opus_int64 res; 545 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 546 { 547 fprintf (stderr, "MULT16_16_Q13: inputs are not short: %d %d\n", a, b); 548 #ifdef FIXED_DEBUG_ASSERT 549 celt_assert(0); 550 #endif 551 } 552 res = ((opus_int64)a)*b; 553 res >>= 13; 554 if (!VERIFY_SHORT(res)) 555 { 556 fprintf (stderr, "MULT16_16_Q13: output is not short: %d*%d=%d\n", a, b, (int)res); 557 #ifdef FIXED_DEBUG_ASSERT 558 celt_assert(0); 559 #endif 560 } 561 celt_mips+=3; 562 return res; 563 } 564 static OPUS_INLINE short MULT16_16_Q14(int a, int b) 565 { 566 opus_int64 res; 567 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 568 { 569 fprintf (stderr, "MULT16_16_Q14: inputs are not short: %d %d\n", a, b); 570 #ifdef FIXED_DEBUG_ASSERT 571 celt_assert(0); 572 #endif 573 } 574 res = ((opus_int64)a)*b; 575 res >>= 14; 576 if (!VERIFY_SHORT(res)) 577 { 578 fprintf (stderr, "MULT16_16_Q14: output is not short: %d\n", (int)res); 579 #ifdef FIXED_DEBUG_ASSERT 580 celt_assert(0); 581 #endif 582 } 583 celt_mips+=3; 584 return res; 585 } 586 587 #define MULT16_16_Q15(a, b) MULT16_16_Q15_(a, b, __FILE__, __LINE__) 588 static OPUS_INLINE short MULT16_16_Q15_(int a, int b, char *file, int line) 589 { 590 opus_int64 res; 591 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 592 { 593 fprintf (stderr, "MULT16_16_Q15: inputs are not short: %d %d in %s: line %d\n", a, b, file, line); 594 #ifdef FIXED_DEBUG_ASSERT 595 celt_assert(0); 596 #endif 597 } 598 res = ((opus_int64)a)*b; 599 res >>= 15; 600 if (!VERIFY_SHORT(res)) 601 { 602 fprintf (stderr, "MULT16_16_Q15: output is not short: %d in %s: line %d\n", (int)res, file, line); 603 #ifdef FIXED_DEBUG_ASSERT 604 celt_assert(0); 605 #endif 606 } 607 celt_mips+=1; 608 return res; 609 } 610 611 static OPUS_INLINE short MULT16_16_P13(int a, int b) 612 { 613 opus_int64 res; 614 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 615 { 616 fprintf (stderr, "MULT16_16_P13: inputs are not short: %d %d\n", a, b); 617 #ifdef FIXED_DEBUG_ASSERT 618 celt_assert(0); 619 #endif 620 } 621 res = ((opus_int64)a)*b; 622 res += 4096; 623 if (!VERIFY_INT(res)) 624 { 625 fprintf (stderr, "MULT16_16_P13: overflow: %d*%d=%d\n", a, b, (int)res); 626 #ifdef FIXED_DEBUG_ASSERT 627 celt_assert(0); 628 #endif 629 } 630 res >>= 13; 631 if (!VERIFY_SHORT(res)) 632 { 633 fprintf (stderr, "MULT16_16_P13: output is not short: %d*%d=%d\n", a, b, (int)res); 634 #ifdef FIXED_DEBUG_ASSERT 635 celt_assert(0); 636 #endif 637 } 638 celt_mips+=4; 639 return res; 640 } 641 static OPUS_INLINE short MULT16_16_P14(int a, int b) 642 { 643 opus_int64 res; 644 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 645 { 646 fprintf (stderr, "MULT16_16_P14: inputs are not short: %d %d\n", a, b); 647 #ifdef FIXED_DEBUG_ASSERT 648 celt_assert(0); 649 #endif 650 } 651 res = ((opus_int64)a)*b; 652 res += 8192; 653 if (!VERIFY_INT(res)) 654 { 655 fprintf (stderr, "MULT16_16_P14: overflow: %d*%d=%d\n", a, b, (int)res); 656 #ifdef FIXED_DEBUG_ASSERT 657 celt_assert(0); 658 #endif 659 } 660 res >>= 14; 661 if (!VERIFY_SHORT(res)) 662 { 663 fprintf (stderr, "MULT16_16_P14: output is not short: %d*%d=%d\n", a, b, (int)res); 664 #ifdef FIXED_DEBUG_ASSERT 665 celt_assert(0); 666 #endif 667 } 668 celt_mips+=4; 669 return res; 670 } 671 static OPUS_INLINE short MULT16_16_P15(int a, int b) 672 { 673 opus_int64 res; 674 if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 675 { 676 fprintf (stderr, "MULT16_16_P15: inputs are not short: %d %d\n", a, b); 677 #ifdef FIXED_DEBUG_ASSERT 678 celt_assert(0); 679 #endif 680 } 681 res = ((opus_int64)a)*b; 682 res += 16384; 683 if (!VERIFY_INT(res)) 684 { 685 fprintf (stderr, "MULT16_16_P15: overflow: %d*%d=%d\n", a, b, (int)res); 686 #ifdef FIXED_DEBUG_ASSERT 687 celt_assert(0); 688 #endif 689 } 690 res >>= 15; 691 if (!VERIFY_SHORT(res)) 692 { 693 fprintf (stderr, "MULT16_16_P15: output is not short: %d*%d=%d\n", a, b, (int)res); 694 #ifdef FIXED_DEBUG_ASSERT 695 celt_assert(0); 696 #endif 697 } 698 celt_mips+=2; 699 return res; 700 } 701 702 #define DIV32_16(a, b) DIV32_16_(a, b, __FILE__, __LINE__) 703 704 static OPUS_INLINE int DIV32_16_(opus_int64 a, opus_int64 b, char *file, int line) 705 { 706 opus_int64 res; 707 if (b==0) 708 { 709 fprintf(stderr, "DIV32_16: divide by zero: %d/%d in %s: line %d\n", (int)a, (int)b, file, line); 710 #ifdef FIXED_DEBUG_ASSERT 711 celt_assert(0); 712 #endif 713 return 0; 714 } 715 if (!VERIFY_INT(a) || !VERIFY_SHORT(b)) 716 { 717 fprintf (stderr, "DIV32_16: inputs are not int/short: %d %d in %s: line %d\n", (int)a, (int)b, file, line); 718 #ifdef FIXED_DEBUG_ASSERT 719 celt_assert(0); 720 #endif 721 } 722 res = a/b; 723 if (!VERIFY_SHORT(res)) 724 { 725 fprintf (stderr, "DIV32_16: output is not short: %d / %d = %d in %s: line %d\n", (int)a,(int)b,(int)res, file, line); 726 if (res>32767) 727 res = 32767; 728 if (res<-32768) 729 res = -32768; 730 #ifdef FIXED_DEBUG_ASSERT 731 celt_assert(0); 732 #endif 733 } 734 celt_mips+=35; 735 return res; 736 } 737 738 #define DIV32(a, b) DIV32_(a, b, __FILE__, __LINE__) 739 static OPUS_INLINE int DIV32_(opus_int64 a, opus_int64 b, char *file, int line) 740 { 741 opus_int64 res; 742 if (b==0) 743 { 744 fprintf(stderr, "DIV32: divide by zero: %d/%d in %s: line %d\n", (int)a, (int)b, file, line); 745 #ifdef FIXED_DEBUG_ASSERT 746 celt_assert(0); 747 #endif 748 return 0; 749 } 750 751 if (!VERIFY_INT(a) || !VERIFY_INT(b)) 752 { 753 fprintf (stderr, "DIV32: inputs are not int/short: %d %d in %s: line %d\n", (int)a, (int)b, file, line); 754 #ifdef FIXED_DEBUG_ASSERT 755 celt_assert(0); 756 #endif 757 } 758 res = a/b; 759 if (!VERIFY_INT(res)) 760 { 761 fprintf (stderr, "DIV32: output is not int: %d in %s: line %d\n", (int)res, file, line); 762 #ifdef FIXED_DEBUG_ASSERT 763 celt_assert(0); 764 #endif 765 } 766 celt_mips+=70; 767 return res; 768 } 769 770 #undef PRINT_MIPS 771 #define PRINT_MIPS(file) do {fprintf (file, "total complexity = %llu MIPS\n", celt_mips);} while (0); 772 773 #endif 774
