ffmpeg/libavcodec/mpegaudiodec.c

294 lines
8.0 KiB
C

/*
* MPEG Audio decoder
* Copyright (c) 2001 Gerard Lantau.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include "avcodec.h"
#include "mpglib/mpg123.h"
/*
* TODO:
* - add free format
* - do not rely anymore on mpglib (first step: implement dct64 and decoding filter)
*/
#define HEADER_SIZE 4
#define BACKSTEP_SIZE 512
typedef struct MPADecodeContext {
struct mpstr mpstr;
UINT8 inbuf1[2][MAXFRAMESIZE + BACKSTEP_SIZE]; /* input buffer */
int inbuf_index;
UINT8 *inbuf_ptr, *inbuf;
int frame_size;
int error_protection;
int layer;
int sample_rate;
int bit_rate;
int old_frame_size;
GetBitContext gb;
} MPADecodeContext;
/* XXX: suppress that mess */
struct mpstr *gmp;
GetBitContext *gmp_gb;
static MPADecodeContext *gmp_s;
/* XXX: merge constants with encoder */
static const unsigned short mp_bitrate_tab[2][3][15] = {
{ {0, 32, 64, 96, 128, 160, 192, 224, 256, 288, 320, 352, 384, 416, 448 },
{0, 32, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320, 384 },
{0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320 } },
{ {0, 32, 48, 56, 64, 80, 96, 112, 128, 144, 160, 176, 192, 224, 256},
{0, 8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160},
{0, 8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160}
}
};
static unsigned short mp_freq_tab[3] = { 44100, 48000, 32000 };
static int decode_init(AVCodecContext * avctx)
{
MPADecodeContext *s = avctx->priv_data;
struct mpstr *mp = &s->mpstr;
static int init;
mp->fr.single = -1;
mp->synth_bo = 1;
if(!init) {
init = 1;
make_decode_tables(32767);
init_layer2();
init_layer3(SBLIMIT);
}
s->inbuf_index = 0;
s->inbuf = &s->inbuf1[s->inbuf_index][BACKSTEP_SIZE];
s->inbuf_ptr = s->inbuf;
return 0;
}
/* fast header check for resync */
static int check_header(UINT32 header)
{
/* header */
if ((header & 0xffe00000) != 0xffe00000)
return -1;
/* layer check */
if (((header >> 17) & 3) == 0)
return -1;
/* bit rate : currently no free format supported */
if (((header >> 12) & 0xf) == 0xf ||
((header >> 12) & 0xf) == 0x0)
return -1;
/* frequency */
if (((header >> 10) & 3) == 3)
return -1;
return 0;
}
/* header decoding. MUST check the header before because no
consistency check is done there */
static void decode_header(MPADecodeContext *s, UINT32 header)
{
struct frame *fr = &s->mpstr.fr;
int sample_rate, frame_size;
if (header & (1<<20)) {
fr->lsf = (header & (1<<19)) ? 0 : 1;
fr->mpeg25 = 0;
} else {
fr->lsf = 1;
fr->mpeg25 = 1;
}
s->layer = 4 - ((header >> 17) & 3);
/* extract frequency */
fr->sampling_frequency = ((header >> 10) & 3);
sample_rate = mp_freq_tab[fr->sampling_frequency] >> (fr->lsf + fr->mpeg25);
fr->sampling_frequency += 3 * (fr->lsf + fr->mpeg25);
s->error_protection = ((header>>16) & 1) ^ 1;
fr->bitrate_index = ((header>>12)&0xf);
fr->padding = ((header>>9)&0x1);
fr->extension = ((header>>8)&0x1);
fr->mode = ((header>>6)&0x3);
fr->mode_ext = ((header>>4)&0x3);
fr->copyright = ((header>>3)&0x1);
fr->original = ((header>>2)&0x1);
fr->emphasis = header & 0x3;
fr->stereo = (fr->mode == MPG_MD_MONO) ? 1 : 2;
frame_size = mp_bitrate_tab[fr->lsf][s->layer - 1][fr->bitrate_index];
s->bit_rate = frame_size * 1000;
switch(s->layer) {
case 1:
frame_size = (frame_size * 12000) / sample_rate;
frame_size = ((frame_size + fr->padding) << 2);
break;
case 2:
frame_size = (frame_size * 144000) / sample_rate;
frame_size += fr->padding;
break;
case 3:
frame_size = (frame_size * 144000) / (sample_rate << fr->lsf);
frame_size += fr->padding;
break;
}
s->frame_size = frame_size;
s->sample_rate = sample_rate;
#if 0
printf("layer%d, %d Hz, %d kbits/s, %s\n",
s->layer, s->sample_rate, s->bit_rate, fr->stereo ? "stereo" : "mono");
#endif
}
static int mp_decode_frame(MPADecodeContext *s,
short *samples)
{
int nb_bytes;
init_get_bits(&s->gb, s->inbuf + HEADER_SIZE, s->inbuf_ptr - s->inbuf - HEADER_SIZE);
/* skip error protection field */
if (s->error_protection)
get_bits(&s->gb, 16);
/* XXX: horrible: global! */
gmp = &s->mpstr;
gmp_s = s;
gmp_gb = &s->gb;
nb_bytes = 0;
switch(s->layer) {
case 1:
do_layer1(&s->mpstr.fr,(unsigned char *)samples, &nb_bytes);
break;
case 2:
do_layer2(&s->mpstr.fr,(unsigned char *)samples, &nb_bytes);
break;
case 3:
do_layer3(&s->mpstr.fr,(unsigned char *)samples, &nb_bytes);
s->inbuf_index ^= 1;
s->inbuf = &s->inbuf1[s->inbuf_index][BACKSTEP_SIZE];
s->old_frame_size = s->frame_size;
break;
default:
break;
}
return nb_bytes;
}
/*
* seek back in the stream for backstep bytes (at most 511 bytes, and
* at most in last frame). Note that this is slightly incorrect (data
* can span more than one block!)
*/
int set_pointer(long backstep)
{
UINT8 *ptr;
/* compute current position in stream */
ptr = gmp_gb->buf_ptr - (gmp_gb->bit_cnt >> 3);
/* copy old data before current one */
ptr -= backstep;
memcpy(ptr, gmp_s->inbuf1[gmp_s->inbuf_index ^ 1] +
BACKSTEP_SIZE + gmp_s->old_frame_size - backstep, backstep);
/* init get bits again */
init_get_bits(gmp_gb, ptr, gmp_s->frame_size + backstep);
return 0;
}
static int decode_frame(AVCodecContext * avctx,
void *data, int *data_size,
UINT8 * buf, int buf_size)
{
MPADecodeContext *s = avctx->priv_data;
UINT32 header;
UINT8 *buf_ptr;
int len, out_size;
short *out_samples = data;
*data_size = 0;
buf_ptr = buf;
while (buf_size > 0) {
len = s->inbuf_ptr - s->inbuf;
if (s->frame_size == 0) {
/* no header seen : find one. We need at least 7 bytes to parse it */
len = HEADER_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;
if ((s->inbuf_ptr - s->inbuf) == HEADER_SIZE) {
header = (s->inbuf[0] << 24) | (s->inbuf[1] << 16) |
(s->inbuf[2] << 8) | s->inbuf[3];
if (check_header(header) < 0) {
/* no sync found : move by one byte (inefficient, but simple!) */
memcpy(s->inbuf, s->inbuf + 1, HEADER_SIZE - 1);
s->inbuf_ptr--;
} else {
decode_header(s, header);
/* update codec info */
avctx->sample_rate = s->sample_rate;
avctx->channels = s->mpstr.fr.stereo ? 2 : 1;
avctx->bit_rate = s->bit_rate;
}
}
} else if (len < s->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;
} else {
out_size = mp_decode_frame(s, out_samples);
s->inbuf_ptr = s->inbuf;
s->frame_size = 0;
*data_size = out_size;
break;
}
}
return buf_ptr - buf;
}
AVCodec mp3_decoder =
{
"mpegaudio",
CODEC_TYPE_AUDIO,
CODEC_ID_MP2,
sizeof(MPADecodeContext),
decode_init,
NULL,
NULL,
decode_frame,
};