Subversion Repositories z80control

#include "FTD2XX.h"

#include <queue.h>

#define   DEFAULT_DEVICE           0

#define   INIT_CMD_SIZE            5

#define   MAX_TOTAL_PACKET         256-20

#define   MAX_TXD_PACKET           256

#define   MAX_RXD_PACKET           100

#define   ALMOST_FULL_SIZE         20

class USB_JTAG

{

     FT_HANDLE FT_Handle;

     FT_STATUS FT_Status;

     int  DeviceNumber;

     unsigned long  NumOfWritten;

     unsigned long  NumOfRead;

     unsigned char  Init_CMD[INIT_CMD_SIZE];

     unsigned char  Close_CMD;

     unsigned char  TXD_Buffer[MAX_TXD_PACKET];

     queue<unsigned char> Buffer;

public:

     USB_JTAG();

     FT_STATUS Get_Status();

     void Select_Device(int Number);

     int  Number_Of_Device();

     int  Number_Of_Queue_Data();

     bool Open_Device();

     bool Close_Device();

     bool Reset_Device(int sleep);

     bool Initial_JTAG();

     bool Write_Data(unsigned char* Source, int Size, int WithRead, bool Immediate);

     bool Read_Data(unsigned char* Dest, int Size);

     ~USB_JTAG();

};

/* TODO : USB_JTAG */

USB_JTAG::USB_JTAG()

{

     Init_CMD[0]    = 0x26;

     Init_CMD[1]    = 0x27;

     Init_CMD[2]    = 0x26;

     Init_CMD[3]    = 0x81;

     Init_CMD[4]    = 0x00;

     Close_CMD      = 0x1F;

     DeviceNumber   = DEFAULT_DEVICE;

     FT_Status      = FT_OK;

}

/* TODO : Get_Status */

FT_STATUS USB_JTAG::Get_Status()

{

     return FT_Status;

}

/* TODO : Select_Device */

void USB_JTAG::Select_Device(int Number)

{

     DeviceNumber=Number;

}

/* TODO : Number_Of_Device */

int  USB_JTAG::Number_Of_Device()

{

     unsigned long numDevs=0;

     FT_Status=FT_ListDevices(&numDevs,NULL,FT_LIST_NUMBER_ONLY);

     return numDevs;

}

/* TODO : Number_Of_Queue_Data */

int  USB_JTAG::Number_Of_Queue_Data()

{

     unsigned long numData=0;

     FT_Status=FT_GetQueueStatus(FT_Handle,&numData);

     return numData;

}

/* TODO : Open_Device */

bool USB_JTAG::Open_Device()

{

     FT_Status=FT_Open(DeviceNumber,&FT_Handle);

     if(FT_Status!=FT_OK)  return false;

     FT_SetLatencyTimer(FT_Handle,0x02);

     return true;

}

/* TODO : Close_Device */

bool USB_JTAG::Close_Device()

{

     FT_Status=FT_Write(FT_Handle,&Close_CMD,1,&NumOfWritten);

     if(FT_Status!=FT_OK)  return false;

     FT_Status=FT_Close(FT_Handle);

     if(FT_Status!=FT_OK)  return false;

     return true;

}

/* TODO : Reset_Device */

bool USB_JTAG::Reset_Device(int sleep)

{

     Close_Device();

     Sleep(sleep);

     Open_Device();

     Initial_JTAG();

     if(FT_Status!=FT_OK)  return false;

     return true;

}

/* TODO : Initial_JTAG */

bool USB_JTAG::Initial_JTAG()

{

     FT_Status=FT_Write(FT_Handle,Init_CMD,5,&NumOfWritten);

     if(FT_Status!=FT_OK)  return false;

     return true;

}

/* TODO : Write_Data */

bool USB_JTAG::Write_Data(unsigned char* Source, int Size, int WithRead, bool Immediate)

{

     int i;

     if(Size!=0)

     {

          //   Insert Write Command

          Buffer.push((unsigned char)Size|0x80);

          for(i=0;i<Size;i++)

          Buffer.push(Source[i]);

     }

     if(WithRead!=0)

     {

          //   Insert Read Command

          Buffer.push((unsigned char)WithRead|0xC0);

          for(i=0;i<WithRead;i++)

          Buffer.push(0x00);

     }

     //   Transfer Queue To Array

     int Trans_Size=Buffer.size();

     if(Immediate || Trans_Size>MAX_TXD_PACKET-ALMOST_FULL_SIZE)

     {

          for(i=0;i<Trans_Size;i++)

          {

               TXD_Buffer[i]=Buffer.front();

               Buffer.pop();

          }

          FT_Status=FT_Write(FT_Handle,TXD_Buffer,Trans_Size,&NumOfWritten);

     }

     if(FT_Status!=FT_OK)  return false;

     return true;

}

/* TODO : Read_Data */

bool  USB_JTAG::Read_Data(unsigned char* Dest, int Size)

{

     FT_Status=FT_Read(FT_Handle,Dest,Size,&NumOfRead);

     if(FT_Status!=FT_OK)  return false;

     return true;

}

/* TODO : ~USB_JTAG */

USB_JTAG::~USB_JTAG()

{

     Close_Device();

}