mainloop.c

D12 USB源代码 硬盘

				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
		    {
			    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)
					
					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
{
	D12SUSPD	= 0;
    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);

        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)	// 从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)
{
	INT16 c;
	c = *((INT16 xdata *)D12_data);  // read D12 for ATA_LByte
	*((INT8 xdata *)ATAREG4OUT_DATA) = c ;
    *((INT8 xdata *)ATAREG4OUT_DATA+1) = c >>8 ;
}


void MLsup_XferWordFrIDE2USB(void)
{
	INT16 c;
    c = *((INT16 xdata *)ATAREG4IN_DATA);
     *((INT8 xdata *)D12_data) = c;
	 *((INT8 xdata *)D12_data) = c>>8;
}