?? tpbulk.c
字號:
#include "common.h"
#include "SL811.H"
#include "TPBULK.H"
#include "HAL.H"
#include "HPI.H"
#include "HPI32.H"
//////////////////////////////////
extern unsigned char DBUF[BUFFER_LENGTH];
extern SYS_INFO_BLOCK DeviceInfo;
extern FILE_INFO ThisFile;
extern unsigned int DirStartCluster;
extern unsigned long DirStartCluster32;
unsigned char out[0x20];
///////////////////////////////////////////////////////////////////////////
unsigned char EnumMassDev(void)
{
unsigned int ReservedSectorsNum;
if(!SPC_Inquiry())
return FALSE;
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; //暫假設為512
if(!SPC_RequestSense())
return FALSE;
if(!SPC_TestUnit())
return FALSE;
if(!RBC_ReadCapacity())
return FALSE;
////////////////////////////////////////////////////
if(!RBC_Read(0x0,1,DBUF))
return FALSE;
//////////////////////////////////
if(DBUF[0]==0xeb||DBUF[0]==0xe9)
{
DeviceInfo.StartSector=0;
}
else
{
DeviceInfo.StartSector=LSwapINT32(DBUF[454],DBUF[455],DBUF[456],DBUF[457]);
}
///////////////////////////////////////////////////////
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;
out[4]=0x60;out[5]=0xa6;out[6]=0x24;out[7]=0xde;
out[8]=0x24;out[9]=0x00;out[10]=0x00;out[11]=0x00;
out[12]=0x80;out[13]=0x00;out[14]=06;
out[15]=SPC_CMD_INQUIRY;out[16]=0x00;out[17]=0x00;
out[18]=0x00;out[19]=0x00;out[20]=0x24;
////////////////////////////////
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(150);
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]=0x01;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;
//delay_dsp
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]=0x80;out[13]=0x00;out[14]=10;
out[9]=(unsigned char)((lout>>24)&0xff);
out[10]=(unsigned char)((lout>>16)&0xff);
out[11]=(unsigned char)((lout>>8)&0xff);
out[12]=(unsigned char)(lout&0xff);
/////////////////////////////////////
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(5); //test
if(!epBulkRcv(pBuffer,len*DeviceInfo.BPB_BytesPerSec))
return FALSE;
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;
out8]=(unsigned char)((lout>>24)&0xff);
out[9]=(unsigned char)((lout>>16)&0xff);
out[10]=(unsigned char)((lout>>8)&0xff);
out[11]=(unsigned char)(lout&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;
//////////////////////////////////////
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(15); //15test
if(!epBulkSend(pBuffer,DeviceInfo.BPB_BytesPerSec))
return FALSE;
DelayMs(10); //10test
if(!epBulkRcv(out,13))
return FALSE;
return TRUE;
}?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -