1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66
|
/*
Copyright (C) 2004-2006 Fons Adriaensen <fons@kokkinizita.net>
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
#include <stdlib.h>
#include <math.h>
#include "filter1.h"
#define P2F 6.283185f
void Lowpass1::init (float fsam, float f3db)
{
float w, c, s, d;
w = P2F * f3db / fsam;
c = cosf (w);
s = sinf (w);
d = (c < 1e-3f) ? (-0.5f * c) : ((s - 1) / c);
_a = 0.5f * (1 + d);
}
void Allpass1::init (float fsam, float fmid)
{
float w, c, s;
w = P2F * fmid / fsam;
c = cosf (w);
s = sinf (w);
_d = (c < 1e-3f) ? (-0.5f * c) : ((s - 1) / c);
}
void Pcshelf1::init (float fsam, float fmid, float glf, float ghf)
{
float w, c, s, g, v;
w = P2F * fmid / fsam;
c = cosf (w);
s = sinf (w);
g = -glf / ghf;
g = (g - 1) / (g + 1);
v = s * sqrt (1 - g * g) - 1;
_d1 = (fabs (c - g) < 1e-3f) ? 0 : ((v + c * g) / (c - g));
_d2 = (fabs (c + g) < 1e-3f) ? 0 : ((v - c * g) / (c + g));
_g = glf * (1 + _d2) / (1 + _d1);
}
|