📄 tpbulk.c
字号:
#include "DSP28_Device.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 char i;
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; //暂假设为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+j]==0x0b||DBUF[450+j]==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+j]==0x04||DBUF[450+j]==0x06||DBUF[450+j]==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+j]==0x05||DBUF[450+j]==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; //表示是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需要传输长度为0X24
out[12]=0x80; //传输方向
out[13]=0x00; //一般为0,当有多个逻辑单元时为指定的逻辑单元
out[14]=06; //本次要传输的CBW命令的长度
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(100); //300
if(!epBulkRcv(pBuffer,len*DeviceInfo.BPB_BytesPerSec))
return FALSE;
DelayMs(50); //300
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;
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -