?? tpbulk.c
字號(hào):
#include "config.h"
//////////////////////////////////
extern unsigned char DBUF[BUFFER_LENGTH];
extern PKG usbstack;
extern SYS_INFO_BLOCK DeviceInfo;
extern FILE_INFO ThisFile;
extern unsigned long DirStartCluster32,NowCluster32;
extern FLAGS bFlags;
unsigned char out[0x20];
///////////////////////////////////////////////////////////////////////////
unsigned char EnumMassDev(void)
{
unsigned int ReservedSectorsNum;
if(!SPC_Inquiry())
return FALSE;
DelayMs(50);
if(!SPC_TestUnit())
return FALSE;
if(!SPC_LockMedia())
return FALSE;
if(!SPC_RequestSense())
return FALSE;
if(!SPC_TestUnit())
return FALSE;
if(!RBC_ReadCapacity())
return FALSE;
DeviceInfo.BPB_BytesPerSec=512; //暫假設(shè)為512
DelayMs(50);
////////////////////////////////////////////////////
if(!RBC_Read(0x00,1,DBUF))
return FALSE;
DBUF[0] = DBUF[0] & 0xFF;
//////////////////////////////////
if(DBUF[0]==0xeb||DBUF[0]==0xe9)
{
DeviceInfo.StartSector=0;
}
else
{
DeviceInfo.StartSector=LSwapINT32(DBUF[454],DBUF[455],DBUF[456],DBUF[457]);
}
///////////////////////////////////////////////////////
DelayMs(50);
if(!RBC_Read(DeviceInfo.StartSector,1,DBUF))
return FALSE;
DeviceInfo.BPB_BytesPerSec=LSwapINT16(DBUF[11],DBUF[12]);
DeviceInfo.BPB_SecPerClus=DBUF[13];
ReservedSectorsNum=LSwapINT16(DBUF[14],DBUF[15]);
DeviceInfo.BPB_NumFATs=DBUF[16];
if(DBUF[82]=='F'&&DBUF[83]=='A'&&DBUF[84]=='T'&&DBUF[85]=='3'&&DBUF[86]=='2')
{
DeviceInfo.BPB_TotSec32=LSwapINT32(DBUF[32],DBUF[33],DBUF[34],DBUF[35]);
DeviceInfo.BPB_FATSz32=LSwapINT32(DBUF[36],DBUF[37],DBUF[38],DBUF[39]);
DeviceInfo.RootStartCluster=LSwapINT32(DBUF[44],DBUF[45],DBUF[46],DBUF[47]);
DeviceInfo.FatStartSector=DeviceInfo.StartSector+ReservedSectorsNum;
DeviceInfo.FirstDataSector=DeviceInfo.FatStartSector+DeviceInfo.BPB_NumFATs*DeviceInfo.BPB_FATSz32;
DeviceInfo.TotCluster=(DeviceInfo.BPB_TotSec32-DeviceInfo.FirstDataSector+1)/DeviceInfo.BPB_SecPerClus+1;
DirStartCluster32=DeviceInfo.RootStartCluster;
DeviceInfo.FAT=1; //FAT16=0,FAT32=1;
}
else
{
DeviceInfo.BPB_RootEntCnt=LSwapINT16(DBUF[17],DBUF[18]);
DeviceInfo.BPB_RootEntCnt=(DeviceInfo.BPB_RootEntCnt)*32/DeviceInfo.BPB_BytesPerSec;
DeviceInfo.BPB_TotSec16=LSwapINT16(DBUF[19],DBUF[20]);
DeviceInfo.BPB_FATSz16=LSwapINT16(DBUF[22],DBUF[23]);
DeviceInfo.FatStartSector=DeviceInfo.StartSector+ReservedSectorsNum;
DeviceInfo.RootStartSector=DeviceInfo.StartSector+DeviceInfo.BPB_NumFATs*DeviceInfo.BPB_FATSz16+ReservedSectorsNum;
DeviceInfo.FirstDataSector=DeviceInfo.FatStartSector+DeviceInfo.BPB_NumFATs*DeviceInfo.BPB_FATSz16+DeviceInfo.BPB_RootEntCnt;
DeviceInfo.FAT=0;
}
///////////////////////////////////////////////////////
ThisFile.bFileOpen=0;
///////////////////////////////////////////////////////
return TRUE;
}
unsigned char SPC_Inquiry(void)
{
out[0]=0x55;out[1]=0x53;out[2]=0x42;out[3]=0x43; //表示是CBW包
out[4]=0x60;out[5]=0xa6;out[6]=0x24;out[7]=0xde; //
out[8]=0x24;out[9]=0x00;out[10]=0x00;out[11]=0x00; //本次CBW需要傳輸長(zhǎng)度為0X24
out[12]=0x80; //傳輸方向
out[13]=0x00; //一般為0，當(dāng)有多個(gè)邏輯單元時(shí)為指定的邏輯單元
out[14]=06; //本次要傳輸?shù)腃BW命令的長(zhǎng)度
out[15]=SPC_CMD_INQUIRY;out[16]=0x00;out[17]=0x00; //
out[18]=0x00;out[19]=0x24;out[20]=0x00;
////////////////////////////////
DelayMs(200);
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(50);
if(!epBulkRcv(DBUF,38))
return FALSE;
if(!epBulkRcv(out,13))
return FALSE;
////////////////////////////////
return TRUE;
}
unsigned char SPC_RequestSense(void)
{
out[0]=0x55;out[1]=0x53;out[2]=0x42;out[3]=0x43;
out[4]=0x60;out[5]=0xa6;out[6]=0x24;out[7]=0xde;
out[8]=0x0e;out[9]=0x00;out[10]=0x00;out[11]=0x00;
out[12]=0x80;out[13]=0x00;out[14]=6;
out[15]=SPC_CMD_REQUESTSENSE;out[16]=0x00;out[17]=0x00;
out[18]=0x00;out[19]=0x0e;out[20]=0x00;
//////////////////////////////////////
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(5);
if(!epBulkRcv(out,18))
return FALSE;
if(!epBulkRcv(out,13))
return FALSE;
/////////////////////////////
return TRUE;
}
unsigned char SPC_TestUnit(void)
{
out[0]=0x55;out[1]=0x53;out[2]=0x42;out[3]=0x43;
out[4]=0x60;out[5]=0xa6;out[6]=0x24;out[7]=0xde;
out[8]=0x00;out[9]=0x00;out[10]=0x00;out[11]=0x00;
out[12]=0x00;out[13]=0x00;out[14]=6;
/////////////////////////////////////
out[15]=SPC_CMD_TESTUNITREADY;
out[16]=0;out[17]=0;out[18]=0;out[19]=0;out[20]=0;
//////////////////////////////////////
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(5);
if(!epBulkRcv(out,13))
return FALSE;
return TRUE;
}
unsigned char SPC_LockMedia(void)
{
out[0]=0x55;out[1]=0x53;out[2]=0x42;out[3]=0x43;
out[4]=0x60;out[5]=0xa6;out[6]=0x24;out[7]=0xde;
out[8]=0x00;out[9]=0x00;out[10]=0x00;out[11]=0x00;
out[12]=0x00;out[13]=0x00;out[14]=5;
///////////////////////////////////////////
out[15]=SPC_CMD_PRVENTALLOWMEDIUMREMOVAL;
out[16]=0;out[17]=0;out[18]=0;out[19]=1;
///////////////////////////////////////////
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(5);
if(!epBulkRcv(out,13))
return FALSE;
/////////////////////////////
return TRUE;
}
unsigned char RBC_ReadCapacity(void)
{
out[0]=0x55;out[1]=0x53;out[2]=0x42;out[3]=0x43;
out[4]=0x60;out[5]=0xa6;out[6]=0x24;out[7]=0xde;
out[8]=0x08;out[9]=0x00;out[10]=0x00;out[11]=0x00;
out[12]=0x80;out[13]=0x00;out[14]=10;
/////////////////////////////////////
out[15]=RBC_CMD_READCAPACITY;
out[16]=0;out[17]=0;out[18]=0;out[19]=0;
out[20]=0;out[21]=0;out[22]=0;out[23]=0;
out[24]=0;
/////////////////////////////////////
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(10);
if(!epBulkRcv(DBUF,8))
return FALSE;
if(!epBulkRcv(out,13))
return FALSE;
/////////////////////////////
return TRUE;
}
unsigned char RBC_Read(unsigned long lba,unsigned char len,unsigned char *pBuffer)
{
unsigned long lout;
out[0]=0x55;out[1]=0x53;out[2]=0x42;out[3]=0x43;
out[4]=0x60;out[5]=0xa6;out[6]=0x24;out[7]=0xde;
lout=len*DeviceInfo.BPB_BytesPerSec;
out[8]=(unsigned char)(lout&0xff);
out[9]=(unsigned char)((lout>>8)&0xff);
out[10]=(unsigned char)((lout>>16)&0xff);
out[11]=(unsigned char)((lout>>24)&0xff);
out[12]=0x80;out[13]=0x00;out[14]=10;
/////////////////////////////////////
out[15]=RBC_CMD_READ10;out[16]=0x00;
out[17]=(unsigned char)((lba>>24)&0xff);
out[18]=(unsigned char)((lba>>16)&0xff);
out[19]=(unsigned char)((lba>>8)&0xff);
out[20]=(unsigned char)(lba&0xff);
out[21]=0x00;
out[22]=(unsigned char)((len>>8)&0xff);
out[23]=(unsigned char)(len&0xff);
out[24]=0x00;
//////////////////////////////////////
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(20);
if(!epBulkRcv(pBuffer,len*DeviceInfo.BPB_BytesPerSec))
return FALSE;
DelayMs(5);
if(!epBulkRcv(out,13))
return FALSE;
/////////////////////////////
return TRUE;
}
unsigned char RBC_Write(unsigned long lba,unsigned char len,unsigned char *pBuffer)
{
unsigned long lout;
out[0]=0x55;out[1]=0x53;out[2]=0x42;out[3]=0x43;
out[4]=0xb4;out[5]=0xd9;out[6]=0x77;out[7]=0xc1;
lout=len*DeviceInfo.BPB_BytesPerSec;
out[8]=(unsigned char)(lout&0xff);
out[9]=(unsigned char)((lout>>8)&0xff);
out[10]=(unsigned char)((lout>>16)&0xff);
out[11]=(unsigned char)((lout>>24)&0xff);
out[12]=0x00;out[13]=0x00;out[14]=10;
/////////////////////////////////////
out[15]=RBC_CMD_WRITE10;
out[16]=0x00;
out[17]=(unsigned char)((lba>>24)&0xff);
out[18]=(unsigned char)((lba>>16)&0xff);
out[19]=(unsigned char)((lba>>8)&0xff);
out[20]=(unsigned char)(lba&0xff);
out[21]=0x00;
out[22]=(unsigned char)((len>>8)&0xff);
out[23]=(unsigned char)(len&0xff);
out[24]=0x00;
//////////////////////////////////////
DelayMs(200);
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(150);
if(!epBulkSend(pBuffer,DeviceInfo.BPB_BytesPerSec))
return FALSE;
DelayMs(100);
if(!epBulkRcv(out,13))
return FALSE;
return TRUE;
}
?? 快捷鍵說(shuō)明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號(hào)
Ctrl + =
減小字號(hào)
Ctrl + -