📄 tpbulk.c
字号:
#include "common.h"
#include "SL811.H"
#include "TPBULK.H"
#include "HAL.H"
#include "HPI.H"
#include "HPI32.H"
//////////////////////////////////
extern unsigned char xdata DBUF[BUFFER_LENGTH];
extern SYS_INFO_BLOCK xdata DeviceInfo;
extern FILE_INFO xdata ThisFile;
extern unsigned int xdata DirStartCluster;
extern unsigned long xdata DirStartCluster32;
unsigned char idata 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[510] != 0x55 || DBUF[511] != 0xaa) return FALSE;
//////////////////////////////////
if(DBUF[0]==0xeb||DBUF[0]==0xe9)
{
DeviceInfo.StartSector=0;
}
else
{
if(DBUF[446] != 0x80 && DBUF[446] != 0) return FALSE;
//DeviceInfo.StartSector=LSwapINT32(DBUF[454],DBUF[455],DBUF[456],DBUF[457]);
AssignLong(DeviceInfo.StartSector,DBUF[454],DBUF[455],DBUF[456],DBUF[457]);
}
///////////////////////////////////////////////////////
if(!RBC_Read(DeviceInfo.StartSector,1,DBUF))
return FALSE;
if(DBUF[510] != 0x55 || DBUF[511] != 0xaa) return FALSE;
// DeviceInfo.BPB_BytesPerSec=LSwapINT16(DBUF[11],DBUF[12]);
AssignInt(DeviceInfo.BPB_BytesPerSec,DBUF[11],DBUF[12]);
DeviceInfo.BPB_SecPerClus=DBUF[13];
// ReservedSectorsNum=LSwapINT16(DBUF[14],DBUF[15]);
AssignInt(ReservedSectorsNum,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')
{
AssignInt(DeviceInfo.BPB_RootEntCnt,DBUF[17],DBUF[18]);
DeviceInfo.BPB_RootEntCnt=(DeviceInfo.BPB_RootEntCnt)*32/DeviceInfo.BPB_BytesPerSec;
//DeviceInfo.BPB_TotSec32=LSwapINT32(DBUF[32],DBUF[33],DBUF[34],DBUF[35]);
AssignLong(DeviceInfo.BPB_TotSec32,DBUF[32],DBUF[33],DBUF[34],DBUF[35]);
//DeviceInfo.BPB_FATSz32=LSwapINT32(DBUF[36],DBUF[37],DBUF[38],DBUF[39]);
AssignLong(DeviceInfo.BPB_FATSz32,DBUF[36],DBUF[37],DBUF[38],DBUF[39]);
//DeviceInfo.RootStartCluster=LSwapINT32(DBUF[44],DBUF[45],DBUF[46],DBUF[47]);
AssignLong(DeviceInfo.RootStartCluster,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;
DeviceInfo.TotCluster=(DeviceInfo.BPB_TotSec32-ReservedSectorsNum-DeviceInfo.BPB_NumFATs*DeviceInfo.BPB_FATSz32-DeviceInfo.BPB_RootEntCnt)/DeviceInfo.BPB_SecPerClus;
DirStartCluster32=DeviceInfo.RootStartCluster;
DeviceInfo.FAT=1; //FAT16=0,FAT32=1;
}
else
{
//DeviceInfo.BPB_RootEntCnt=LSwapINT16(DBUF[17],DBUF[18]);
AssignInt(DeviceInfo.BPB_RootEntCnt,DBUF[17],DBUF[18]);
DeviceInfo.BPB_RootEntCnt=(DeviceInfo.BPB_RootEntCnt)*32/DeviceInfo.BPB_BytesPerSec;
//DeviceInfo.BPB_TotSec16=LSwapINT16(DBUF[19],DBUF[20]);
AssignLong(DeviceInfo.BPB_TotSec16,DBUF[19],DBUF[20],0,0);
if(DeviceInfo.BPB_TotSec16==0)
{AssignLong(DeviceInfo.BPB_TotSec16,DBUF[32],DBUF[33],DBUF[34],DBUF[35]);}
//DeviceInfo.BPB_FATSz16=LSwapINT16(DBUF[22],DBUF[23]);
AssignInt(DeviceInfo.BPB_FATSz16,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.TotCluster=(DeviceInfo.BPB_TotSec16-DeviceInfo.FirstDataSector+1)/DeviceInfo.BPB_SecPerClus+1;
DeviceInfo.TotCluster=(DeviceInfo.BPB_TotSec16-DeviceInfo.BPB_RootEntCnt-DeviceInfo.BPB_NumFATs*DeviceInfo.BPB_FATSz16-1)/DeviceInfo.BPB_SecPerClus;
if(DeviceInfo.TotCluster<4085) return FALSE; //FAT12 不被支持
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]=0x24;out[20]=0x00;
////////////////////////////////
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]=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;
//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 xdata *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)[3];
out[9]=((unsigned char *)&lout)[2];
out[10]=((unsigned char *)&lout)[1];
out[11]=((unsigned char *)&lout)[0];
out[12]=0x80;out[13]=0x00;out[14]=10;
/////////////////////////////////////
out[15]=RBC_CMD_READ10;out[16]=0x00;
out[17]=((unsigned char *)&lba)[0];
out[18]=((unsigned char *)&lba)[1];
out[19]=((unsigned char *)&lba)[2];
out[20]=((unsigned char *)&lba)[3];
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);
// if(!epBulkRcv(pBuffer,len*DeviceInfo.BPB_BytesPerSec))
// return FALSE;
lout=0;
while(!epBulkRcv(pBuffer,len*DeviceInfo.BPB_BytesPerSec)) if(++lout >10000) return FALSE;
if(!epBulkRcv(out,13))
return FALSE;
/////////////////////////////
return TRUE;
}
unsigned char RBC_Write(unsigned long lba,unsigned char len,unsigned char xdata *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)[3];
out[9]=((unsigned char *)&lout)[2];
out[10]=((unsigned char *)&lout)[1];
out[11]=((unsigned char *)&lout)[0];
out[12]=0x00;out[13]=0x00;out[14]=10;
/////////////////////////////////////
out[15]=RBC_CMD_WRITE10;
out[16]=0x00;
out[17]=((unsigned char *)&lba)[0];
out[18]=((unsigned char *)&lba)[1];
out[19]=((unsigned char *)&lba)[2];
out[20]=((unsigned char *)&lba)[3];
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(2);
if(!epBulkSend(pBuffer,len*DeviceInfo.BPB_BytesPerSec))
return FALSE;
// DelayMs(10);
// if(!epBulkRcv(out,13))
lout=0;
while(!epBulkRcv(out,13))
if(++lout>10000)
return FALSE;
return TRUE;
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -