#include "typedef.h"
#include "Fir.h"

void Fir(
    Word16 *Input,			//	原始輸入數(shù)據(jù)
    Word16 *Output,			//	FIR濾波輸出結(jié)果
    Word16 *Fir_Coef,		//	FIR濾波器系數(shù)
    Word16 *Fir_Memory,		//	FIR濾波器狀態(tài)
    Word16 order,			//	FIR濾波器階數(shù)
    Word16 length			//	FIR濾波長度
)
{

	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, Fir_Coef[j], Fir_Memory[j] ) ;
		}

		for( j = order - 1 ; j > 0 ; j -- )
		{
			Fir_Memory[j] = Fir_Memory[j-1] ;
		}
		Fir_Memory[0] = Input[i] ;

		Output[i] = _rnd( _lsshl( sum, 3 ) ) ;
	}

	return ;
}