diff options
Diffstat (limited to 'Src/Plugins/Input/in_mp3/mpegutil.cpp')
-rw-r--r-- | Src/Plugins/Input/in_mp3/mpegutil.cpp | 372 |
1 files changed, 372 insertions, 0 deletions
diff --git a/Src/Plugins/Input/in_mp3/mpegutil.cpp b/Src/Plugins/Input/in_mp3/mpegutil.cpp new file mode 100644 index 00000000..27d76488 --- /dev/null +++ b/Src/Plugins/Input/in_mp3/mpegutil.cpp @@ -0,0 +1,372 @@ +#include "DecodeThread.h" +#include "main.h" +// benski> cut some old shit +// this code would take the filterbank coefficients to get an approximate spectrum +// and modify the coefficients to do a quick&easy EQ +// it's been off by default for quite a few versions (i think starting with 5.12) +// but not I just yanked it out. cause none of us have 486SX's any more + +static float eq_lookup1[64]={ + 4.000000f,3.610166f,3.320019f,3.088821f,2.896617f, + 2.732131f,2.588368f,2.460685f,2.345845f,2.241498f, + 2.145887f,2.057660f,1.975760f,1.899338f,1.827707f, + 1.760303f,1.696653f,1.636363f,1.579094f,1.524558f, + 1.472507f,1.422724f,1.375019f,1.329225f,1.285197f, + 1.242801f,1.201923f,1.162456f,1.124306f,1.087389f, + 1.051628f,1.016951f,0.983296f,0.950604f,0.918821f, + 0.887898f,0.857789f,0.828454f,0.799853f,0.771950f, + 0.744712f,0.718108f,0.692110f,0.666689f,0.641822f, + 0.617485f,0.593655f,0.570311f,0.547435f,0.525008f, + 0.503013f,0.481433f,0.460253f,0.439458f,0.419035f, + 0.398970f,0.379252f,0.359868f,0.340807f,0.322060f, + 0.303614f,0.285462f,0.267593f,0.250000 +}; + +static float eq_lookup2[64] = { +2.00000000f, 1.96825397f, 1.93650794f, 1.90476191f, 1.87301588f, +1.84126985f, 1.80952382f, 1.77777779f, 1.74603176f, 1.71428573f, +1.68253970f, 1.65079367f, 1.61904764f, 1.58730161f, 1.55555558f, +1.52380955f, 1.49206352f, 1.46031749f, 1.42857146f, 1.39682543f, +1.36507940f, 1.33333337f, 1.30158734f, 1.26984131f, 1.23809528f, +1.20634925f, 1.17460322f, 1.14285719f, 1.11111116f, 1.07936513f, +1.04761910f, 1.01587307f, 0.98412699f, 0.95238096f, 0.92063493f, +0.88888890f, 0.85714287f, 0.82539684f, 0.79365081f, 0.76190478f, +0.73015875f, 0.69841272f, 0.66666669f, 0.63492066f, 0.60317463f, +0.57142860f, 0.53968257f, 0.50793654f, 0.47619048f, 0.44444445f, +0.41269842f, 0.38095239f, 0.34920636f, 0.31746033f, 0.28571430f, +0.25396827f, 0.22222222f, 0.19047619f, 0.15873016f, 0.12698413f, +0.09523810f, 0.06349207f, 0.03174603f, 0.00000000 +}; + +unsigned char eq_preamp = 0; +unsigned char eq_enabled = 0; +unsigned char eq_tab[10] = {0}; + +float g_vis_table[2][2][32][18] = {0}; + +void mp3GiveVisData(float vistable[2][32][18],int gr, int nch) +{ + if (g_vis_enabled) + { + memcpy(&g_vis_table[gr][0][0][0],&vistable[0][0][0],sizeof(float)*32*18*nch); + } +} + +void mp2Equalize(float *xr, int nch, int srate, int nparts) +{ + if (!g_eq_ok || !(mod.UsesOutputPlug & 2)) return; + if (!eq_enabled) return; + float *eq_lookup = (config_eqmode&1)?eq_lookup2:eq_lookup1; + float preamp = eq_lookup[eq_preamp]; + int offs[11] = { 0,1,2,3,4,5,6,9,15,18,32}; + int scale_offs[11] = {0}; + int x; + unsigned char eqt[12] = {0}; + memcpy(eqt+1,eq_tab,10); + eqt[0]=eqt[1]; + eqt[11]=eqt[10]; + for (x = 0; x < 11; x ++) + { + scale_offs[x] = float_to_long( ((float) offs[x] / (float) srate * 44100.0)); + if (scale_offs[x] > 32) scale_offs[x] = 32; + } + { + if (nch == 1) + { + register int i; + for (i = 0; i < 10; i ++) + { + register int x=scale_offs[i]; + register int t=scale_offs[i+1]; + float d = eq_lookup[(int)eqt[i]]*preamp; + float dd = (eq_lookup[(int)eqt[i+1]]*preamp-d)/(float)(t-x); + if (dd < 0.000000001f && dd > -0.000000001f) dd = 0.000000001f; + while (x < t) + { + register float *p = xr+x; + int e=nparts; + while (e--) + { + *(p) *= d; + p+=32; + } + p += 32*(18-nparts); + d += dd; + x++; + } + } + } + else + { + register int i; + for (i = 0; i < 10; i ++) + { + register int x=scale_offs[i]; + register int t=scale_offs[i+1]; + float d = eq_lookup[(int)eqt[i]]*preamp; + float dd = (eq_lookup[(int)eqt[i+1]]*preamp-d)/(float)(t-x); + if (dd < 0.000000001f && dd > -0.000000001f) dd = 0.000000001f; + while (x < t) + { + register float *p = xr+x; + int e=nparts; + while (e--) + { + *(p+32*18) *= d; + *(p) *= d; + p+=32; + } + p += 32*(18-nparts); + d += dd; + x++; + } + } + } + } +} + + +void mp3Equalize(float *xr, int nch, int srate) +{ + if (!g_eq_ok || !(mod.UsesOutputPlug & 2)) return; + if (!eq_enabled) return; + float *eq_lookup = (config_eqmode&1)?eq_lookup2:eq_lookup1; + float preamp = eq_lookup[eq_preamp]; + static int scale_offs[11]; + static int lrate; + unsigned char eqt[12] = {0}; + memcpy(eqt+1,eq_tab,10); + eqt[0]=eqt[1]; + eqt[11]=eqt[10]; + if (lrate!=srate) + { + lrate=srate; + for (int x = 0; x < 11; x ++) + { + int offs[11] = { 0,2,4, 9,16, 30, 63, 95,153,308, 576}; + scale_offs[x] = float_to_long( ((float) offs[x] / (float) srate * 44100.0)); + if (scale_offs[x] > 576) scale_offs[x] = 576; + } + } + { + if (nch == 1) + { + register float *p = xr; + register float d = eq_lookup[eqt[0]]*preamp; + register int i = 0; + for (i = 0; i < 10; i ++) + { + register int x=scale_offs[i]; + register int t=scale_offs[i+1]; + register float dd = (eq_lookup[eqt[i+1]]*preamp-d)/(float)(t-x); + while (x++ < t) + { + *(p++) *= d; + d += dd; + } + } + } + else + { + register float *p = xr; + register int i; + for (i = 0; i < 10; i ++) + { + register int x=scale_offs[i]; + register int t=scale_offs[i+1]; + float d = eq_lookup[(int)eqt[i]]*preamp; + float dd = (eq_lookup[(int)eqt[i+1]]*preamp-d)/(float)(t-x); + if (dd < 0.000000001f && dd > -0.000000001f) dd = 0.000000001f; + while (x++ < t) + { + *(p+32*18) *= d; + *(p++) *= d; + d += dd; + } + } + } + } +} + + +void genOsc(char *tempdata, short *samples, int len) +{ + float d = 0.0f, dd = len/(75.0f*2.0f); + short int *sbuf = samples; + int x,y=0; + signed char *c = (signed char *) tempdata; + for (x = 0; x < 75; x ++) + { + float q=0; + int td = float_to_long((d+=dd)); + for (; y < td; y ++) + q += *sbuf++; + q *= (32.0f/(dd*65536.0f)); + *c++ = (signed char) float_to_long(q); + } +} +void genSpec(char *tempdata, float *xr, int nch) +{ + static int offsets[76] = + { + 0,1,2,3,4,5,7,8,9,10,12,13,15,16,18,20,21,23,25,27,29,31,33,36,38,41,43,46,48,51, + 54,57,60,64,67,71,74,78,82,86,91,95,100,105,109,115,120,126,131,137,144,150,157, + 164,171,178,186,194,203,211,220,230,239,250,260,271,282,294,306,319,332,345,360, + 374,389,576 + }; + { + for (int x = 0; x < 75; x++) + { + float sum = 0.0; + int z; + int sx = offsets[x]; + int ex = offsets[x+1]; + if (nch == 2) + { + float *p = &xr[0]; + int w=32*18; + for (z = sx; z < ex; z ++) + { + register float t1=p[z], t2=p[w+z]; + if (t1 <0.0) t1=-t1; + if (t2<0.0f) t2=-t2; + sum += (t1+t2) * 0.5f; + } + } + else + { + float *p = &xr[0]; + for (z = sx; z < ex; z ++) + { + register float t=p[z]; + if (t < 0.0) t=-t; + sum += t; + } + } + sum *= 1.0f + (x) * 12.0f / (ex-sx) ; + sum *= 1.8f/24000.0f; + if (sum < 0.0) sum = 0.0; + if (sum > 255.0) sum = 255.0; + tempdata[x] = (unsigned char) float_to_long(sum); + } + } +} + +void do_layer3_vis(short *samples, float *xr, int nch, int ts) +{ + int vis_waveNch; + int vis_specNch; + int csa = mod.SAGetMode(); + int is_vis_running = mod.VSAGetMode(&vis_specNch,&vis_waveNch); + static char tempdata[75*2]; + int len=32*18*nch; + + if (is_vis_running) + { + char data[576*4] = {0}; + int data_offs=0; + int x; + + if (nch == 1 && vis_specNch > 0) + { + float *specdata = xr; + int y; + for (y=0; y < 576; y++) + { + float p = *specdata++ / 24.0f; + if (p < 0.0) p = -p; + if (p > 255.0) p = 255.0; + data[data_offs++] = (unsigned char) float_to_long(p); + } + if (vis_specNch == 2) + { + memcpy(data+data_offs,data+data_offs-576,576); + data_offs += 576; + } + } + else if (vis_specNch == 2) + { + for (x = 0; x < 2; x ++) + { + float *specdata = &xr[x*32*18]; + for (int y=0; y < 576; y++) + { + float p = *specdata++ / 24.0f; + if (p < 0.0) p = -p; + if (p > 255.0) p = 255.0; + data[data_offs++] = (unsigned char) float_to_long(p); + } + } + } + else if (vis_specNch == 1) + { + float *specdata = &xr[0]; + int y; + for (y = 0; y < 576; y++) + { + register float p1=specdata[0],p2=specdata[32*18],p; + if (p1 < 0.0) p1=-p1; + if (p2 < 0.0) p2=-p2; + p = (p1+p2)/ 48.0f; + specdata++; + if (p > 255.0) p = 255.0; + data[data_offs++] = (unsigned char) float_to_long(p); + } + } // end of spectrum code + + if (nch == 1 && vis_waveNch > 0) + { + for (x = 0; x < 576; x++) + { + data[data_offs++] = ((samples[x])>>8); + } + if (vis_waveNch == 2) + { + memcpy(data+data_offs,data+data_offs-576,576); + data_offs += 576; + } + } + else if (vis_waveNch == 2) + { + for (x = 0; x < 2; x ++) + { + int y; + for (y = 0; y < 576; y ++ ) + { + data[data_offs++] = ((samples[y*2+x])>>8); + } + } + } + else if (vis_waveNch == 1) + { + int x; + for (x = 0; x < 576; x ++) + { + data[data_offs++] = ((int)samples[x*2]+(int)samples[x*2+1])>>9; + } + } + mod.VSAAdd(data,ts); + } + if (csa==4) + { + tempdata[0] = 0; + tempdata[1] = 0; + mod.SAAdd(tempdata,ts,4); + } + else if (csa == 3) + { + genSpec(tempdata,xr,nch); + genOsc(tempdata+75,samples,len); + mod.SAAdd(tempdata,ts,0x80000003); + } + else if (csa == 2) + { + genOsc(tempdata,samples,len); + mod.SAAdd(tempdata,ts,2); + } + else if (csa == 1) { + genSpec(tempdata,xr,nch); + mod.SAAdd(tempdata,ts,1); + } +} + |