切比雪夫ii型滤波怎么用C语言在单片机上实现滤波

有谁可以帮忙，我需要切比雪夫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;   
}

这个函数只能实现低通滤波，高通实现不了，带通也不对，不知道是我用错了还是高低带通需要不同的程序来实现