| 0,0 → 1,1034 |
|---|
| /******************** (C) COPYRIGHT 2008 STMicroelectronics ******************** |
| * File Name : usb_core.c |
| * Author : MCD Application Team |
| * Version : V4.0.0 |
| * Date : 09/29/2008 |
| * Description : Standard protocol processing (USB v2.0). |
| ******************************************************************************** |
| * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS |
| * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME. |
| * AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT, |
| * INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE |
| * CONTENT OF SUCH SOFTWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING |
| * INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS. |
| *******************************************************************************/ |
| |
| /* Includes ------------------------------------------------------------------*/ |
| /* Private typedef -----------------------------------------------------------*/ |
| /* Private define ------------------------------------------------------------*/ |
| /* Private macro -------------------------------------------------------------*/ |
| /* Private variables ---------------------------------------------------------*/ |
| /* Private function prototypes -----------------------------------------------*/ |
| /* Private functions ---------------------------------------------------------*/ |
| |
| /* Includes ------------------------------------------------------------------*/ |
| #include "usb_lib.h" |
| #include "usb_mem.h" |
| #include "usb_conf.h" |
| |
| /* Private typedef -----------------------------------------------------------*/ |
| /* Private define ------------------------------------------------------------*/ |
| #define ValBit(VAR,Place) (VAR & (1<<Place)) |
| #define SetBit(VAR,Place) (VAR |= (1<<Place)) |
| #define ClrBit(VAR,Place) (VAR &= ((1<<Place)^255)) |
| |
| #define Send0LengthData() { \ |
| _SetEPTxCount(ENDP0, 0); \ |
| vSetEPTxStatus(EP_TX_VALID); \ |
| } |
| |
| #define vSetEPRxStatus(st) (SaveRState = st) |
| #define vSetEPTxStatus(st) (SaveTState = st) |
| |
| #define USB_StatusIn() Send0LengthData() |
| #define USB_StatusOut() vSetEPRxStatus(EP_RX_VALID) |
| |
| #define StatusInfo0 StatusInfo.bw.bb1 /* Reverse bb0 & bb1 */ |
| #define StatusInfo1 StatusInfo.bw.bb0 |
| |
| /* Private macro -------------------------------------------------------------*/ |
| /* Private variables ---------------------------------------------------------*/ |
| u16_u8 StatusInfo; |
| bool Data_Mul_MaxPacketSize = FALSE; |
| /* Private function prototypes -----------------------------------------------*/ |
| static void DataStageOut(void); |
| static void DataStageIn(void); |
| static void NoData_Setup0(void); |
| static void Data_Setup0(void); |
| /* Private functions ---------------------------------------------------------*/ |
| |
| /******************************************************************************* |
| * Function Name : Standard_GetConfiguration. |
| * Description : Return the current configuration variable address. |
| * Input : Length - How many bytes are needed. |
| * Output : None. |
| * Return : Return 1 , if the request is invalid when "Length" is 0. |
| * Return "Buffer" if the "Length" is not 0. |
| *******************************************************************************/ |
| u8 *Standard_GetConfiguration(u16 Length) |
| { |
| if (Length == 0) |
| { |
| pInformation->Ctrl_Info.Usb_wLength = |
| sizeof(pInformation->Current_Configuration); |
| |
| return 0; |
| } |
| pUser_Standard_Requests->User_GetConfiguration(); |
| return (u8 *)&pInformation->Current_Configuration; |
| } |
| |
| /******************************************************************************* |
| * Function Name : Standard_SetConfiguration. |
| * Description : This routine is called to set the configuration value |
| * Then each class should configure device themself. |
| * Input : None. |
| * Output : None. |
| * Return : Return USB_SUCCESS, if the request is performed. |
| * Return USB_UNSUPPORT, if the request is invalid. |
| *******************************************************************************/ |
| RESULT Standard_SetConfiguration(void) |
| { |
| if (pInformation->USBwValue0 <= Device_Table.Total_Configuration |
| && pInformation->USBwValue1 == 0 && pInformation->USBwIndex == 0) |
| /*call Back usb spec 2.0*/ |
| { |
| pInformation->Current_Configuration = pInformation->USBwValue0; |
| pUser_Standard_Requests->User_SetConfiguration(); |
| return USB_SUCCESS; |
| } |
| else |
| { |
| return USB_UNSUPPORT; |
| } |
| } |
| |
| /******************************************************************************* |
| * Function Name : Standard_GetInterface. |
| * Description : Return the Alternate Setting of the current interface. |
| * Input : Length - How many bytes are needed. |
| * Output : None. |
| * Return : Return 0, if the request is invalid when "Length" is 0. |
| * Return "Buffer" if the "Length" is not 0. |
| *******************************************************************************/ |
| u8 *Standard_GetInterface(u16 Length) |
| { |
| if (Length == 0) |
| { |
| pInformation->Ctrl_Info.Usb_wLength = |
| sizeof(pInformation->Current_AlternateSetting); |
| return 0; |
| } |
| pUser_Standard_Requests->User_GetInterface(); |
| return (u8 *)&pInformation->Current_AlternateSetting; |
| } |
| |
| /******************************************************************************* |
| * Function Name : Standard_SetInterface. |
| * Description : This routine is called to set the interface. |
| * Then each class should configure the interface them self. |
| * Input : None. |
| * Output : None. |
| * Return : - Return USB_SUCCESS, if the request is performed. |
| * - Return USB_UNSUPPORT, if the request is invalid. |
| *******************************************************************************/ |
| RESULT Standard_SetInterface(void) |
| { |
| RESULT Re; |
| /*Test if the specified Interface and Alternate Setting are supported by |
| the application Firmware*/ |
| Re = (*pProperty->Class_Get_Interface_Setting)(pInformation->USBwIndex0, |
| pInformation->USBwValue0); |
| |
| if (pInformation->Current_Configuration != 0 ) |
| { |
| if (Re != USB_SUCCESS || pInformation->USBwIndex1 != 0 |
| || pInformation->USBwValue1 != 0) |
| { |
| return USB_UNSUPPORT; |
| } |
| else if (Re == USB_SUCCESS) |
| { |
| pUser_Standard_Requests->User_SetInterface(); |
| pInformation->Current_Interface = pInformation->USBwIndex0; |
| pInformation->Current_AlternateSetting = pInformation->USBwValue0; |
| return USB_SUCCESS; |
| } |
| } |
| return USB_UNSUPPORT; |
| } |
| |
| /******************************************************************************* |
| * Function Name : Standard_GetStatus. |
| * Description : Copy the device request data to "StatusInfo buffer". |
| * Input : - Length - How many bytes are needed. |
| * Output : None. |
| * Return : Return 0, if the request is at end of data block, |
| * or is invalid when "Length" is 0. |
| *******************************************************************************/ |
| u8 *Standard_GetStatus(u16 Length) |
| { |
| if (Length == 0) |
| { |
| pInformation->Ctrl_Info.Usb_wLength = 2; |
| return 0; |
| } |
| |
| StatusInfo.w = 0; |
| /* Reset Status Information */ |
| |
| if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) |
| { |
| /*Get Device Status */ |
| u8 Feature = pInformation->Current_Feature; |
| |
| /* Remote Wakeup enabled */ |
| if (ValBit(Feature, 5)) |
| { |
| SetBit(StatusInfo0, 1); |
| } |
| |
| /* Bus-powered */ |
| if (ValBit(Feature, 6)) |
| { |
| ClrBit(StatusInfo0, 0); |
| } |
| else /* Self-powered */ |
| { |
| SetBit(StatusInfo0, 0); |
| } |
| } |
| /*Interface Status*/ |
| else if (Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT)) |
| { |
| return (u8 *)&StatusInfo; |
| } |
| /*Get EndPoint Status*/ |
| else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT)) |
| { |
| u8 Related_Endpoint; |
| u8 wIndex0 = pInformation->USBwIndex0; |
| |
| Related_Endpoint = (wIndex0 & 0x0f); |
| if (ValBit(wIndex0, 7)) |
| { |
| /* IN endpoint */ |
| if (_GetTxStallStatus(Related_Endpoint)) |
| { |
| SetBit(StatusInfo0, 0); /* IN Endpoint stalled */ |
| } |
| } |
| else |
| { |
| /* OUT endpoint */ |
| if (_GetRxStallStatus(Related_Endpoint)) |
| { |
| SetBit(StatusInfo0, 0); /* OUT Endpoint stalled */ |
| } |
| } |
| |
| } |
| else |
| { |
| return NULL; |
| } |
| pUser_Standard_Requests->User_GetStatus(); |
| return (u8 *)&StatusInfo; |
| } |
| |
| /******************************************************************************* |
| * Function Name : Standard_ClearFeature. |
| * Description : Clear or disable a specific feature. |
| * Input : None. |
| * Output : None. |
| * Return : - Return USB_SUCCESS, if the request is performed. |
| * - Return USB_UNSUPPORT, if the request is invalid. |
| *******************************************************************************/ |
| RESULT Standard_ClearFeature(void) |
| { |
| |
| u32 Type_Rec = Type_Recipient; |
| u32 Status; |
| |
| |
| if (Type_Rec == (STANDARD_REQUEST | DEVICE_RECIPIENT)) |
| {/*Device Clear Feature*/ |
| ClrBit(pInformation->Current_Feature, 5); |
| pUser_Standard_Requests->User_ClearFeature(); |
| return USB_SUCCESS; |
| } |
| else if (Type_Rec == (STANDARD_REQUEST | ENDPOINT_RECIPIENT)) |
| {/*EndPoint Clear Feature*/ |
| DEVICE* pDev; |
| u32 Related_Endpoint; |
| u32 wIndex0; |
| u32 rEP; |
| |
| if (pInformation->USBwValue != ENDPOINT_STALL |
| || pInformation->USBwIndex1 != 0) |
| { |
| return USB_UNSUPPORT; |
| } |
| |
| pDev = &Device_Table; |
| wIndex0 = pInformation->USBwIndex0; |
| rEP = wIndex0 & ~0x80; |
| Related_Endpoint = ENDP0 + rEP; |
| |
| if (ValBit(pInformation->USBwIndex0, 7)) |
| { /*Get Status of endpoint & stall the request if the related_ENdpoint is |
| Disabled*/ |
| Status = _GetEPTxStatus(Related_Endpoint); |
| } |
| else |
| { |
| Status = _GetEPRxStatus(Related_Endpoint); |
| } |
| |
| if (rEP >= pDev->Total_Endpoint || Status == 0 |
| || pInformation->Current_Configuration == 0) |
| { |
| return USB_UNSUPPORT; |
| } |
| |
| |
| if (wIndex0 & 0x80) |
| { /* IN endpoint */ |
| if (_GetTxStallStatus(Related_Endpoint )) |
| { |
| ClearDTOG_TX(Related_Endpoint); |
| SetEPTxStatus(Related_Endpoint, EP_TX_VALID); |
| } |
| } |
| else |
| { /* OUT endpoint */ |
| if (_GetRxStallStatus(Related_Endpoint)) |
| { |
| if (Related_Endpoint == ENDP0) |
| { |
| /* After clear the STALL, enable the default endpoint receiver */ |
| SetEPRxCount(Related_Endpoint, Device_Property.MaxPacketSize); |
| _SetEPRxStatus(Related_Endpoint, EP_RX_VALID); |
| } |
| else |
| { |
| ClearDTOG_RX(Related_Endpoint); |
| _SetEPRxStatus(Related_Endpoint, EP_RX_VALID); |
| } |
| } |
| } |
| pUser_Standard_Requests->User_ClearFeature(); |
| return USB_SUCCESS; |
| } |
| |
| return USB_UNSUPPORT; |
| } |
| |
| /******************************************************************************* |
| * Function Name : Standard_SetEndPointFeature |
| * Description : Set or enable a specific feature of EndPoint |
| * Input : None. |
| * Output : None. |
| * Return : - Return USB_SUCCESS, if the request is performed. |
| * - Return USB_UNSUPPORT, if the request is invalid. |
| *******************************************************************************/ |
| RESULT Standard_SetEndPointFeature(void) |
| { |
| u32 wIndex0; |
| u32 Related_Endpoint; |
| u32 rEP; |
| u32 Status; |
| |
| wIndex0 = pInformation->USBwIndex0; |
| rEP = wIndex0 & ~0x80; |
| Related_Endpoint = ENDP0 + rEP; |
| |
| if (ValBit(pInformation->USBwIndex0, 7)) |
| { /* get Status of endpoint & stall the request if the related_ENdpoint is |
| Disabled*/ |
| Status = _GetEPTxStatus(Related_Endpoint); |
| } |
| else |
| { |
| Status = _GetEPRxStatus(Related_Endpoint); |
| } |
| if (Related_Endpoint >= Device_Table.Total_Endpoint |
| || pInformation->USBwValue != 0 || Status == 0 |
| || pInformation->Current_Configuration == 0) |
| { |
| return USB_UNSUPPORT; |
| } |
| else |
| { |
| if (wIndex0 & 0x80) |
| { /* IN endpoint */ |
| _SetEPTxStatus(Related_Endpoint, EP_TX_STALL); |
| } |
| |
| else |
| { /* OUT endpoint */ |
| _SetEPRxStatus(Related_Endpoint, EP_RX_STALL); |
| } |
| } |
| pUser_Standard_Requests->User_SetEndPointFeature(); |
| return USB_SUCCESS; |
| } |
| |
| /******************************************************************************* |
| * Function Name : Standard_SetDeviceFeature. |
| * Description : Set or enable a specific feature of Device. |
| * Input : None. |
| * Output : None. |
| * Return : - Return USB_SUCCESS, if the request is performed. |
| * - Return USB_UNSUPPORT, if the request is invalid. |
| *******************************************************************************/ |
| RESULT Standard_SetDeviceFeature(void) |
| { |
| SetBit(pInformation->Current_Feature, 5); |
| pUser_Standard_Requests->User_SetDeviceFeature(); |
| return USB_SUCCESS; |
| |
| } |
| |
| /******************************************************************************* |
| * Function Name : Standard_GetDescriptorData. |
| * Description : Standard_GetDescriptorData is used for descriptors transfer. |
| * : This routine is used for the descriptors resident in Flash |
| * or RAM |
| * pDesc can be in either Flash or RAM |
| * The purpose of this routine is to have a versatile way to |
| * response descriptors request. It allows user to generate |
| * certain descriptors with software or read descriptors from |
| * external storage part by part. |
| * Input : - Length - Length of the data in this transfer. |
| * - pDesc - A pointer points to descriptor struct. |
| * The structure gives the initial address of the descriptor and |
| * its original size. |
| * Output : None. |
| * Return : Address of a part of the descriptor pointed by the Usb_ |
| * wOffset The buffer pointed by this address contains at least |
| * Length bytes. |
| *******************************************************************************/ |
| u8 *Standard_GetDescriptorData(u16 Length, ONE_DESCRIPTOR *pDesc) |
| { |
| u32 wOffset; |
| |
| wOffset = pInformation->Ctrl_Info.Usb_wOffset; |
| if (Length == 0) |
| { |
| pInformation->Ctrl_Info.Usb_wLength = pDesc->Descriptor_Size - wOffset; |
| return 0; |
| } |
| |
| return pDesc->Descriptor + wOffset; |
| } |
| |
| /******************************************************************************* |
| * Function Name : DataStageOut. |
| * Description : Data stage of a Control Write Transfer. |
| * Input : None. |
| * Output : None. |
| * Return : None. |
| *******************************************************************************/ |
| void DataStageOut(void) |
| { |
| ENDPOINT_INFO *pEPinfo = &pInformation->Ctrl_Info; |
| u32 save_rLength; |
| |
| save_rLength = pEPinfo->Usb_rLength; |
| |
| if (pEPinfo->CopyData && save_rLength) |
| { |
| u8 *Buffer; |
| u32 Length; |
| |
| Length = pEPinfo->PacketSize; |
| if (Length > save_rLength) |
| { |
| Length = save_rLength; |
| } |
| |
| Buffer = (*pEPinfo->CopyData)(Length); |
| pEPinfo->Usb_rLength -= Length; |
| pEPinfo->Usb_rOffset += Length; |
| |
| PMAToUserBufferCopy(Buffer, GetEPRxAddr(ENDP0), Length); |
| } |
| |
| if (pEPinfo->Usb_rLength != 0) |
| { |
| vSetEPRxStatus(EP_RX_VALID);/* re-enable for next data reception */ |
| SetEPTxCount(ENDP0, 0); |
| vSetEPTxStatus(EP_TX_VALID);/* Expect the host to abort the data OUT stage */ |
| } |
| /* Set the next State*/ |
| if (pEPinfo->Usb_rLength >= pEPinfo->PacketSize) |
| { |
| pInformation->ControlState = OUT_DATA; |
| } |
| else |
| { |
| if (pEPinfo->Usb_rLength > 0) |
| { |
| pInformation->ControlState = LAST_OUT_DATA; |
| } |
| else if (pEPinfo->Usb_rLength == 0) |
| { |
| pInformation->ControlState = WAIT_STATUS_IN; |
| USB_StatusIn(); |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * Function Name : DataStageIn. |
| * Description : Data stage of a Control Read Transfer. |
| * Input : None. |
| * Output : None. |
| * Return : None. |
| *******************************************************************************/ |
| void DataStageIn(void) |
| { |
| ENDPOINT_INFO *pEPinfo = &pInformation->Ctrl_Info; |
| u32 save_wLength = pEPinfo->Usb_wLength; |
| u32 ControlState = pInformation->ControlState; |
| |
| u8 *DataBuffer; |
| u32 Length; |
| |
| if ((save_wLength == 0) && (ControlState == LAST_IN_DATA)) |
| { |
| if(Data_Mul_MaxPacketSize == TRUE) |
| { |
| /* No more data to send and empty packet */ |
| Send0LengthData(); |
| ControlState = LAST_IN_DATA; |
| Data_Mul_MaxPacketSize = FALSE; |
| } |
| else |
| { |
| /* No more data to send so STALL the TX Status*/ |
| ControlState = WAIT_STATUS_OUT; |
| vSetEPTxStatus(EP_TX_STALL); |
| } |
| |
| goto Expect_Status_Out; |
| } |
| |
| Length = pEPinfo->PacketSize; |
| ControlState = (save_wLength <= Length) ? LAST_IN_DATA : IN_DATA; |
| |
| if (Length > save_wLength) |
| { |
| Length = save_wLength; |
| } |
| |
| DataBuffer = (*pEPinfo->CopyData)(Length); |
| |
| UserToPMABufferCopy(DataBuffer, GetEPTxAddr(ENDP0), Length); |
| |
| SetEPTxCount(ENDP0, Length); |
| |
| pEPinfo->Usb_wLength -= Length; |
| pEPinfo->Usb_wOffset += Length; |
| vSetEPTxStatus(EP_TX_VALID); |
| |
| USB_StatusOut();/* Expect the host to abort the data IN stage */ |
| |
| Expect_Status_Out: |
| pInformation->ControlState = ControlState; |
| } |
| /******************************************************************************* |
| * Function Name : NoData_Setup0. |
| * Description : Proceed the processing of setup request without data stage. |
| * Input : None. |
| * Output : None. |
| * Return : None. |
| *******************************************************************************/ |
| void NoData_Setup0(void) |
| { |
| RESULT Result = USB_UNSUPPORT; |
| u32 RequestNo = pInformation->USBbRequest; |
| u32 ControlState; |
| |
| if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) |
| {/* Device Request*/ |
| |
| /* SET_CONFIGURATION*/ |
| if (RequestNo == SET_CONFIGURATION) |
| { |
| Result = Standard_SetConfiguration(); |
| } |
| |
| /*SET ADDRESS*/ |
| else if (RequestNo == SET_ADDRESS) |
| { |
| if (pInformation->USBwValue0 > 127 || pInformation->USBwValue1 != 0 |
| || pInformation->USBwIndex != 0 |
| || pInformation->Current_Configuration != 0) |
| /* Device Address should be 127 or less -> call Back spec USB 2.0*/ |
| { |
| ControlState = STALLED; |
| goto exit_NoData_Setup0; |
| } |
| else |
| { |
| Result = USB_SUCCESS; |
| } |
| } |
| /*SET FEATURE for Device*/ |
| else if (RequestNo == SET_FEATURE) |
| { |
| if (pInformation->USBwValue0 == DEVICE_REMOTE_WAKEUP |
| && pInformation->USBwIndex == 0 |
| && ValBit(pInformation->Current_Feature, 5)) |
| { |
| Result = Standard_SetDeviceFeature(); |
| } |
| else |
| { |
| Result = USB_UNSUPPORT; |
| } |
| } |
| /*Clear FEATURE for Device */ |
| else if (RequestNo == CLEAR_FEATURE) |
| { |
| if (pInformation->USBwValue0 == DEVICE_REMOTE_WAKEUP |
| && pInformation->USBwIndex == 0 |
| && ValBit(pInformation->Current_Feature, 5)) |
| { |
| Result = Standard_ClearFeature(); |
| } |
| else |
| { |
| Result = USB_UNSUPPORT; |
| } |
| } |
| |
| } |
| |
| /* Interface Request*/ |
| |
| else if (Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT)) |
| { |
| |
| /*SET INTERFACE*/ |
| if (RequestNo == SET_INTERFACE) |
| { |
| Result = Standard_SetInterface(); |
| } |
| } |
| |
| |
| /* EndPoint Request*/ |
| |
| else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT)) |
| { |
| /*CLEAR FEATURE for EndPoint*/ |
| if (RequestNo == CLEAR_FEATURE) |
| { |
| Result = Standard_ClearFeature(); |
| } |
| /* SET FEATURE for EndPoint*/ |
| else if (RequestNo == SET_FEATURE) |
| { |
| Result = Standard_SetEndPointFeature(); |
| } |
| } |
| else |
| { |
| Result = USB_UNSUPPORT; |
| } |
| |
| |
| if (Result != USB_SUCCESS) |
| { |
| Result = (*pProperty->Class_NoData_Setup)(RequestNo); |
| if (Result == USB_NOT_READY) |
| { |
| ControlState = PAUSE; |
| goto exit_NoData_Setup0; |
| } |
| } |
| |
| if (Result != USB_SUCCESS) |
| { |
| ControlState = STALLED; |
| goto exit_NoData_Setup0; |
| } |
| |
| ControlState = WAIT_STATUS_IN;/* After no data stage SETUP */ |
| |
| USB_StatusIn(); |
| |
| exit_NoData_Setup0: |
| pInformation->ControlState = ControlState; |
| return; |
| } |
| |
| |
| /******************************************************************************* |
| * Function Name : Data_Setup0. |
| * Description : Proceed the processing of setup request with data stage. |
| * Input : None. |
| * Output : None. |
| * Return : None. |
| *******************************************************************************/ |
| void Data_Setup0(void) |
| { |
| u8 *(*CopyRoutine)(u16); |
| RESULT Result; |
| u32 Request_No = pInformation->USBbRequest; |
| |
| u32 Related_Endpoint, Reserved; |
| u32 wOffset, Status; |
| |
| |
| |
| CopyRoutine = NULL; |
| wOffset = 0; |
| |
| if (Request_No == GET_DESCRIPTOR) |
| { |
| if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) |
| { |
| u8 wValue1 = pInformation->USBwValue1; |
| if (wValue1 == DEVICE_DESCRIPTOR) |
| { |
| CopyRoutine = pProperty->GetDeviceDescriptor; |
| } |
| else if (wValue1 == CONFIG_DESCRIPTOR) |
| { |
| CopyRoutine = pProperty->GetConfigDescriptor; |
| } |
| else if (wValue1 == STRING_DESCRIPTOR) |
| { |
| CopyRoutine = pProperty->GetStringDescriptor; |
| } /* End of GET_DESCRIPTOR */ |
| } |
| } |
| |
| /*GET STATUS*/ |
| else if ((Request_No == GET_STATUS) && (pInformation->USBwValue == 0) |
| && (pInformation->USBwLength == 0x0002) |
| && (pInformation->USBwIndex1 == 0)) |
| { |
| /* GET STATUS for Device*/ |
| if ((Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) |
| && (pInformation->USBwIndex == 0)) |
| { |
| CopyRoutine = Standard_GetStatus; |
| } |
| |
| /* GET STATUS for Interface*/ |
| else if (Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT)) |
| { |
| if (((*pProperty->Class_Get_Interface_Setting)(pInformation->USBwIndex0, 0) == USB_SUCCESS) |
| && (pInformation->Current_Configuration != 0)) |
| { |
| CopyRoutine = Standard_GetStatus; |
| } |
| } |
| |
| /* GET STATUS for EndPoint*/ |
| else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT)) |
| { |
| Related_Endpoint = (pInformation->USBwIndex0 & 0x0f); |
| Reserved = pInformation->USBwIndex0 & 0x70; |
| |
| if (ValBit(pInformation->USBwIndex0, 7)) |
| { |
| /*Get Status of endpoint & stall the request if the related_ENdpoint |
| is Disabled*/ |
| Status = _GetEPTxStatus(Related_Endpoint); |
| } |
| else |
| { |
| Status = _GetEPRxStatus(Related_Endpoint); |
| } |
| |
| if ((Related_Endpoint < Device_Table.Total_Endpoint) && (Reserved == 0) |
| && (Status != 0)) |
| { |
| CopyRoutine = Standard_GetStatus; |
| } |
| } |
| |
| } |
| |
| /*GET CONFIGURATION*/ |
| else if (Request_No == GET_CONFIGURATION) |
| { |
| if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) |
| { |
| CopyRoutine = Standard_GetConfiguration; |
| } |
| } |
| /*GET INTERFACE*/ |
| else if (Request_No == GET_INTERFACE) |
| { |
| if ((Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT)) |
| && (pInformation->Current_Configuration != 0) && (pInformation->USBwValue == 0) |
| && (pInformation->USBwIndex1 == 0) && (pInformation->USBwLength == 0x0001) |
| && ((*pProperty->Class_Get_Interface_Setting)(pInformation->USBwIndex0, 0) == USB_SUCCESS)) |
| { |
| CopyRoutine = Standard_GetInterface; |
| } |
| |
| } |
| |
| if (CopyRoutine) |
| { |
| pInformation->Ctrl_Info.Usb_wOffset = wOffset; |
| pInformation->Ctrl_Info.CopyData = CopyRoutine; |
| /* sb in the original the cast to word was directly */ |
| /* now the cast is made step by step */ |
| (*CopyRoutine)(0); |
| Result = USB_SUCCESS; |
| } |
| else |
| { |
| Result = (*pProperty->Class_Data_Setup)(pInformation->USBbRequest); |
| if (Result == USB_NOT_READY) |
| { |
| pInformation->ControlState = PAUSE; |
| return; |
| } |
| } |
| |
| if (pInformation->Ctrl_Info.Usb_wLength == 0xFFFF) |
| { |
| /* Data is not ready, wait it */ |
| pInformation->ControlState = PAUSE; |
| return; |
| } |
| if ((Result == USB_UNSUPPORT) || (pInformation->Ctrl_Info.Usb_wLength == 0)) |
| { |
| /* Unsupported request */ |
| pInformation->ControlState = STALLED; |
| return; |
| } |
| |
| |
| if (ValBit(pInformation->USBbmRequestType, 7)) |
| { |
| /* Device ==> Host */ |
| vu32 wLength = pInformation->USBwLength; |
| |
| /* Restrict the data length to be the one host asks */ |
| if (pInformation->Ctrl_Info.Usb_wLength > wLength) |
| { |
| pInformation->Ctrl_Info.Usb_wLength = wLength; |
| } |
| |
| else if (pInformation->Ctrl_Info.Usb_wLength < pInformation->USBwLength) |
| { |
| if (pInformation->Ctrl_Info.Usb_wLength < pProperty->MaxPacketSize) |
| { |
| Data_Mul_MaxPacketSize = FALSE; |
| } |
| else if ((pInformation->Ctrl_Info.Usb_wLength % pProperty->MaxPacketSize) == 0) |
| { |
| Data_Mul_MaxPacketSize = TRUE; |
| } |
| } |
| |
| pInformation->Ctrl_Info.PacketSize = pProperty->MaxPacketSize; |
| DataStageIn(); |
| } |
| else |
| { |
| pInformation->ControlState = OUT_DATA; |
| vSetEPRxStatus(EP_RX_VALID); /* enable for next data reception */ |
| } |
| |
| return; |
| } |
| |
| /******************************************************************************* |
| * Function Name : Setup0_Process |
| * Description : Get the device request data and dispatch to individual process. |
| * Input : None. |
| * Output : None. |
| * Return : Post0_Process. |
| *******************************************************************************/ |
| u8 Setup0_Process(void) |
| { |
| #ifdef STR7xx /* STR7xx family*/ |
| union { |
| u8* b; |
| u16* w; |
| } pBuf; |
| pBuf.b = PMAAddr + (u8 *)(_GetEPRxAddr(ENDP0) * 2); /* *2 for 32 bits addr */ |
| |
| if (pInformation->ControlState != PAUSE) |
| { |
| pInformation->USBbmRequestType = *pBuf.b++; /* bmRequestType */ |
| pInformation->USBbRequest = *pBuf.b++; /* bRequest */ |
| pBuf.w++; /* word not accessed because of 32 bits addressing */ |
| pInformation->USBwValue = ByteSwap(*pBuf.w++); /* wValue */ |
| pBuf.w++; /* word not accessed because of 32 bits addressing */ |
| pInformation->USBwIndex = ByteSwap(*pBuf.w++); /* wIndex */ |
| pBuf.w++; /* word not accessed because of 32 bits addressing */ |
| pInformation->USBwLength = *pBuf.w; /* wLength */ |
| } |
| #endif/* End of STR7xx family*/ |
| |
| #ifdef STR91x /* STR91x family*/ |
| u16* pBuf; |
| |
| pBuf = (u16 *)(GetEPRxAddr(ENDP0) + PMAAddr); |
| if (pInformation->ControlState != PAUSE) |
| { |
| pInformation->USBbmRequestType = (*pBuf) & 0xFF; /* bmRequestType */ |
| pInformation->USBbRequest = ((*pBuf) & 0xFF00) >> 8; /* bRequest */ |
| pInformation->USBwValue = ByteSwap(*(pBuf + 1)); /* wValue */ |
| pInformation->USBwIndex = ByteSwap(*(pBuf + 2)); /* wIndex */ |
| pInformation->USBwLength = *(pBuf + 3); /* wLength */ |
| } |
| #endif /* End of STR91x family*/ |
| pInformation->ControlState = SETTING_UP; |
| if (pInformation->USBwLength == 0) |
| { |
| /* Setup with no data stage */ |
| NoData_Setup0(); |
| } |
| else |
| { |
| /* Setup with data stage */ |
| Data_Setup0(); |
| } |
| return Post0_Process(); |
| } |
| |
| /******************************************************************************* |
| * Function Name : In0_Process |
| * Description : Process the IN token on all default endpoint. |
| * Input : None. |
| * Output : None. |
| * Return : Post0_Process. |
| *******************************************************************************/ |
| u8 In0_Process(void) |
| { |
| u32 ControlState = pInformation->ControlState; |
| |
| if ((ControlState == IN_DATA) || (ControlState == LAST_IN_DATA)) |
| { |
| DataStageIn(); |
| ControlState = pInformation->ControlState; |
| /* may be changed outside the function */ |
| } |
| else if (ControlState == WAIT_STATUS_IN) |
| { |
| if (pInformation->USBbRequest == SET_ADDRESS && |
| Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT) ) |
| { |
| SetDeviceAddress(pInformation->USBwValue0); |
| pUser_Standard_Requests->User_SetDeviceAddress(); |
| } |
| (*pProperty->Process_Status_IN)(); |
| ControlState = STALLED; |
| } |
| else |
| { |
| ControlState = STALLED; |
| } |
| |
| pInformation->ControlState = ControlState; |
| |
| return Post0_Process(); |
| } |
| |
| /******************************************************************************* |
| * Function Name : Out0_Process |
| * Description : Process the OUT token on all default endpoint. |
| * Input : None. |
| * Output : None. |
| * Return : Post0_Process. |
| *******************************************************************************/ |
| u8 Out0_Process(void) |
| { |
| u32 ControlState = pInformation->ControlState; |
| |
| if ((ControlState == OUT_DATA) || (ControlState == LAST_OUT_DATA)) |
| { |
| DataStageOut(); |
| ControlState = pInformation->ControlState; |
| /* may be changed outside the function */ |
| } |
| else if (ControlState == WAIT_STATUS_OUT) |
| { |
| (*pProperty->Process_Status_OUT)(); |
| ControlState = STALLED; |
| } |
| else if ((ControlState == IN_DATA) || (ControlState == LAST_IN_DATA)) |
| { |
| /* host aborts the transfer before finish */ |
| ControlState = STALLED; |
| } |
| /* Unexpect state, STALL the endpoint */ |
| else |
| { |
| ControlState = STALLED; |
| } |
| |
| pInformation->ControlState = ControlState; |
| |
| return Post0_Process(); |
| } /* Out0_Process */ |
| |
| /******************************************************************************* |
| * Function Name : Post0_Process |
| * Description : Stall the Endpoint 0 in case of error. |
| * Input : None. |
| * Output : None. |
| * Return : - 0 if the control State is in PAUSE |
| * - 1 if not. |
| *******************************************************************************/ |
| u8 Post0_Process(void) |
| { |
| SetEPRxCount(ENDP0, Device_Property.MaxPacketSize); |
| |
| if (pInformation->ControlState == STALLED) |
| { |
| vSetEPRxStatus(EP_RX_STALL); |
| vSetEPTxStatus(EP_TX_STALL); |
| } |
| |
| return (pInformation->ControlState == PAUSE); |
| } |
| |
| /******************************************************************************* |
| * Function Name : SetDeviceAddress. |
| * Description : Set the device and all the used Endpoints addresses. |
| * Input : - Val: device adress. |
| * Output : None. |
| * Return : None. |
| *******************************************************************************/ |
| void SetDeviceAddress(u8 Val) |
| { |
| u32 i; |
| u32 nEP = Device_Table.Total_Endpoint; |
| |
| /* set address in every used endpoint */ |
| for (i = 0; i < nEP; i++) |
| { |
| _SetEPAddress((u8)i, (u8)i); |
| } |
| _SetDADDR(Val | DADDR_EF); /* set device address and enable function */ |
| |
| } |
| |
| /******************************************************************************* |
| * Function Name : NOP_Process |
| * Description : No operation function. |
| * Input : None. |
| * Output : None. |
| * Return : None. |
| *******************************************************************************/ |
| void NOP_Process(void) |
| { |
| } |
| /******************* (C) COPYRIGHT 2008 STMicroelectronics *****END OF FILE****/ |
| |
| |