00001
00002
00003
00004 #ifndef _MPC_MATH_H_
00005 #define _MPC_MATH_H_
00006
00007
00008
00009 #define MPC_FIXED_POINT_SHIFT 16
00010
00011 #ifdef MPC_FIXED_POINT
00012
00013
00014 #ifdef _WIN32_WCE
00015
00016 #include <cmnintrin.h>
00017
00018 #define MPC_HAVE_MULHIGH
00019
00020 #endif
00021
00022
00023 #define MPC_FIXED_POINT_SCALE_SHIFT (MPC_FIXED_POINT_SHIFT + MPC_FIXED_POINT_FRACTPART)
00024 #define MPC_FIXED_POINT_SCALE (1 << (MPC_FIXED_POINT_SCALE_SHIFT - 1))
00025
00026
00027
00028
00029 #define MPC_FIXED_POINT_FRACTPART 14
00030 typedef mpc_int32_t MPC_SAMPLE_FORMAT;
00031
00032 typedef mpc_int64_t MPC_SAMPLE_FORMAT_MULTIPLY;
00033
00034 #define MAKE_MPC_SAMPLE(X) (MPC_SAMPLE_FORMAT)((double)(X) * (double)(((mpc_int64_t)1)<<MPC_FIXED_POINT_FRACTPART))
00035 #define MAKE_MPC_SAMPLE_EX(X,Y) (MPC_SAMPLE_FORMAT)((double)(X) * (double)(((mpc_int64_t)1)<<(Y)))
00036
00037 #define MPC_MULTIPLY_NOTRUNCATE(X,Y) \
00038 (((MPC_SAMPLE_FORMAT_MULTIPLY)(X) * (MPC_SAMPLE_FORMAT_MULTIPLY)(Y)) >> MPC_FIXED_POINT_FRACTPART)
00039
00040 #define MPC_MULTIPLY_EX_NOTRUNCATE(X,Y,Z) \
00041 (((MPC_SAMPLE_FORMAT_MULTIPLY)(X) * (MPC_SAMPLE_FORMAT_MULTIPLY)(Y)) >> (Z))
00042
00043 #ifdef _DEBUG
00044 static inline MPC_SAMPLE_FORMAT MPC_MULTIPLY(MPC_SAMPLE_FORMAT item1,MPC_SAMPLE_FORMAT item2)
00045 {
00046 MPC_SAMPLE_FORMAT_MULTIPLY temp = MPC_MULTIPLY_NOTRUNCATE(item1,item2);
00047 assert(temp == (MPC_SAMPLE_FORMAT_MULTIPLY)(MPC_SAMPLE_FORMAT)temp);
00048 return (MPC_SAMPLE_FORMAT)temp;
00049 }
00050
00051 static inline MPC_SAMPLE_FORMAT MPC_MULTIPLY_EX(MPC_SAMPLE_FORMAT item1,MPC_SAMPLE_FORMAT item2,unsigned shift)
00052 {
00053 MPC_SAMPLE_FORMAT_MULTIPLY temp = MPC_MULTIPLY_EX_NOTRUNCATE(item1,item2,shift);
00054 assert(temp == (MPC_SAMPLE_FORMAT_MULTIPLY)(MPC_SAMPLE_FORMAT)temp);
00055 return (MPC_SAMPLE_FORMAT)temp;
00056 }
00057
00058 #else
00059
00060 #define MPC_MULTIPLY(X,Y) ((MPC_SAMPLE_FORMAT)MPC_MULTIPLY_NOTRUNCATE(X,Y))
00061 #define MPC_MULTIPLY_EX(X,Y,Z) ((MPC_SAMPLE_FORMAT)MPC_MULTIPLY_EX_NOTRUNCATE(X,Y,Z))
00062
00063 #endif
00064
00065 #ifdef MPC_HAVE_MULHIGH
00066 #define MPC_MULTIPLY_FRACT(X,Y) _MulHigh(X,Y)
00067 #else
00068 #define MPC_MULTIPLY_FRACT(X,Y) MPC_MULTIPLY_EX(X,Y,32)
00069 #endif
00070
00071 #define MPC_MAKE_FRACT_CONST(X) (MPC_SAMPLE_FORMAT)((X) * (double)(((mpc_int64_t)1)<<32) )
00072 #define MPC_MULTIPLY_FRACT_CONST(X,Y) MPC_MULTIPLY_FRACT(X,MPC_MAKE_FRACT_CONST(Y))
00073 #define MPC_MULTIPLY_FRACT_CONST_FIX(X,Y,Z) ( MPC_MULTIPLY_FRACT(X,MPC_MAKE_FRACT_CONST( Y / (1<<(Z)) )) << (Z) )
00074 #define MPC_MULTIPLY_FRACT_CONST_SHR(X,Y,Z) MPC_MULTIPLY_FRACT(X,MPC_MAKE_FRACT_CONST( Y / (1<<(Z)) ))
00075
00076 #define MPC_MULTIPLY_FLOAT_INT(X,Y) ((X)*(Y))
00077 #define MPC_SCALE_CONST(X,Y,Z) MPC_MULTIPLY_EX(X,MAKE_MPC_SAMPLE_EX(Y,Z),(Z))
00078 #define MPC_SCALE_CONST_SHL(X,Y,Z,S) MPC_MULTIPLY_EX(X,MAKE_MPC_SAMPLE_EX(Y,Z),(Z)-(S))
00079 #define MPC_SCALE_CONST_SHR(X,Y,Z,S) MPC_MULTIPLY_EX(X,MAKE_MPC_SAMPLE_EX(Y,Z),(Z)+(S))
00080 #define MPC_SHR(X,Y) ((X)>>(Y))
00081 #define MPC_SHL(X,Y) ((X)<<(Y))
00082
00083 #else
00084
00085
00086
00087 typedef float MPC_SAMPLE_FORMAT;
00088
00089 #define MAKE_MPC_SAMPLE(X) ((MPC_SAMPLE_FORMAT)(X))
00090 #define MAKE_MPC_SAMPLE_EX(X,Y) ((MPC_SAMPLE_FORMAT)(X))
00091
00092 #define MPC_MULTIPLY_FRACT(X,Y) ((X)*(Y))
00093 #define MPC_MAKE_FRACT_CONST(X) (X)
00094 #define MPC_MULTIPLY_FRACT_CONST(X,Y) MPC_MULTPLY_FRACT(X,MPC_MAKE_FRACT_CONST(Y))
00095 #define MPC_MULTIPLY_FRACT_CONST_SHR(X,Y,Z) MPC_MULTIPLY_FRACT(X,MPC_MAKE_FRACT_CONST( Y ))
00096 #define MPC_MULTIPLY_FRACT_CONST_FIX(X,Y,Z) MPC_MULTIPLY_FRACT(X,MPC_MAKE_FRACT_CONST( Y ))
00097
00098 #define MPC_MULTIPLY_FLOAT_INT(X,Y) ((X)*(Y))
00099 #define MPC_MULTIPLY(X,Y) ((X)*(Y))
00100 #define MPC_MULTIPLY_EX(X,Y,Z) ((X)*(Y))
00101 #define MPC_SCALE_CONST(X,Y,Z) ((X)*(Y))
00102 #define MPC_SCALE_CONST_SHL(X,Y,Z,S) ((X)*(Y))
00103 #define MPC_SCALE_CONST_SHR(X,Y,Z,S) ((X)*(Y))
00104 #define MPC_SHR(X,Y) (X)
00105 #define MPC_SHL(X,Y) (X)
00106
00107 #endif
00108
00109 #endif
00110