00001
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035 #ifndef FIXED_GENERIC_H
00036 #define FIXED_GENERIC_H
00037
00038 #define SHR(a,shift) ((a) >> (shift))
00039 #define SHL(a,shift) ((a) << (shift))
00040
00041 #define SATURATE(x,a) ((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x))
00042
00043 #define ADD16(a,b) ((short)((short)(a)+(short)(b)))
00044 #define SUB16(a,b) ((a)-(b))
00045 #define ADD32(a,b) ((a)+(b))
00046 #define SUB32(a,b) ((a)-(b))
00047 #define ADD64(a,b) ((a)+(b))
00048
00049 #define PSHR(a,shift) (SHR((a)+(1<<((shift)-1)),shift))
00050
00051
00052 #define MULT16_16_16(a,b) ((((short)(a))*((short)(b))))
00053
00054 #define MULT16_16(a,b) (((short)(a))*((short)(b)))
00055
00056
00057
00058
00059 #define MAC16_16(c,a,b) (ADD32((c),MULT16_16((a),(b))))
00060 #define MULT16_32_Q12(a,b) ADD32(MULT16_16((a),SHR((b),12)), SHR(MULT16_16((a),((b)&0x00000fff)),12))
00061 #define MULT16_32_Q13(a,b) ADD32(MULT16_16((a),SHR((b),13)), SHR(MULT16_16((a),((b)&0x00001fff)),13))
00062 #define MULT16_32_Q14(a,b) ADD32(MULT16_16((a),SHR((b),14)), SHR(MULT16_16((a),((b)&0x00003fff)),14))
00063
00064 #define MULT16_32_Q11(a,b) ADD32(MULT16_16((a),SHR((b),11)), SHR(MULT16_16((a),((b)&0x000007ff)),11))
00065 #define MAC16_32_Q11(c,a,b) ADD32(c,ADD32(MULT16_16((a),SHR((b),11)), SHR(MULT16_16((a),((b)&0x000007ff)),11)))
00066
00067 #define MULT16_32_Q15(a,b) ADD32(MULT16_16((a),SHR((b),15)), SHR(MULT16_16((a),((b)&0x00007fff)),15))
00068 #define MAC16_32_Q15(c,a,b) ADD32(c,ADD32(MULT16_16((a),SHR((b),15)), SHR(MULT16_16((a),((b)&0x00007fff)),15)))
00069
00070
00071 #define MAC16_16_Q11(c,a,b) (ADD32((c),SHR(MULT16_16((a),(b)),11)))
00072
00073 #define MULT16_16_Q11(a,b) (SHR(MULT16_16((a),(b)),11))
00074 #define MULT16_16_Q13(a,b) (SHR(MULT16_16((a),(b)),13))
00075 #define MULT16_16_Q14(a,b) (SHR(MULT16_16((a),(b)),14))
00076 #define MULT16_16_Q15(a,b) (SHR(MULT16_16((a),(b)),15))
00077
00078 #define MULT16_16_P13(a,b) (SHR(ADD32(4096,MULT16_16((a),(b))),13))
00079 #define MULT16_16_P14(a,b) (SHR(ADD32(8192,MULT16_16((a),(b))),14))
00080 #define MULT16_16_P15(a,b) (SHR(ADD32(16384,MULT16_16((a),(b))),15))
00081
00082 #define MUL_16_32_R15(a,bh,bl) ADD32(MULT16_16((a),(bh)), SHR(MULT16_16((a),(bl)),15))
00083
00084
00085
00086 #define DIV32_16(a,b) ((short)(((signed int)(a))/((short)(b))))
00087 #define DIV32(a,b) (((signed int)(a))/((signed int)(b)))
00088
00089
00090
00091 #endif