mainloop.c

ARM嵌入式系统软件开发实例(一) 里面含有很多UCOS教程和源码

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