Debian Codegraph @

plugins/actor/pseudotoad_flower/notch.c

raw
1 /* Libvisual-plugins - Standard plugins for libvisual
2 *
3 * Copyright (C) 2004, 2005, 2006 Antti Silvast <[email protected]>
4 *
5 * Authors: Antti Silvast <[email protected]>
6 * Dennis Smit <[email protected]>
7 *
8 * $Id: notch.c,v 1.3 2006/01/22 13:25:26 synap Exp $
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as
12 * published by the Free Software Foundation; either version 2
13 * of the License, or (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 */
24
25 #include <stdio.h>
26 #include <stdlib.h>
27 #include <math.h>
28 #include <string.h>
29
30 #include "notch.h"
31
32 NOTCH_FILTER * init_notch(float cutoff) {
33 NOTCH_FILTER * l=malloc(sizeof(NOTCH_FILTER));
34 float steep = 0.99;;
35 float r = steep * 0.99609375;
36 float f = cos(M_PI * cutoff / SAMPLING_RATE);
37 l->cutoff = cutoff;
38 l->a0 = (1 - r) * sqrt( r * (r - 4 * (f * f) + 2) + 1);
39 l->b1 = 2 * f * r;
40 l->b2 = -(r * r);
41
42 l->x1 = 0.0;
43 l->x2 = 0.0;
44 return l;
45 }
46
47 float process_notch(NOTCH_FILTER * l, float x0) {
48 float outp = l->a0 * x0 + l->b1 * l->x1 + l->b2 * l->x2;
49 l->x2 = l->x1;
50 l->x1 = outp;
51
52 return outp;
53 }
54