test19.c

5402开发板附带的源程序

#include "math.h"
#include "REG5402.h"

#define PI 3.1415926

int i,A,k,T,BIAN;
int N,j;
int time1_over;
float fo,fs;                     
int x[4000];

void wave0(void)                       /*正弦波*/
{
   A=1000;
   fo=1000; 
   N=1000;
   fs=N*fo;
   
   for(i=0;i<N;i++)
      x[i]=(int)(A*sin(2*PI*i*fo/fs)+A);    
}

void wave1(void)                       /*余弦波*/
{
   A=1000;
   fo=10;
   N=1000;
   fs=N*fo;            
   
   for(i=0;i<N;i++)
      x[i]=(int)(A*cos(2*PI*fo*i/fs)+A);   
}

void wave2(void)                      /*三角波*/
{
   k=1;
   T=1000;
   N=1000; 
   fs=(float)N/T;
   
   for(i=0;i<N/4;i++)
      x[i]=(int)(k*i*1.0/fs+k*T/4.0);
   
   for(i=N/4;i<N/2;i++)
      x[i]=(int)(k*(T/2.0-i*1.0/fs)+k*T/4.0);
  
   for(i=N/2;i<3*N/4;i++)
      x[i]=(int)(k*(T/2.0-i*1.0/fs)+k*T/4.0);      
   
   for(i=3*N/4;i<N;i++)
      x[i]=(int)(k*(i*1.0/fs-T)+k*T/4.0);    
}

void wave3(void)                       /*方波*/
{
   A=1000;
   T=1000;
   N=T;
   fs=N/T;
   
   for(i=0;i<N;i++)
   {
      if((i/fs)<(T/2.0))
         x[i]=A;
      else 
	     x[i]=0;     
   }
}

void wave4(void)                          /*锯齿波*/                       
{
   k=1;
   T=1000;
   N=T;
   fs=N/T;
   
   for(i=0;i<N;i++)
      x[i]=(int)k*i/fs;     
}

void wave5(void)
{
   k=1;
   T=1000;
   N=T;
   fs=N/T;
   
   for(i=0;i<N;i++)
      x[i]=(int)(-k*i/fs); 
}

void cpu_init()
{
   PMST=0x3fa0;
   SWWSR=0x0fff;
   SWCR=0x0000;
   BSCR=0x0002;
   IMR=0;
   IFR=IFR;
} 

void set_t0()    
{
   asm(" ssbx intm");
   TCR0=0x0a18;
   PRD0=0x001F;       
   IMR=IMR|0x0008;
   IFR=IFR;
   asm(" rsbx intm");
}

main()                       /*正弦波*/
{
   cpu_init();
   set_t0();
   time1_over=0;
   READS=0;
   for(i=0;i<4000;i++)
      x[i]=0;
      
aaaa:     BIAN=(READS&0xF000)>>13;
     
     switch(BIAN)
     {
       case 0: wave0(); break;
       case 1: wave1(); break;
       case 2: wave2(); break;
       case 3: wave3(); break;
       case 4: wave4(); break; 
       case 5: wave5(); break;
     } 
  
   for(;;)
   {
     for(k=0;k<N;k++)
     {   
       TCR0=0x0a28;
       PRD0=0x001F;          
       while(time1_over==0);
       time1_over=0;   
       READS=x[k];
     }
     j=(READS&0xF000)>>13;
     if(j!=BIAN) goto aaaa;
   }         
}

interrupt void tint0()        
{  
  time1_over=1;
}