filter.c

来自「一个28系列dsp应用的程序,包括adc,cpu_timer,pwm,gpio,」· C语言 代码 · 共 31 行

#include  "math.h"
void filter(double b[],double a[],int m,int n,double x[],int len,double px[],double py[])
/*int m,n,len;
double a[],b[],x[],px[],py[];  */
{
int k,i;
	for(k=0;k<len;k++)
	{
	px[0]=x[k];
	x[k]=0.0;
		for(i=0;i<=m;i++)
		{
		x[k]=x[k]+b[i]*px[i];
		}
		for(i=1;i<=n;i++)
		{
		x[k]=x[k]-a[i]*py[i];
		}
		for(i=m;i>=1;i--)
		{
		px[i]=px[i-1];
		}
		for(i=n;i>=2;i--)
		{
		py[i]=py[i-1];
		}
		py[1]=x[k];

	}
}