00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00026 #include "libavutil/mathematics.h"
00027 #include "libavutil/lfg.h"
00028 #include "libavutil/log.h"
00029 #include "fft.h"
00030 #include "dct.h"
00031 #include "rdft.h"
00032 #include <math.h>
00033 #include <unistd.h>
00034 #include <sys/time.h>
00035 #include <stdlib.h>
00036 #include <string.h>
00037
00038 #undef exit
00039
00040
00041
00042 #define MUL16(a,b) ((a) * (b))
00043
00044 #define CMAC(pre, pim, are, aim, bre, bim) \
00045 {\
00046 pre += (MUL16(are, bre) - MUL16(aim, bim));\
00047 pim += (MUL16(are, bim) + MUL16(bre, aim));\
00048 }
00049
00050 FFTComplex *exptab;
00051
00052 static void fft_ref_init(int nbits, int inverse)
00053 {
00054 int n, i;
00055 double c1, s1, alpha;
00056
00057 n = 1 << nbits;
00058 exptab = av_malloc((n / 2) * sizeof(FFTComplex));
00059
00060 for (i = 0; i < (n/2); i++) {
00061 alpha = 2 * M_PI * (float)i / (float)n;
00062 c1 = cos(alpha);
00063 s1 = sin(alpha);
00064 if (!inverse)
00065 s1 = -s1;
00066 exptab[i].re = c1;
00067 exptab[i].im = s1;
00068 }
00069 }
00070
00071 static void fft_ref(FFTComplex *tabr, FFTComplex *tab, int nbits)
00072 {
00073 int n, i, j, k, n2;
00074 double tmp_re, tmp_im, s, c;
00075 FFTComplex *q;
00076
00077 n = 1 << nbits;
00078 n2 = n >> 1;
00079 for (i = 0; i < n; i++) {
00080 tmp_re = 0;
00081 tmp_im = 0;
00082 q = tab;
00083 for (j = 0; j < n; j++) {
00084 k = (i * j) & (n - 1);
00085 if (k >= n2) {
00086 c = -exptab[k - n2].re;
00087 s = -exptab[k - n2].im;
00088 } else {
00089 c = exptab[k].re;
00090 s = exptab[k].im;
00091 }
00092 CMAC(tmp_re, tmp_im, c, s, q->re, q->im);
00093 q++;
00094 }
00095 tabr[i].re = tmp_re;
00096 tabr[i].im = tmp_im;
00097 }
00098 }
00099
00100 static void imdct_ref(float *out, float *in, int nbits)
00101 {
00102 int n = 1<<nbits;
00103 int k, i, a;
00104 double sum, f;
00105
00106 for (i = 0; i < n; i++) {
00107 sum = 0;
00108 for (k = 0; k < n/2; k++) {
00109 a = (2 * i + 1 + (n / 2)) * (2 * k + 1);
00110 f = cos(M_PI * a / (double)(2 * n));
00111 sum += f * in[k];
00112 }
00113 out[i] = -sum;
00114 }
00115 }
00116
00117
00118 static void mdct_ref(float *output, float *input, int nbits)
00119 {
00120 int n = 1<<nbits;
00121 int k, i;
00122 double a, s;
00123
00124
00125 for (k = 0; k < n/2; k++) {
00126 s = 0;
00127 for (i = 0; i < n; i++) {
00128 a = (2*M_PI*(2*i+1+n/2)*(2*k+1) / (4 * n));
00129 s += input[i] * cos(a);
00130 }
00131 output[k] = s;
00132 }
00133 }
00134
00135 static void idct_ref(float *output, float *input, int nbits)
00136 {
00137 int n = 1<<nbits;
00138 int k, i;
00139 double a, s;
00140
00141
00142 for (i = 0; i < n; i++) {
00143 s = 0.5 * input[0];
00144 for (k = 1; k < n; k++) {
00145 a = M_PI*k*(i+0.5) / n;
00146 s += input[k] * cos(a);
00147 }
00148 output[i] = 2 * s / n;
00149 }
00150 }
00151 static void dct_ref(float *output, float *input, int nbits)
00152 {
00153 int n = 1<<nbits;
00154 int k, i;
00155 double a, s;
00156
00157
00158 for (k = 0; k < n; k++) {
00159 s = 0;
00160 for (i = 0; i < n; i++) {
00161 a = M_PI*k*(i+0.5) / n;
00162 s += input[i] * cos(a);
00163 }
00164 output[k] = s;
00165 }
00166 }
00167
00168
00169 static float frandom(AVLFG *prng)
00170 {
00171 return (int16_t)av_lfg_get(prng) / 32768.0;
00172 }
00173
00174 static int64_t gettime(void)
00175 {
00176 struct timeval tv;
00177 gettimeofday(&tv,NULL);
00178 return (int64_t)tv.tv_sec * 1000000 + tv.tv_usec;
00179 }
00180
00181 static int check_diff(float *tab1, float *tab2, int n, double scale)
00182 {
00183 int i;
00184 double max= 0;
00185 double error= 0;
00186 int err = 0;
00187
00188 for (i = 0; i < n; i++) {
00189 double e= fabsf(tab1[i] - (tab2[i] / scale));
00190 if (e >= 1e-3) {
00191 av_log(NULL, AV_LOG_ERROR, "ERROR %5d: %10.6f %10.6f\n",
00192 i, tab1[i], tab2[i]);
00193 err = 1;
00194 }
00195 error+= e*e;
00196 if(e>max) max= e;
00197 }
00198 av_log(NULL, AV_LOG_INFO, "max:%f e:%g\n", max, sqrt(error)/n);
00199 return err;
00200 }
00201
00202
00203 static void help(void)
00204 {
00205 av_log(NULL, AV_LOG_INFO,"usage: fft-test [-h] [-s] [-i] [-n b]\n"
00206 "-h print this help\n"
00207 "-s speed test\n"
00208 "-m (I)MDCT test\n"
00209 "-d (I)DCT test\n"
00210 "-r (I)RDFT test\n"
00211 "-i inverse transform test\n"
00212 "-n b set the transform size to 2^b\n"
00213 "-f x set scale factor for output data of (I)MDCT to x\n"
00214 );
00215 exit(1);
00216 }
00217
00218 enum tf_transform {
00219 TRANSFORM_FFT,
00220 TRANSFORM_MDCT,
00221 TRANSFORM_RDFT,
00222 TRANSFORM_DCT,
00223 };
00224
00225 int main(int argc, char **argv)
00226 {
00227 FFTComplex *tab, *tab1, *tab_ref;
00228 FFTSample *tab2;
00229 int it, i, c;
00230 int do_speed = 0;
00231 int err = 1;
00232 enum tf_transform transform = TRANSFORM_FFT;
00233 int do_inverse = 0;
00234 FFTContext s1, *s = &s1;
00235 FFTContext m1, *m = &m1;
00236 RDFTContext r1, *r = &r1;
00237 DCTContext d1, *d = &d1;
00238 int fft_nbits, fft_size, fft_size_2;
00239 double scale = 1.0;
00240 AVLFG prng;
00241 av_lfg_init(&prng, 1);
00242
00243 fft_nbits = 9;
00244 for(;;) {
00245 c = getopt(argc, argv, "hsimrdn:f:");
00246 if (c == -1)
00247 break;
00248 switch(c) {
00249 case 'h':
00250 help();
00251 break;
00252 case 's':
00253 do_speed = 1;
00254 break;
00255 case 'i':
00256 do_inverse = 1;
00257 break;
00258 case 'm':
00259 transform = TRANSFORM_MDCT;
00260 break;
00261 case 'r':
00262 transform = TRANSFORM_RDFT;
00263 break;
00264 case 'd':
00265 transform = TRANSFORM_DCT;
00266 break;
00267 case 'n':
00268 fft_nbits = atoi(optarg);
00269 break;
00270 case 'f':
00271 scale = atof(optarg);
00272 break;
00273 }
00274 }
00275
00276 fft_size = 1 << fft_nbits;
00277 fft_size_2 = fft_size >> 1;
00278 tab = av_malloc(fft_size * sizeof(FFTComplex));
00279 tab1 = av_malloc(fft_size * sizeof(FFTComplex));
00280 tab_ref = av_malloc(fft_size * sizeof(FFTComplex));
00281 tab2 = av_malloc(fft_size * sizeof(FFTSample));
00282
00283 switch (transform) {
00284 case TRANSFORM_MDCT:
00285 av_log(NULL, AV_LOG_INFO,"Scale factor is set to %f\n", scale);
00286 if (do_inverse)
00287 av_log(NULL, AV_LOG_INFO,"IMDCT");
00288 else
00289 av_log(NULL, AV_LOG_INFO,"MDCT");
00290 ff_mdct_init(m, fft_nbits, do_inverse, scale);
00291 break;
00292 case TRANSFORM_FFT:
00293 if (do_inverse)
00294 av_log(NULL, AV_LOG_INFO,"IFFT");
00295 else
00296 av_log(NULL, AV_LOG_INFO,"FFT");
00297 ff_fft_init(s, fft_nbits, do_inverse);
00298 fft_ref_init(fft_nbits, do_inverse);
00299 break;
00300 case TRANSFORM_RDFT:
00301 if (do_inverse)
00302 av_log(NULL, AV_LOG_INFO,"IDFT_C2R");
00303 else
00304 av_log(NULL, AV_LOG_INFO,"DFT_R2C");
00305 ff_rdft_init(r, fft_nbits, do_inverse ? IDFT_C2R : DFT_R2C);
00306 fft_ref_init(fft_nbits, do_inverse);
00307 break;
00308 case TRANSFORM_DCT:
00309 if (do_inverse)
00310 av_log(NULL, AV_LOG_INFO,"DCT_III");
00311 else
00312 av_log(NULL, AV_LOG_INFO,"DCT_II");
00313 ff_dct_init(d, fft_nbits, do_inverse ? DCT_III : DCT_II);
00314 break;
00315 }
00316 av_log(NULL, AV_LOG_INFO," %d test\n", fft_size);
00317
00318
00319
00320 for (i = 0; i < fft_size; i++) {
00321 tab1[i].re = frandom(&prng);
00322 tab1[i].im = frandom(&prng);
00323 }
00324
00325
00326 av_log(NULL, AV_LOG_INFO,"Checking...\n");
00327
00328 switch (transform) {
00329 case TRANSFORM_MDCT:
00330 if (do_inverse) {
00331 imdct_ref((float *)tab_ref, (float *)tab1, fft_nbits);
00332 m->imdct_calc(m, tab2, (float *)tab1);
00333 err = check_diff((float *)tab_ref, tab2, fft_size, scale);
00334 } else {
00335 mdct_ref((float *)tab_ref, (float *)tab1, fft_nbits);
00336
00337 m->mdct_calc(m, tab2, (float *)tab1);
00338
00339 err = check_diff((float *)tab_ref, tab2, fft_size / 2, scale);
00340 }
00341 break;
00342 case TRANSFORM_FFT:
00343 memcpy(tab, tab1, fft_size * sizeof(FFTComplex));
00344 s->fft_permute(s, tab);
00345 s->fft_calc(s, tab);
00346
00347 fft_ref(tab_ref, tab1, fft_nbits);
00348 err = check_diff((float *)tab_ref, (float *)tab, fft_size * 2, 1.0);
00349 break;
00350 case TRANSFORM_RDFT:
00351 if (do_inverse) {
00352 tab1[ 0].im = 0;
00353 tab1[fft_size_2].im = 0;
00354 for (i = 1; i < fft_size_2; i++) {
00355 tab1[fft_size_2+i].re = tab1[fft_size_2-i].re;
00356 tab1[fft_size_2+i].im = -tab1[fft_size_2-i].im;
00357 }
00358
00359 memcpy(tab2, tab1, fft_size * sizeof(FFTSample));
00360 tab2[1] = tab1[fft_size_2].re;
00361
00362 r->rdft_calc(r, tab2);
00363 fft_ref(tab_ref, tab1, fft_nbits);
00364 for (i = 0; i < fft_size; i++) {
00365 tab[i].re = tab2[i];
00366 tab[i].im = 0;
00367 }
00368 err = check_diff((float *)tab_ref, (float *)tab, fft_size * 2, 0.5);
00369 } else {
00370 for (i = 0; i < fft_size; i++) {
00371 tab2[i] = tab1[i].re;
00372 tab1[i].im = 0;
00373 }
00374 r->rdft_calc(r, tab2);
00375 fft_ref(tab_ref, tab1, fft_nbits);
00376 tab_ref[0].im = tab_ref[fft_size_2].re;
00377 err = check_diff((float *)tab_ref, (float *)tab2, fft_size, 1.0);
00378 }
00379 break;
00380 case TRANSFORM_DCT:
00381 memcpy(tab, tab1, fft_size * sizeof(FFTComplex));
00382 d->dct_calc(d, tab);
00383 if (do_inverse) {
00384 idct_ref(tab_ref, tab1, fft_nbits);
00385 } else {
00386 dct_ref(tab_ref, tab1, fft_nbits);
00387 }
00388 err = check_diff((float *)tab_ref, (float *)tab, fft_size, 1.0);
00389 break;
00390 }
00391
00392
00393
00394 if (do_speed) {
00395 int64_t time_start, duration;
00396 int nb_its;
00397
00398 av_log(NULL, AV_LOG_INFO,"Speed test...\n");
00399
00400 nb_its = 1;
00401 for(;;) {
00402 time_start = gettime();
00403 for (it = 0; it < nb_its; it++) {
00404 switch (transform) {
00405 case TRANSFORM_MDCT:
00406 if (do_inverse) {
00407 m->imdct_calc(m, (float *)tab, (float *)tab1);
00408 } else {
00409 m->mdct_calc(m, (float *)tab, (float *)tab1);
00410 }
00411 break;
00412 case TRANSFORM_FFT:
00413 memcpy(tab, tab1, fft_size * sizeof(FFTComplex));
00414 s->fft_calc(s, tab);
00415 break;
00416 case TRANSFORM_RDFT:
00417 memcpy(tab2, tab1, fft_size * sizeof(FFTSample));
00418 r->rdft_calc(r, tab2);
00419 break;
00420 case TRANSFORM_DCT:
00421 memcpy(tab2, tab1, fft_size * sizeof(FFTSample));
00422 d->dct_calc(d, tab2);
00423 break;
00424 }
00425 }
00426 duration = gettime() - time_start;
00427 if (duration >= 1000000)
00428 break;
00429 nb_its *= 2;
00430 }
00431 av_log(NULL, AV_LOG_INFO,"time: %0.1f us/transform [total time=%0.2f s its=%d]\n",
00432 (double)duration / nb_its,
00433 (double)duration / 1000000.0,
00434 nb_its);
00435 }
00436
00437 switch (transform) {
00438 case TRANSFORM_MDCT:
00439 ff_mdct_end(m);
00440 break;
00441 case TRANSFORM_FFT:
00442 ff_fft_end(s);
00443 break;
00444 case TRANSFORM_RDFT:
00445 ff_rdft_end(r);
00446 break;
00447 case TRANSFORM_DCT:
00448 ff_dct_end(d);
00449 break;
00450 }
00451
00452 av_free(tab);
00453 av_free(tab1);
00454 av_free(tab2);
00455 av_free(tab_ref);
00456 av_free(exptab);
00457
00458 return err;
00459 }