?? mainloop.c
字號:
{
Hal4Sys_D12CmdPortOutB( 0x04);// 選擇端點4
FlexByte = Hal4Sys_D12DataPortInB(); //讀取端點狀態
if(FlexByte_b0 == 0) // 端點為空退出
break;
Hal4Sys_D12CmdPortOutB( 0xF0); // 發讀D12數據指令
Hal4Sys_D12DataPortInB(); // 沒效數據
FlexByte = Hal4Sys_D12DataPortInB();// 讀取D12緩沖區數據長度
if(BOTXfer_atATA) //BOTXfer_atATA = Xfer_Space^5
MLsup_XferPktFrUSB2IDE();
else
if(BOTXfer_atRAM || BOTXfer_atROM)
MLsup_XferPktFrUSB2MEM(FlexByte);
BOTXfer_pdata += FlexByte; // 已傳輸數據地址指針
BOTXfer_wResidue -= FlexByte; // 沉余字節數
if(BOTXfer_wResidue == 0)
{
TPBulk_CSWHandler(); // Goto BOTFSMstate_CSWProc
}
}//BOTFSM_DATAOUT
while(BOTFSM_DataIn)//BOTFSM_DataIn = BOTFSMstate^2
{
Hal4Sys_D12CmdPortOutB( 0x05);// SelectEP BulkIn
FlexByte = Hal4Sys_D12DataPortInB();
if(FlexByte_b0 == 1) // BulkIn is full
break;
if(BOTXfer_atATA)
{
MLsup_XferPktFrIDE2USB(); //從IDE寫到USB
FlexByte = EP2_PACKET_SIZE; //EP2_PACKET_SIZE=64
}
else if(BOTXfer_atRAM || BOTXfer_atROM)
FlexByte = MLsup_XferPktFrMEM2USB(); //從MEMORY 寫到 USB
BOTXfer_pdata += FlexByte;
BOTXfer_wResidue -= FlexByte; //沉余字節數
if(BOTXfer_wResidue == 0)
{ TPBulk_CSWHandler();// Goto BOTFSMstate_CSWProc
BOTFSM_DataIn = 0 ;//*******
}
} // BOTFSM_DataIn
if(BOTFSM_CSW) //BOTFSM_CSW = BOTFSMstate^5
{
//Hal4D12_SetEndpointStatus(5,1); //Bulk-In設置端點5狀態為停止
Hal4Sys_D12CmdPortOutB( 0x05);// SelectEP BulkIn
FlexByte = Hal4Sys_D12DataPortInB();
if((FlexByte_b0==0)&&(FlexByte_b1==0)) // 如果緩沖區空開始傳輸
{
FlexByte = MLsup_XferPktFrMEM2USB(); // 返回已傳輸到USB字節數
BOTXfer_pdata += FlexByte; // 調整緩沖區指針
BOTXfer_wResidue -= FlexByte; // 沉余字節數
if(BOTXfer_wResidue == 0)
Hal4D12_ReadLastTransactionStatus(5);
BOTFSMstate = USBFSM4BOT_IDLE; // Goto BOTFSMstate_IDLE
}
}
}
//LowerIRQL();
}
}
void MLsup_DisconnectUSB(void) //斷開USB
{
//RaiseIRQL();
// Initialize D12 configuration
Hal4D12_SetMode(D12_NOLAZYCLOCK, D12_SETTOONE | D12_CLOCK_4M);
}
void MLsup_ConnectUSB(void) //聯接USB
{
// reset event flags
//RaiseIRQL();
// No DMA, No IRQ from EPI4 & EPI5
Hal4D12_SetDMA(0);
// Initialize D12 configuration
Hal4D12_SetMode(D12_NOLAZYCLOCK|D12_SOFTCONNECT, D12_SETTOONE | D12_CLOCK_4M);
}
void MLsup_ReconnectUSB(void) //重接USB
{
IOCLR = SUSP;
MLsup_DisconnectUSB();
// Make sure disconnect time > 2.5 uS
// LowerIRQL();
Hal4Sys_WaitInMS(100);
MLsup_ConnectUSB();
}
void MLsup_USBSetupTokenHandler(void)
{
D12BF_SetupOverwritten = 0;
DCPXfer_wResidue = 0;
tempvars4UsbReq.chars.c0 = Hal4D12_ReadEndpoint(0, sizeof(DEVICE_REQUEST),(INT8 *)(&(DCPDeviceRequest)));
if( tempvars4UsbReq.chars.c0 == sizeof(DEVICE_REQUEST) )
{
//DCPDeviceRequest.wValue = Hal4Sys_SwapINT16(DCPDeviceRequest.wValue);
//DCPDeviceRequest.wIndex = Hal4Sys_SwapINT16(DCPDeviceRequest.wIndex);
//DCPDeviceRequest.wLength = Hal4Sys_SwapINT16(DCPDeviceRequest.wLength);
DCPDeviceRequest.wValue = (DCPDeviceRequest.wValue);
DCPDeviceRequest.wIndex = (DCPDeviceRequest.wIndex);
DCPDeviceRequest.wLength = (DCPDeviceRequest.wLength);
if(DCPDeviceRequest.bmRequestType & USB_ENDPOINT_DIRECTION_MASK)//USB_ENDPOINT_DIRECTION_MASK=0x80
{
// get command
REQBF_DCPRequest_dir = 1; // REQBF_DCPRequest_dir = bFlags.value^3
}
else
{
// Set command without Data stage
// or
// Set command with Data Buffer
REQBF_DCPRequest_dir = 0;
}
if(DCPDeviceRequest.wIndex & USB_ENDPOINT_DIRECTION_MASK)//0x80
{
REQBF_DCPRequest_EPdir = 1;
}
else
{
REQBF_DCPRequest_EPdir = 0;
}
// 主機到設備標請求準
UsbReq_Recipient = DCPDeviceRequest.bmRequestType & USB_RECIPIENT;//0x1f
// 大容量類請求
UsbReq_Type = DCPDeviceRequest.bmRequestType & USB_REQUEST_TYPE_MASK;//0x60
UsbReq_Request = DCPDeviceRequest.bRequest & USB_REQUEST_MASK;// 0xff 請求類型
if ( REQBF_DCPRequest_dir || (DCPDeviceRequest.wLength == 0))
{
// For Get command via Control In
// For Set command without Data Stage via Control Out
// First of all, AckSetup to make it available for BUFFER fill in fifo
MLsup_AcknowledgeSETUP(); // A needle hole for Setup TK overwritten
if(D12BF_SetupOverwritten)
return;
}
REQBF_StallDCPRequest = 0; // has been cleared already!
if ( (UsbReq_Type == USB_STANDARD_REQUEST) && (UsbReq_Request<MAX_STD_REQUEST))//0x12
{
(*StandardDeviceRequest[UsbReq_Request])();
}
else if((UsbReq_Type == USB_CLASS_REQUEST))//0X20
{
UsbReq_Request = 0xFF - UsbReq_Request;
if(UsbReq_Request < MAX_CLASS_REQUEST)
(*ClassDeviceRequest[UsbReq_Request])();
}
/* else if((UsbReq_Type == USB_VENDOR_REQUEST) &&(UsbReq_Request<MAX_VENDOR_REQUEST))
{
(*VendorDeviceRequest[UsbReq_Request])();
}
*/
else
{
REQBF_StallDCPRequest = 1;
}
if(REQBF_StallDCPRequest)
{
MLsup_StallEP0();
}
else if ( (!REQBF_DCPRequest_dir) && (DCPDeviceRequest.wLength != 0))
{
// For Set command with Data Stage via Control Out
// First of all, AckSetup to make it available for Buffer Out Clearing
MLsup_AcknowledgeSETUP(); // A needle hole for Setup TK overwritten
}
}
else
{
MLsup_StallEP0();
}
}
void MLsup_AcknowledgeSETUP(void)
{
// Give a needle hole for Setup Overwritten as well as ISR
//if(!(IOPIN & USBINT))
//{
// usb_isr();
//}
// LowerIRQL();
// RaiseIRQL();
if(!D12BF_SetupOverwritten)
Hal4D12_AcknowledgeSETUP();
}
void MLsup_StallEP0(void)
{
// Give a needle hole for Setup Overwritten as well as ISR
// LowerIRQL();
// RaiseIRQL();
//if (!(IOPIN & USBINT))
//{
// usb_isr();
//}
if(!D12BF_SetupOverwritten)
{
DCPFSMstate = USBFSM4DCP_STALL;
Hal4D12_StallEP0();
}
}
void MLsup_XferPktFrUSB2MEM(INT8 Len) // 從D12讀取數據到MEMORY
{
TPBulksup_ReadFrBOEP(Len); // 批量讀取數據
}
INT8 MLsup_XferPktFrMEM2USB(void)
{
if(BOTXfer_wResidue > EP2_PACKET_SIZE )
return TPBulksup_WriteToBIEP(EP2_PACKET_SIZE);
else
return TPBulksup_WriteToBIEP((INT8)BOTXfer_wResidue);
}
void MLsup_XferPktFrUSB2IDE(void)
{
INT8 c0;
for(c0=EP2_PACKET_SIZE/2 ; c0!=0; c0--)
MLsup_XferWordFrUSB2IDE();
Hal4Sys_D12CmdPortOutB( 0xF2); // 清D12緩沖區
Hal4ATA_SectCntInBlk -- ;
if( Hal4ATA_SectCntInBlk == 0) //寫滿扇區
{
Hal4ATA_SectCntInBlk = ATADevExt_IDData.MaximumBlockTransfer << BITNUM4EP2PKT_PER_SECTOR;
// Hal4ATA_WaitOnBusyNDrq();
Hal4ATA_WaitOnBusy();
}
}
void MLsup_XferPktFrIDE2USB(void)
{
INT8 c0;
Hal4Sys_D12CmdPortOutB( 0xF0); // 發寫緩沖區指令
Hal4Sys_D12DataPortOutB(0); // 第一字節沒效總為0
Hal4Sys_D12DataPortOutB(EP2_PACKET_SIZE); // LO BYTE of Buffer Len
for(c0=EP2_PACKET_SIZE/2 ; c0!=0; c0--)
MLsup_XferWordFrIDE2USB(); //從IDE寫一個字(16位)到USB
Hal4Sys_D12CmdPortOutB( 0xFA); //使緩沖區有效
Hal4ATA_SectCntInBlk -- ;
if( Hal4ATA_SectCntInBlk == 0)
{
Hal4ATA_SectCntInBlk = ATADevExt_IDData.MaximumBlockTransfer << BITNUM4EP2PKT_PER_SECTOR;//傳送的最大扇區*每扇區的字節數
Hal4ATA_WaitOnBusy();
}
}
void MLsup_XferWordFrUSB2IDE(void)
{
uint16 c;
c = Hal4Sys_D12DataPortInB(); // read D12 for ATA_LByte
c |= (Hal4Sys_D12DataPortInB()<<8);
IDE_Write( IDE_DATA, c); // 字IDE一個字
}
void MLsup_XferWordFrIDE2USB(void)
{
uint16 c;
c = Hal4Sys_ATADataPortInW(); // 讀取IDE一個字
Hal4Sys_D12DataPortOutB( c );
Hal4Sys_D12DataPortOutB( c>>8);
}
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -