| 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 |
|