📄 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;
extern FLAGS bdata bFlags;
unsigned char idata out[0x20];
///////////////////////////////////////////////////////////////////////////
unsigned char EnumMassDev(void)
{
unsigned char i;
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;
////////////////////////////////////////////////////
for(i=0;i<0x1f;i++)
out[i]=0;
if(!ListDirve())
return FALSE;
ThisFile.bFileOpen=0;
///////////////////////////////////////////////////////
return TRUE;
}
unsigned char ListDirve(void)
{
unsigned char i,stop,j,extend;
unsigned long sector0,sector1,sector2,sectorp;
bFlags.bits.SLAVE_IS_ATTACHED=0;
DeviceInfo.DriveNum=0;
extend=0;
if(!RBC_Read(0x0,1,DBUF))
return FALSE;
//////////////////////Main Partain////////////////////////////////////////////
for(i=0;i<4;i++)
{
j=i*16;
if(DBUF[450+i*16]==0x0b||DBUF[450+i*16]==0x0c)//FAT32
{
DeviceInfo.par_FAT[DeviceInfo.DriveNum]=1;
DeviceInfo.StartSector[DeviceInfo.DriveNum]=LSwapINT32(DBUF[454+j],DBUF[455+j],DBUF[456+j],DBUF[457+j]);
DeviceInfo.DriveNum=DeviceInfo.DriveNum+1;
}
else if(DBUF[450+i*16]==0x04||DBUF[450+i*16]==0x06||DBUF[450+i*16]==0x0e)//FAT16
{
DeviceInfo.par_FAT[DeviceInfo.DriveNum]=0;
DeviceInfo.StartSector[DeviceInfo.DriveNum]=LSwapINT32(DBUF[454+j],DBUF[455+j],DBUF[456+j],DBUF[457+j]);
DeviceInfo.DriveNum=DeviceInfo.DriveNum+1;
}
else if(DBUF[450+i*16]==0x05||DBUF[450+i*16]==0x0f)//extend
{
extend=i;
DeviceInfo.StartSector[extend]=LSwapINT32(DBUF[454+j],DBUF[455+j],DBUF[456+j],DBUF[457+j]);
DeviceInfo.DriveNum=DeviceInfo.DriveNum+1;
}
}
//////////////////////////////扩展分区//////////////////////////////////////
if(extend)
{
stop=0;i=1;
sector0=DeviceInfo.StartSector[extend];
sectorp=sector0;
do{
if(!RBC_Read(sector0,1,DBUF))
return FALSE;
sector1=LSwapINT32(DBUF[454],DBUF[455],DBUF[456],DBUF[457]);
sector2=LSwapINT32(DBUF[470],DBUF[471],DBUF[472],DBUF[473]);
if(sector2==0||DeviceInfo.DriveNum>=MAX_par)
stop=1;
if(DBUF[450]==0x0b||DBUF[450]==0x0c)//FAT32
{
if(i==1)
{
DeviceInfo.par_FAT[extend]=1;
DeviceInfo.StartSector[extend]=sector0+sector1;
i=i+1;
}
else
{
DeviceInfo.StartSector[DeviceInfo.DriveNum]=sector0+sector1;
DeviceInfo.par_FAT[DeviceInfo.DriveNum]=1;
DeviceInfo.DriveNum=DeviceInfo.DriveNum+1;
}
}
else if(DBUF[450]==0x04||DBUF[450]==0x06||DBUF[450]==0x0e)//FAT16
{
if(i==1)
{
DeviceInfo.par_FAT[extend]=0;
DeviceInfo.StartSector[extend]=sector0+sector1;
i=i+1;
}
else
{
DeviceInfo.StartSector[DeviceInfo.DriveNum]=sector0+sector1;
DeviceInfo.par_FAT[DeviceInfo.DriveNum]=0;
DeviceInfo.DriveNum=DeviceInfo.DriveNum+1;
}
}
sector0=sectorp+sector2;
}while(!stop);
}
///////////////////////////////////////////////////////
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 *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(50);
if(!epBulkRcv(pBuffer,len*DeviceInfo.BPB_BytesPerSec))
return FALSE;
//DelayMs(10);
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;
//////////////////////////////////////
if(!epBulkSend(out,0x1f))
return FALSE;
DelayMs(30);
if(!epBulkSend(pBuffer,DeviceInfo.BPB_BytesPerSec))
return FALSE;
DelayMs(20);
if(!epBulkRcv(out,13))
return FALSE;
return TRUE;
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -