diff options
Diffstat (limited to 'Src/Winamp/eq10dsp.cpp')
| -rw-r--r-- | Src/Winamp/eq10dsp.cpp | 277 |
1 files changed, 277 insertions, 0 deletions
diff --git a/Src/Winamp/eq10dsp.cpp b/Src/Winamp/eq10dsp.cpp new file mode 100644 index 00000000..5f8f0137 --- /dev/null +++ b/Src/Winamp/eq10dsp.cpp @@ -0,0 +1,277 @@ +/***************************************** + + EQ10 library version 1.0 + Copyright (C)2002 4Front Technologies + Written by George Yohng + + http://www.opensound.com + + Proprietary software. + + *****************************************/ +#include "main.h" +#include "eq10dsp.h" + +//#include <stdio.h> +//#include <string.h> +#include <math.h> +#include "WinampAttributes.h" + +#define DENORMAL_FIX // comment this for no denormal fixes + +char _eq10_copyright[]= +"EQ10 Library version 1.0\n" +"Copyright (C)2002 4Front Technologies http://www.opensound.com\n" +"Copyright (C)2001-2002 by George Yohng http://www.yohng.com\n\0" +"EQ10 ENGINE"; + +static double eq10_freq[EQ10_NOFBANDS]={ 70, 180, 320, 600, 1000, 3000, 6000, 12000, 14000, 16000 }; // winamp style frequency table; +static double eq10_freq_iso[EQ10_NOFBANDS]={31,62,125,250,500,1000,2000,4000,8000,16000}; // ISO frequency table + +#ifdef EQ10_DQ +static double eq10_q[EQ10_NOFBANDS]=EQ10_DQ; +#endif + + +static void eq10_bsetup2(int u,double rate,eq10band_t *band,double freq,double Q) +{ + double angle; + double a0,/*a1,a2,*/b0,b1,b2,alpha; + + if (rate<4000.0) rate=4000.0; + if (rate>384000.0) rate=384000.0; + if (freq<20.0) freq=20.0; + if (freq>=(rate*0.499)) {band->ua0=band->da0=0;return;} + + angle = 2.0*3.1415926535897932384626433832795*freq/rate; + alpha = sin(angle)/(2.0*Q); + + b0 = 1.0/(1.0+alpha); + a0 = b0*alpha; + b1 = b0*2*cos(angle); + b2 = b0*(alpha-1); + + if (u>0) + { + band->ua0=a0; + band->ub1=b1; + band->ub2=b2; + } + else + { + band->da0=a0; + band->db1=b1; + band->db2=b2; + } +} + +static void eq10_bsetup(double rate,eq10band_t *band,double freq,double Q) +{ + memset(band,0,sizeof(*band)); + eq10_bsetup2(-1,rate,band,freq,Q*0.5); + eq10_bsetup2(1,rate,band,freq,Q*2.0); +#ifdef EQ10_DETECTOR_CODE + /* release of detector */ + band->detectdecay=pow(0.001,1.0/(rate*EQ10_DETECTOR_RELEASE)); +#endif +} + +void eq10_setup(eq10_t *eq, int eqs, double rate) +{ + int t,k; + + for(k=0;k<eqs;k++,eq++) + { + for(t=0;t<EQ10_NOFBANDS;t++) +#ifndef EQ10_DQ + eq10_bsetup(rate,&eq->band[t],(config_eq_frequencies==EQ_FREQUENCIES_WINAMP)?eq10_freq[t]:eq10_freq_iso[t],EQ10_Q); +#else + eq10_bsetup(rate,&eq->band[t],(config_eq_frequencies==EQ_FREQUENCIES_WINAMP)?eq10_freq[t]:eq10_freq_iso[t],eq10_q[t]); +#endif + + eq->detect=0; + /* release of trimmer */ + eq->detectdecay=pow(0.001,1.0/(rate*EQ10_TRIM_RELEASE)); + } +} + +void eq10_processf(eq10_t *eq,float *buf,float *outbuf,int sz,int idx,int step) +{ + int t,k; + float *in,*out; + if (!eq) return; + + buf+=idx; + outbuf+=idx; + + in=buf; + + for(k=0;k<EQ10_NOFBANDS;k++) + { + double a0,b1,b2; + double x1 = eq->band[k].x1; + double x2 = eq->band[k].x2; + double y1 = eq->band[k].y1; + double y2 = eq->band[k].y2; + double gain = eq->band[k].gain; + +#ifdef EQ10_DETECTOR_CODE + double detect = eq->band[k].detect; + double detectdecay = eq->band[k].detectdecay; +#endif + + + out = outbuf; + + if (gain>0.0) + { + a0 = eq->band[k].ua0*gain; + b1 = eq->band[k].ub1; + b2 = eq->band[k].ub2; + } + else + { + a0 = eq->band[k].da0*gain; + b1 = eq->band[k].db1; + b2 = eq->band[k].db2; + } + + if (a0==0.0) continue; + + for(t=0;t<sz;t++,in+=step,out+=step) + { + double y0 = (in[0]-x2)*a0 + y1*b1 + y2*b2 + +#ifdef DENORMAL_FIX + + 1e-30; +#else + ; +#endif + +#ifdef EQ10_DETECTOR_CODE + if (fabs(y0)>detect) detect=fabs(y0); + detect*=detectdecay; + +#ifdef DENORMAL_FIX + detect+=1e-30; +#endif + +#endif + x2=x1; x1=in[0]; y2=y1; y1=y0; + + out[0] = (float)(y0 + in[0]); + } + + in=outbuf; + + eq->band[k].x1=x1; + eq->band[k].x2=x2; + eq->band[k].y1=y1; + eq->band[k].y2=y2; + +#ifdef EQ10_DETECTOR_CODE + eq->band[k].detect=detect; +#endif + } + + if (config_eq_limiter) + { + double detect=eq->detect; + double detectdecay=eq->detectdecay; + out=outbuf; + for(t=0;t<sz;t++,in+=step,out+=step) + { + /* *0.99 - reserve */ + if (fabs(in[0])>detect) detect=fabs(in[0]); + + + if (detect>EQ10_TRIM_CODE) + out[0]=in[0]*(float)(EQ10_TRIM_CODE/detect); + else + out[0]=in[0]; + + detect*=detectdecay; +#ifdef DENORMAL_FIX + detect+=1e-30; +#endif + } + eq->detect=detect; + } + else if ((in==buf)&&(buf!=outbuf)) + { + out=outbuf; + for(t=0;t<sz;t++,in+=step,out+=step) out[0]=in[0]; + } + +} + +double eq10_db2gain(double gain_dB) +{ + return pow(10.0,gain_dB/20.0)-1.0; +} + +double eq10_gain2db(double gain) +{ + return 20.0*log10(gain+1.0); +} + + +void eq10_setgain(eq10_t *eq,int eqs,int bandnr,double gain_dB) +{ + double realgain; + int k; + + if (!eq) + return; + + realgain=eq10_db2gain(gain_dB); + + for(k=0;k<eqs;k++,eq++) + eq->band[bandnr].gain=realgain; +} + +double eq10_getgain(eq10_t *eq,int bandnr) +{ + return eq10_gain2db(eq->band[bandnr].gain); +} + +double eq10_detect(eq10_t *eq,int bandnr) +{ +#ifdef EQ10_DETECTOR_CODE + return eq10_gain2db(eq->band[bandnr].detect); +#else + return 0; +#endif +} + + +#ifdef TESTCASE + + +eq10_t eq; + +float buf1[4096] = {0}; +float buf[4096] = {0}; + +int main() +{ + int t,k; + eq10_setup(&eq,1,44100); + + for(t=0;t<4096;t++) + { + buf1[t]=warand()*(1.0/16384); + } + + for(t=0;t<EQ10_NOFBANDS;t++) eq.band[t].gain=-0.874107; + + for(t=0;t<10000;t++) + { + eq10_processf(&eq,buf1,buf,4096,0,1); + } + + return 0; +} + +#endif + |