请大家看看我的FIR滤波问题出在哪边？

发表于 2010-9-6 16:54

我的FIR滤波的代码
#define M 16 /*number of coefficients*/
#define N 16 /*number of output samples*/
COEFS fir_coefs;/*coefficients structure*/
int a[N];/*filter output vector*/
int x0[N];
short x[M+N-1];/*filter input vector*/
short h[M]={3099, 1137, 1305, 1456, 1586, 1687, 1758, 1795, 1795,
   1758, 1687, 1586, 1456, 1305, 1137, 3099};/*filter coefficients vector*/
uint16_t xyz_FIR[16];
void FIR_filter(u32 k)
{
  u8 j;
  for (j=0;j<16;j++)
{
   x0[j] = ADCConvertedValue[j]+offsetx;
  x[j+16]= x0[j];
}
if (k>1) //第一次的16个数据无法完成FIR滤波
{
   fir_coefs.nh = M; /*Number of Coefficients for FIR*/
   fir_coefs.h = h; /*Pointer on FIR coefficient vector*/
   fir_16by16_stm32(a,x,&fir_coefs,N);/*performs the FIR filtering*/
}
for(j=0;j<15;j++)
{
   x[j]= x0[j+1];
}
if (k>1)  //第一次的16个数据无法完成FIR滤波
{
for (j=0;j<16;j++)
{
   xyz_FIR[j]=a[j]/65535;
}
}
}
在没有滤波时采集的数据

没有滤波时采集的数据