]> git.sesse.net Git - ffmpeg/blobdiff - libavcodec/mpegaudiodec.c
decode adts aac streams
[ffmpeg] / libavcodec / mpegaudiodec.c
index 8e66315549b1ee27bbf77ab2b268bcbe19960b13..ff1f1113e77c3c288ad83473800adb49c29cece8 100644 (file)
  *
  * You should have received a copy of the GNU Lesser General Public
  * License along with this library; if not, write to the Free Software
- * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  */
 
 /**
  * @file mpegaudiodec.c
  * MPEG Audio decoder.
- */ 
+ */
 
 //#define DEBUG
 #include "avcodec.h"
 #include "bitstream.h"
-#include "mpegaudio.h"
 #include "dsputil.h"
 
 /*
 #define USE_HIGHPRECISION
 #endif
 
-#ifdef USE_HIGHPRECISION
-#define FRAC_BITS   23   /* fractional bits for sb_samples and dct */
-#define WFRAC_BITS  16   /* fractional bits for window */
-#else
-#define FRAC_BITS   15   /* fractional bits for sb_samples and dct */
-#define WFRAC_BITS  14   /* fractional bits for window */
-#endif
-
-#if defined(USE_HIGHPRECISION) && defined(CONFIG_AUDIO_NONSHORT)
-typedef int32_t OUT_INT;
-#define OUT_MAX INT32_MAX
-#define OUT_MIN INT32_MIN
-#define OUT_SHIFT (WFRAC_BITS + FRAC_BITS - 31)
-#else
-typedef int16_t OUT_INT;
-#define OUT_MAX INT16_MAX
-#define OUT_MIN INT16_MIN
-#define OUT_SHIFT (WFRAC_BITS + FRAC_BITS - 15)
-#endif
+#include "mpegaudio.h"
 
 #define FRAC_ONE    (1 << FRAC_BITS)
 
@@ -75,12 +56,6 @@ static always_inline int MULH(int a, int b){
     return ((int64_t)(a) * (int64_t)(b))>>32;
 }
 
-#if FRAC_BITS <= 15
-typedef int16_t MPA_INT;
-#else
-typedef int32_t MPA_INT;
-#endif
-
 /****************/
 
 #define HEADER_SIZE 4
@@ -89,14 +64,14 @@ typedef int32_t MPA_INT;
 struct GranuleDef;
 
 typedef struct MPADecodeContext {
-    uint8_t inbuf1[2][MPA_MAX_CODED_FRAME_SIZE + BACKSTEP_SIZE];       /* input buffer */
+    uint8_t inbuf1[2][MPA_MAX_CODED_FRAME_SIZE + BACKSTEP_SIZE];        /* input buffer */
     int inbuf_index;
     uint8_t *inbuf_ptr, *inbuf;
     int frame_size;
     int free_format_frame_size; /* frame size in case of free format
                                    (zero if currently unknown) */
     /* next header (used in free format parsing) */
-    uint32_t free_format_next_header; 
+    uint32_t free_format_next_header;
     int error_protection;
     int layer;
     int sample_rate;
@@ -120,6 +95,15 @@ typedef struct MPADecodeContext {
     unsigned int dither_state;
 } MPADecodeContext;
 
+/**
+ * Context for MP3On4 decoder
+ */
+typedef struct MP3On4DecodeContext {
+    int frames;   ///< number of mp3 frames per block (number of mp3 decoder instances)
+    int chan_cfg; ///< channel config number
+    MPADecodeContext *mp3decctx[5]; ///< MPADecodeContext for every decoder instance
+} MP3On4DecodeContext;
+
 /* layer 3 "granule" */
 typedef struct GranuleDef {
     uint8_t scfsi;
@@ -156,7 +140,7 @@ static void compute_antialias_integer(MPADecodeContext *s, GranuleDef *g);
 static void compute_antialias_float(MPADecodeContext *s, GranuleDef *g);
 
 /* vlc structure for decoding layer 3 huffman tables */
-static VLC huff_vlc[16]; 
+static VLC huff_vlc[16];
 static uint8_t *huff_code_table[16];
 static VLC huff_quad_vlc[2];
 /* computed from band_size_long */
@@ -181,7 +165,7 @@ static int32_t scale_factor_mult[15][3];
 #define SCALE_GEN(v) \
 { FIXR(1.0 * (v)), FIXR(0.7937005259 * (v)), FIXR(0.6299605249 * (v)) }
 
-static int32_t scale_factor_mult2[3][3] = {
+static const int32_t scale_factor_mult2[3][3] = {
     SCALE_GEN(4.0 / 3.0), /* 3 steps */
     SCALE_GEN(4.0 / 5.0), /* 5 steps */
     SCALE_GEN(4.0 / 9.0), /* 9 steps */
@@ -189,7 +173,7 @@ static int32_t scale_factor_mult2[3][3] = {
 
 void ff_mpa_synth_init(MPA_INT *window);
 static MPA_INT window[512] __attribute__((aligned(16)));
-    
+
 /* layer 1 unscaling */
 /* n = number of bits of the mantissa minus 1 */
 static inline int l1_unscale(int n, int mant, int scale_factor)
@@ -248,11 +232,13 @@ static inline int l3_unscale(int value, int exponent)
 
 static int dev_4_3_coefs[DEV_ORDER];
 
+#if 0 /* unused */
 static int pow_mult3[3] = {
     POW_FIX(1.0),
     POW_FIX(1.25992104989487316476),
     POW_FIX(1.58740105196819947474),
 };
+#endif
 
 static void int_pow_init(void)
 {
@@ -265,12 +251,13 @@ static void int_pow_init(void)
     }
 }
 
+#if 0 /* unused, remove? */
 /* return the mantissa and the binary exponent */
 static int int_pow(int i, int *exp_ptr)
 {
     int e, er, eq, j;
     int a, a1;
-    
+
     /* renormalize */
     a = i;
     e = POW_FRAC_BITS;
@@ -309,6 +296,7 @@ static int int_pow(int i, int *exp_ptr)
     *exp_ptr = eq;
     return a;
 }
+#endif
 
 static int decode_init(AVCodecContext * avctx)
 {
@@ -320,8 +308,8 @@ static int decode_init(AVCodecContext * avctx)
     avctx->sample_fmt= SAMPLE_FMT_S32;
 #else
     avctx->sample_fmt= SAMPLE_FMT_S16;
-#endif    
-    
+#endif
+
     if(avctx->antialias_algo != FF_AA_FLOAT)
         s->compute_antialias= compute_antialias_integer;
     else
@@ -346,28 +334,28 @@ static int decode_init(AVCodecContext * avctx)
             scale_factor_mult[i][1] = MULL(FIXR(0.7937005259 * 2.0), norm);
             scale_factor_mult[i][2] = MULL(FIXR(0.6299605249 * 2.0), norm);
             dprintf("%d: norm=%x s=%x %x %x\n",
-                    i, norm, 
+                    i, norm,
                     scale_factor_mult[i][0],
                     scale_factor_mult[i][1],
                     scale_factor_mult[i][2]);
         }
-        
-       ff_mpa_synth_init(window);
-        
+
+        ff_mpa_synth_init(window);
+
         /* huffman decode tables */
         huff_code_table[0] = NULL;
         for(i=1;i<16;i++) {
             const HuffTable *h = &mpa_huff_tables[i];
-           int xsize, x, y;
+            int xsize, x, y;
             unsigned int n;
             uint8_t *code_table;
 
             xsize = h->xsize;
             n = xsize * xsize;
             /* XXX: fail test */
-            init_vlc(&huff_vlc[i], 8, n, 
+            init_vlc(&huff_vlc[i], 8, n,
                      h->bits, 1, 1, h->codes, 2, 2, 1);
-            
+
             code_table = av_mallocz(n);
             j = 0;
             for(x=0;x<xsize;x++) {
@@ -377,7 +365,7 @@ static int decode_init(AVCodecContext * avctx)
             huff_code_table[i] = code_table;
         }
         for(i=0;i<2;i++) {
-            init_vlc(&huff_quad_vlc[i], i == 0 ? 7 : 4, 16, 
+            init_vlc(&huff_quad_vlc[i], i == 0 ? 7 : 4, 16,
                      mpa_quad_bits[i], 1, 1, mpa_quad_codes[i], 1, 1, 1);
         }
 
@@ -390,29 +378,29 @@ static int decode_init(AVCodecContext * avctx)
             band_index_long[i][22] = k;
         }
 
-       /* compute n ^ (4/3) and store it in mantissa/exp format */
-       table_4_3_exp= av_mallocz_static(TABLE_4_3_SIZE * sizeof(table_4_3_exp[0]));
+        /* compute n ^ (4/3) and store it in mantissa/exp format */
+        table_4_3_exp= av_mallocz_static(TABLE_4_3_SIZE * sizeof(table_4_3_exp[0]));
         if(!table_4_3_exp)
-           return -1;
-       table_4_3_value= av_mallocz_static(TABLE_4_3_SIZE * sizeof(table_4_3_value[0]));
+            return -1;
+        table_4_3_value= av_mallocz_static(TABLE_4_3_SIZE * sizeof(table_4_3_value[0]));
         if(!table_4_3_value)
             return -1;
-        
+
         int_pow_init();
         for(i=1;i<TABLE_4_3_SIZE;i++) {
             double f, fm;
             int e, m;
             f = pow((double)(i/4), 4.0 / 3.0) * pow(2, (i&3)*0.25);
             fm = frexp(f, &e);
-            m = FIXHR(fm*0.5);
-            e+= FRAC_BITS - 31;
+            m = (uint32_t)(fm*(1LL<<31) + 0.5);
+            e+= FRAC_BITS - 31 + 5;
 
             /* normalized to FRAC_BITS */
             table_4_3_value[i] = m;
 //            av_log(NULL, AV_LOG_DEBUG, "%d %d %f\n", i, m, pow((double)i, 4.0 / 3.0));
             table_4_3_exp[i] = -e;
         }
-        
+
         for(i=0;i<7;i++) {
             float f;
             int v;
@@ -439,7 +427,7 @@ static int decode_init(AVCodecContext * avctx)
                 k = i & 1;
                 is_table_lsf[j][k ^ 1][i] = FIXR(f);
                 is_table_lsf[j][k][i] = FIXR(1.0);
-                dprintf("is_table_lsf %d %d: %x %x\n", 
+                dprintf("is_table_lsf %d %d: %x %x\n",
                         i, j, is_table_lsf[j][0][i], is_table_lsf[j][1][i]);
             }
         }
@@ -452,11 +440,11 @@ static int decode_init(AVCodecContext * avctx)
             csa_table[i][0] = FIXHR(cs/4);
             csa_table[i][1] = FIXHR(ca/4);
             csa_table[i][2] = FIXHR(ca/4) + FIXHR(cs/4);
-            csa_table[i][3] = FIXHR(ca/4) - FIXHR(cs/4); 
+            csa_table[i][3] = FIXHR(ca/4) - FIXHR(cs/4);
             csa_table_float[i][0] = cs;
             csa_table_float[i][1] = ca;
             csa_table_float[i][2] = ca + cs;
-            csa_table_float[i][3] = ca - cs; 
+            csa_table_float[i][3] = ca - cs;
 //            printf("%d %d %d %d\n", FIX(cs), FIX(cs-1), FIX(ca), FIX(cs)-FIX(ca));
 //            av_log(NULL, AV_LOG_DEBUG,"%f %f %f %f\n", cs, ca, ca+cs, ca-cs);
         }
@@ -465,8 +453,10 @@ static int decode_init(AVCodecContext * avctx)
         for(i=0;i<36;i++) {
             for(j=0; j<4; j++){
                 double d;
-                if(j==2) continue;
-                
+
+                if(j==2 && i%3 != 1)
+                    continue;
+
                 d= sin(M_PI * (i + 0.5) / 36.0);
                 if(j==1){
                     if     (i>=30) d= 0;
@@ -478,18 +468,16 @@ static int decode_init(AVCodecContext * avctx)
                     else if(i< 18) d= 1;
                 }
                 //merge last stage of imdct into the window coefficients
-                if     (i/9 == 0) d*= 0.5 / cos(M_PI*(2*(     i) +19)/72);
-                else if(i/9 == 1) d*= 0.5 / cos(M_PI*(2*(17 - i) +19)/72);
-                else if(i/9 == 2) d*= 0.5 / cos(M_PI*(2*(     i) +19)/72);
-                else              d*=-0.5 / cos(M_PI*(2*(17 - i) +19)/72);
-                mdct_win[j][i] = FIXHR((d / (1<<5)));
+                d*= 0.5 / cos(M_PI*(2*i + 19)/72);
+
+                if(j==2)
+                    mdct_win[j][i/3] = FIXHR((d / (1<<5)));
+                else
+                    mdct_win[j][i  ] = FIXHR((d / (1<<5)));
 //                av_log(NULL, AV_LOG_DEBUG, "%2d %d %f\n", i,j,d / (1<<5));
             }
         }
 
-        for(i=0;i<12;i++)
-            mdct_win[2][i] = FIXR(sin(M_PI * (i + 0.5) / 12.0));
-        
         /* NOTE: we do frequency inversion adter the MDCT by changing
            the sign of the right window coefs */
         for(j=0;j<4;j++) {
@@ -621,7 +609,7 @@ static void dct32(int32_t *out, int32_t *tab)
     BF(5, 10, COS1_5);
     BF(6,  9, COS1_6);
     BF(7,  8, COS1_7);
-    
+
     BF(16, 31, -COS1_0);
     BF(17, 30, -COS1_1);
     BF(18, 29, -COS1_2);
@@ -630,23 +618,23 @@ static void dct32(int32_t *out, int32_t *tab)
     BF(21, 26, -COS1_5);
     BF(22, 25, -COS1_6);
     BF(23, 24, -COS1_7);
-    
+
     /* pass 3 */
     BF(0, 7, COS2_0);
     BF(1, 6, COS2_1);
     BF(2, 5, COS2_2);
     BF(3, 4, COS2_3);
-    
+
     BF(8, 15, -COS2_0);
     BF(9, 14, -COS2_1);
     BF(10, 13, -COS2_2);
     BF(11, 12, -COS2_3);
-    
+
     BF(16, 23, COS2_0);
     BF(17, 22, COS2_1);
     BF(18, 21, COS2_2);
     BF(19, 20, COS2_3);
-    
+
     BF(24, 31, -COS2_0);
     BF(25, 30, -COS2_1);
     BF(26, 29, -COS2_2);
@@ -655,28 +643,28 @@ static void dct32(int32_t *out, int32_t *tab)
     /* pass 4 */
     BF(0, 3, COS3_0);
     BF(1, 2, COS3_1);
-    
+
     BF(4, 7, -COS3_0);
     BF(5, 6, -COS3_1);
-    
+
     BF(8, 11, COS3_0);
     BF(9, 10, COS3_1);
-    
+
     BF(12, 15, -COS3_0);
     BF(13, 14, -COS3_1);
-    
+
     BF(16, 19, COS3_0);
     BF(17, 18, COS3_1);
-    
+
     BF(20, 23, -COS3_0);
     BF(21, 22, -COS3_1);
-    
+
     BF(24, 27, COS3_0);
     BF(25, 26, COS3_1);
-    
+
     BF(28, 31, -COS3_0);
     BF(29, 30, -COS3_1);
-    
+
     /* pass 5 */
     BF1(0, 1, 2, 3);
     BF2(4, 5, 6, 7);
@@ -686,9 +674,9 @@ static void dct32(int32_t *out, int32_t *tab)
     BF2(20, 21, 22, 23);
     BF1(24, 25, 26, 27);
     BF2(28, 29, 30, 31);
-    
+
     /* pass 6 */
-    
+
     ADD( 8, 12);
     ADD(12, 10);
     ADD(10, 14);
@@ -713,7 +701,7 @@ static void dct32(int32_t *out, int32_t *tab)
     out[22] = tab[13];
     out[14] = tab[14];
     out[30] = tab[15];
-    
+
     ADD(24, 28);
     ADD(28, 26);
     ADD(26, 30);
@@ -776,7 +764,7 @@ static inline int round_sample(int *sum)
 
 #else
 
-static inline int round_sample(int64_t *sum) 
+static inline int round_sample(int64_t *sum)
 {
     int sum1;
     sum1 = (int)((*sum) >> OUT_SHIFT);
@@ -849,15 +837,15 @@ void ff_mpa_synth_init(MPA_INT *window)
             v = -v;
         if (i != 0)
             window[512 - i] = v;
-    }  
+    }
 }
 
 /* 32 sub band synthesis filter. Input: 32 sub band samples, Output:
    32 samples. */
 /* XXX: optimize by avoiding ring buffer usage */
 void ff_mpa_synth_filter(MPA_INT *synth_buf_ptr, int *synth_buf_offset,
-                        MPA_INT *window, int *dither_state,
-                         OUT_INT *samples, int incr, 
+                         MPA_INT *window, int *dither_state,
+                         OUT_INT *samples, int incr,
                          int32_t sb_samples[SBLIMIT])
 {
     int32_t tmp[32];
@@ -872,7 +860,7 @@ void ff_mpa_synth_filter(MPA_INT *synth_buf_ptr, int *synth_buf_offset,
 #endif
 
     dct32(tmp, sb_samples);
-    
+
     offset = *synth_buf_offset;
     synth_buf = synth_buf_ptr + offset;
 
@@ -921,7 +909,7 @@ void ff_mpa_synth_filter(MPA_INT *synth_buf_ptr, int *synth_buf_offset,
         w++;
         w2--;
     }
-    
+
     p = synth_buf + 32;
     SUM8(sum, -=, w + 32, p);
     *samples = round_sample(&sum);
@@ -931,59 +919,64 @@ void ff_mpa_synth_filter(MPA_INT *synth_buf_ptr, int *synth_buf_offset,
     *synth_buf_offset = offset;
 }
 
-/* cos(pi*i/24) */
-#define C1  FIXR(0.99144486137381041114)
-#define C3  FIXR(0.92387953251128675612)
-#define C5  FIXR(0.79335334029123516458)
-#define C7  FIXR(0.60876142900872063941)
-#define C9  FIXR(0.38268343236508977173)
-#define C11 FIXR(0.13052619222005159154)
+#define C3 FIXHR(0.86602540378443864676/2)
+
+/* 0.5 / cos(pi*(2*i+1)/36) */
+static const int icos36[9] = {
+    FIXR(0.50190991877167369479),
+    FIXR(0.51763809020504152469), //0
+    FIXR(0.55168895948124587824),
+    FIXR(0.61038729438072803416),
+    FIXR(0.70710678118654752439), //1
+    FIXR(0.87172339781054900991),
+    FIXR(1.18310079157624925896),
+    FIXR(1.93185165257813657349), //2
+    FIXR(5.73685662283492756461),
+};
 
 /* 12 points IMDCT. We compute it "by hand" by factorizing obvious
    cases. */
 static void imdct12(int *out, int *in)
 {
-    int tmp;
-    int64_t in1_3, in1_9, in4_3, in4_9;
-
-    in1_3 = MUL64(in[1], C3);
-    in1_9 = MUL64(in[1], C9);
-    in4_3 = MUL64(in[4], C3);
-    in4_9 = MUL64(in[4], C9);
-    
-    tmp = FRAC_RND(MUL64(in[0], C7) - in1_3 - MUL64(in[2], C11) + 
-                   MUL64(in[3], C1) - in4_9 - MUL64(in[5], C5));
-    out[0] = tmp;
-    out[5] = -tmp;
-    tmp = FRAC_RND(MUL64(in[0] - in[3], C9) - in1_3 + 
-                   MUL64(in[2] + in[5], C3) - in4_9);
-    out[1] = tmp;
-    out[4] = -tmp;
-    tmp = FRAC_RND(MUL64(in[0], C11) - in1_9 + MUL64(in[2], C7) -
-                   MUL64(in[3], C5) + in4_3 - MUL64(in[5], C1));
-    out[2] = tmp;
-    out[3] = -tmp;
-    tmp = FRAC_RND(MUL64(-in[0], C5) + in1_9 + MUL64(in[2], C1) + 
-                   MUL64(in[3], C11) - in4_3 - MUL64(in[5], C7));
-    out[6] = tmp;
-    out[11] = tmp;
-    tmp = FRAC_RND(MUL64(-in[0] + in[3], C3) - in1_9 + 
-                   MUL64(in[2] + in[5], C9) + in4_3);
-    out[7] = tmp;
-    out[10] = tmp;
-    tmp = FRAC_RND(-MUL64(in[0], C1) - in1_3 - MUL64(in[2], C5) -
-                   MUL64(in[3], C7) - in4_9 - MUL64(in[5], C11));
-    out[8] = tmp;
-    out[9] = tmp;
+    int in0, in1, in2, in3, in4, in5, t1, t2;
+
+    in0= in[0*3];
+    in1= in[1*3] + in[0*3];
+    in2= in[2*3] + in[1*3];
+    in3= in[3*3] + in[2*3];
+    in4= in[4*3] + in[3*3];
+    in5= in[5*3] + in[4*3];
+    in5 += in3;
+    in3 += in1;
+
+    in2= MULH(2*in2, C3);
+    in3= MULH(2*in3, C3);
+
+    t1 = in0 - in4;
+    t2 = MULL(in1 - in5, icos36[4]);
+
+    out[ 7]=
+    out[10]= t1 + t2;
+    out[ 1]=
+    out[ 4]= t1 - t2;
+
+    in0 += in4>>1;
+    in4 = in0 + in2;
+    in1 += in5>>1;
+    in5 = MULL(in1 + in3, icos36[1]);
+    out[ 8]=
+    out[ 9]= in4 + in5;
+    out[ 2]=
+    out[ 3]= in4 - in5;
+
+    in0 -= in2;
+    in1 = MULL(in1 - in3, icos36[7]);
+    out[ 0]=
+    out[ 5]= in0 - in1;
+    out[ 6]=
+    out[11]= in0 + in1;
 }
 
-#undef C1
-#undef C3
-#undef C5
-#undef C7
-#undef C9
-#undef C11
-
 /* cos(pi*i/18) */
 #define C1 FIXHR(0.98480775301220805936/2)
 #define C2 FIXHR(0.93969262078590838405/2)
@@ -995,18 +988,6 @@ static void imdct12(int *out, int *in)
 #define C8 FIXHR(0.17364817766693034885/2)
 
 
-/* 0.5 / cos(pi*(2*i+1)/36) */
-static const int icos36[9] = {
-    FIXR(0.50190991877167369479),
-    FIXR(0.51763809020504152469),
-    FIXR(0.55168895948124587824),
-    FIXR(0.61038729438072803416),
-    FIXR(0.70710678118654752439),
-    FIXR(0.87172339781054900991),
-    FIXR(1.18310079157624925896),
-    FIXR(1.93185165257813657349),
-    FIXR(5.73685662283492756461),
-};
 /* using Lee like decomposition followed by hand coded 9 points DCT */
 static void imdct36(int *out, int *buf, int *in, int *win)
 {
@@ -1025,7 +1006,7 @@ static void imdct36(int *out, int *buf, int *in, int *win)
 //more accurate but slower
         int64_t t0, t1, t2, t3;
         t2 = in1[2*4] + in1[2*8] - in1[2*2];
-        
+
         t3 = (in1[2*0] + (int64_t)(in1[2*6]>>1))<<32;
         t1 = in1[2*0] - in1[2*6];
         tmp1[ 6] = t1 - (t2>>1);
@@ -1034,11 +1015,11 @@ static void imdct36(int *out, int *buf, int *in, int *win)
         t0 = MUL64(2*(in1[2*2] + in1[2*4]),    C2);
         t1 = MUL64(   in1[2*4] - in1[2*8] , -2*C8);
         t2 = MUL64(2*(in1[2*2] + in1[2*8]),   -C4);
-        
+
         tmp1[10] = (t3 - t0 - t2) >> 32;
         tmp1[ 2] = (t3 + t0 + t1) >> 32;
         tmp1[14] = (t3 + t2 - t1) >> 32;
-        
+
         tmp1[ 4] = MULH(2*(in1[2*5] + in1[2*7] - in1[2*1]), -C3);
         t2 = MUL64(2*(in1[2*1] + in1[2*5]),    C1);
         t3 = MUL64(   in1[2*5] - in1[2*7] , -2*C7);
@@ -1051,7 +1032,7 @@ static void imdct36(int *out, int *buf, int *in, int *win)
         tmp1[ 8] = (t3 - t1 - t0) >> 32;
 #else
         t2 = in1[2*4] + in1[2*8] - in1[2*2];
-        
+
         t3 = in1[2*0] + (in1[2*6]>>1);
         t1 = in1[2*0] - in1[2*6];
         tmp1[ 6] = t1 - (t2>>1);
@@ -1060,11 +1041,11 @@ static void imdct36(int *out, int *buf, int *in, int *win)
         t0 = MULH(2*(in1[2*2] + in1[2*4]),    C2);
         t1 = MULH(   in1[2*4] - in1[2*8] , -2*C8);
         t2 = MULH(2*(in1[2*2] + in1[2*8]),   -C4);
-        
+
         tmp1[10] = t3 - t0 - t2;
         tmp1[ 2] = t3 + t0 + t1;
         tmp1[14] = t3 + t2 - t1;
-        
+
         tmp1[ 4] = MULH(2*(in1[2*5] + in1[2*7] - in1[2*1]), -C3);
         t2 = MULH(2*(in1[2*1] + in1[2*5]),    C1);
         t3 = MULH(   in1[2*5] - in1[2*7] , -2*C7);
@@ -1089,17 +1070,17 @@ static void imdct36(int *out, int *buf, int *in, int *win)
         t3 = tmp[i + 3];
         s1 = MULL(t3 + t2, icos36[j]);
         s3 = MULL(t3 - t2, icos36[8 - j]);
-        
-        t0 = (s0 + s1) << 5;
-        t1 = (s0 - s1) << 5;
-        out[(9 + j)*SBLIMIT] = -MULH(t1, win[9 + j]) + buf[9 + j];
+
+        t0 = s0 + s1;
+        t1 = s0 - s1;
+        out[(9 + j)*SBLIMIT] =  MULH(t1, win[9 + j]) + buf[9 + j];
         out[(8 - j)*SBLIMIT] =  MULH(t1, win[8 - j]) + buf[8 - j];
         buf[9 + j] = MULH(t0, win[18 + 9 + j]);
         buf[8 - j] = MULH(t0, win[18 + 8 - j]);
-        
-        t0 = (s2 + s3) << 5;
-        t1 = (s2 - s3) << 5;
-        out[(9 + 8 - j)*SBLIMIT] = -MULH(t1, win[9 + 8 - j]) + buf[9 + 8 - j];
+
+        t0 = s2 + s3;
+        t1 = s2 - s3;
+        out[(9 + 8 - j)*SBLIMIT] =  MULH(t1, win[9 + 8 - j]) + buf[9 + 8 - j];
         out[(        j)*SBLIMIT] =  MULH(t1, win[        j]) + buf[        j];
         buf[9 + 8 - j] = MULH(t0, win[18 + 9 + 8 - j]);
         buf[      + j] = MULH(t0, win[18         + j]);
@@ -1108,9 +1089,9 @@ static void imdct36(int *out, int *buf, int *in, int *win)
 
     s0 = tmp[16];
     s1 = MULL(tmp[17], icos36[4]);
-    t0 = (s0 + s1) << 5;
-    t1 = (s0 - s1) << 5;
-    out[(9 + 4)*SBLIMIT] = -MULH(t1, win[9 + 4]) + buf[9 + 4];
+    t0 = s0 + s1;
+    t1 = s0 - s1;
+    out[(9 + 4)*SBLIMIT] =  MULH(t1, win[9 + 4]) + buf[9 + 4];
     out[(8 - 4)*SBLIMIT] =  MULH(t1, win[8 - 4]) + buf[8 - 4];
     buf[9 + 4] = MULH(t0, win[18 + 9 + 4]);
     buf[8 - 4] = MULH(t0, win[18 + 8 - 4]);
@@ -1130,7 +1111,7 @@ static int decode_header(MPADecodeContext *s, uint32_t header)
         s->lsf = 1;
         mpeg25 = 1;
     }
-    
+
     s->layer = 4 - ((header >> 17) & 3);
     /* extract frequency */
     sample_rate_index = (header >> 10) & 3;
@@ -1153,7 +1134,7 @@ static int decode_header(MPADecodeContext *s, uint32_t header)
         s->nb_channels = 1;
     else
         s->nb_channels = 2;
-    
+
     if (bitrate_index != 0) {
         frame_size = mpa_bitrate_tab[s->lsf][s->layer - 1][bitrate_index];
         s->bit_rate = frame_size * 1000;
@@ -1196,7 +1177,7 @@ static int decode_header(MPADecodeContext *s, uint32_t header)
             break;
         }
     }
-    
+
 #if defined(DEBUG)
     printf("layer%d, %d Hz, %d kbits/s, ",
            s->layer, s->sample_rate, s->bit_rate);
@@ -1260,7 +1241,7 @@ static int mp_decode_layer1(MPADecodeContext *s)
     uint8_t allocation[MPA_MAX_CHANNELS][SBLIMIT];
     uint8_t scale_factors[MPA_MAX_CHANNELS][SBLIMIT];
 
-    if (s->mode == MPA_JSTEREO) 
+    if (s->mode == MPA_JSTEREO)
         bound = (s->mode_ext + 1) * 4;
     else
         bound = SBLIMIT;
@@ -1288,7 +1269,7 @@ static int mp_decode_layer1(MPADecodeContext *s)
             scale_factors[1][i] = get_bits(&s->gb, 6);
         }
     }
-    
+
     /* compute samples */
     for(j=0;j<12;j++) {
         for(i=0;i<bound;i++) {
@@ -1324,17 +1305,17 @@ static int mp_decode_layer1(MPADecodeContext *s)
 int l2_select_table(int bitrate, int nb_channels, int freq, int lsf)
 {
     int ch_bitrate, table;
-    
+
     ch_bitrate = bitrate / nb_channels;
     if (!lsf) {
         if ((freq == 48000 && ch_bitrate >= 56) ||
-            (ch_bitrate >= 56 && ch_bitrate <= 80)) 
+            (ch_bitrate >= 56 && ch_bitrate <= 80))
             table = 0;
-        else if (freq != 48000 && ch_bitrate >= 96) 
+        else if (freq != 48000 && ch_bitrate >= 96)
             table = 1;
-        else if (freq != 32000 && ch_bitrate <= 48) 
+        else if (freq != 32000 && ch_bitrate <= 48)
             table = 2;
-        else 
+        else
             table = 3;
     } else {
         table = 4;
@@ -1353,12 +1334,12 @@ static int mp_decode_layer2(MPADecodeContext *s)
     int scale, qindex, bits, steps, k, l, m, b;
 
     /* select decoding table */
-    table = l2_select_table(s->bit_rate / 1000, s->nb_channels, 
+    table = l2_select_table(s->bit_rate / 1000, s->nb_channels,
                             s->sample_rate, s->lsf);
     sblimit = sblimit_table[table];
     alloc_table = alloc_tables[table];
 
-    if (s->mode == MPA_JSTEREO) 
+    if (s->mode == MPA_JSTEREO)
         bound = (s->mode_ext + 1) * 4;
     else
         bound = sblimit;
@@ -1398,11 +1379,11 @@ static int mp_decode_layer2(MPADecodeContext *s)
     /* scale codes */
     for(i=0;i<sblimit;i++) {
         for(ch=0;ch<s->nb_channels;ch++) {
-            if (bit_alloc[ch][i]) 
+            if (bit_alloc[ch][i])
                 scale_code[ch][i] = get_bits(&s->gb, 2);
         }
     }
-    
+
     /* scale factors */
     for(i=0;i<sblimit;i++) {
         for(ch=0;ch<s->nb_channels;ch++) {
@@ -1465,13 +1446,13 @@ static int mp_decode_layer2(MPADecodeContext *s)
                             /* 3 values at the same time */
                             v = get_bits(&s->gb, -bits);
                             steps = quant_steps[qindex];
-                            s->sb_samples[ch][k * 12 + l + 0][i] = 
+                            s->sb_samples[ch][k * 12 + l + 0][i] =
                                 l2_unscale_group(steps, v % steps, scale);
                             v = v / steps;
-                            s->sb_samples[ch][k * 12 + l + 1][i] = 
+                            s->sb_samples[ch][k * 12 + l + 1][i] =
                                 l2_unscale_group(steps, v % steps, scale);
                             v = v / steps;
-                            s->sb_samples[ch][k * 12 + l + 2][i] = 
+                            s->sb_samples[ch][k * 12 + l + 2][i] =
                                 l2_unscale_group(steps, v, scale);
                         } else {
                             for(m=0;m<3;m++) {
@@ -1487,7 +1468,7 @@ static int mp_decode_layer2(MPADecodeContext *s)
                     }
                 }
                 /* next subband in alloc table */
-                j += 1 << bit_alloc_bits; 
+                j += 1 << bit_alloc_bits;
             }
             /* XXX: find a way to avoid this duplication of code */
             for(i=bound;i<sblimit;i++) {
@@ -1505,26 +1486,26 @@ static int mp_decode_layer2(MPADecodeContext *s)
                         steps = quant_steps[qindex];
                         mant = v % steps;
                         v = v / steps;
-                        s->sb_samples[0][k * 12 + l + 0][i] = 
+                        s->sb_samples[0][k * 12 + l + 0][i] =
                             l2_unscale_group(steps, mant, scale0);
-                        s->sb_samples[1][k * 12 + l + 0][i] = 
+                        s->sb_samples[1][k * 12 + l + 0][i] =
                             l2_unscale_group(steps, mant, scale1);
                         mant = v % steps;
                         v = v / steps;
-                        s->sb_samples[0][k * 12 + l + 1][i] = 
+                        s->sb_samples[0][k * 12 + l + 1][i] =
                             l2_unscale_group(steps, mant, scale0);
-                        s->sb_samples[1][k * 12 + l + 1][i] = 
+                        s->sb_samples[1][k * 12 + l + 1][i] =
                             l2_unscale_group(steps, mant, scale1);
-                        s->sb_samples[0][k * 12 + l + 2][i] = 
+                        s->sb_samples[0][k * 12 + l + 2][i] =
                             l2_unscale_group(steps, v, scale0);
-                        s->sb_samples[1][k * 12 + l + 2][i] = 
+                        s->sb_samples[1][k * 12 + l + 2][i] =
                             l2_unscale_group(steps, v, scale1);
                     } else {
                         for(m=0;m<3;m++) {
                             mant = get_bits(&s->gb, bits);
-                            s->sb_samples[0][k * 12 + l + m][i] = 
+                            s->sb_samples[0][k * 12 + l + m][i] =
                                 l1_unscale(bits - 1, mant, scale0);
-                            s->sb_samples[1][k * 12 + l + m][i] = 
+                            s->sb_samples[1][k * 12 + l + m][i] =
                                 l1_unscale(bits - 1, mant, scale1);
                         }
                     }
@@ -1537,7 +1518,7 @@ static int mp_decode_layer2(MPADecodeContext *s)
                     s->sb_samples[1][k * 12 + l + 2][i] = 0;
                 }
                 /* next subband in alloc table */
-                j += 1 << bit_alloc_bits; 
+                j += 1 << bit_alloc_bits;
             }
             /* fill remaining samples to zero */
             for(i=sblimit;i<SBLIMIT;i++) {
@@ -1564,7 +1545,7 @@ static void seek_to_maindata(MPADecodeContext *s, unsigned int backstep)
 
     /* copy old data before current one */
     ptr -= backstep;
-    memcpy(ptr, s->inbuf1[s->inbuf_index ^ 1] + 
+    memcpy(ptr, s->inbuf1[s->inbuf_index ^ 1] +
            BACKSTEP_SIZE + s->old_frame_size - backstep, backstep);
     /* init get bits again */
     init_get_bits(&s->gb, ptr, (s->frame_size + backstep)*8);
@@ -1595,7 +1576,7 @@ static inline void lsf_sf_expand(int *slen,
     slen[0] = sf;
 }
 
-static void exponents_from_scale_factors(MPADecodeContext *s, 
+static void exponents_from_scale_factors(MPADecodeContext *s,
                                          GranuleDef *g,
                                          int16_t *exponents)
 {
@@ -1669,7 +1650,7 @@ static int huffman_decode(MPADecodeContext *s, GranuleDef *g,
             if (get_bits_count(&s->gb) >= end_pos)
                 break;
             if (code_table) {
-                code = get_vlc(&s->gb, vlc);
+                code = get_vlc2(&s->gb, vlc->table, 8, 2);
                 if (code < 0)
                     return -1;
                 y = code_table[code];
@@ -1679,7 +1660,7 @@ static int huffman_decode(MPADecodeContext *s, GranuleDef *g,
                 x = 0;
                 y = 0;
             }
-            dprintf("region=%d n=%d x=%d y=%d exp=%d\n", 
+            dprintf("region=%d n=%d x=%d y=%d exp=%d\n",
                     i, g->region_size[i] - j, x, y, exponents[s_index]);
             if (x) {
                 if (x == 15)
@@ -1703,7 +1684,7 @@ static int huffman_decode(MPADecodeContext *s, GranuleDef *g,
             g->sb_hybrid[s_index++] = v;
         }
     }
-            
+
     /* high frequencies */
     vlc = &huff_quad_vlc[g->count1table_select];
     last_gb.buffer = NULL;
@@ -1720,7 +1701,7 @@ static int huffman_decode(MPADecodeContext *s, GranuleDef *g,
         }
         last_gb= s->gb;
 
-        code = get_vlc(&s->gb, vlc);
+        code = get_vlc2(&s->gb, vlc->table, vlc->bits, 2);
         dprintf("t=%d code=%d\n", g->count1table_select, code);
         if (code < 0)
             return -1;
@@ -1763,7 +1744,7 @@ static void reorder_block(MPADecodeContext *s, GranuleDef *g)
     } else {
         ptr = g->sb_hybrid;
     }
-    
+
     for(i=g->short_start;i<13;i++) {
         len = band_size_short[s->sample_rate_index][i];
         ptr1 = ptr;
@@ -1799,7 +1780,7 @@ static void compute_stereo(MPADecodeContext *s,
             is_tab = is_table_lsf[g1->scalefac_compress & 1];
             sf_max = 16;
         }
-            
+
         tab0 = g0->sb_hybrid + 576;
         tab1 = g1->sb_hybrid + 576;
 
@@ -1850,8 +1831,8 @@ static void compute_stereo(MPADecodeContext *s,
             }
         }
 
-        non_zero_found = non_zero_found_short[0] | 
-            non_zero_found_short[1] | 
+        non_zero_found = non_zero_found_short[0] |
+            non_zero_found_short[1] |
             non_zero_found_short[2];
 
         for(i = g1->long_end - 1;i >= 0;i--) {
@@ -1922,17 +1903,17 @@ static void compute_antialias_integer(MPADecodeContext *s,
     } else {
         n = SBLIMIT - 1;
     }
-    
+
     ptr = g->sb_hybrid + 18;
     for(i = n;i > 0;i--) {
         int tmp0, tmp1, tmp2;
         csa = &csa_table[0][0];
 #define INT_AA(j) \
-            tmp0 = 4*(ptr[-1-j]);\
-            tmp1 = 4*(ptr[   j]);\
+            tmp0 = ptr[-1-j];\
+            tmp1 = ptr[   j];\
             tmp2= MULH(tmp0 + tmp1, csa[0+4*j]);\
-            ptr[-1-j] = tmp2 - MULH(tmp1, csa[2+4*j]);\
-            ptr[   j] = tmp2 + MULH(tmp0, csa[3+4*j]);
+            ptr[-1-j] = 4*(tmp2 - MULH(tmp1, csa[2+4*j]));\
+            ptr[   j] = 4*(tmp2 + MULH(tmp0, csa[3+4*j]));
 
         INT_AA(0)
         INT_AA(1)
@@ -1942,8 +1923,8 @@ static void compute_antialias_integer(MPADecodeContext *s,
         INT_AA(5)
         INT_AA(6)
         INT_AA(7)
-            
-        ptr += 18;       
+
+        ptr += 18;
     }
 }
 
@@ -1962,17 +1943,17 @@ static void compute_antialias_float(MPADecodeContext *s,
     } else {
         n = SBLIMIT - 1;
     }
-    
+
     ptr = g->sb_hybrid + 18;
     for(i = n;i > 0;i--) {
         float tmp0, tmp1;
-        float *csa = &csa_table_float[0][0];       
+        float *csa = &csa_table_float[0][0];
 #define FLOAT_AA(j)\
         tmp0= ptr[-1-j];\
         tmp1= ptr[   j];\
         ptr[-1-j] = lrintf(tmp0 * csa[0+4*j] - tmp1 * csa[1+4*j]);\
         ptr[   j] = lrintf(tmp0 * csa[1+4*j] + tmp1 * csa[0+4*j]);
-        
+
         FLOAT_AA(0)
         FLOAT_AA(1)
         FLOAT_AA(2)
@@ -1982,20 +1963,18 @@ static void compute_antialias_float(MPADecodeContext *s,
         FLOAT_AA(6)
         FLOAT_AA(7)
 
-        ptr += 18;       
+        ptr += 18;
     }
 }
 
 static void compute_imdct(MPADecodeContext *s,
-                          GranuleDef *g, 
+                          GranuleDef *g,
                           int32_t *sb_samples,
                           int32_t *mdct_buf)
 {
-    int32_t *ptr, *win, *win1, *buf, *buf2, *out_ptr, *ptr1;
-    int32_t in[6];
-    int32_t out[36];
+    int32_t *ptr, *win, *win1, *buf, *out_ptr, *ptr1;
     int32_t out2[12];
-    int i, j, k, mdct_long_end, v, sblimit;
+    int i, j, mdct_long_end, v, sblimit;
 
     /* find last non zero block */
     ptr = g->sb_hybrid + 576;
@@ -2036,36 +2015,32 @@ static void compute_imdct(MPADecodeContext *s,
         buf += 18;
     }
     for(j=mdct_long_end;j<sblimit;j++) {
-        for(i=0;i<6;i++) {
-            out[i] = 0;
-            out[6 + i] = 0;
-            out[30+i] = 0;
-        }
         /* select frequency inversion */
         win = mdct_win[2] + ((4 * 36) & -(j & 1));
-        buf2 = out + 6;
-        for(k=0;k<3;k++) {
-            /* reorder input for short mdct */
-            ptr1 = ptr + k;
-            for(i=0;i<6;i++) {
-                in[i] = *ptr1;
-                ptr1 += 3;
-            }
-            imdct12(out2, in);
-            /* apply 12 point window and do small overlap */
-            for(i=0;i<6;i++) {
-                buf2[i] = MULL(out2[i], win[i]) + buf2[i];
-                buf2[i + 6] = MULL(out2[i + 6], win[i + 6]);
-            }
-            buf2 += 6;
-        }
-        /* overlap */
         out_ptr = sb_samples + j;
-        for(i=0;i<18;i++) {
-            *out_ptr = out[i] + buf[i];
-            buf[i] = out[i + 18];
+
+        for(i=0; i<6; i++){
+            *out_ptr = buf[i];
+            out_ptr += SBLIMIT;
+        }
+        imdct12(out2, ptr + 0);
+        for(i=0;i<6;i++) {
+            *out_ptr = MULH(out2[i], win[i]) + buf[i + 6*1];
+            buf[i + 6*2] = MULH(out2[i + 6], win[i + 6]);
             out_ptr += SBLIMIT;
         }
+        imdct12(out2, ptr + 1);
+        for(i=0;i<6;i++) {
+            *out_ptr = MULH(out2[i], win[i]) + buf[i + 6*2];
+            buf[i + 6*0] = MULH(out2[i + 6], win[i + 6]);
+            out_ptr += SBLIMIT;
+        }
+        imdct12(out2, ptr + 2);
+        for(i=0;i<6;i++) {
+            buf[i + 6*0] = MULH(out2[i], win[i]) + buf[i + 6*0];
+            buf[i + 6*1] = MULH(out2[i + 6], win[i + 6]);
+            buf[i + 6*2] = 0;
+        }
         ptr += 18;
         buf += 18;
     }
@@ -2089,11 +2064,11 @@ void sample_dump(int fnum, int32_t *tab, int n)
     char buf[512];
     int i;
     int32_t v;
-    
+
     f = files[fnum];
     if (!f) {
-        snprintf(buf, sizeof(buf), "/tmp/out%d.%s.pcm", 
-                fnum, 
+        snprintf(buf, sizeof(buf), "/tmp/out%d.%s.pcm",
+                fnum,
 #ifdef USE_HIGHPRECISION
                 "hp"
 #else
@@ -2105,7 +2080,7 @@ void sample_dump(int fnum, int32_t *tab, int n)
             return;
         files[fnum] = f;
     }
-    
+
     if (fnum == 0) {
         static int pos = 0;
         av_log(NULL, AV_LOG_DEBUG, "pos=%d\n", pos);
@@ -2153,7 +2128,7 @@ static int mp_decode_layer3(MPADecodeContext *s)
             granules[ch][1].scfsi = get_bits(&s->gb, 4);
         }
     }
-    
+
     for(gr=0;gr<nb_granules;gr++) {
         for(ch=0;ch<s->nb_channels;ch++) {
             dprintf("gr=%d ch=%d: side_info\n", gr, ch);
@@ -2163,7 +2138,7 @@ static int mp_decode_layer3(MPADecodeContext *s)
             g->global_gain = get_bits(&s->gb, 8);
             /* if MS stereo only is selected, we precompute the
                1/sqrt(2) renormalization factor */
-            if ((s->mode_ext & (MODE_EXT_MS_STEREO | MODE_EXT_I_STEREO)) == 
+            if ((s->mode_ext & (MODE_EXT_MS_STEREO | MODE_EXT_I_STEREO)) ==
                 MODE_EXT_MS_STEREO)
                 g->global_gain -= 2;
             if (s->lsf)
@@ -2178,15 +2153,15 @@ static int mp_decode_layer3(MPADecodeContext *s)
                 g->switch_point = get_bits(&s->gb, 1);
                 for(i=0;i<2;i++)
                     g->table_select[i] = get_bits(&s->gb, 5);
-                for(i=0;i<3;i++) 
+                for(i=0;i<3;i++)
                     g->subblock_gain[i] = get_bits(&s->gb, 3);
                 /* compute huffman coded region sizes */
                 if (g->block_type == 2)
                     g->region_size[0] = (36 / 2);
                 else {
-                    if (s->sample_rate_index <= 2) 
+                    if (s->sample_rate_index <= 2)
                         g->region_size[0] = (36 / 2);
-                    else if (s->sample_rate_index != 8) 
+                    else if (s->sample_rate_index != 8)
                         g->region_size[0] = (54 / 2);
                     else
                         g->region_size[0] = (108 / 2);
@@ -2201,15 +2176,15 @@ static int mp_decode_layer3(MPADecodeContext *s)
                 /* compute huffman coded region sizes */
                 region_address1 = get_bits(&s->gb, 4);
                 region_address2 = get_bits(&s->gb, 3);
-                dprintf("region1=%d region2=%d\n", 
+                dprintf("region1=%d region2=%d\n",
                         region_address1, region_address2);
-                g->region_size[0] = 
+                g->region_size[0] =
                     band_index_long[s->sample_rate_index][region_address1 + 1] >> 1;
                 l = region_address1 + region_address2 + 2;
                 /* should not overflow */
                 if (l > 22)
                     l = 22;
-                g->region_size[1] = 
+                g->region_size[1] =
                     band_index_long[s->sample_rate_index][l] >> 1;
             }
             /* convert region offsets to region sizes and truncate
@@ -2236,11 +2211,11 @@ static int mp_decode_layer3(MPADecodeContext *s)
                         g->long_end = 6;
                     else
                         g->long_end = 4; /* 8000 Hz */
-                    
+
                     if (s->sample_rate_index != 8)
                         g->short_start = 3;
                     else
-                        g->short_start = 2; 
+                        g->short_start = 2;
                 } else {
                     g->long_end = 0;
                     g->short_start = 0;
@@ -2249,7 +2224,7 @@ static int mp_decode_layer3(MPADecodeContext *s)
                 g->short_start = 13;
                 g->long_end = 22;
             }
-            
+
             g->preflag = 0;
             if (!s->lsf)
                 g->preflag = get_bits(&s->gb, 1);
@@ -2269,9 +2244,9 @@ static int mp_decode_layer3(MPADecodeContext *s)
     for(gr=0;gr<nb_granules;gr++) {
         for(ch=0;ch<s->nb_channels;ch++) {
             g = &granules[ch][gr];
-            
+
             bits_pos = get_bits_count(&s->gb);
-            
+
             if (!s->lsf) {
                 uint8_t *sc;
                 int slen, slen1, slen2;
@@ -2310,7 +2285,7 @@ static int mp_decode_layer3(MPADecodeContext *s)
                 }
 #if defined(DEBUG)
                 {
-                    printf("scfsi=%x gr=%d ch=%d scale_factors:\n", 
+                    printf("scfsi=%x gr=%d ch=%d scale_factors:\n",
                            g->scfsi, gr, ch);
                     for(i=0;i<j;i++)
                         printf(" %d", g->scale_factors[i]);
@@ -2367,7 +2342,7 @@ static int mp_decode_layer3(MPADecodeContext *s)
                     g->scale_factors[j] = 0;
 #if defined(DEBUG)
                 {
-                    printf("gr=%d ch=%d scale_factors:\n", 
+                    printf("gr=%d ch=%d scale_factors:\n",
                            gr, ch);
                     for(i=0;i<40;i++)
                         printf(" %d", g->scale_factors[i]);
@@ -2414,7 +2389,7 @@ static int mp_decode_layer3(MPADecodeContext *s)
 #if defined(DEBUG)
             sample_dump(1, g->sb_hybrid, 576);
 #endif
-            compute_imdct(s, g, &s->sb_samples[ch][18 * gr][0], s->mdct_buf[ch]); 
+            compute_imdct(s, g, &s->sb_samples[ch][18 * gr][0], s->mdct_buf[ch]);
 #if defined(DEBUG)
             sample_dump(2, &s->sb_samples[ch][18 * gr][0], 576);
 #endif
@@ -2423,15 +2398,15 @@ static int mp_decode_layer3(MPADecodeContext *s)
     return nb_granules * 18;
 }
 
-static int mp_decode_frame(MPADecodeContext *s, 
+static int mp_decode_frame(MPADecodeContext *s,
                            OUT_INT *samples)
 {
     int i, nb_frames, ch;
     OUT_INT *samples_ptr;
 
-    init_get_bits(&s->gb, s->inbuf + HEADER_SIZE, 
+    init_get_bits(&s->gb, s->inbuf + HEADER_SIZE,
                   (s->inbuf_ptr - s->inbuf - HEADER_SIZE)*8);
-    
+
     /* skip error protection field */
     if (s->error_protection)
         get_bits(&s->gb, 16);
@@ -2465,21 +2440,21 @@ static int mp_decode_frame(MPADecodeContext *s,
         samples_ptr = samples + ch;
         for(i=0;i<nb_frames;i++) {
             ff_mpa_synth_filter(s->synth_buf[ch], &(s->synth_buf_offset[ch]),
-                        window, &s->dither_state,
-                        samples_ptr, s->nb_channels,
+                         window, &s->dither_state,
+                         samples_ptr, s->nb_channels,
                          s->sb_samples[ch][i]);
             samples_ptr += 32 * s->nb_channels;
         }
     }
 #ifdef DEBUG
-    s->frame_count++;        
+    s->frame_count++;
 #endif
     return nb_frames * 32 * sizeof(OUT_INT) * s->nb_channels;
 }
 
 static int decode_frame(AVCodecContext * avctx,
-                       void *data, int *data_size,
-                       uint8_t * buf, int buf_size)
+                        void *data, int *data_size,
+                        uint8_t * buf, int buf_size)
 {
     MPADecodeContext *s = avctx->priv_data;
     uint32_t header;
@@ -2489,8 +2464,8 @@ static int decode_frame(AVCodecContext * avctx,
 
     buf_ptr = buf;
     while (buf_size > 0) {
-       len = s->inbuf_ptr - s->inbuf;
-       if (s->frame_size == 0) {
+        len = s->inbuf_ptr - s->inbuf;
+        if (s->frame_size == 0) {
             /* special case for next header for first frame in free
                format case (XXX: find a simpler method) */
             if (s->free_format_next_header != 0) {
@@ -2502,34 +2477,34 @@ static int decode_frame(AVCodecContext * avctx,
                 s->free_format_next_header = 0;
                 goto got_header;
             }
-           /* no header seen : find one. We need at least HEADER_SIZE
+            /* no header seen : find one. We need at least HEADER_SIZE
                bytes to parse it */
-           len = HEADER_SIZE - len;
-           if (len > buf_size)
-               len = buf_size;
-           if (len > 0) {
-               memcpy(s->inbuf_ptr, buf_ptr, len);
-               buf_ptr += len;
-               buf_size -= len;
-               s->inbuf_ptr += len;
-           }
-           if ((s->inbuf_ptr - s->inbuf) >= HEADER_SIZE) {
+            len = HEADER_SIZE - len;
+            if (len > buf_size)
+                len = buf_size;
+            if (len > 0) {
+                memcpy(s->inbuf_ptr, buf_ptr, len);
+                buf_ptr += len;
+                buf_size -= len;
+                s->inbuf_ptr += len;
+            }
+            if ((s->inbuf_ptr - s->inbuf) >= HEADER_SIZE) {
             got_header:
-               header = (s->inbuf[0] << 24) | (s->inbuf[1] << 16) |
-                   (s->inbuf[2] << 8) | s->inbuf[3];
+                header = (s->inbuf[0] << 24) | (s->inbuf[1] << 16) |
+                    (s->inbuf[2] << 8) | s->inbuf[3];
 
-               if (ff_mpa_check_header(header) < 0) {
-                   /* no sync found : move by one byte (inefficient, but simple!) */
-                   memmove(s->inbuf, s->inbuf + 1, s->inbuf_ptr - s->inbuf - 1);
-                   s->inbuf_ptr--;
+                if (ff_mpa_check_header(header) < 0) {
+                    /* no sync found : move by one byte (inefficient, but simple!) */
+                    memmove(s->inbuf, s->inbuf + 1, s->inbuf_ptr - s->inbuf - 1);
+                    s->inbuf_ptr--;
                     dprintf("skip %x\n", header);
                     /* reset free format frame size to give a chance
                        to get a new bitrate */
                     s->free_format_frame_size = 0;
-               } else {
-                   if (decode_header(s, header) == 1) {
+                } else {
+                    if (decode_header(s, header) == 1) {
                         /* free format: prepare to compute frame size */
-                       s->frame_size = -1;
+                        s->frame_size = -1;
                     }
                     /* update codec info */
                     avctx->sample_rate = s->sample_rate;
@@ -2550,18 +2525,18 @@ static int decode_frame(AVCodecContext * avctx,
                             avctx->frame_size = 1152;
                         break;
                     }
-               }
-           }
+                }
+            }
         } else if (s->frame_size == -1) {
             /* free format : find next sync to compute frame size */
-           len = MPA_MAX_CODED_FRAME_SIZE - len;
-           if (len > buf_size)
-               len = buf_size;
+            len = MPA_MAX_CODED_FRAME_SIZE - len;
+            if (len > buf_size)
+                len = buf_size;
             if (len == 0) {
-               /* frame too long: resync */
+                /* frame too long: resync */
                 s->frame_size = 0;
-               memmove(s->inbuf, s->inbuf + 1, s->inbuf_ptr - s->inbuf - 1);
-               s->inbuf_ptr--;
+                memmove(s->inbuf, s->inbuf + 1, s->inbuf_ptr - s->inbuf - 1);
+                s->inbuf_ptr--;
             } else {
                 uint8_t *p, *pend;
                 uint32_t header1;
@@ -2593,7 +2568,7 @@ static int decode_frame(AVCodecContext * avctx,
                             s->free_format_frame_size -= padding * 4;
                         else
                             s->free_format_frame_size -= padding;
-                        dprintf("free frame size=%d padding=%d\n", 
+                        dprintf("free frame size=%d padding=%d\n",
                                 s->free_format_frame_size, padding);
                         decode_header(s, header1);
                         goto next_data;
@@ -2605,19 +2580,19 @@ static int decode_frame(AVCodecContext * avctx,
                 s->inbuf_ptr += len;
                 buf_size -= len;
             }
-       } else if (len < s->frame_size) {
+        } else if (len < s->frame_size) {
             if (s->frame_size > MPA_MAX_CODED_FRAME_SIZE)
                 s->frame_size = MPA_MAX_CODED_FRAME_SIZE;
-           len = s->frame_size - len;
-           if (len > buf_size)
-               len = buf_size;
-           memcpy(s->inbuf_ptr, buf_ptr, len);
-           buf_ptr += len;
-           s->inbuf_ptr += len;
-           buf_size -= len;
-       }
+            len = s->frame_size - len;
+            if (len > buf_size)
+                len = buf_size;
+            memcpy(s->inbuf_ptr, buf_ptr, len);
+            buf_ptr += len;
+            s->inbuf_ptr += len;
+            buf_size -= len;
+        }
     next_data:
-        if (s->frame_size > 0 && 
+        if (s->frame_size > 0 &&
             (s->inbuf_ptr - s->inbuf) >= s->frame_size) {
             if (avctx->parse_only) {
                 /* simply return the frame data */
@@ -2626,19 +2601,22 @@ static int decode_frame(AVCodecContext * avctx,
             } else {
                 out_size = mp_decode_frame(s, out_samples);
             }
-           s->inbuf_ptr = s->inbuf;
-           s->frame_size = 0;
-           *data_size = out_size;
-           break;
-       }
+            s->inbuf_ptr = s->inbuf;
+            s->frame_size = 0;
+            if(out_size>=0)
+                *data_size = out_size;
+            else
+                av_log(avctx, AV_LOG_DEBUG, "Error while decoding mpeg audio frame\n"); //FIXME return -1 / but also return the number of bytes consumed
+            break;
+        }
     }
     return buf_ptr - buf;
 }
 
 
 static int decode_frame_adu(AVCodecContext * avctx,
-                       void *data, int *data_size,
-                       uint8_t * buf, int buf_size)
+                        void *data, int *data_size,
+                        uint8_t * buf, int buf_size)
 {
     MPADecodeContext *s = avctx->priv_data;
     uint32_t header;
@@ -2691,6 +2669,170 @@ static int decode_frame_adu(AVCodecContext * avctx,
 }
 
 
+/* Next 3 arrays are indexed by channel config number (passed via codecdata) */
+static int mp3Frames[16] = {0,1,1,2,3,3,4,5,2};   /* number of mp3 decoder instances */
+static int mp3Channels[16] = {0,1,2,3,4,5,6,8,4}; /* total output channels */
+/* offsets into output buffer, assume output order is FL FR BL BR C LFE */
+static int chan_offset[9][5] = {
+    {0},
+    {0},            // C
+    {0},            // FLR
+    {2,0},          // C FLR
+    {2,0,3},        // C FLR BS
+    {4,0,2},        // C FLR BLRS
+    {4,0,2,5},      // C FLR BLRS LFE
+    {4,0,2,6,5},    // C FLR BLRS BLR LFE
+    {0,2}           // FLR BLRS
+};
+
+
+static int decode_init_mp3on4(AVCodecContext * avctx)
+{
+    MP3On4DecodeContext *s = avctx->priv_data;
+    int i;
+
+    if ((avctx->extradata_size < 2) || (avctx->extradata == NULL)) {
+        av_log(avctx, AV_LOG_ERROR, "Codec extradata missing or too short.\n");
+        return -1;
+    }
+
+    s->chan_cfg = (((unsigned char *)avctx->extradata)[1] >> 3) & 0x0f;
+    s->frames = mp3Frames[s->chan_cfg];
+    if(!s->frames) {
+        av_log(avctx, AV_LOG_ERROR, "Invalid channel config number.\n");
+        return -1;
+    }
+    avctx->channels = mp3Channels[s->chan_cfg];
+
+    /* Init the first mp3 decoder in standard way, so that all tables get builded
+     * We replace avctx->priv_data with the context of the first decoder so that
+     * decode_init() does not have to be changed.
+     * Other decoders will be inited here copying data from the first context
+     */
+    // Allocate zeroed memory for the first decoder context
+    s->mp3decctx[0] = av_mallocz(sizeof(MPADecodeContext));
+    // Put decoder context in place to make init_decode() happy
+    avctx->priv_data = s->mp3decctx[0];
+    decode_init(avctx);
+    // Restore mp3on4 context pointer
+    avctx->priv_data = s;
+    s->mp3decctx[0]->adu_mode = 1; // Set adu mode
+
+    /* Create a separate codec/context for each frame (first is already ok).
+     * Each frame is 1 or 2 channels - up to 5 frames allowed
+     */
+    for (i = 1; i < s->frames; i++) {
+        s->mp3decctx[i] = av_mallocz(sizeof(MPADecodeContext));
+        s->mp3decctx[i]->compute_antialias = s->mp3decctx[0]->compute_antialias;
+        s->mp3decctx[i]->inbuf = &s->mp3decctx[i]->inbuf1[0][BACKSTEP_SIZE];
+        s->mp3decctx[i]->inbuf_ptr = s->mp3decctx[i]->inbuf;
+        s->mp3decctx[i]->adu_mode = 1;
+    }
+
+    return 0;
+}
+
+
+static int decode_close_mp3on4(AVCodecContext * avctx)
+{
+    MP3On4DecodeContext *s = avctx->priv_data;
+    int i;
+
+    for (i = 0; i < s->frames; i++)
+        if (s->mp3decctx[i])
+            av_free(s->mp3decctx[i]);
+
+    return 0;
+}
+
+
+static int decode_frame_mp3on4(AVCodecContext * avctx,
+                        void *data, int *data_size,
+                        uint8_t * buf, int buf_size)
+{
+    MP3On4DecodeContext *s = avctx->priv_data;
+    MPADecodeContext *m;
+    int len, out_size = 0;
+    uint32_t header;
+    OUT_INT *out_samples = data;
+    OUT_INT decoded_buf[MPA_FRAME_SIZE * MPA_MAX_CHANNELS];
+    OUT_INT *outptr, *bp;
+    int fsize;
+    unsigned char *start2 = buf, *start;
+    int fr, i, j, n;
+    int off = avctx->channels;
+    int *coff = chan_offset[s->chan_cfg];
+
+    len = buf_size;
+
+    // Discard too short frames
+    if (buf_size < HEADER_SIZE) {
+        *data_size = 0;
+        return buf_size;
+    }
+
+    // If only one decoder interleave is not needed
+    outptr = s->frames == 1 ? out_samples : decoded_buf;
+
+    for (fr = 0; fr < s->frames; fr++) {
+        start = start2;
+        fsize = (start[0] << 4) | (start[1] >> 4);
+        start2 += fsize;
+        if (fsize > len)
+            fsize = len;
+        len -= fsize;
+        if (fsize > MPA_MAX_CODED_FRAME_SIZE)
+            fsize = MPA_MAX_CODED_FRAME_SIZE;
+        m = s->mp3decctx[fr];
+        assert (m != NULL);
+        /* copy original to new */
+        m->inbuf_ptr = m->inbuf + fsize;
+        memcpy(m->inbuf, start, fsize);
+
+        // Get header
+        header = (m->inbuf[0] << 24) | (m->inbuf[1] << 16) |
+                  (m->inbuf[2] << 8) | m->inbuf[3] | 0xfff00000;
+
+        if (ff_mpa_check_header(header) < 0) { // Bad header, discard block
+            *data_size = 0;
+            return buf_size;
+        }
+
+        decode_header(m, header);
+        mp_decode_frame(m, decoded_buf);
+
+        n = MPA_FRAME_SIZE * m->nb_channels;
+        out_size += n * sizeof(OUT_INT);
+        if(s->frames > 1) {
+            /* interleave output data */
+            bp = out_samples + coff[fr];
+            if(m->nb_channels == 1) {
+                for(j = 0; j < n; j++) {
+                    *bp = decoded_buf[j];
+                    bp += off;
+                }
+            } else {
+                for(j = 0; j < n; j++) {
+                    bp[0] = decoded_buf[j++];
+                    bp[1] = decoded_buf[j];
+                    bp += off;
+                }
+            }
+        }
+    }
+
+    /* update codec info */
+    avctx->sample_rate = s->mp3decctx[0]->sample_rate;
+    avctx->frame_size= buf_size;
+    avctx->bit_rate = 0;
+    for (i = 0; i < s->frames; i++)
+        avctx->bit_rate += s->mp3decctx[i]->bit_rate;
+
+    *data_size = out_size;
+    return buf_size;
+}
+
+
 AVCodec mp2_decoder =
 {
     "mp2",
@@ -2729,3 +2871,16 @@ AVCodec mp3adu_decoder =
     decode_frame_adu,
     CODEC_CAP_PARSE_ONLY,
 };
+
+AVCodec mp3on4_decoder =
+{
+    "mp3on4",
+    CODEC_TYPE_AUDIO,
+    CODEC_ID_MP3ON4,
+    sizeof(MP3On4DecodeContext),
+    decode_init_mp3on4,
+    NULL,
+    decode_close_mp3on4,
+    decode_frame_mp3on4,
+    0
+};