[deb_ffmpeg.git] / ffmpeg / libavcodec / nellymoserdec.c

/*
 * NellyMoser audio decoder
 * Copyright (c) 2007 a840bda5870ba11f19698ff6eb9581dfb0f95fa5,
 *                    539459aeb7d425140b62a3ec7dbf6dc8e408a306, and
 *                    520e17cd55896441042b14df2566a6eb610ed444
 * Copyright (c) 2007 Loic Minier <lool at dooz.org>
 *                    Benjamin Larsson
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 */

/**
 * @file
 * The 3 alphanumeric copyright notices are md5summed they are from the original
 * implementors. The original code is available from http://code.google.com/p/nelly2pcm/
 */

#include "libavutil/channel_layout.h"
#include "libavutil/float_dsp.h"
#include "libavutil/lfg.h"
#include "libavutil/random_seed.h"
#include "avcodec.h"
#include "fft.h"
#include "fmtconvert.h"
#include "internal.h"
#include "nellymoser.h"
#include "sinewin.h"

#define BITSTREAM_READER_LE
#include "get_bits.h"


typedef struct NellyMoserDecodeContext {
    AVCodecContext* avctx;
    AVLFG           random_state;
    GetBitContext   gb;
    float           scale_bias;
    AVFloatDSPContext *fdsp;
    FFTContext      imdct_ctx;
    DECLARE_ALIGNED(32, float, imdct_buf)[2][NELLY_BUF_LEN];
    float          *imdct_out;
    float          *imdct_prev;
} NellyMoserDecodeContext;

static void nelly_decode_block(NellyMoserDecodeContext *s,
                               const unsigned char block[NELLY_BLOCK_LEN],
                               float audio[NELLY_SAMPLES])
{
    int i,j;
    float buf[NELLY_FILL_LEN], pows[NELLY_FILL_LEN];
    float *aptr, *bptr, *pptr, val, pval;
    int bits[NELLY_BUF_LEN];
    unsigned char v;

    init_get_bits(&s->gb, block, NELLY_BLOCK_LEN * 8);

    bptr = buf;
    pptr = pows;
    val = ff_nelly_init_table[get_bits(&s->gb, 6)];
    for (i=0 ; i<NELLY_BANDS ; i++) {
        if (i > 0)
            val += ff_nelly_delta_table[get_bits(&s->gb, 5)];
        pval = -pow(2, val/2048) * s->scale_bias;
        for (j = 0; j < ff_nelly_band_sizes_table[i]; j++) {
            *bptr++ = val;
            *pptr++ = pval;
        }

    }

    ff_nelly_get_sample_bits(buf, bits);

    for (i = 0; i < 2; i++) {
        aptr = audio + i * NELLY_BUF_LEN;

        init_get_bits(&s->gb, block, NELLY_BLOCK_LEN * 8);
        skip_bits_long(&s->gb, NELLY_HEADER_BITS + i*NELLY_DETAIL_BITS);

        for (j = 0; j < NELLY_FILL_LEN; j++) {
            if (bits[j] <= 0) {
                aptr[j] = M_SQRT1_2*pows[j];
                if (av_lfg_get(&s->random_state) & 1)
                    aptr[j] *= -1.0;
            } else {
                v = get_bits(&s->gb, bits[j]);
                aptr[j] = ff_nelly_dequantization_table[(1<<bits[j])-1+v]*pows[j];
            }
        }
        memset(&aptr[NELLY_FILL_LEN], 0,
               (NELLY_BUF_LEN - NELLY_FILL_LEN) * sizeof(float));

        s->imdct_ctx.imdct_half(&s->imdct_ctx, s->imdct_out, aptr);
        s->fdsp->vector_fmul_window(aptr, s->imdct_prev + NELLY_BUF_LEN / 2,
                                   s->imdct_out, ff_sine_128,
                                   NELLY_BUF_LEN / 2);
        FFSWAP(float *, s->imdct_out, s->imdct_prev);
    }
}

static av_cold int decode_init(AVCodecContext * avctx) {
    NellyMoserDecodeContext *s = avctx->priv_data;

    s->avctx = avctx;
    s->imdct_out = s->imdct_buf[0];
    s->imdct_prev = s->imdct_buf[1];
    av_lfg_init(&s->random_state, 0);
    ff_mdct_init(&s->imdct_ctx, 8, 1, 1.0);

    s->fdsp = avpriv_float_dsp_alloc(avctx->flags & CODEC_FLAG_BITEXACT);
    if (!s->fdsp)
        return AVERROR(ENOMEM);

    s->scale_bias = 1.0/(32768*8);
    avctx->sample_fmt = AV_SAMPLE_FMT_FLT;

    /* Generate overlap window */
    if (!ff_sine_128[127])
        ff_init_ff_sine_windows(7);

    avctx->channels       = 1;
    avctx->channel_layout = AV_CH_LAYOUT_MONO;

    return 0;
}

static int decode_tag(AVCodecContext *avctx, void *data,
                      int *got_frame_ptr, AVPacket *avpkt)
{
    AVFrame *frame     = data;
    const uint8_t *buf = avpkt->data;
    const uint8_t *side=av_packet_get_side_data(avpkt, 'F', NULL);
    int buf_size = avpkt->size;
    NellyMoserDecodeContext *s = avctx->priv_data;
    int blocks, i, ret;
    float   *samples_flt;

    blocks     = buf_size / NELLY_BLOCK_LEN;

    if (blocks <= 0) {
        av_log(avctx, AV_LOG_ERROR, "Packet is too small\n");
        return AVERROR_INVALIDDATA;
    }

    if (buf_size % NELLY_BLOCK_LEN) {
        av_log(avctx, AV_LOG_WARNING, "Leftover bytes: %d.\n",
               buf_size % NELLY_BLOCK_LEN);
    }
    /* Normal numbers of blocks for sample rates:
     *  8000 Hz - 1
     * 11025 Hz - 2
     * 16000 Hz - 3
     * 22050 Hz - 4
     * 44100 Hz - 8
     */
    if(side && blocks>1 && avctx->sample_rate%11025==0 && (1<<((side[0]>>2)&3)) == blocks)
        avctx->sample_rate= 11025*(blocks/2);

    /* get output buffer */
    frame->nb_samples = NELLY_SAMPLES * blocks;
    if ((ret = ff_get_buffer(avctx, frame, 0)) < 0)
        return ret;
    samples_flt = (float *)frame->data[0];

    for (i=0 ; i<blocks ; i++) {
        nelly_decode_block(s, buf, samples_flt);
        samples_flt += NELLY_SAMPLES;
        buf += NELLY_BLOCK_LEN;
    }

    *got_frame_ptr = 1;

    return buf_size;
}

static av_cold int decode_end(AVCodecContext * avctx) {
    NellyMoserDecodeContext *s = avctx->priv_data;

    ff_mdct_end(&s->imdct_ctx);
    av_freep(&s->fdsp);

    return 0;
}

AVCodec ff_nellymoser_decoder = {
    .name           = "nellymoser",
    .long_name      = NULL_IF_CONFIG_SMALL("Nellymoser Asao"),
    .type           = AVMEDIA_TYPE_AUDIO,
    .id             = AV_CODEC_ID_NELLYMOSER,
    .priv_data_size = sizeof(NellyMoserDecodeContext),
    .init           = decode_init,
    .close          = decode_end,
    .decode         = decode_tag,
    .capabilities   = CODEC_CAP_DR1 | CODEC_CAP_PARAM_CHANGE,
    .sample_fmts    = (const enum AVSampleFormat[]) { AV_SAMPLE_FMT_FLT,
                                                      AV_SAMPLE_FMT_NONE },
};
Commit	Line	Data
2ba45a60 DM	1	/*
	2	* NellyMoser audio decoder
	3	* Copyright (c) 2007 a840bda5870ba11f19698ff6eb9581dfb0f95fa5,
	4	* 539459aeb7d425140b62a3ec7dbf6dc8e408a306, and
	5	* 520e17cd55896441042b14df2566a6eb610ed444
	6	* Copyright (c) 2007 Loic Minier <lool at dooz.org>
	7	* Benjamin Larsson
	8	*
	9	* Permission is hereby granted, free of charge, to any person obtaining a
	10	* copy of this software and associated documentation files (the "Software"),
	11	* to deal in the Software without restriction, including without limitation
	12	* the rights to use, copy, modify, merge, publish, distribute, sublicense,
	13	* and/or sell copies of the Software, and to permit persons to whom the
	14	* Software is furnished to do so, subject to the following conditions:
	15	*
	16	* The above copyright notice and this permission notice shall be included in
	17	* all copies or substantial portions of the Software.
	18	*
	19	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	20	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	21	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	22	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	23	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
	24	* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
	25	* DEALINGS IN THE SOFTWARE.
	26	*/
	27
	28	/**
	29	* @file
	30	* The 3 alphanumeric copyright notices are md5summed they are from the original
	31	* implementors. The original code is available from http://code.google.com/p/nelly2pcm/
	32	*/
	33
	34	#include "libavutil/channel_layout.h"
	35	#include "libavutil/float_dsp.h"
	36	#include "libavutil/lfg.h"
	37	#include "libavutil/random_seed.h"
	38	#include "avcodec.h"
	39	#include "fft.h"
	40	#include "fmtconvert.h"
	41	#include "internal.h"
	42	#include "nellymoser.h"
	43	#include "sinewin.h"
	44
	45	#define BITSTREAM_READER_LE
	46	#include "get_bits.h"
	47
	48
	49	typedef struct NellyMoserDecodeContext {
	50	AVCodecContext* avctx;
	51	AVLFG random_state;
	52	GetBitContext gb;
	53	float scale_bias;
f6fa7814	54	AVFloatDSPContext *fdsp;
2ba45a60 DM	55	FFTContext imdct_ctx;
	56	DECLARE_ALIGNED(32, float, imdct_buf)[2][NELLY_BUF_LEN];
	57	float *imdct_out;
	58	float *imdct_prev;
	59	} NellyMoserDecodeContext;
	60
	61	static void nelly_decode_block(NellyMoserDecodeContext *s,
	62	const unsigned char block[NELLY_BLOCK_LEN],
	63	float audio[NELLY_SAMPLES])
	64	{
	65	int i,j;
	66	float buf[NELLY_FILL_LEN], pows[NELLY_FILL_LEN];
	67	float aptr, bptr, *pptr, val, pval;
	68	int bits[NELLY_BUF_LEN];
	69	unsigned char v;
	70
	71	init_get_bits(&s->gb, block, NELLY_BLOCK_LEN * 8);
	72
	73	bptr = buf;
	74	pptr = pows;
	75	val = ff_nelly_init_table[get_bits(&s->gb, 6)];
	76	for (i=0 ; i<NELLY_BANDS ; i++) {
	77	if (i > 0)
	78	val += ff_nelly_delta_table[get_bits(&s->gb, 5)];
	79	pval = -pow(2, val/2048) * s->scale_bias;
	80	for (j = 0; j < ff_nelly_band_sizes_table[i]; j++) {
	81	*bptr++ = val;
	82	*pptr++ = pval;
	83	}
	84
	85	}
	86
	87	ff_nelly_get_sample_bits(buf, bits);
	88
	89	for (i = 0; i < 2; i++) {
	90	aptr = audio + i * NELLY_BUF_LEN;
	91
	92	init_get_bits(&s->gb, block, NELLY_BLOCK_LEN * 8);
	93	skip_bits_long(&s->gb, NELLY_HEADER_BITS + i*NELLY_DETAIL_BITS);
	94
	95	for (j = 0; j < NELLY_FILL_LEN; j++) {
	96	if (bits[j] <= 0) {
	97	aptr[j] = M_SQRT1_2*pows[j];
	98	if (av_lfg_get(&s->random_state) & 1)
	99	aptr[j] *= -1.0;
	100	} else {
	101	v = get_bits(&s->gb, bits[j]);
	102	aptr[j] = ff_nelly_dequantization_table[(1<<bits[j])-1+v]*pows[j];
	103	}
	104	}
	105	memset(&aptr[NELLY_FILL_LEN], 0,
	106	(NELLY_BUF_LEN - NELLY_FILL_LEN) * sizeof(float));
	107
	108	s->imdct_ctx.imdct_half(&s->imdct_ctx, s->imdct_out, aptr);
f6fa7814	109	s->fdsp->vector_fmul_window(aptr, s->imdct_prev + NELLY_BUF_LEN / 2,
2ba45a60 DM	110	s->imdct_out, ff_sine_128,
	111	NELLY_BUF_LEN / 2);
	112	FFSWAP(float *, s->imdct_out, s->imdct_prev);
	113	}
	114	}
	115
	116	static av_cold int decode_init(AVCodecContext * avctx) {
	117	NellyMoserDecodeContext *s = avctx->priv_data;
	118
	119	s->avctx = avctx;
	120	s->imdct_out = s->imdct_buf[0];
	121	s->imdct_prev = s->imdct_buf[1];
	122	av_lfg_init(&s->random_state, 0);
	123	ff_mdct_init(&s->imdct_ctx, 8, 1, 1.0);
	124
f6fa7814 DM	125	s->fdsp = avpriv_float_dsp_alloc(avctx->flags & CODEC_FLAG_BITEXACT);
	126	if (!s->fdsp)
	127	return AVERROR(ENOMEM);
2ba45a60 DM	128
	129	s->scale_bias = 1.0/(32768*8);
	130	avctx->sample_fmt = AV_SAMPLE_FMT_FLT;
	131
	132	/* Generate overlap window */
	133	if (!ff_sine_128[127])
	134	ff_init_ff_sine_windows(7);
	135
	136	avctx->channels = 1;
	137	avctx->channel_layout = AV_CH_LAYOUT_MONO;
	138
	139	return 0;
	140	}
	141
	142	static int decode_tag(AVCodecContext avctx, void data,
	143	int got_frame_ptr, AVPacket avpkt)
	144	{
	145	AVFrame *frame = data;
	146	const uint8_t *buf = avpkt->data;
	147	const uint8_t *side=av_packet_get_side_data(avpkt, 'F', NULL);
	148	int buf_size = avpkt->size;
	149	NellyMoserDecodeContext *s = avctx->priv_data;
	150	int blocks, i, ret;
	151	float *samples_flt;
	152
	153	blocks = buf_size / NELLY_BLOCK_LEN;
	154
	155	if (blocks <= 0) {
	156	av_log(avctx, AV_LOG_ERROR, "Packet is too small\n");
	157	return AVERROR_INVALIDDATA;
	158	}
	159
	160	if (buf_size % NELLY_BLOCK_LEN) {
	161	av_log(avctx, AV_LOG_WARNING, "Leftover bytes: %d.\n",
	162	buf_size % NELLY_BLOCK_LEN);
	163	}
	164	/* Normal numbers of blocks for sample rates:
	165	* 8000 Hz - 1
	166	* 11025 Hz - 2
	167	* 16000 Hz - 3
	168	* 22050 Hz - 4
	169	* 44100 Hz - 8
	170	*/
	171	if(side && blocks>1 && avctx->sample_rate%11025==0 && (1<<((side[0]>>2)&3)) == blocks)
	172	avctx->sample_rate= 11025*(blocks/2);
	173
	174	/* get output buffer */
	175	frame->nb_samples = NELLY_SAMPLES * blocks;
	176	if ((ret = ff_get_buffer(avctx, frame, 0)) < 0)
	177	return ret;
	178	samples_flt = (float *)frame->data[0];
	179
	180	for (i=0 ; i<blocks ; i++) {
	181	nelly_decode_block(s, buf, samples_flt);
	182	samples_flt += NELLY_SAMPLES;
	183	buf += NELLY_BLOCK_LEN;
	184	}
	185
	186	*got_frame_ptr = 1;
	187
	188	return buf_size;
	189	}
	190
	191	static av_cold int decode_end(AVCodecContext * avctx) {
192	NellyMoserDecodeContext *s = avctx->priv_data;
193
194	ff_mdct_end(&s->imdct_ctx);
f6fa7814	195	av_freep(&s->fdsp);
2ba45a60 DM	196
	197	return 0;
	198	}
	199
	200	AVCodec ff_nellymoser_decoder = {
	201	.name = "nellymoser",
	202	.long_name = NULL_IF_CONFIG_SMALL("Nellymoser Asao"),
	203	.type = AVMEDIA_TYPE_AUDIO,
	204	.id = AV_CODEC_ID_NELLYMOSER,
	205	.priv_data_size = sizeof(NellyMoserDecodeContext),
	206	.init = decode_init,
	207	.close = decode_end,
	208	.decode = decode_tag,
	209	.capabilities = CODEC_CAP_DR1 \| CODEC_CAP_PARAM_CHANGE,
	210	.sample_fmts = (const enum AVSampleFormat[]) { AV_SAMPLE_FMT_FLT,
	211	AV_SAMPLE_FMT_NONE },
	212	};