speaker.c

DM642上的直流电机程序

#include "2407c.h"                    

unsigned int uWork,uWork1,i=0,uN,nCount,nCount1;//,nCount;
unsigned int Mdir=0,speed=10,UWork=0;

main()
{
	int i,wg;
	uN=40; nCount=nCount1=0;
	*WDCR=0x6f;
	*WDKEY=0x5555;
	*WDKEY=0xaaaa;    
	*SCSR1=0x81fe;    //40m   
	
	wg =*WSGR;
	wg=wg&0xffc8; 
	*WSGR=wg;  
	    
	uWork=(*MCRA);
	uWork&=0x0f3ff;	/* CANTX/IOPC6 for normal I/O port */
	(*MCRA)=uWork;

	*IMR=0x3;
	*IFR=0xffff;    
	
	uWork=(*WSGR);
	uWork&=0x0fe3f;
	(*WSGR)=uWork;
		
	uWork=(*PBDATDIR);
	uWork|=0x0400;
	uWork&=0x0fffb;		/* Set direct=0 */
	(*PFDATDIR)=uWork;
	
	asm(" clrc INTM"); 
	while(1)
	{
	   
			if(Mdir==0)
			{
			 if ( nCount1>speed )
				uWork=0x0ff00;
			 else
				uWork=0x0ff04;		
			}
			else if(Mdir==1)
			{
			 if ( nCount1>speed )
				uWork=0x0ff00;
			 else
				uWork=0x0ff08;		
			}
			
			UWork=(*PBDATDIR);
			if(UWork!=uWork)
			 (*PBDATDIR)=uWork;
		     nCount1++;
		     nCount1%=50;
	}
}