00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015 #define MIN(a,b) ((a)<(b) ? (a):(b))
00016 #define MAX(a,b) ((a)>(b) ? (a):(b))
00017
00018
00019
00020
00021
00022 #include "kiss_fft.h"
00023 #include <limits.h>
00024
00025 #define MAXFACTORS 32
00026
00027
00028
00029
00030
00031 struct kiss_fft_state{
00032 int nfft;
00033 int inverse;
00034 int factors[2*MAXFACTORS];
00035 kiss_fft_cpx twiddles[1];
00036 };
00037
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047 #ifdef FIXED_POINT
00048 # define FRACBITS 15
00049 # define SAMPPROD int32_t
00050 #define SAMP_MAX 32767
00051
00052 #define SAMP_MIN -SAMP_MAX
00053
00054 #if defined(CHECK_OVERFLOW)
00055 # define CHECK_OVERFLOW_OP(a,op,b) \
00056 if ( (SAMPPROD)(a) op (SAMPPROD)(b) > SAMP_MAX || (SAMPPROD)(a) op (SAMPPROD)(b) < SAMP_MIN ) { \
00057 fprintf(stderr,"WARNING:overflow @ " __FILE__ "(%d): (%d " #op" %d) = %ld\n",__LINE__,(a),(b),(SAMPPROD)(a) op (SAMPPROD)(b) ); }
00058 #endif
00059
00060
00061 # define smul(a,b) ( (SAMPPROD)(a)*(b) )
00062 # define sround( x ) (kiss_fft_scalar)( ( (x) + (1<<(FRACBITS-1)) ) >> FRACBITS )
00063
00064 # define S_MUL(a,b) sround( smul(a,b) )
00065
00066 # define C_MUL(m,a,b) \
00067 do{ (m).r = sround( smul((a).r,(b).r) - smul((a).i,(b).i) ); \
00068 (m).i = sround( smul((a).r,(b).i) + smul((a).i,(b).r) ); }while(0)
00069
00070 # define DIVSCALAR(x,k) \
00071 (x) = sround( smul( x, SAMP_MAX/k ) )
00072
00073 # define C_FIXDIV(c,div) \
00074 do { DIVSCALAR( (c).r , div); \
00075 DIVSCALAR( (c).i , div); }while (0)
00076
00077 # define C_MULBYSCALAR( c, s ) \
00078 do{ (c).r = sround( smul( (c).r , s ) ) ;\
00079 (c).i = sround( smul( (c).i , s ) ) ; }while(0)
00080
00081 #else
00082
00083 # define S_MUL(a,b) ( (a)*(b) )
00084 #define C_MUL(m,a,b) \
00085 do{ (m).r = (a).r*(b).r - (a).i*(b).i;\
00086 (m).i = (a).r*(b).i + (a).i*(b).r; }while(0)
00087 # define C_FIXDIV(c,div)
00088 # define C_MULBYSCALAR( c, s ) \
00089 do{ (c).r *= (s);\
00090 (c).i *= (s); }while(0)
00091 #endif
00092
00093 #ifndef CHECK_OVERFLOW_OP
00094 # define CHECK_OVERFLOW_OP(a,op,b)
00095 #endif
00096
00097 #define C_ADD( res, a,b)\
00098 do { \
00099 CHECK_OVERFLOW_OP((a).r,+,(b).r)\
00100 CHECK_OVERFLOW_OP((a).i,+,(b).i)\
00101 (res).r=(a).r+(b).r; (res).i=(a).i+(b).i; \
00102 }while(0)
00103 #define C_SUB( res, a,b)\
00104 do { \
00105 CHECK_OVERFLOW_OP((a).r,-,(b).r)\
00106 CHECK_OVERFLOW_OP((a).i,-,(b).i)\
00107 (res).r=(a).r-(b).r; (res).i=(a).i-(b).i; \
00108 }while(0)
00109 #define C_ADDTO( res , a)\
00110 do { \
00111 CHECK_OVERFLOW_OP((res).r,+,(a).r)\
00112 CHECK_OVERFLOW_OP((res).i,+,(a).i)\
00113 (res).r += (a).r; (res).i += (a).i;\
00114 }while(0)
00115
00116 #define C_SUBFROM( res , a)\
00117 do {\
00118 CHECK_OVERFLOW_OP((res).r,-,(a).r)\
00119 CHECK_OVERFLOW_OP((res).i,-,(a).i)\
00120 (res).r -= (a).r; (res).i -= (a).i; \
00121 }while(0)
00122
00123
00124 #ifdef FIXED_POINT
00125 # define KISS_FFT_COS(phase) floor(MIN(32767,MAX(-32767,.5+32768 * cos (phase))))
00126 # define KISS_FFT_SIN(phase) floor(MIN(32767,MAX(-32767,.5+32768 * sin (phase))))
00127 # define HALF_OF(x) ((x)>>1)
00128 #elif defined(USE_SIMD)
00129 # define KISS_FFT_COS(phase) _mm_set1_ps( cos(phase) )
00130 # define KISS_FFT_SIN(phase) _mm_set1_ps( sin(phase) )
00131 # define HALF_OF(x) ((x)*_mm_set1_ps(.5))
00132 #else
00133 # define KISS_FFT_COS(phase) (kiss_fft_scalar) cos(phase)
00134 # define KISS_FFT_SIN(phase) (kiss_fft_scalar) sin(phase)
00135 # define HALF_OF(x) ((x)*.5)
00136 #endif
00137
00138 #define kf_cexp(x,phase) \
00139 do{ \
00140 (x)->r = KISS_FFT_COS(phase);\
00141 (x)->i = KISS_FFT_SIN(phase);\
00142 }while(0)
00143
00144
00145
00146 #define pcpx(c)\
00147 fprintf(stderr,"%g + %gi\n",(double)((c)->r),(double)((c)->i) )