373 lines
9.0 KiB
C++
373 lines
9.0 KiB
C++
#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);
|
|
}
|
|
}
|
|
|