libavcodec/mdct.c
bb6f5690
 /*
  * MDCT/IMDCT transforms
406792e7
  * Copyright (c) 2002 Fabrice Bellard
bb6f5690
  *
b78e7197
  * This file is part of FFmpeg.
  *
  * FFmpeg is free software; you can redistribute it and/or
bb6f5690
  * modify it under the terms of the GNU Lesser General Public
  * License as published by the Free Software Foundation; either
b78e7197
  * version 2.1 of the License, or (at your option) any later version.
bb6f5690
  *
b78e7197
  * FFmpeg is distributed in the hope that it will be useful,
bb6f5690
  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  * Lesser General Public License for more details.
  *
  * You should have received a copy of the GNU Lesser General Public
b78e7197
  * License along with FFmpeg; if not, write to the Free Software
5509bffa
  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
bb6f5690
  */
1429224b
 
2ed6f399
 #include <stdlib.h>
 #include <string.h>
 #include "libavutil/common.h"
1429224b
 #include "libavutil/mathematics.h"
 #include "fft.h"
7087ce08
 #include "fft-internal.h"
bb6f5690
 
983e3246
 /**
ba87f080
  * @file
983e3246
  * MDCT/IMDCT transforms.
  */
 
7087ce08
 #if CONFIG_FFT_FLOAT
 #   define RSCALE(x) (x)
 #else
 #   define RSCALE(x) ((x) >> 1)
 #endif
 
983e3246
 /**
  * init MDCT or IMDCT computation.
bb6f5690
  */
01b22147
 av_cold int ff_mdct_init(FFTContext *s, int nbits, int inverse, double scale)
bb6f5690
 {
     int n, n4, i;
7d485f16
     double alpha, theta;
94274b82
     int tstep;
bb6f5690
 
     memset(s, 0, sizeof(*s));
     n = 1 << nbits;
01b22147
     s->mdct_bits = nbits;
     s->mdct_size = n;
bb6f5690
     n4 = n >> 2;
11ab1e40
     s->mdct_permutation = FF_MDCT_PERM_NONE;
94274b82
 
     if (ff_fft_init(s, s->mdct_bits - 2, inverse) < 0)
         goto fail;
 
     s->tcos = av_malloc(n/2 * sizeof(FFTSample));
bb6f5690
     if (!s->tcos)
         goto fail;
94274b82
 
11ab1e40
     switch (s->mdct_permutation) {
94274b82
     case FF_MDCT_PERM_NONE:
         s->tsin = s->tcos + n4;
         tstep = 1;
         break;
     case FF_MDCT_PERM_INTERLEAVE:
         s->tsin = s->tcos + 1;
         tstep = 2;
         break;
     default:
bb6f5690
         goto fail;
94274b82
     }
bb6f5690
 
7d485f16
     theta = 1.0 / 8.0 + (scale < 0 ? n4 : 0);
     scale = sqrt(fabs(scale));
bb6f5690
     for(i=0;i<n4;i++) {
7d485f16
         alpha = 2 * M_PI * (i + theta) / n;
7087ce08
         s->tcos[i*tstep] = FIX15(-cos(alpha) * scale);
         s->tsin[i*tstep] = FIX15(-sin(alpha) * scale);
bb6f5690
     }
     return 0;
  fail:
94274b82
     ff_mdct_end(s);
bb6f5690
     return -1;
 }
 
46803f4f
 /**
  * Compute the middle half of the inverse MDCT of size N = 2^nbits,
  * thus excluding the parts that can be derived by symmetry
  * @param output N/2 samples
  * @param input N/2 samples
  */
01b22147
 void ff_imdct_half_c(FFTContext *s, FFTSample *output, const FFTSample *input)
bb6f5690
 {
46803f4f
     int k, n8, n4, n2, n, j;
01b22147
     const uint16_t *revtab = s->revtab;
bb6f5690
     const FFTSample *tcos = s->tcos;
     const FFTSample *tsin = s->tsin;
     const FFTSample *in1, *in2;
46803f4f
     FFTComplex *z = (FFTComplex *)output;
bb6f5690
 
01b22147
     n = 1 << s->mdct_bits;
bb6f5690
     n2 = n >> 1;
     n4 = n >> 2;
46803f4f
     n8 = n >> 3;
bb6f5690
 
     /* pre rotation */
     in1 = input;
     in2 = input + n2 - 1;
     for(k = 0; k < n4; k++) {
         j=revtab[k];
         CMUL(z[j].re, z[j].im, *in2, *in1, tcos[k], tsin[k]);
         in1 += 2;
         in2 -= 2;
     }
26f548bb
     s->fft_calc(s, z);
bb6f5690
 
     /* post rotation + reordering */
46803f4f
     for(k = 0; k < n8; k++) {
         FFTSample r0, i0, r1, i1;
         CMUL(r0, i1, z[n8-k-1].im, z[n8-k-1].re, tsin[n8-k-1], tcos[n8-k-1]);
         CMUL(r1, i0, z[n8+k  ].im, z[n8+k  ].re, tsin[n8+k  ], tcos[n8+k  ]);
         z[n8-k-1].re = r0;
         z[n8-k-1].im = i0;
         z[n8+k  ].re = r1;
         z[n8+k  ].im = i1;
bb6f5690
     }
b9fa3208
 }
 
 /**
  * Compute inverse MDCT of size N = 2^nbits
  * @param output N samples
  * @param input N/2 samples
  */
01b22147
 void ff_imdct_calc_c(FFTContext *s, FFTSample *output, const FFTSample *input)
b9fa3208
 {
46803f4f
     int k;
01b22147
     int n = 1 << s->mdct_bits;
46803f4f
     int n2 = n >> 1;
     int n4 = n >> 2;
bb6f5690
 
d46ac5bf
     ff_imdct_half_c(s, output+n4, input);
bb6f5690
 
46803f4f
     for(k = 0; k < n4; k++) {
         output[k] = -output[n2-k-1];
         output[n-k-1] = output[n2+k];
b9fa3208
     }
 }
 
 /**
bb6f5690
  * Compute MDCT of size N = 2^nbits
  * @param input N samples
  * @param out N/2 samples
  */
01b22147
 void ff_mdct_calc_c(FFTContext *s, FFTSample *out, const FFTSample *input)
bb6f5690
 {
     int i, j, n, n8, n4, n2, n3;
7087ce08
     FFTDouble re, im;
01b22147
     const uint16_t *revtab = s->revtab;
bb6f5690
     const FFTSample *tcos = s->tcos;
     const FFTSample *tsin = s->tsin;
46803f4f
     FFTComplex *x = (FFTComplex *)out;
bb6f5690
 
01b22147
     n = 1 << s->mdct_bits;
bb6f5690
     n2 = n >> 1;
     n4 = n >> 2;
     n8 = n >> 3;
     n3 = 3 * n4;
 
     /* pre rotation */
     for(i=0;i<n8;i++) {
7087ce08
         re = RSCALE(-input[2*i+n3] - input[n3-1-2*i]);
         im = RSCALE(-input[n4+2*i] + input[n4-1-2*i]);
bb6f5690
         j = revtab[i];
         CMUL(x[j].re, x[j].im, re, im, -tcos[i], tsin[i]);
 
7087ce08
         re = RSCALE( input[2*i]    - input[n2-1-2*i]);
         im = RSCALE(-input[n2+2*i] - input[ n-1-2*i]);
bb6f5690
         j = revtab[n8 + i];
         CMUL(x[j].re, x[j].im, re, im, -tcos[n8 + i], tsin[n8 + i]);
     }
 
26f548bb
     s->fft_calc(s, x);
115329f1
 
bb6f5690
     /* post rotation */
46803f4f
     for(i=0;i<n8;i++) {
         FFTSample r0, i0, r1, i1;
         CMUL(i1, r0, x[n8-i-1].re, x[n8-i-1].im, -tsin[n8-i-1], -tcos[n8-i-1]);
         CMUL(i0, r1, x[n8+i  ].re, x[n8+i  ].im, -tsin[n8+i  ], -tcos[n8+i  ]);
         x[n8-i-1].re = r0;
         x[n8-i-1].im = i0;
         x[n8+i  ].re = r1;
         x[n8+i  ].im = i1;
bb6f5690
     }
 }
 
01b22147
 av_cold void ff_mdct_end(FFTContext *s)
bb6f5690
 {
     av_freep(&s->tcos);
01b22147
     ff_fft_end(s);
bb6f5690
 }