📄 mainloop.c
字号:
}
}
}
// MCU_P1 = D12REG_ONLY;
LowerIRQL();
}
}
void MLsup_DisconnectUSB(void)
{
RaiseIRQL();
// Initialize D12 configuration
Hal4D12_SetMode(D12_NOLAZYCLOCK, D12_SETTOONE | D12_CLOCK_4M);
}
void MLsup_ConnectUSB(void)
{
// 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)
{
D12SUSPD = 0;
MLsup_DisconnectUSB();
// Make sure disconnect time > 2.5 uS
LowerIRQL();
Hal4Sys_WaitInMS(10);
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);
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)
{
REQBF_DCPRequest_EPdir = 1;
}
else
{
REQBF_DCPRequest_EPdir = 0;
}
// USBDeviceRequest_Handler();
UsbReq_Recipient = DCPDeviceRequest.bmRequestType & USB_RECIPIENT;
UsbReq_Type = DCPDeviceRequest.bmRequestType & USB_REQUEST_TYPE_MASK;
UsbReq_Request = DCPDeviceRequest.bRequest & USB_REQUEST_MASK;
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))
{
(*StandardDeviceRequest[UsbReq_Request])();
}
else if((UsbReq_Type == USB_CLASS_REQUEST))
{
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
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(!D12BF_SetupOverwritten)
{
DCPFSMstate = USBFSM4DCP_STALL;
Hal4D12_StallEP0();
}
}
void MLsup_XferPktFrUSB2MEM(INT8 Len)
{
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);
}
#ifdef MAX_SPEED
//unsigned char c;
void MLsup_XferPktFrUSB2IDE(void)
{
INT16 c;
// MCU_P1 = D12REG_ATAREG4OUT;
// --------- ------------ ---------
//D12_RD | | | |
// ----- -----
//
//
#if(EP2_PACKET_SIZE == 8)
#elif(EP2_PACKET_SIZE == 16)
// ==========================================================
#elif(EP2_PACKET_SIZE == 32)
// ========================================================
#elif(EP2_PACKET_SIZE == 64)
//MLsup_XferWordFrUSB2IDE(); //Word 0x00
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x01
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x02
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x03
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x04
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x05
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x06
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x07
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x08
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x09
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x0A
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x0B
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x0C
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x0D
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x0E
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x0F
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x10
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x11
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x12
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x13
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x14
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x15
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x16
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x17
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x18
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
//MLsup_XferWordFrUSB2IDE(); //Word 0x19
c = *((INT8 xdata *)D12_data); // read D12 for ATA_LByte
c += (*((INT8 xdata *)D12_data) ) <<8; // read D12 for ATA_HByte
*((INT16 xdata *)ATAREG4OUT_DATA) = c ;
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -