iirfilter_1.c

来自「用于TM1300/PNX1300系列DSP（主要用于视频处理）的各种滤波器源码」· C语言 代码 · 共 27 行

#include <stdlib.h>
#include <math.h>

int iirFilter_1( float *inputData, float *outputData, 
                 float *coeff, float *state, int sampleNumber )
{
    int i;

    for( i=0; i < sampleNumber; i++ )
    {
        outputData[i] =    coeff[0]*inputData[i] 
                         + coeff[1]*state[0] 
                         + coeff[2]*state[1] 
                         - coeff[3]*state[2] 
                         - coeff[4]*state[3];

        state[1] = state[0];
        state[0] = inputData[i];
        state[3] = state[2];
        state[2] = outputData[i];
    } 

    return 0;  
}