qfilter.cpp

来自「基于MATLAB与VC混合编程的数字均衡器的设计」· C++ 代码 · 共 29 行

//Quick filter for matlab.Written by plum. Contact:[e-mail]

#include "mex.h" 
void mexFunction(int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[]) 
{
	double *a,*b,*x,*y;
	int M,n,i,j;
	b=mxGetPr(prhs[0]); //获得指向矩阵的指针
	a=mxGetPr(prhs[1]);
	x=mxGetPr(prhs[2]);
	M=mxGetM(prhs[2]); //获得矩阵的行数
	plhs[0]=mxCreateDoubleMatrix(M,1,mxREAL);
	y=mxGetPr(plhs[0]);
	n=mxGetN(prhs[0]);
	for(i=0;i<n;i++)
	{
		y[i]=b[0]*x[i];
		for(j=1;j<i+1;j++)
			y[i]+=b[j]*x[i-j]-a[j]*y[i-j];
        if(y[i]>1)y[i]=1;else if(y[i]<-1)y[i]=-1;
	}
	for(;i<M;i++)
	{
		y[i]=b[0]*x[i];
		for(j=1;j<n;j++)
			y[i]+=b[j]*x[i-j]-a[j]*y[i-j];
        if(y[i]>1)y[i]=1;else if(y[i]<-1)y[i]=-1;
	}
}