fixed_debug.h
资源名称:tcpmp.rar [点击查看]
上传用户:wstnjxml
上传日期:2014-04-03
资源大小:7248k
文件大小:12k
源码类别:
Windows CE
开发平台:
C/C++
- /* Copyright (C) 2003 Jean-Marc Valin */
- /**
- @file fixed_debug.h
- @brief Fixed-point operations with debugging
- */
- /*
- Redistribution and use in source and binary forms, with or without
- modification, are permitted provided that the following conditions
- are met:
- - Redistributions of source code must retain the above copyright
- notice, this list of conditions and the following disclaimer.
- - Redistributions in binary form must reproduce the above copyright
- notice, this list of conditions and the following disclaimer in the
- documentation and/or other materials provided with the distribution.
- - Neither the name of the Xiph.org Foundation nor the names of its
- contributors may be used to endorse or promote products derived from
- this software without specific prior written permission.
- THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
- ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
- LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
- A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR
- CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
- EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
- PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
- PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
- LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
- NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
- SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
- #ifndef FIXED_DEBUG_H
- #define FIXED_DEBUG_H
- #include <stdio.h>
- extern long long spx_mips;
- #define MIPS_INC spx_mips++,
- #define VERIFY_SHORT(x) ((x)<=32767&&(x)>=-32768)
- #define VERIFY_INT(x) ((x)<=2147483647LL&&(x)>=-2147483648LL)
- static inline short NEG16(int x)
- {
- int res;
- if (!VERIFY_SHORT(x))
- {
- fprintf (stderr, "NEG16: input is not short: %dn", (int)x);
- }
- res = -x;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "NEG16: output is not short: %dn", (int)res);
- spx_mips++;
- return res;
- }
- static inline int NEG32(long long x)
- {
- long long res;
- if (!VERIFY_INT(x))
- {
- fprintf (stderr, "NEG16: input is not int: %dn", (int)x);
- }
- res = -x;
- if (!VERIFY_INT(res))
- fprintf (stderr, "NEG16: output is not int: %dn", (int)res);
- spx_mips++;
- return res;
- }
- static inline short EXTRACT16(int x)
- {
- int res;
- if (!VERIFY_SHORT(x))
- {
- fprintf (stderr, "EXTRACT16: input is not short: %dn", x);
- }
- res = x;
- spx_mips++;
- return res;
- }
- static inline int EXTEND32(int x)
- {
- int res;
- if (!VERIFY_SHORT(x))
- {
- fprintf (stderr, "EXTRACT16: input is not short: %dn", x);
- }
- res = x;
- spx_mips++;
- return res;
- }
- static inline short SHR16(int a, int shift)
- {
- int res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(shift))
- {
- fprintf (stderr, "SHR16: inputs are not short: %d %dn", a, shift);
- }
- res = a>>shift;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "SHR16: output is not short: %dn", res);
- spx_mips++;
- return res;
- }
- static inline short SHL16(int a, int shift)
- {
- int res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(shift))
- {
- fprintf (stderr, "SHR16: inputs are not short: %d %dn", a, shift);
- }
- res = a<<shift;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "SHR16: output is not short: %dn", res);
- spx_mips++;
- return res;
- }
- static inline int SHR32(long long a, int shift)
- {
- long long res;
- if (!VERIFY_INT(a) || !VERIFY_SHORT(shift))
- {
- fprintf (stderr, "SHR32: inputs are not int: %d %dn", (int)a, shift);
- }
- res = a>>shift;
- if (!VERIFY_INT(res))
- fprintf (stderr, "SHR32: output is not int: %dn", (int)res);
- spx_mips++;
- return res;
- }
- static inline int SHL32(long long a, int shift)
- {
- long long res;
- if (!VERIFY_INT(a) || !VERIFY_SHORT(shift))
- {
- fprintf (stderr, "SHR32: inputs are not int: %d %dn", (int)a, shift);
- }
- res = a<<shift;
- if (!VERIFY_INT(res))
- fprintf (stderr, "SHR32: output is not int: %dn", (int)res);
- spx_mips++;
- return res;
- }
- #define PSHR16(a,shift) (SHR16(ADD16(a,(1<<((shift)-1))),shift))
- #define PSHR32(a,shift) (SHR32(ADD32(a,(1<<((shift)-1))),shift))
- #define SATURATE16(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x)))
- #define SATURATE32(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x)))
- #define SHR(a,shift) ((a) >> (shift))
- #define SHL(a,shift) ((a) << (shift))
- static inline short ADD16(int a, int b)
- {
- int res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "ADD16: inputs are not short: %d %dn", a, b);
- }
- res = a+b;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "ADD16: output is not short: %dn", res);
- spx_mips++;
- return res;
- }
- static inline short SUB16(int a, int b)
- {
- int res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "SUB16: inputs are not short: %d %dn", a, b);
- }
- res = a-b;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "SUB16: output is not short: %dn", res);
- spx_mips++;
- return res;
- }
- static inline int ADD32(long long a, long long b)
- {
- long long res;
- if (!VERIFY_INT(a) || !VERIFY_INT(b))
- {
- fprintf (stderr, "ADD32: inputs are not int: %d %dn", (int)a, (int)b);
- }
- res = a+b;
- if (!VERIFY_INT(res))
- fprintf (stderr, "ADD32: output is not int: %dn", (int)res);
- spx_mips++;
- return res;
- }
- static inline int SUB32(long long a, long long b)
- {
- long long res;
- if (!VERIFY_INT(a) || !VERIFY_INT(b))
- {
- fprintf (stderr, "SUB32: inputs are not int: %d %dn", (int)a, (int)b);
- }
- res = a-b;
- if (!VERIFY_INT(res))
- fprintf (stderr, "SUB32: output is not int: %dn", (int)res);
- spx_mips++;
- return res;
- }
- #define ADD64(a,b) (MIPS_INC(a)+(b))
- #define PSHR(a,shift) (SHR((a)+(1<<((shift)-1)),shift))
- /* result fits in 16 bits */
- static inline short MULT16_16_16(int a, int b)
- {
- int res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "MULT16_16_16: inputs are not short: %d %dn", a, b);
- }
- res = a*b;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "MULT16_16_16: output is not short: %dn", res);
- spx_mips++;
- return res;
- }
- static inline int MULT16_16(int a, int b)
- {
- long long res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "MULT16_16: inputs are not short: %d %dn", a, b);
- }
- res = ((long long)a)*b;
- if (!VERIFY_INT(res))
- fprintf (stderr, "MULT16_16: output is not int: %dn", (int)res);
- spx_mips++;
- return res;
- }
- #define MAC16_16(c,a,b) (spx_mips--,ADD32((c),MULT16_16((a),(b))))
- #define MAC16_16_Q11(c,a,b) (ADD16((c),EXTRACT16(SHR32(MULT16_16((a),(b)),11))))
- #define MAC16_16_Q13(c,a,b) (ADD16((c),EXTRACT16(SHR32(MULT16_16((a),(b)),13))))
- static inline int MULT16_32_QX(int a, long long b, int Q)
- {
- long long res;
- if (!VERIFY_SHORT(a) || !VERIFY_INT(b))
- {
- fprintf (stderr, "MULT16_32_Q%d: inputs are not short+int: %d %dn", Q, (int)a, (int)b);
- }
- res = (((long long)a)*(long long)b) >> Q;
- if (!VERIFY_INT(res))
- fprintf (stderr, "MULT16_32_Q%d: output is not int: %d*%d=%dn", Q, (int)a, (int)b,(int)res);
- spx_mips+=5;
- return res;
- }
- #define MULT16_32_Q11(a,b) MULT16_32_QX(a,b,11)
- #define MAC16_32_Q11(c,a,b) ADD32((c),MULT16_32_Q11((a),(b)))
- #define MULT16_32_Q12(a,b) MULT16_32_QX(a,b,12)
- #define MULT16_32_Q13(a,b) MULT16_32_QX(a,b,13)
- #define MULT16_32_Q14(a,b) MULT16_32_QX(a,b,14)
- #define MULT16_32_Q15(a,b) MULT16_32_QX(a,b,15)
- #define MAC16_32_Q15(c,a,b) ADD32((c),MULT16_32_Q15((a),(b)))
- static inline int SATURATE(int a, int b)
- {
- if (a>b)
- a=b;
- if (a<-b)
- a = -b;
- return a;
- }
- static inline int MULT16_16_Q11_32(int a, int b)
- {
- long long res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "MULT16_16_Q11: inputs are not short: %d %dn", a, b);
- }
- res = ((long long)a)*b;
- res >>= 11;
- if (!VERIFY_INT(res))
- fprintf (stderr, "MULT16_16_Q11: output is not short: %d*%d=%dn", (int)a, (int)b, (int)res);
- spx_mips+=3;
- return res;
- }
- static inline short MULT16_16_Q13(int a, int b)
- {
- long long res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "MULT16_16_Q13: inputs are not short: %d %dn", a, b);
- }
- res = ((long long)a)*b;
- res >>= 13;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "MULT16_16_Q13: output is not short: %d*%d=%dn", a, b, (int)res);
- spx_mips+=3;
- return res;
- }
- static inline short MULT16_16_Q14(int a, int b)
- {
- long long res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "MULT16_16_Q14: inputs are not short: %d %dn", a, b);
- }
- res = ((long long)a)*b;
- res >>= 14;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "MULT16_16_Q14: output is not short: %dn", (int)res);
- spx_mips+=3;
- return res;
- }
- static inline short MULT16_16_Q15(int a, int b)
- {
- long long res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "MULT16_16_Q15: inputs are not short: %d %dn", a, b);
- }
- res = ((long long)a)*b;
- res >>= 15;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "MULT16_16_Q15: output is not short: %dn", (int)res);
- spx_mips+=3;
- return res;
- }
- static inline short MULT16_16_P13(int a, int b)
- {
- long long res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "MULT16_16_P13: inputs are not short: %d %dn", a, b);
- }
- res = ((long long)a)*b;
- res += 4096;
- if (!VERIFY_INT(res))
- fprintf (stderr, "MULT16_16_P13: overflow: %d*%d=%dn", a, b, (int)res);
- res >>= 13;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "MULT16_16_P13: output is not short: %d*%d=%dn", a, b, (int)res);
- spx_mips+=4;
- return res;
- }
- static inline short MULT16_16_P14(int a, int b)
- {
- long long res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "MULT16_16_P14: inputs are not short: %d %dn", a, b);
- }
- res = ((long long)a)*b;
- res += 8192;
- if (!VERIFY_INT(res))
- fprintf (stderr, "MULT16_16_P14: overflow: %d*%d=%dn", a, b, (int)res);
- res >>= 14;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "MULT16_16_P14: output is not short: %d*%d=%dn", a, b, (int)res);
- spx_mips+=4;
- return res;
- }
- static inline short MULT16_16_P15(int a, int b)
- {
- long long res;
- if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "MULT16_16_P15: inputs are not short: %d %dn", a, b);
- }
- res = ((long long)a)*b;
- res += 16384;
- if (!VERIFY_INT(res))
- fprintf (stderr, "MULT16_16_P15: overflow: %d*%d=%dn", a, b, (int)res);
- res >>= 15;
- if (!VERIFY_SHORT(res))
- fprintf (stderr, "MULT16_16_P15: output is not short: %d*%d=%dn", a, b, (int)res);
- spx_mips+=4;
- return res;
- }
- static inline int DIV32_16(long long a, long long b)
- {
- long long res;
- if (b==0)
- {
- fprintf(stderr, "DIV32_16: divide by zero: %d/%dn", (int)a, (int)b);
- return 0;
- }
- if (!VERIFY_INT(a) || !VERIFY_SHORT(b))
- {
- fprintf (stderr, "DIV32_16: inputs are not int/short: %d %dn", (int)a, (int)b);
- }
- res = a/b;
- if (!VERIFY_SHORT(res))
- {
- fprintf (stderr, "DIV32_16: output is not short: %d / %d = %dn", (int)a,(int)b,(int)res);
- if (res>32767)
- res = 32767;
- if (res<-32768)
- res = -32768;
- }
- spx_mips+=20;
- return res;
- }
- static inline int DIV32(long long a, long long b)
- {
- long long res;
- if (b==0)
- {
- fprintf(stderr, "DIV32: divide by zero: %d/%dn", (int)a, (int)b);
- return 0;
- }
- if (!VERIFY_INT(a) || !VERIFY_INT(b))
- {
- fprintf (stderr, "DIV32: inputs are not int/short: %d %dn", (int)a, (int)b);
- }
- res = a/b;
- if (!VERIFY_INT(res))
- fprintf (stderr, "DIV32: output is not int: %dn", (int)res);
- spx_mips+=36;
- return res;
- }
- #endif