hm_lms_Final.rar_NOISE

typedef unsigned int Uint32; typedef int Int32; typedef short Int16; typedef unsigned short Uint16; #define PI 3.14 #include<fastmath67x.h> #include<math.h> int Count; void sin_Cal() { // short *AdcValue,AdcOut; const float Fsamp = 16000.00; const int Finp = 500; int Nsamp; float Tsamp; double Ang; short *SinOut; // short *DacOut; SinOut = (short *)0xc0010000; // DacOut = (short *)0x60000554; Nsamp = Fsamp / Finp; Tsamp = 1 / Fsamp; for(Count = 0; Count < Nsamp; Count++) { Ang = 2 * PI * Finp * Tsamp * Count; *(SinOut + Count) = sin(Ang) * 512 + 512; } } void main() { // Uint16 *SocValue; // Uint16 *AdcValue; Int16 *DacValue; // Int16 adcOut1,adcOut2; // Int32 Count; Int32 outValue,clear = 0; Int16 nseEst; Int16 errSgl; Int16 addSgl; Int16 *OrgSgl; Int16 *NseSgl; double *kern; // SocValue = (Uint16 *)0x60000558; // AdcValue = (Uint16 *)0x60000554; DacValue = (Int16 *)0x60000554; // OrgSgl = (Int16 *)0xc0010000; NseSgl = (Int16 *)0xc0002000; kern = (double *)0xc0003000; for(Count = 0; Count < 32; Count++) { kern[Count] = 0; NseSgl[Count] = 0; OrgSgl[Count] =0; } /* hm Input Signal Call */ sin_Cal(); OrgSgl = (Int16 *)0xc0010000; while(1) { /* hm Noise Signal Read from ADC1(Input max 2V ) */ *NseSgl = *(short *) (0x60000554); /* vary the noise signal 25HZ to 3KHZ */ /* *SocValue = 0x00; for(Count = 0; Count < 10; Count++); *NseSgl = *AdcValue; addSgl = *NseSgl; *OrgSgl = Real_In(); *DacValue = adcOut | 0x1000; *SocValue = 0x01; for(Count = 0; Count < 100; Count++); adcOut = *AdcValue; *NseSgl = adcOut;*/ /* hm Input Signal added with Noise Signal */ addSgl = (*OrgSgl++) + *NseSgl; /* hm Reinitialize Input Signal Memory */ if(clear++ > 30) { OrgSgl = (Int16 *)0xc0010000; clear = 0;} outValue = 0; for(Count = 0; Count < 32; Count++) { outValue += *(NseSgl + Count) * *(kern + Count);} // adcOut1 = *AdcValue; // *OrgSgl = adcOut1; nseEst = outValue >> 8; errSgl = addSgl - nseEst; for(Count = 31; Count >=0; Count--) { *(kern + Count) = *(kern + Count) + ((2 * 0.00000001 * errSgl) * *(NseSgl + Count)); *(NseSgl + Count + 1) = *(NseSgl + Count); } // addSgl = addSgl;// + 2048;//>> 2; *DacValue = addSgl | 0x1000; for(Count = 0; Count < 40; Count++); /* errSgl &= 0x0fff; // errSgl = errSgl ^ 4096; //errSgl ^=0x0800;*/ errSgl += 2048; *DacValue = errSgl | 0x5000; } }