main.cpp

一个IIR滤波器类的源码,有比较详细的说明.支持设置延迟线初始值.

// main.cpp : Defines the entry point for the console application.
//

#include "stdafx.h"
#include "windows.h"

#include <iostream>
#include <vector>
#include <string>
#include <algorithm>
using namespace std;


// 滤波器开始
//////////////////////////////////////////////////
// 分子N个系数, 分母D个系数
template <int N, int D>
class cFilter {
public:
	// 配置滤波系数, 并且置延迟线的初始值
	void Config( float _A[], float _B[] ) {
		memcpy( A, _A, N*sizeof(float) );
		memcpy( B, _B, D*sizeof(float) );
		for( int n=0; n<N; n++ ) X[n] = 0;
		for( n=0; n<D; n++ ) Y[n] = 0;
		return;
	}

	float Run( float in ) {
		X[0] = in;
		Y[0] = 0;

		for( int n=N-1; n>0; n-- ) {
			Y[0] += X[n]*A[n];
			X[n] = X[n-1];
		}
		Y[0] += X[0]*A[0];

		for( n=D-1; n>0; n-- ) {
			Y[0] += Y[n]*B[n];
			Y[n] = Y[n-1];
		}

		return Y[0];

	}

public:
	unsigned short mDatNum;
	float A[N];		// 分子系数向量
	float B[D];		// 分母系数向量
	float X[N];		// 输入延迟线
	float Y[D];		// 输出延迟线
};

int main( int argc, char* argv[] ) {

	cFilter< 2, 2 > Filter;
	float A[2] = { 1, 0.1 };
	float B[2] = { 1, 0.35 };

	Filter.Config( A, B );
	float ret;

	// 测试其冲击响应
	for( int n=0; n<5; n++ ) {
		ret = Filter.Run( n == 0 );
		ret += 1;
	}


	return 0;
}