有谁可以帮忙,我需要切比雪夫ii型的高通、低通、带通的滤波程序,对这个不是很了解,想研究下,我可以从
matlab上把滤波系数搞定,但是不知道怎么用C语言在
单片机上实现滤波,请各位大侠帮忙,急需
int16_t IIR_Filter(double *a, int Lenth_a,
double *b, int Lenth_b,
int16_t Input_Data,
double *Memory_Buffer)
{
int Count=0;
double Output_Data = 0;
int Memory_Lenth = 0;
if(Lenth_a >= Lenth_b) Memory_Lenth = Lenth_a;
else Memory_Lenth = Lenth_b;
Output_Data += (*a) * Input_Data; //a(0)*x(n)
for(Count = 1; Count < Lenth_a ;Count++)
{
Output_Data -= (*(a + Count)) *
(*(Memory_Buffer + (Memory_Lenth - 1) - Count));
}
//------------------------save data--------------------------//
*(Memory_Buffer +Memory_Lenth-1 ) = Output_Data;
Output_Data = 0;
//----------------------------------------------------------//
for(Count = 0; Count < Lenth_b ;Count++)
{
Output_Data += (*(b + Count)) *
(*(Memory_Buffer + (Memory_Lenth - 1) - Count));
}
//------------------------move data--------------------------//
for(Count = 0 ; Count < Memory_Lenth -1 ; Count++)
{
*(Memory_Buffer + Count) = *(Memory_Buffer + Count + 1);
}
*(Memory_Buffer + Memory_Lenth - 1) = 0;
//-----------------------------------------------------------//
return (int16_t)Output_Data;
}
这个函数只能实现低通滤波,高通实现不了,带通也不对,不知道是我用错了还是高低带通需要不同的程序来实现
一周热门 更多>