#pragma NOIV               // Do not generate interrupt vectors
//-----------------------------------------------------------------------------
//   File:      bulkloop.c
//   Contents:   Hooks required to implement USB peripheral function.
//
//   Copyright (c) 2000 Cypress Semiconductor All rights reserved
//-----------------------------------------------------------------------------
#include "fx2.h"
#include "fx2regs.h"
#include "fx2sdly.h"            // SYNCDELAY macro
#include "string.h"

extern BOOL GotSUD;             // Received setup data flag
extern BOOL Sleep;
extern BOOL Rwuen;
extern BOOL Selfpwr;

BYTE Configuration;             // Current configuration
BYTE AlternateSetting;          // Alternate settings

#define VR_NAKALL_ON    0xD0
#define VR_NAKALL_OFF   0xD1

void SlaveFIFOInit(void)
{
  REVCTL = 0x03;     
  SYNCDELAY;
  SYNCDELAY;
 
  IFCONFIG = 0xEB;
  SYNCDELAY;
 
  EP2FIFOCFG = 0x0D; 
  SYNCDELAY;
  
  EP2CFG = 0xE8; 
  SYNCDELAY;

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

  EP2AUTOINLENH = 0x04;
  SYNCDELAY; 
  EP2AUTOINLENL = 0x00;
  SYNCDELAY;
 
  EP2FIFOPFH = 0xC2; 
  SYNCDELAY;        
  EP2FIFOPFL = 0x00;
  SYNCDELAY;
 
  FIFORESET = 0x80;  
  SYNCDELAY;
  FIFORESET = 0x02;  
  SYNCDELAY;
  FIFORESET = 0x00;  
  SYNCDELAY;


   EP4BCL = 0x80; //4倍緩沖，寫4遍
   SYNCDELAY;
   EP4BCL = 0x80; 
   SYNCDELAY;
   EP4BCL = 0x80;
   SYNCDELAY;
   EP4BCL = 0x80;
   SYNCDELAY;

   EP6BCL = 0x80;
   SYNCDELAY;
   EP6BCL = 0x80; 
   SYNCDELAY;
   EP6BCL = 0x80; 
   SYNCDELAY;
   EP6BCL = 0x80; 
   SYNCDELAY;

   EP8BCL = 0x80;
   SYNCDELAY;
   EP8BCL = 0x80;
   SYNCDELAY;
   EP8BCL = 0x80;
   SYNCDELAY;
   EP8BCL = 0x80; 
   SYNCDELAY;
}

void FPGAInit(void)
{
  *((BYTE xdata *) 0x2000) = 0X00; //復位硬件電路
}

void SENDDATA(void)
{
   *((BYTE xdata *) 0x2000) = EP1OUTBUF[0]; //利用地址線和數據線發送命令到FPGA
   *((BYTE xdata *) 0x4000) = EP1OUTBUF[1];
   *((BYTE xdata *) 0x6000) = EP1OUTBUF[2];
   *((BYTE xdata *) 0x8000) = EP1OUTBUF[3];
   *((BYTE xdata *) 0xA000) = EP1OUTBUF[4];
   *((BYTE xdata *) 0xC000) = EP1OUTBUF[5];
   *((BYTE xdata *) 0xE000) = EP1OUTBUF[6];
   *((BYTE xdata *) 0x0400) = EP1OUTBUF[7];
   *((BYTE xdata *) 0x0800) = EP1OUTBUF[8];
   *((BYTE xdata *) 0x0C00) = EP1OUTBUF[9];
   *((BYTE xdata *) 0x1000) = 0X00;
   *((BYTE xdata *) 0x1000) = EP1OUTBUF[10];
   *((BYTE xdata *) 0x1400) = EP1OUTBUF[11];
   *((BYTE xdata *) 0x1800) = EP1OUTBUF[12];
   *((BYTE xdata *) 0x1C00) = EP1OUTBUF[13];
}

void TD_Init(void)             
{
  IFCONFIG = 0xEB;
  SYNCDELAY;

  EP1OUTCFG=0xA0;
  SYNCDELAY;
 
  EP2CFG = 0xE8; 
  SYNCDELAY;

  PORTACFG = 0xC0;
    
  EPIE|=0x10;
  SYNCDELAY;

  EP2BCL = 0x80; //管道2初始化
  SYNCDELAY;
  EP2BCL = 0x80; 
  SYNCDELAY;

  AUTOPTRSETUP |= 0x01;
  Rwuen = TRUE;   

}

void TD_Poll(void)              
{
   EP1OUTBC=0;
}

BOOL TD_Suspend(void)          // Called before the device goes into suspend mode
{
   return(TRUE);
}

BOOL TD_Resume(void)          // Called after the device resumes
{
   return(TRUE);
}

//-----------------------------------------------------------------------------
// Device Request hooks
//   The following hooks are called by the end point 0 device request parser.
//-----------------------------------------------------------------------------

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

BOOL DR_SetConfiguration(void)   // Called when a Set Configuration command is received
{
   Configuration = SETUPDAT[2];
   return(TRUE);            // Handled by user code
}

BOOL DR_GetConfiguration(void)   // Called when a Get Configuration command is received
{
   EP0BUF[0] = Configuration;
   EP0BCH = 0X00;
   EP0BCL = 0X01;
   return(TRUE);            // Handled by user code
}

BOOL DR_SetInterface(void)       // Called when a Set Interface command is received
{
   AlternateSetting = SETUPDAT[2];
   return(TRUE);            // Handled by user code
}

BOOL DR_GetInterface(void)       // Called when a Set Interface command is received
{
   EP0BUF[0] = AlternateSetting;
   EP0BCH = 0X00;
   EP0BCL = 0X01;
   return(TRUE);            // Handled by user code
}

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

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

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

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 0xB3:
	    SlaveFIFOInit();
		FPGAInit();
        SENDDATA();
		*EP0BUF=0xB3; EP0BCH=0; EP0BCL=1; EP0CS|=bmHSNAK;
	    break;
     default:
        return(TRUE);
  }

  return(FALSE);
}

//-----------------------------------------------------------------------------
// USB Interrupt Handlers
//   The following functions are called by the USB interrupt jump table.
//-----------------------------------------------------------------------------

// Setup Data Available Interrupt Handler
void ISR_Sudav(void) interrupt 0
{
   GotSUD = TRUE;            // Set flag
   EZUSB_IRQ_CLEAR();
   USBIRQ = bmSUDAV;         // Clear SUDAV IRQ
}

// Setup Token Interrupt Handler
void ISR_Sutok(void) interrupt 0
{
   EZUSB_IRQ_CLEAR();
   USBIRQ = bmSUTOK;         // Clear SUTOK IRQ
}

void ISR_Sof(void) interrupt 0
{
   EZUSB_IRQ_CLEAR();
   USBIRQ = bmSOF;            // Clear SOF IRQ
}

void ISR_Ures(void) interrupt 0
{
   // whenever we get a USB reset, we should revert to full speed mode
   pConfigDscr = pFullSpeedConfigDscr;
   ((CONFIGDSCR xdata *) pConfigDscr)->type = CONFIG_DSCR;
   pOtherConfigDscr = pHighSpeedConfigDscr;
   ((CONFIGDSCR xdata *) pOtherConfigDscr)->type = OTHERSPEED_DSCR;

   EZUSB_IRQ_CLEAR();
   USBIRQ = bmURES;         // Clear URES IRQ
}

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
{
}