均衡器的原始码.docVIP

均衡器的原始码 /* Simple implementation of Biquad filters -- Tom St Denis * * Based on the work Cookbook formulae for audio EQ biquad filter coefficients --------------------------------------------------------- by Robert Bristow-Johnson, pbjrbj@ a.k.a. robert@ * Available on the web at /musicdsp/text/filters005.txt * Enjoy. * * This work is hereby placed in the public domain for all purposes, whether * commercial, free [as in speech] or educational, etc. Use the code and please * give me credit if you wish. * * Tom St Denis -- */ /* this would be biquad.h */ #include math.h #include stdlib.h #ifndef M_LN2 #define M_LN2 0.69314718055994530942 #endif #ifndef M_PI #define M_PI 3.14159265358979323846 #endif /* whatever sample type you want */ typedef double smp_type; /* this holds the data required to update samples thru a filter */ typedef struct { smp_type a0, a1, a2, a3, a4; smp_type x1, x2, y1, y2; } biquad; extern smp_type BiQuad(smp_type sample, biquad * b); extern biquad *BiQuad_new(int type, smp_type dbGain, /* gain of filter */ smp_type freq, /* center frequency */ smp_type srate, /* sampling rate */ smp_type bandwidth); /* bandwidth in octaves */ /* filter types */ enum { LPF, /* low pass filter */ HPF, /* High pass filter */ BPF, /* band pass filter */ NOTCH, /* Notch Filter */ PEQ, /* Peaking band EQ filter */ LSH, /* Low shelf filter */ HSH /* High shelf filter */ }; /* Below this would be biquad.c */ /* Computes a BiQuad filter on a sample */ smp_type BiQuad(smp_type sample, biquad * b) { smp_type result; /* compute result */ result = b-a0 * sample + b-a1 * b-x1 + b-a2 * b-x2 - b-a3 * b-y1 - b-a4 * b-y2; /* shift x1 to x2, sample to x1 */ b-x2 = b-x1; b-x1 = sample; /* shift y1 to y2, result to y1 */ b-y2 = b-y1; b-y1 = result; return result; } /* sets up a BiQuad Filter */ bi