Mercurial > audlegacy-plugins
diff src/Input/mpg123/layer1.c @ 0:13389e613d67 trunk
[svn] - initial import of audacious-plugins tree (lots to do)
author | nenolod |
---|---|
date | Mon, 18 Sep 2006 01:11:49 -0700 |
parents | |
children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/Input/mpg123/layer1.c Mon Sep 18 01:11:49 2006 -0700 @@ -0,0 +1,167 @@ +/* + * Mpeg Layer-1 audio decoder + * -------------------------- + * copyright (c) 1995 by Michael Hipp, All rights reserved. See also 'README' + * near unoptimzed ... + * + * may have a few bugs after last optimization ... + * + */ + +#include "audacious/output.h" +#include "mpg123.h" +#include "getbits.h" + +void I_step_one(unsigned int balloc[], unsigned int scale_index[2][SBLIMIT],struct frame *fr) +{ + unsigned int *ba=balloc; + unsigned int *sca = (unsigned int *) scale_index; + + if(fr->stereo) { + int i; + int jsbound = fr->jsbound; + for (i=0;i<jsbound;i++) { + *ba++ = mpgdec_getbits(&bsi,4); + *ba++ = mpgdec_getbits(&bsi,4); + } + for (i=jsbound;i<SBLIMIT;i++) + *ba++ = mpgdec_getbits(&bsi,4); + + ba = balloc; + + for (i=0;i<jsbound;i++) { + if ((*ba++)) + *sca++ = mpgdec_getbits(&bsi,6); + if ((*ba++)) + *sca++ = mpgdec_getbits(&bsi,6); + } + for (i=jsbound;i<SBLIMIT;i++) + if ((*ba++)) { + *sca++ = mpgdec_getbits(&bsi,6); + *sca++ = mpgdec_getbits(&bsi,6); + } + } + else { + int i; + for (i=0;i<SBLIMIT;i++) + *ba++ = mpgdec_getbits(&bsi,4); + ba = balloc; + for (i=0;i<SBLIMIT;i++) + if ((*ba++)) + *sca++ = mpgdec_getbits(&bsi,6); + } +} + +void I_step_two(mpgdec_real fraction[2][SBLIMIT],unsigned int balloc[2*SBLIMIT], + unsigned int scale_index[2][SBLIMIT],struct frame *fr) +{ + int i,n; + int smpb[2*SBLIMIT]; /* values: 0-65535 */ + int *sample; + register unsigned int *ba; + register unsigned int *sca = (unsigned int *) scale_index; + + if(fr->stereo) { + int jsbound = fr->jsbound; + register mpgdec_real *f0 = fraction[0]; + register mpgdec_real *f1 = fraction[1]; + ba = balloc; + for (sample=smpb,i=0;i<jsbound;i++) { + if ((n = *ba++)) + *sample++ = mpgdec_getbits(&bsi,n+1); + if ((n = *ba++)) + *sample++ = mpgdec_getbits(&bsi,n+1); + } + for (i=jsbound;i<SBLIMIT;i++) + if ((n = *ba++)) + *sample++ = mpgdec_getbits(&bsi,n+1); + + ba = balloc; + for (sample=smpb,i=0;i<jsbound;i++) { + if((n=*ba++)) + *f0++ = (mpgdec_real) ( ((-1)<<n) + (*sample++) + 1) * mpgdec_muls[n+1][*sca++]; + else + *f0++ = 0.0; + if((n=*ba++)) + *f1++ = (mpgdec_real) ( ((-1)<<n) + (*sample++) + 1) * mpgdec_muls[n+1][*sca++]; + else + *f1++ = 0.0; + } + for (i=jsbound;i<SBLIMIT;i++) { + if ((n=*ba++)) { + mpgdec_real samp = ( ((-1)<<n) + (*sample++) + 1); + *f0++ = samp * mpgdec_muls[n+1][*sca++]; + *f1++ = samp * mpgdec_muls[n+1][*sca++]; + } + else + *f0++ = *f1++ = 0.0; + } + for(i=fr->down_sample_sblimit;i<32;i++) + fraction[0][i] = fraction[1][i] = 0.0; + } + else { + register mpgdec_real *f0 = fraction[0]; + ba = balloc; + for (sample=smpb,i=0;i<SBLIMIT;i++) + if ((n = *ba++)) + *sample++ = mpgdec_getbits(&bsi,n+1); + ba = balloc; + for (sample=smpb,i=0;i<SBLIMIT;i++) { + if((n=*ba++)) + *f0++ = (mpgdec_real) ( ((-1)<<n) + (*sample++) + 1) * mpgdec_muls[n+1][*sca++]; + else + *f0++ = 0.0; + } + for(i=fr->down_sample_sblimit;i<32;i++) + fraction[0][i] = 0.0; + } +} + +int +mpgdec_do_layer1(struct frame *fr) +{ + int i, stereo = fr->stereo; + unsigned int balloc[2 * SBLIMIT]; + unsigned int scale_index[2][SBLIMIT]; + mpgdec_real fraction[2][SBLIMIT]; + int single = fr->single; + + fr->jsbound = + (fr->mode == MPG_MD_JOINT_STEREO) ? (fr->mode_ext << 2) + 4 : 32; + + if (stereo == 1 || single == 3) + single = 0; + + I_step_one(balloc, scale_index, fr); + + for (i = 0; i < SCALE_BLOCK; i++) { + I_step_two(fraction, balloc, scale_index, fr); + + if (single >= 0) { + (fr->synth_mono) ((mpgdec_real *) fraction[single], mpgdec_pcm_sample, + &mpgdec_pcm_point); + } + else { + int p1 = mpgdec_pcm_point; + + (fr->synth) ((mpgdec_real *) fraction[0], 0, mpgdec_pcm_sample, &p1); + (fr->synth) ((mpgdec_real *) fraction[1], 1, mpgdec_pcm_sample, + &mpgdec_pcm_point); + } +#ifdef PSYCHO + psycho_process(mpgdec_pcm_sample, mpgdec_pcm_point, mpgdec_cfg.channels == 2 ? fr->stereo : 1); +#endif + if (mpgdec_info->output_audio && mpgdec_info->jump_to_time == -1) { + produce_audio(mpgdec_ip.output->written_time(), + mpgdec_cfg.resolution == + 16 ? FMT_S16_NE : FMT_U8, + mpgdec_cfg.channels == + 2 ? fr->stereo : 1, mpgdec_pcm_point, + mpgdec_pcm_sample, &mpgdec_info->going); + } + + mpgdec_pcm_point = 0; + } + + return 1; +}