Initial community commit

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);
+	}
+}
+