数字滤波器源代码

【核心代码】

#include <string>
#include <stdio.h>
#include <stdlib.h>
#include "CWebFilter.h"
#include "CoefFilter.h"
#include <windows.h>

CWebFilter::CWebFilter()
{

}
CWebFilter::~CWebFilter()
{

}

//初始化
void CWebFilter::EcgFilterInit()
{
}
//基漂滤波
int CWebFilter::BaseFilter(int* pInData, int* pOutData, int nLength)
{
	int result = 0;
	int idx = 0;
	int nSum = 0;
	for (int i = 0; i < nLength;   i) {
		if (idx < HIGH_FILTER_LEVEL)
		{
			idx  ;
			nSum  = pInData[i];
			pOutData[i] = pInData[i] - nSum / idx;
		}
		else
		{
			nSum  = pInData[i] - nSum / idx;
			pOutData[i] = pInData[i] - nSum / idx;
		}
		result  ;
	}

	return result;
}
//高通滤波
int CWebFilter::HighPassFilter005HZ(int* pInData, int* pOutData, int nLength)
{
	int result = 0;
	int idx = 0;
	int nSum = 0;
	for (int i = 0; i < nLength;   i) {
		if (idx < HIGH_FILTER_005_LEVEL)
		{
			idx  ;
			nSum  = pInData[i];
			pOutData[i] = pInData[i] - nSum / idx;
		}
		else
		{
			nSum  = pInData[i] - nSum / idx;
			pOutData[i] = pInData[i] - nSum / idx;
		}
		result  ;
	}

	return result;
}
int CWebFilter::HighPassFilter015HZ(int* pInData, int* pOutData, int nLength)
{
	int result = 0;
	int idx = 0;
	int nSum = 0;
	for (int i = 0; i < nLength;   i) {
		if (idx < HIGH_FILTER_015_LEVEL)
		{
			idx  ;
			nSum  = pInData[i];
			pOutData[i] = pInData[i] - nSum / idx;
		}
		else
		{
			nSum  = pInData[i] - nSum / idx;
			pOutData[i] = pInData[i] - nSum / idx;
		}
		result  ;
	}
	return result;
}
int CWebFilter::HighPassFilter025HZ(int* pInData, int* pOutData, int nLength)
{
	int result = 0;
	int idx = 0;
	int nSum = 0;
	for (int i = 0; i < nLength;   i) {
		if (idx < HIGH_FILTER_025_LEVEL)
		{
			idx  ;
			nSum  = pInData[i];
			pOutData[i] = pInData[i] - nSum / idx;
		}
		else
		{
			nSum  = pInData[i] - nSum / idx;
			pOutData[i] = pInData[i] - nSum / idx;
		}
		result  ;
	}
	return result;
}
int CWebFilter::HighPassFilter05HZ(int* pInData, int* pOutData, int nLength)
{
	int result = 0;
	int idx = 0;
	int nSum = 0;
	for (int i = 0; i < nLength;   i) {
		if (idx < HIGH_FILTER_05_LEVEL)
		{
			idx  ;
			nSum  = pInData[i];
			pOutData[i] = pInData[i] - nSum / idx;
		}
		else
		{
			nSum  = pInData[i] - nSum / idx;
			pOutData[i] = pInData[i] - nSum / idx;
		}
		result  ;
	}
	return result;
}
//低通滤波
int CWebFilter::LowPassFilter45HZ(int* pInData, int* pOutData, int nLength)
{
	return dataFilter(pInData, pOutData, nLength, LOW_FILTER_45_LEVEL, Coef_of_LP45HZ);
}
int CWebFilter::LowPassFilter75HZ(int* pInData, int* pOutData, int nLength)
{
	return dataFilter(pInData, pOutData, nLength, LOW_FILTER_75_LEVEL, Coef_of_LP75HZ);
}
int CWebFilter::LowPassFilter100HZ(int* pInData, int* pOutData, int nLength)
{
	return dataFilter(pInData, pOutData, nLength, LOW_FILTER_100_LEVEL, Coef_of_LP100HZ);
}
int CWebFilter::LowPassFilter150HZ(int* pInData, int* pOutData, int nLength)
{
	return dataFilter(pInData, pOutData, nLength, LOW_FILTER_150_LEVEL, Coef_of_LP150HZ);
}
int CWebFilter::LowPassFilter200HZ(int* pInData, int* pOutData, int nLength)
{
	return dataFilter(pInData, pOutData, nLength, LOW_FILTER_200_LEVEL, Coef_of_LP200HZ);
}
//肌电滤波
int CWebFilter::EMGFilter(int* pInData, int* pOutData, int nLength)
{
	return dataFilter(pInData, pOutData, nLength, EMG_FILTER_LEVEL, Coef_of_EMG);
}
int CWebFilter::EMGFilter25HZ(int* pInData, int* pOutData, int nLength)
{
	return dataFilter(pInData, pOutData, nLength, EMG_FILTER_25_LEVEL, Coef_of_EMG25HZ);
}
int CWebFilter::EMGFilter35HZ(int* pInData, int* pOutData, int nLength)
{
	return dataFilter(pInData, pOutData, nLength, EMG_FILTER_35_LEVEL, Coef_of_EMG35HZ);
}
//工频干扰滤波
int CWebFilter::ACFilter50HZ(int* pInData, int* pOutData, int nLength)
{
	return dataFilter(pInData, pOutData, nLength, AC_FILTER_50_LEVEL, Coef_of_AC50HZ);
}
int CWebFilter::dataFilter(int* pInData, int* pOutData, int length, int nFilterLength, long* nCoef)
{
	long sum = 0;
	int idx = 0;
	int postIdx = 0;
	int preIdx = 0;
	int i = 0;
	int nCount = 0;
	int* nBuff = new int[nFilterLength];
	memset(nBuff, 0, sizeof(nBuff[0])*nFilterLength);
	for (int n = 0; n < length;   n) {
		sum = 0;
		i = 0;
		preIdx = idx;
		postIdx = ADD_DEF(preIdx, 1, nFilterLength);
		nBuff[preIdx] = pInData[n];
		idx = ADD_DEF(idx, 1, nFilterLength);

		for (i = 0; i < nFilterLength / 2; i  )
		{
			sum  = (nBuff[preIdx]   nBuff[postIdx])*nCoef[i];
			preIdx = SUB_DEF(preIdx, 1, nFilterLength);
			postIdx = ADD_DEF(postIdx, 1, nFilterLength);
		}
		if (nFilterLength % 2 != 0)
		{
			sum  = nBuff[postIdx] * nCoef[i];
		}
		pOutData[n] = (int)sum >> 15;
		nCount  ;
	}
	delete[] nBuff;
	return nCount;
}
//get延迟时间
//基漂滤波
int CWebFilter::GetBaseFilterDelay()
{
	return 0;
}
//高通滤波
int CWebFilter::GetHighPassFilter005HZDelay()
{
	return 0;
}
int CWebFilter::GetHighPassFilter015HZDelay()
{
	return 0;
}
int CWebFilter::GetHighPassFilter025HZDelay()
{
	return 0;
}
int CWebFilter::GetHighPassFilter05HZDelay()
{
	return 0;
}
//低通滤波
int CWebFilter::GetLowPassFilter45HZDelay()
{
	return LOW_FILTER_45_LEVEL/2;
}
int CWebFilter::GetLowPassFilter75HZDelay()
{
	return LOW_FILTER_75_LEVEL/2;
}
int CWebFilter::GetLowPassFilter100HZDelay()
{
	return LOW_FILTER_100_LEVEL/2;
}
int CWebFilter::GetLowPassFilter150HZDelay()
{
	return LOW_FILTER_150_LEVEL/2;
}
int CWebFilter::GetLowPassFilter200HZDelay()
{
	return LOW_FILTER_200_LEVEL/2;
}
//肌电滤波
int CWebFilter::GetEMGFilterDelay()
{
	return EMG_FILTER_LEVEL/2;
}
int CWebFilter::GetEMGFilter25HZDelay()
{
	return EMG_FILTER_25_LEVEL/2;
}
int CWebFilter::GetEMGFilter35HZDelay()
{
	return EMG_FILTER_35_LEVEL/2;
}
//工频干扰滤波
int CWebFilter::GetACFilter50HZDelay()
{
	return AC_FILTER_50_LEVEL/2;
}