ex

Fork of mbed-os-example-mbed5-blinky by mbed-os-examples

Committer:
TMBOY
Date:
Tue Jul 18 16:54:45 2017 +0800
Revision:
47:9e361da97763
?

Who changed what in which revision?

UserRevisionLine numberNew contents of line
TMBOY 47:9e361da97763 1 /* Copyright (C) 2003 Jean-Marc Valin */
TMBOY 47:9e361da97763 2 /**
TMBOY 47:9e361da97763 3 @file fixed_generic.h
TMBOY 47:9e361da97763 4 @brief Generic fixed-point operations
TMBOY 47:9e361da97763 5 */
TMBOY 47:9e361da97763 6 /*
TMBOY 47:9e361da97763 7 Redistribution and use in source and binary forms, with or without
TMBOY 47:9e361da97763 8 modification, are permitted provided that the following conditions
TMBOY 47:9e361da97763 9 are met:
TMBOY 47:9e361da97763 10
TMBOY 47:9e361da97763 11 - Redistributions of source code must retain the above copyright
TMBOY 47:9e361da97763 12 notice, this list of conditions and the following disclaimer.
TMBOY 47:9e361da97763 13
TMBOY 47:9e361da97763 14 - Redistributions in binary form must reproduce the above copyright
TMBOY 47:9e361da97763 15 notice, this list of conditions and the following disclaimer in the
TMBOY 47:9e361da97763 16 documentation and/or other materials provided with the distribution.
TMBOY 47:9e361da97763 17
TMBOY 47:9e361da97763 18 - Neither the name of the Xiph.org Foundation nor the names of its
TMBOY 47:9e361da97763 19 contributors may be used to endorse or promote products derived from
TMBOY 47:9e361da97763 20 this software without specific prior written permission.
TMBOY 47:9e361da97763 21
TMBOY 47:9e361da97763 22 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
TMBOY 47:9e361da97763 23 ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
TMBOY 47:9e361da97763 24 LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
TMBOY 47:9e361da97763 25 A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR
TMBOY 47:9e361da97763 26 CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
TMBOY 47:9e361da97763 27 EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
TMBOY 47:9e361da97763 28 PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
TMBOY 47:9e361da97763 29 PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
TMBOY 47:9e361da97763 30 LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
TMBOY 47:9e361da97763 31 NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
TMBOY 47:9e361da97763 32 SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
TMBOY 47:9e361da97763 33 */
TMBOY 47:9e361da97763 34
TMBOY 47:9e361da97763 35 #ifndef FIXED_GENERIC_H
TMBOY 47:9e361da97763 36 #define FIXED_GENERIC_H
TMBOY 47:9e361da97763 37
TMBOY 47:9e361da97763 38 #define QCONST16(x,bits) ((spx_word16_t)(.5+(x)*(((spx_word32_t)1)<<(bits))))
TMBOY 47:9e361da97763 39 #define QCONST32(x,bits) ((spx_word32_t)(.5+(x)*(((spx_word32_t)1)<<(bits))))
TMBOY 47:9e361da97763 40
TMBOY 47:9e361da97763 41 #define NEG16(x) (-(x))
TMBOY 47:9e361da97763 42 #define NEG32(x) (-(x))
TMBOY 47:9e361da97763 43 #define EXTRACT16(x) ((spx_word16_t)(x))
TMBOY 47:9e361da97763 44 #define EXTEND32(x) ((spx_word32_t)(x))
TMBOY 47:9e361da97763 45 #define SHR16(a,shift) ((a) >> (shift))
TMBOY 47:9e361da97763 46 #define SHL16(a,shift) ((a) << (shift))
TMBOY 47:9e361da97763 47 #define SHR32(a,shift) ((a) >> (shift))
TMBOY 47:9e361da97763 48 #define SHL32(a,shift) ((a) << (shift))
TMBOY 47:9e361da97763 49 #define PSHR16(a,shift) (SHR16((a)+((1<<((shift))>>1)),shift))
TMBOY 47:9e361da97763 50 #define PSHR32(a,shift) (SHR32((a)+((1<<((shift))>>1)),shift))
TMBOY 47:9e361da97763 51 #define VSHR32(a, shift) (((shift)>0) ? SHR32(a, shift) : SHL32(a, -(shift)))
TMBOY 47:9e361da97763 52 #define SATURATE16(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x)))
TMBOY 47:9e361da97763 53 #define SATURATE32(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x)))
TMBOY 47:9e361da97763 54
TMBOY 47:9e361da97763 55 #define SHR(a,shift) ((a) >> (shift))
TMBOY 47:9e361da97763 56 #define SHL(a,shift) ((spx_word32_t)(a) << (shift))
TMBOY 47:9e361da97763 57 #define PSHR(a,shift) (SHR((a)+((1<<((shift))>>1)),shift))
TMBOY 47:9e361da97763 58 #define SATURATE(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x)))
TMBOY 47:9e361da97763 59
TMBOY 47:9e361da97763 60
TMBOY 47:9e361da97763 61 #define ADD16(a,b) ((spx_word16_t)((spx_word16_t)(a)+(spx_word16_t)(b)))
TMBOY 47:9e361da97763 62 #define SUB16(a,b) ((spx_word16_t)(a)-(spx_word16_t)(b))
TMBOY 47:9e361da97763 63 #define ADD32(a,b) ((spx_word32_t)(a)+(spx_word32_t)(b))
TMBOY 47:9e361da97763 64 #define SUB32(a,b) ((spx_word32_t)(a)-(spx_word32_t)(b))
TMBOY 47:9e361da97763 65
TMBOY 47:9e361da97763 66
TMBOY 47:9e361da97763 67 /* result fits in 16 bits */
TMBOY 47:9e361da97763 68 #define MULT16_16_16(a,b) ((((spx_word16_t)(a))*((spx_word16_t)(b))))
TMBOY 47:9e361da97763 69
TMBOY 47:9e361da97763 70 /* (spx_word32_t)(spx_word16_t) gives TI compiler a hint that it's 16x16->32 multiply */
TMBOY 47:9e361da97763 71 #define MULT16_16(a,b) (((spx_word32_t)(spx_word16_t)(a))*((spx_word32_t)(spx_word16_t)(b)))
TMBOY 47:9e361da97763 72
TMBOY 47:9e361da97763 73 #define MAC16_16(c,a,b) (ADD32((c),MULT16_16((a),(b))))
TMBOY 47:9e361da97763 74 #define MULT16_32_Q12(a,b) ADD32(MULT16_16((a),SHR((b),12)), SHR(MULT16_16((a),((b)&0x00000fff)),12))
TMBOY 47:9e361da97763 75 #define MULT16_32_Q13(a,b) ADD32(MULT16_16((a),SHR((b),13)), SHR(MULT16_16((a),((b)&0x00001fff)),13))
TMBOY 47:9e361da97763 76 #define MULT16_32_Q14(a,b) ADD32(MULT16_16((a),SHR((b),14)), SHR(MULT16_16((a),((b)&0x00003fff)),14))
TMBOY 47:9e361da97763 77
TMBOY 47:9e361da97763 78 #define MULT16_32_Q11(a,b) ADD32(MULT16_16((a),SHR((b),11)), SHR(MULT16_16((a),((b)&0x000007ff)),11))
TMBOY 47:9e361da97763 79 #define MAC16_32_Q11(c,a,b) ADD32(c,ADD32(MULT16_16((a),SHR((b),11)), SHR(MULT16_16((a),((b)&0x000007ff)),11)))
TMBOY 47:9e361da97763 80
TMBOY 47:9e361da97763 81 #define MULT16_32_P15(a,b) ADD32(MULT16_16((a),SHR((b),15)), PSHR(MULT16_16((a),((b)&0x00007fff)),15))
TMBOY 47:9e361da97763 82 #define MULT16_32_Q15(a,b) ADD32(MULT16_16((a),SHR((b),15)), SHR(MULT16_16((a),((b)&0x00007fff)),15))
TMBOY 47:9e361da97763 83 #define MAC16_32_Q15(c,a,b) ADD32(c,ADD32(MULT16_16((a),SHR((b),15)), SHR(MULT16_16((a),((b)&0x00007fff)),15)))
TMBOY 47:9e361da97763 84
TMBOY 47:9e361da97763 85
TMBOY 47:9e361da97763 86 #define MAC16_16_Q11(c,a,b) (ADD32((c),SHR(MULT16_16((a),(b)),11)))
TMBOY 47:9e361da97763 87 #define MAC16_16_Q13(c,a,b) (ADD32((c),SHR(MULT16_16((a),(b)),13)))
TMBOY 47:9e361da97763 88 #define MAC16_16_P13(c,a,b) (ADD32((c),SHR(ADD32(4096,MULT16_16((a),(b))),13)))
TMBOY 47:9e361da97763 89
TMBOY 47:9e361da97763 90 #define MULT16_16_Q11_32(a,b) (SHR(MULT16_16((a),(b)),11))
TMBOY 47:9e361da97763 91 #define MULT16_16_Q13(a,b) (SHR(MULT16_16((a),(b)),13))
TMBOY 47:9e361da97763 92 #define MULT16_16_Q14(a,b) (SHR(MULT16_16((a),(b)),14))
TMBOY 47:9e361da97763 93 #define MULT16_16_Q15(a,b) (SHR(MULT16_16((a),(b)),15))
TMBOY 47:9e361da97763 94
TMBOY 47:9e361da97763 95 #define MULT16_16_P13(a,b) (SHR(ADD32(4096,MULT16_16((a),(b))),13))
TMBOY 47:9e361da97763 96 #define MULT16_16_P14(a,b) (SHR(ADD32(8192,MULT16_16((a),(b))),14))
TMBOY 47:9e361da97763 97 #define MULT16_16_P15(a,b) (SHR(ADD32(16384,MULT16_16((a),(b))),15))
TMBOY 47:9e361da97763 98
TMBOY 47:9e361da97763 99 #define MUL_16_32_R15(a,bh,bl) ADD32(MULT16_16((a),(bh)), SHR(MULT16_16((a),(bl)),15))
TMBOY 47:9e361da97763 100
TMBOY 47:9e361da97763 101 #define DIV32_16(a,b) ((spx_word16_t)(((spx_word32_t)(a))/((spx_word16_t)(b))))
TMBOY 47:9e361da97763 102 #define PDIV32_16(a,b) ((spx_word16_t)(((spx_word32_t)(a)+((spx_word16_t)(b)>>1))/((spx_word16_t)(b))))
TMBOY 47:9e361da97763 103 #define DIV32(a,b) (((spx_word32_t)(a))/((spx_word32_t)(b)))
TMBOY 47:9e361da97763 104 #define PDIV32(a,b) (((spx_word32_t)(a)+((spx_word16_t)(b)>>1))/((spx_word32_t)(b)))
TMBOY 47:9e361da97763 105
TMBOY 47:9e361da97763 106 #endif