Question

我正在尝试在C中为FRDMKL25Z板实现IIR过滤器。我目前的代码如下所示：

#include "Cpu.h"
#include "Events.h"
#include "ADC_1.h"
#include "AdcLdd1.h"
#include "DAC_1.h"
#include "PE_Types.h"
#include "PE_Error.h"
#include "PE_Const.h"
#include "IO_Map.h"


#define NSP 16
static uint16_t DACvalue, ADCvalue;
static LDD_TError Error;
static LDD_TDeviceData *MyDacPtr;
int N=10; // Filter order
double NumCoeff[11]={0.8017, -8.0174, 36.0785, -96.2094, 168.3664, -202.0397, 
                    168.3664, -96.2094, 36.0785, -8.0174, 0.8017};

double DenomCoeff[11]={1.0000, -9.5582, 41.1210, -104.8588, 175.5143, -201.4924,
                    160.6706 , -87.8720, 31.5447, -6.7119, 0.6428};

double Signal[NSP], FilteredSignal[NSP];


int main(void)
{
  /* Write your local variable definition here */
  /*** Processor Expert internal initialization. DON'T REMOVE THIS CODE!!! ***/
    int j, k;
    double y, Reg[NSP];
    PE_low_level_init();
    MyDacPtr = DAC_1_Init(NULL);

    for(j=0; j<NSP; j++) Reg[j] = 0.0; // Init the delay registers
    for(;;){
      for(j=0;j<NSP;j++)
     {  
      for(k=N; k>0; k--) Reg[k] = Reg[k-1];  // Shift the delay register values.

      (void)ADC_1_Measure(TRUE);                /* do conversion and wait for the result */
      (void)ADC_1_GetValue16(&ADCvalue);            /* get the result into value variable */
      Signal[j]=(ADCvalue/65535)*3.5;               /*Convert to volts*/
      Reg[0] = Signal[j];    // The denominator

      for(k=1; k<=N; k++)  Reg[0] -= DenomCoeff[k] * Reg[k];

      y = 0;            // The numerator
      for(k=0; k<=N; k++)y += NumCoeff[k] * Reg[k];
      FilteredSignal[j] = y;

      DACvalue=(FilteredSignal[j]*65535)*3.5; //Convert back to 16 bit 
      Error = DAC_1_SetValue(MyDacPtr, DACvalue);               /* Set DA converter output */
     }
  }

代码的一些细节：

我正在使用飞思卡尔的Processor Expert（PE）编程嵌入式主板;
使用MATLAB生成的IIR滤波器系数;
由于设备需要实时过滤数据，我会从

ADC并对其进行滤波，然后在处理后立即将其输出到DAC;

一旦闪存到电路板，我就无法从DAC端口输出任何信号。

我对所有建议和调试方法持开放态度。

Answer 1

这是你做错了什么

您还需要跟踪以前的输出
- 也许你正在尝试，但有趣的嵌套循环没有工作
分母适用于输出，而不是输入
- 当你应用系数时，分母并不是真正的分母;它之所以被称为是因为频率响应就像一个分母。分母系数乘以输出历史，并从输出中减去它们的总和。（考虑将所有y(n-1)... y(n-k)项移到等号的另一侧，只留下过滤器输出一侧）
- 有趣的分母系数是第一个，它乘以你实际想要计算的新输出！您将整个结果除以该结果，以找出新输出的内容。（在大多数IIR过滤器中，这是1.0，所以你可以跳过这个。）
16位整数除以65535为零！，无需转换为伏特（正如其他人提到的那样）。
- 只在最后才进行工程，只有在你需要时才进行;你没有

这是我的建议，同时试图保持相同的代码结构...

unsigned int ADCvalue, 
int Reg[NSP]; // use signed values instead of unsigned, and no need for double for history of ADCvalue

for(j=0; j<NSP; j++) Reg[j] = 0; // Init the delayed input registers
for(j=0; j<NSP; j++) FilteredSignal[j] = 0.0; // Init the delayed output registers

for(;;)
{  
     for(k=N; k>0; k--) Reg[k] = Reg[k-1];  // Shift the delay register values.
     for(k=N; k>0; k--) FilteredSignal[k] = FilteredSignal[k-1];

     (void)ADC_1_Measure(TRUE);                /* do conversion and wait for the result */
     (void)ADC_1_GetValue16(&ADCvalue);            /* get the result into value variable */

     Reg[0] = ADCvalue - 0x8000;    // Save the previous inputs samples (and shift the zero value to 0)

     y = 0;
     for(k=0; k<=N; k++) y += NumCoeff[k] * Reg[k];               // The numerator
     for(k=1; k<=N; k++) y -= DenomCoeff[k] * FilteredSignal[k];  // The denominator

     FilteredSignal[0] = y/DenomCoeff[0];

     DACvalue= FilteredSignal[0] + 0x8000;   // shift the zero value back to unsigned, centered at 0x8000
     Error = DAC_1_SetValue(MyDacPtr, DACvalue);               /* Set DA converter output */
}

Answer 2

C中的二阶IIR-Filter实现：

 static double b[] = {1,  -1.4, 1};
 static double a[] = {1, -1.3, 0.5};
 static double v1m1 = 0, v2m1 = 0, v1m, v2m;

 static double iirfilter(double x1) {
    double y1 = 0;
    y1 = (b[0] * x1 + v1m1) / a[0];
    v1m = (b[1] * x1 + v2m1) - a[1] * y1;
    v2m = b[2] * x1 - a[2] * y1;
    v1m1 = v1m;
    v2m1 = v2m;
    return y1;
 }

C语言中的IIR过滤器实现

2 个答案: