C语言实现:#include <stdio.h>
#include <math.h>
#include <memory.h>
#include <stdlib.h>
#define EPS 0.000001
void filter(const double* x, double* y, int xlen, double* a, double* b, int nfilt, double* zi)//nfilt为系数数组长度
{
double tmp;
int i,j;
if( (*a-1.0>EPS) || (*a-1.0<-EPS) )
{
tmp=*a;
for(i=0;i<nfilt;i++)
{
b[i]/=tmp;
a[i]/=tmp;
}
}
for(i=0;i<xlen;i++)
{
for(j=0;i>=j&&j<nfilt;j++)
{
y[i] += (b[j]*x[i-j]-a[j]*y[i-j]);
}
if(zi&&i<nfilt-1) y[i] += zi[i];
}
a[0]=1.0;