lvbo.c

实现自适应滤波的噪音抵消功能

#include<refnoise.h>
#include<dplusn.h>
#define beta 1E-9
#define N 30
#define NS 128
float w[N];
float delay[N];
short output;
short out_type=1;
 void  c_int11()
{
  short i;
  static short buffercount=0;
  float yn,E;
  delay[0]=refnoise[buffercount];
  yn=0;
  for (i=0;i<N;i++)
    yn +=(w[i]*delay[i]);
    E=dplusn[buffercount]-yn;
    for(i=N-1;i>=0;i--)
     { w[i]=w[i]+beta*E*delay[i];
     delay[i]=delay[i-1];
     }
     buffercount++;
     if(buffercount>=NS)
       buffercount=0;
       if(out_type==1)
           output=((short)E*10);
        else if(out_type==2)
           output=dplusn[buffercount]*10;

           return;
}
 main()
 {
    short T=0;
    for(T=0;T<30;T++)
      {  w[T]=0;
         delay[T]=0;
      }
      c_int11();
      while(1);
 }