STM32 切比雪夫ii型滤波
有谁可以帮忙,我需要切比雪夫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;
}
这个函数只能实现低通滤波,高通实现不了,带通也不对,不知道是我用错了还是高低带通需要不同的程序来实现
很高级的名字...曾今也在matlab上面敲过...
就没用过,顶一下 支持一下,没搞过 本帖最后由 adlu 于 2016-11-11 15:02 编辑
可以参考该文档的P79,DSPF_sp_iir()的实现,或者P141的DSPF_dp_iir()的实现。
两个函数结构是一样的,只是数据精度不同,一个是float的一个的double的。
文档中实现的是一个5阶IIR滤波器。
void DSPF_sp_iir (
float* restrict r1,
const float* x,
float* restrict r2,
const float* h2,
const float* h1,
int nr)
{
int i, j;
float sum;
for (i = 0; i < nr; i++)
{
sum = h2 * x;
for (j = 1; j <= 4; j++)
sum += h2 * x − h1 * r1;
r1 = sum;
r2 = r1;
}}
h1和h2是要通过MATLAB设计的参数。
:):):):):):):) 很想知道c怎么实现 谢谢,各位,通过我上面的程序都是可以的,我只是采集的时候有点问题。 没有用C编过, 学习学习。。。。。:)
页:
[1]
2