myproc2.c

TMS320C6416的BOOTLOADER程序代码

/*********************************************************/
/*                                                       */
/*                DETECT.C                                 */
/*                                                       */
/*     The program is used to detect and  estimate       */
/*                                                       */
/*     the signal received .                      */   
/*                                                       */
/*     And the program can be used when only one target. */
/*                                                       */
/*     Copyright2004.1-2004.9 by FU JIN          */
/*                                                       */
/*********************************************************/

void  myproc()
{
    
      int ii;
    add_yout=0;
 
    for(ii=0;ii<ChnNum;ii++)
    {
	  
  
  
      
  	 
  	  
  	  
  	  
  		if (KUAN[i]==0)
  		{
  		  pXS[i]=0x0000;pXC[i]=0x0800; 
  		  ws[i]=0;wc[i]=0;
  		  KUAN[i]++;
		  ws[i]=ws[i]+(((e*u1>>15)*SINE[pXS[i]])>>15);//u=4000/32768;
		  wc[i]=wc[i]+(((e*u1>>15)*SINE[pXC[i]])>>15);
		  pXS[i]=(pXS[i]+STEP_f[i])%0x2000;
		  pXC[i]=(pXC[i]+STEP_f[i])%0x2000;
		  yout[i]=((ws[i]*SINE[pXS[i]])>>15)+((wc[i]*SINE[pXC[i]])>>15);
		  A[i]=(ws[i]*ws[i]+wc[i]*wc[i]);
		  add_yout+=yout[i];
		  
  		}
  		else
  		{
  		  KUAN[i]++;
		  ws[i]=ws[i]+(((e*u1>>15)*SINE[pXS[i]])>>15);//u=4000/32768;
		  wc[i]=wc[i]+(((e*u1>>15)*SINE[pXC[i]])>>15);
		  pXS[i]=(pXS[i]+STEP_f[i])%0x2000;
		  pXC[i]=(pXC[i]+STEP_f[i])%0x2000;
		  yout[i]=((ws[i]*SINE[pXS[i]])>>15)+((wc[i]*SINE[pXC[i]])>>15);
		  A[i]=(ws[i]*ws[i]+wc[i]*wc[i]);
		  add_yout+=yout[i];
    	 /*if (KUAN[i]==(IDENT-256))
	  	  {
	  	    if (A[i]<THRESH[i])
	  	      KUAN[i]=0;
	  	    else
	  	    {
	  	      ws_p[i]=ws[i];wc_p[i]=wc[i];
	  	      sum_f[i]=0;sum_f2[i]=0;sum_amp[i]=0;
	  	      sum_ws[i]=0;sum_wc[i]=0;
	  	    }
	  	  }
	  	  else if (KUAN[i]>(IDENT-256)&&KUAN[i]<=IDENT)
	  	  {
	  	    if (A[i]<THRESH[i])
	  	      KUAN[i]=0;
	  	    else
	  	    {
	  	      sum_amp[i]+=A[i]>>15; 
	  	      sum_ws[i]+=ws[i];
	  	      sum_wc[i]+=wc[i];
	  	      B[i]=ws[i]*wc_p[i]-ws_p[i]*wc[i];
	  	      C[i]=ws_p[i]*ws[i]+wc_p[i]*wc[i];
	  	      w[i]=arctan(B[i],C[i]);
	  	      f[i]=f0-(signed int)(w[i]*fs>>15);
	  	      sum_f[i]+=f[i];
	  	      sum_f2[i]+=(unsigned int)((f[i]>>6)*(f[i]>>6));
	  	      ws_p[i]=ws[i];wc_p[i]=wc[i];
	  	    }
	  	  }
	  	
	   	  
	  	}*/
	  }
	    	  
 	e=DATA-add_yout;

}