iirfilter_2.c

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

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

int iirFilter_2( float *inputData, float *outputData, 
                 float *coeff, float *state, int sampleNumber )
{
    #pragma TCS_dirty_float2
   
    int i;
    float * restrict input, * restrict output;
    float coeff_a0, coeff_a1, coeff_a2, coeff_b1, coeff_b2;
    float state_0, state_1, state_2, state_3;

    input = inputData; output = outputData;
    coeff_a0 = coeff[0]; coeff_a1 = coeff[1]; coeff_a2 = coeff[2];
    coeff_b1 = coeff[3]; coeff_b2 = coeff[4];
    state_0 = state[0]; state_1 = state[1]; 
    state_2 = state[2]; state_3 = state[3];

    for( i=0; i < sampleNumber; i++ )
    {
        output[i] =    coeff_a0*input[i] 
                     + coeff_a1*state_0 
                     + coeff_a2*state_1 
                     - coeff_b1*state_2 
                     - coeff_b2*state_3;

        state_1 = state_0;
        state_0 = input[i];
        state_3 = state_2;
        state_2 = output[i];
    } 

    state[0] = state_0; state[1] = state_1; 
    state[2] = state_2; state[3] = state_3;

    return 0;  
}