function.c

USB2.0原理与工程开发光盘(第二版)

#pragma NOIV     

#include "testheader.h"
#include "testregs.h"
#include "testdly.h"

extern BOOL GotSUD;    
extern BOOL Sleep;
extern BOOL Rwuen;
extern BOOL Selfpwr;

extern void EZUSB_Delay(WORD ms);

BYTE Configuration;         
BYTE AlternateSetting;       

#define VR_NAKALL_ON    0xD0
#define VR_NAKALL_OFF   0xD1

void TD_Init(void)         
{
   CPUCS = ((CPUCS & ~bmCLKSPD) | bmCLKSPD1) ; 
   OEA=OEA|0x03;    
   IOA=IOA|0x03;    
  
  REVCTL = 0x03;     
  SYNCDELAY;
  SYNCDELAY;
 
  IFCONFIG = 0xCB;
  SYNCDELAY;
 
  EP6FIFOCFG = 0x0D; 
  SYNCDELAY;
  
  EP6CFG = 0xEA; 
  SYNCDELAY;

  PINFLAGSAB = 0x00; 
  SYNCDELAY; 
  PINFLAGSCD = 0x00; 
  SYNCDELAY;
 
  PORTACFG = 0x00;    
  FIFOPINPOLAR = 0x00; 
  SYNCDELAY;

  EP6AUTOINLENH = 0x02; 
  SYNCDELAY; 
  EP6AUTOINLENL = 0x00;
  SYNCDELAY;
 
  EP6FIFOPFH = 0xC1; 
  SYNCDELAY;        
  EP6FIFOPFL = 0x00;
  SYNCDELAY;
 
  FIFORESET = 0x80;  
  SYNCDELAY;
  FIFORESET = 0x06;  
  SYNCDELAY;
  FIFORESET = 0x00;  
  SYNCDELAY;


  EP2BCL = 0x80; 
  SYNCDELAY;
  EP2BCL = 0x80; 
  SYNCDELAY;
  EP4BCL = 0x80;
  SYNCDELAY;
  EP4BCL = 0x80;
  SYNCDELAY;
  EP8BCL = 0x80;
  SYNCDELAY;
  EP8BCL = 0x80;  

  AUTOPTRSETUP |= 0x01;
  Rwuen = TRUE;              
}

void TD_Poll(void)          
{ 
    if (IOA&0x80)     
    {  
        FIFORESET = 0x80;  
        SYNCDELAY;
        FIFORESET = 0x06;  
        SYNCDELAY;
        FIFORESET = 0x00;  
        SYNCDELAY;
    }
}

BOOL TD_Suspend(void)       
{
   return(TRUE);
}

BOOL TD_Resume(void)       
{
   return(TRUE);
}

BOOL DR_GetDescriptor(void)
{
   return(TRUE);
}

BOOL DR_SetConfiguration(void)   
{
   Configuration = SETUPDAT[2];
   return(TRUE);       
}

BOOL DR_GetConfiguration(void)  
{
   EP0BUF[0] = Configuration;
   EP0BCH = 0;
   EP0BCL = 1;
   return(TRUE);        
}

BOOL DR_SetInterface(void)      
{
   AlternateSetting = SETUPDAT[2];
   return(TRUE);          
}

BOOL DR_GetInterface(void)     
{
   EP0BUF[0] = AlternateSetting;
   EP0BCH = 0;
   EP0BCL = 1;
   return(TRUE);         
}

BOOL DR_GetStatus(void)
{
   return(TRUE);
}

BOOL DR_ClearFeature(void)
{
   return(TRUE);
}

BOOL DR_SetFeature(void)
{
   return(TRUE);
}

#define VX_B3 0xB3 
#define VX_B4 0xB4 
BOOL DR_VendorCmnd(void)
{
  BYTE tmp;
  
  switch (SETUPDAT[1])
  {
     case VR_NAKALL_ON:
        tmp = FIFORESET;
        tmp |= bmNAKALL;      
        SYNCDELAY;                    
        FIFORESET = tmp;
        break;
     case VR_NAKALL_OFF:
        tmp = FIFORESET;
        tmp &= ~bmNAKALL;      
        SYNCDELAY;                    
        FIFORESET = tmp;
        break;    
	 case VX_B3:     
	 {   
        FIFORESET = 0x80;  
        SYNCDELAY;
        FIFORESET = 0x06;  
        SYNCDELAY;
        FIFORESET = 0x00;   
        SYNCDELAY;     

        IOA=IOA&0xFE;       

        *EP0BUF = VX_B3;
  	    EP0BCH = 0;
	    EP0BCL = 1;
	    EP0CS |= bmHSNAK;
	    break;
     }
	 case VX_B4:        
	 {
       IOA=IOA|0x01;   

       *EP0BUF = VX_B4;
   	   EP0BCH = 0;
	   EP0BCL = 1;
	   EP0CS |= bmHSNAK;
	   break;
     } 
     default:
        return(TRUE);
  }

  return(FALSE);
}

void ISR_Sudav(void) interrupt 0
{
   GotSUD = TRUE;           
   EZUSB_IRQ_CLEAR();
   USBIRQ = bmSUDAV;         
}

void ISR_Sutok(void) interrupt 0
{
   EZUSB_IRQ_CLEAR();
   USBIRQ = bmSUTOK;      
}

void ISR_Sof(void) interrupt 0
{
   EZUSB_IRQ_CLEAR();
   USBIRQ = bmSOF;         
}

void ISR_Ures(void) interrupt 0
{
   pConfigDscr = pFullSpeedConfigDscr;
   ((CONFIGDSCR xdata *) pConfigDscr)->type = CONFIG_DSCR;
   pOtherConfigDscr = pHighSpeedConfigDscr;
   ((CONFIGDSCR xdata *) pOtherConfigDscr)->type = OTHERSPEED_DSCR;

   EZUSB_IRQ_CLEAR();
   USBIRQ = bmURES;       
}

void ISR_Susp(void) interrupt 0
{
   Sleep = TRUE;
   EZUSB_IRQ_CLEAR();
   USBIRQ = bmSUSP;
}

void ISR_Highspeed(void) interrupt 0
{
   if (EZUSB_HIGHSPEED())
   {
      pConfigDscr = pHighSpeedConfigDscr;
      ((CONFIGDSCR xdata *) pConfigDscr)->type = CONFIG_DSCR;
      pOtherConfigDscr = pFullSpeedConfigDscr;
      ((CONFIGDSCR xdata *) pOtherConfigDscr)->type = OTHERSPEED_DSCR;
   }

   EZUSB_IRQ_CLEAR();
   USBIRQ = bmHSGRANT;
}
void ISR_Ep0ack(void) interrupt 0
{
}
void ISR_Stub(void) interrupt 0
{
}
void ISR_Ep0in(void) interrupt 0
{
}
void ISR_Ep0out(void) interrupt 0
{
}
void ISR_Ep1in(void) interrupt 0
{
}
void ISR_Ep1out(void) interrupt 0
{
}
void ISR_Ep2inout(void) interrupt 0
{
}
void ISR_Ep4inout(void) interrupt 0
{
}
void ISR_Ep6inout(void) interrupt 0
{
}
void ISR_Ep8inout(void) interrupt 0
{
}
void ISR_Ibn(void) interrupt 0
{
}
void ISR_Ep0pingnak(void) interrupt 0
{
}
void ISR_Ep1pingnak(void) interrupt 0
{
}
void ISR_Ep2pingnak(void) interrupt 0
{
}
void ISR_Ep4pingnak(void) interrupt 0
{
}
void ISR_Ep6pingnak(void) interrupt 0
{
}
void ISR_Ep8pingnak(void) interrupt 0
{
}
void ISR_Errorlimit(void) interrupt 0
{
}
void ISR_Ep2piderror(void) interrupt 0
{
}
void ISR_Ep4piderror(void) interrupt 0
{
}
void ISR_Ep6piderror(void) interrupt 0
{
}
void ISR_Ep8piderror(void) interrupt 0
{
}
void ISR_Ep2pflag(void) interrupt 0
{
}
void ISR_Ep4pflag(void) interrupt 0
{
}
void ISR_Ep6pflag(void) interrupt 0
{
}
void ISR_Ep8pflag(void) interrupt 0
{
}
void ISR_Ep2eflag(void) interrupt 0
{
}
void ISR_Ep4eflag(void) interrupt 0
{
}
void ISR_Ep6eflag(void) interrupt 0
{
}
void ISR_Ep8eflag(void) interrupt 0
{
}
void ISR_Ep2fflag(void) interrupt 0
{
}
void ISR_Ep4fflag(void) interrupt 0
{
}
void ISR_Ep6fflag(void) interrupt 0
{
}
void ISR_Ep8fflag(void) interrupt 0
{
}
void ISR_GpifComplete(void) interrupt 0
{
}
void ISR_GpifWaveform(void) interrupt 0
{
}