mainloopb.c

用D12实现U盘的单片机程序

    		} // BOTFSM_DataIn

		    if(BOTFSM_CSW)	//BOTFSM_CSW = BOTFSMstate^5
		    {
		//			MCU_P1 = D12REG_ONLY;

			    Hal4Sys_D12CmdPortOutB( 0x05);// SelectEP  BulkIn
			    FlexByte = Hal4Sys_D12DataPortInB();
			    if(FlexByte_b0 == 0) // BulkIn is empty
			    {

				    FlexByte = MLsup_XferPktFrMEM2USB();

				    BOTXfer_pdata += FlexByte;
				    BOTXfer_wResidue -= FlexByte;
				    if(BOTXfer_wResidue == 0)
					    BOTFSMstate = USBFSM4BOT_IDLE; // Goto BOTFSMstate_IDLE

			    }
		   }

        }
 //   	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)
{

    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)
{

    ATA_DATABUS_LO = 0xFF; // Give up DataBus, MCU_P2 = 0xFF;

    Hal4Sys_D12CmdPortOutB( 0xF2); //clear Buffer

    Hal4ATA_SectCntInBlk -- ;
    if( Hal4ATA_SectCntInBlk == 0)
    {
        Hal4ATA_SectCntInBlk = ATADevExt_IDData.MaximumBlockTransfer << BITNUM4EP2PKT_PER_SECTOR;
  //      Hal4ATA_WaitOnBusyNDrq();
 //  while(ATA_IORDY!=1);
  		  Hal4ATA_WaitOnBusy();
     }

}
#else
void MLsup_XferPktFrUSB2IDE(void)
{
    INT8    c0;

    MCU_P1 = D12REG_ATAREG4OUT;

    for(c0=EP2_PACKET_SIZE/2 ; c0!=0; c0--)
        MLsup_XferWordFrUSB2IDE();

    //MCU_P1 = D12REG_ONLY;
    ATA_DATABUS_LO = 0xFF; // Give up DataBus, MCU_P2 = 0xFF;

    Hal4Sys_D12CmdPortOutB( 0xF2); //clear Buffer

    Hal4ATA_SectCntInBlk -- ;
    if( Hal4ATA_SectCntInBlk == 0)
    {
        Hal4ATA_SectCntInBlk = ATADevExt_IDData.MaximumBlockTransfer << BITNUM4EP2PKT_PER_SECTOR;
        Hal4ATA_WaitOnBusyNDrq();
    }

}
#endif

#ifdef MAX_SPEED
	//unsigned char c;
void MLsup_XferPktFrIDE2USB(void)
{
//unsigned char c;
//	if (Hal4ATA_WaitForDrq()==0)
//	{
    //Hal4Sys_WaitInUS(32000); OK value
//    Hal4Sys_WaitInUS(32000); //>25US
//	}

	Hal4Sys_D12CmdPortOutB( 0xF0);// Write Buffer
	Hal4Sys_D12DataPortOutB(0);// HI BYTE of Buffer Len
	Hal4Sys_D12DataPortOutB(EP2_PACKET_SIZE);// LO BYTE of Buffer Len


    //MCU_P1 = ATAREG4IN_DATA;


    //MCU_P1 = D12REG_ONLY;
    Hal4Sys_D12CmdPortOutB( 0xFA); //valid Buffer

    Hal4ATA_SectCntInBlk -- ;
    if( Hal4ATA_SectCntInBlk == 0)
    {
        Hal4ATA_SectCntInBlk = ATADevExt_IDData.MaximumBlockTransfer << BITNUM4EP2PKT_PER_SECTOR;
     //   Hal4ATA_WaitOnBusyNDrq();
     Hal4ATA_WaitOnBusy();
    }
}
#else
void MLsup_XferPktFrIDE2USB(void)
{

    INT8 c0;

	Hal4Sys_D12CmdPortOutB( 0xF0);// Write Buffer
	Hal4Sys_D12DataPortOutB(0);// HI BYTE of Buffer Len
	Hal4Sys_D12DataPortOutB(EP2_PACKET_SIZE);// LO BYTE of Buffer Len

    MCU_P1 = ATAREG4IN_DATA;

    for(c0=EP2_PACKET_SIZE/2 ; c0!=0; c0--)
        MLsup_XferWordFrIDE2USB();

    //MCU_P1 = D12REG_ONLY;
    Hal4Sys_D12CmdPortOutB( 0xFA); //valid Buffer

    Hal4ATA_SectCntInBlk -- ;
    if( Hal4ATA_SectCntInBlk == 0)
    {
        Hal4ATA_SectCntInBlk = ATADevExt_IDData.MaximumBlockTransfer << BITNUM4EP2PKT_PER_SECTOR;
        Hal4ATA_WaitOnBusyNDrq();
    }
}
#endif

#ifndef MAX_SPEED
void MLsup_XferWordFrUSB2IDE(void)
{
    D12RD_N = 0;
    ATA_DATABUS_LO = D12_DATABUS;
    D12RD_N = 1;

    ATA_CS0_N = 0;
    ATA_WR_N = 0;  //ATA_WR_N==D12RD_N
//    while(ATA_IORDY!=1);
    ATA_WR_N = 1;  //ATA_WR_N==D12RD_N
    ATA_CS0_N = 1;
}

void MLsup_XferWordFrIDE2USB(void)
{
    MCU_P1 = ATAREG4IN_DATA;

    ATA_RD_N = 0;
//    while(ATA_IORDY!=1);
    FlexByte = ATA_DATABUS_HI;
//    TempByte = ATA_DATABUS_LO;
    ATA_RD_N = 1;

    MCU_P1 = D12REG_ONLY;

    //Hal4Sys_D12DataPortOutB(TempByte);
//    D12_DATABUS = TempByte;
    D12WR_N = 0;
    D12WR_N = 1;

    //Hal4Sys_D12DataPortOutB(TempByte);
    D12_DATABUS = FlexByte;
    D12WR_N = 0;
    D12WR_N = 1;

    D12_DATABUS = 0xFF; // Give up DataBus
}
#endif