工频抑制滤波算法设计

主要用于对50HZ工频抑制信号进行滤除。

#include 
#include “filter_fdacoefs.h“

#define	M	（MWSPT_NSEC-1）/2
#define N	300

double g b0 b1 b2 a1 a2;  //每一级滤波器的系数

void getcoefs（int m）           //提取每一级滤波器的系数
{
	g = NUM[2*m][0];
	b0 = NUM[2*m+1][0];
	b1 = NUM[2*m+1][1];
	b2 = NUM[2*m+1][2];
	a1 = DEN[2*m+1][1];
	a2 = DEN[2*m+1][2];
}

void main（）
{
	FILE *fp;
	int  x[N];                 //x[N]存放原信号
	double	y[N] ym[N];       //y[N]存放最终输出信号，ym[N]存放前一级滤波器输出信号
	int n m; 
	fp = fopen（“signal.txt““r“）;//打开原信号文件signal.txt

	for（n=0;n	{
		fscanf（fp“%d“&x[n]）; //读入原信号
	}

	fclose（fp）;


	for（n=0;n	{
		ym[n] = x[n];          //把x[N]做为第零级输出ym[N]
	}

	for（m=0; m	{
		getcoefs（m）;          //提取该级滤波器的系数

		y[0]=g*b0*ym[0];      //以下用公式y[n]-a1*y[n-1]-a2*y[n-2]=g*（b0*ym[n]+b1*ym[n-1]+b2*ym[n-2]）求滤波器输出
		y[1]=g*（b0*ym[1]+b1*ym[0]） - a1*y[0];

		for（n=2; n		{
			y[n]=g*（b0*ym[n]+b1*ym[n-1]+b2*ym[n-2]）-a1*y[n-1]-a2*y[n-2];
		}
			
		for（n=0;n		{
			ym[n] = 0;
			ym[n] = y[n];      //ym[N]存放前一级滤波器输出信号
		}

	}

	fp = fopen（“output.txt““w“）;//将输出写入文件output.txt中

	for（n=0;n	{
		fprintf（fp“%f\n“y[n]）;
	}

	fclose（fp）;

}

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件      41984  2012-08-15 17:32  C_filter\Debug\filter.bsc

     文件     209007  2012-08-15 17:32  C_filter\Debug\filter.exe

     文件     217136  2012-08-15 17:32  C_filter\Debug\filter.ilk

     文件     176372  2012-08-15 17:12  C_filter\Debug\filter.pch

     文件     484352  2012-08-15 17:32  C_filter\Debug\filter.pdb

     文件       6902  2012-08-15 17:32  C_filter\Debug\filter_main.obj

     文件          0  2012-08-15 17:32  C_filter\Debug\filter_main.sbr

     文件      33792  2012-08-15 17:32  C_filter\Debug\vc60.idb

     文件      53248  2012-08-15 17:32  C_filter\Debug\vc60.pdb

     文件       4355  2012-08-15 17:24  C_filter\filter.dsp

     文件        537  2010-11-08 08:19  C_filter\filter.dsw

     文件      50176  2012-08-16 17:55  C_filter\filter.ncb

     文件      48640  2012-08-16 17:55  C_filter\filter.opt

     文件       1769  2012-08-15 17:32  C_filter\filter.plg

     文件       2785  2010-11-07 22:25  C_filter\filter_fdacoefs.h

     文件       1319  2012-08-15 17:52  C_filter\filter_main.c

     文件       3497  2012-08-15 17:32  C_filter\output.txt

     文件       1556  2012-08-15 17:31  C_filter\signal.txt

     文件      62570  2010-11-06 08:20  C_filter\signal_0001.txt

     文件        156  2010-11-08 08:15  C_filter\test.m

     目录          0  2012-09-03 14:21  C_filter\Debug

     目录          0  2012-09-03 14:21  C_filter

----------- ---------  ---------- -----  ----

              1400153                    22