#include "typedef.h"
#include "Iir.h"


void Iir(
    Word16 *Input,			//	原始輸入數據
    Word16 *Output,			//	IIR濾波輸出結果
    Word16 *Iir_Coef,		//	IIR濾波器系數
    Word16 *Iir_Memory,		//	IIR濾波器狀態
    Word16 order,			//	IIR濾波器階數
    Word16 length			//	IIR濾波長度
)
{

	Word16 i, j ;
	Word32 sum ;

	for( i = 0 ; i < length ; i ++ )
	{
		sum = (Word32)Input[i]<<13 ;
		for( j = 0 ; j < order ; j ++ )
		{
			sum = _smac( sum, Iir_Coef[j], Iir_Memory[j] ) ;
		}

		for( j = order - 1 ; j > 0 ; j -- )
		{
			Iir_Memory[j] = Iir_Memory[j-1] ;
		}
		Iir_Memory[0] = _rnd( _lsshl( sum, 3 ) ) ;

		Output[i] = Iir_Memory[0] ;
	}

	return ;
}