WebSVN - NaviCtrl - Diff - Rev 1 and 196 - /tags/V0.28i/usblibrary/src/usb

-/******************** (C) COPYRIGHT 2006 STMicroelectronics ********************
+/******************** (C) COPYRIGHT 2008 STMicroelectronics ********************
 * File Name          : usb_core.c
 * Author             : MCD Application Team
+* Version            : V4.0.0
-* Date First Issued  : 10/27/2003 : V1.0
+* Date               : 09/29/2008
-* Description        : Standard protocol processing (USB v2.0)
+* Description        : Standard protocol processing (USB v2.0).
 ********************************************************************************
-* History:
-* 09/18/2006 : V3.0
-* 09/01/2006 : V2.0
-* 10/27/2003 : V1.0
-********************************************************************************
-* THE PRESENT SOFTWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
+* 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"
 #include "usb_conf.h"
 /* Private typedef -----------------------------------------------------------*/
 /* Private define ------------------------------------------------------------*/
 #define ValBit(VAR,Place)    (VAR & (1<<Place))
-#define SetBit(VAR,Place)    ( VAR |= (1<<Place) )
+#define SetBit(VAR,Place)    (VAR |= (1<<Place))
-#define USB_StatusIn()  Send0LengthData()
+#define USB_StatusIn()       Send0LengthData()
-#define USB_StatusOut() vSetEPRxStatus(EP_RX_VALID)
+#define USB_StatusOut()      vSetEPRxStatus(EP_RX_VALID)
-#define StatusInfo0 StatusInfo.bw.bb1   /* Reverse bb0 & bb1 */
+#define StatusInfo0          StatusInfo.bw.bb1 /* Reverse bb0 & bb1 */
+#define StatusInfo1          StatusInfo.bw.bb0
 #define StatusInfo1 StatusInfo.bw.bb0
 /* Private macro -------------------------------------------------------------*/
 /* Private variables ---------------------------------------------------------*/
+u16_u8 StatusInfo;
-u16_u8 StatusInfo;
+bool Data_Mul_MaxPacketSize = FALSE;
+/* Private function prototypes -----------------------------------------------*/
+static void DataStageOut(void);
+static void DataStageIn(void);
+static void NoData_Setup0(void);
-/* Private function prototypes -----------------------------------------------*/
+static void Data_Setup0(void);
 /* Private functions ---------------------------------------------------------*/
 /*******************************************************************************
-* Function Name  : Standard_GetConfiguration
+* Function Name  : Standard_GetConfiguration.
-* Description    : Return the current configuration variable address
+* Description    : Return the current configuration variable address.
-* Input          : Length - How many bytes are needed.
-* Output         : If "Length" is 0, return the length of configuration value
+* Input          : Length - How many bytes are needed.
-                   If "Length" is not 0, return the data buffer address.
+* Output         : None.
-* Return         : Return 1 , if the request is invalid when "Length" is 0
+* Return         : Return 1 , if the request is invalid when "Length" is 0.
-                   Return "Buffer" if the "Length" is not 0
+*                  Return "Buffer" if the "Length" is not 0.
 *******************************************************************************/
 u8 *Standard_GetConfiguration(u16 Length)
+{
+  if (Length == 0)
-{
+  {
+    pInformation->Ctrl_Info.Usb_wLength =
-  if (Length == 0){
+      sizeof(pInformation->Current_Configuration);
     pInformation->Ctrl_Info.Usb_wLength = sizeof(pInformation->Current_Configuration);
-                return 0;
+    return 0;
+  }
-        pUser_Standard_Requests->User_GetConfiguration();
+  pUser_Standard_Requests->User_GetConfiguration();
+  return (u8 *)&pInformation->Current_Configuration;
         return (u8 *)&pInformation->Current_Configuration;
-}
 /*******************************************************************************
-* Function Name  : Standard_SetConfiguration
+* Function Name  : Standard_SetConfiguration.
 * Description    : This routine is called to set the configuration value
-                   Then each class should configure device themself
+*                  Then each class should configure device themself.
-* Input          :
+* Input          : None.
-* Output         :
+* Output         : None.
-* Return         : Return USB_SUCCESS, if the request is performed
+* Return         : Return USB_SUCCESS, if the request is performed.
-                   Return USB_UNSUPPORT, if the request is invalid
+*                  Return USB_UNSUPPORT, if the request is invalid.
 *******************************************************************************/
-RESULT Standard_SetConfiguration(void)
-{
+RESULT Standard_SetConfiguration(void)
+{
+  if (pInformation->USBwValue0 <= Device_Table.Total_Configuration
-        if (pInformation->USBwValue0 <= Device_Table.Total_Configuration && pInformation->USBwValue1==0
+      && pInformation->USBwValue1 == 0 && pInformation->USBwIndex == 0)
-            && pInformation->USBwIndex==0) /*call Back usb spec 2.0*/
+    /*call Back usb spec 2.0*/
+  {
-                pInformation->Current_Configuration = pInformation->USBwValue0;
+    pInformation->Current_Configuration = pInformation->USBwValue0;
-                pUser_Standard_Requests->User_SetConfiguration();
+    pUser_Standard_Requests->User_SetConfiguration();
-                return USB_SUCCESS;
+    return USB_SUCCESS;
+  }
   else
         else
+    return USB_UNSUPPORT;
+  }
         return USB_UNSUPPORT;
-}
 /*******************************************************************************
-* Function Name  : Standard_GetInterface
+* Function Name  : Standard_GetInterface.
-* Description    : Return the Alternate Setting of the current interface
+* Description    : Return the Alternate Setting of the current interface.
-* Input          : Length - How many bytes are needed
-* Output         : If "Length" is 0, return the length of interface value
+* Input          : Length - How many bytes are needed.
-                   If "Length" is not 0, return the data buffer address
+* Output         : None.
-* Return         : Return 0, if the request is invalid when "Length" is 0
+* Return         : Return 0, if the request is invalid when "Length" is 0.
-                   Return "Buffer" if the "Length" is not 0
+*                  Return "Buffer" if the "Length" is not 0.
 *******************************************************************************/
 u8 *Standard_GetInterface(u16 Length)
+{
+  if (Length == 0)
-{
+  {
-  if (Length == 0){
+    pInformation->Ctrl_Info.Usb_wLength =
-        pInformation->Ctrl_Info.Usb_wLength =   sizeof(pInformation->Current_AlternateSetting);
+      sizeof(pInformation->Current_AlternateSetting);
     return 0;
+  }
-        pUser_Standard_Requests->User_GetInterface();
+  pUser_Standard_Requests->User_GetInterface();
+  return (u8 *)&pInformation->Current_AlternateSetting;
         return (u8 *)&pInformation->Current_AlternateSetting;
-}
 /*******************************************************************************
-* Function Name  : Standard_SetInterface
+* Function Name  : Standard_SetInterface.
-* Description    : This routine is called to set the interface
+* Description    : This routine is called to set the interface.
-                   Then each class should configure the interface them self
+*                  Then each class should configure the interface them self.
-* Input          :
+* Input          : None.
-* Output         :
+* Output         : None.
-* Return         : Return USB_SUCCESS, if the request is performed
+* Return         : - Return USB_SUCCESS, if the request is performed.
-                   Return USB_UNSUPPORT, if the request is invalid
+*                  - Return USB_UNSUPPORT, if the request is invalid.
 *******************************************************************************/
 RESULT Standard_SetInterface(void)
 {
+  RESULT Re;
-        RESULT                  Re;
+  /*Test if the specified Interface and Alternate Setting are supported by
+  the application Firmware*/
-        /*Test if the specified Interface and Alternate Setting are supported by the application Firmware*/
+  Re = (*pProperty->Class_Get_Interface_Setting)(pInformation->USBwIndex0,
-        Re = (*pProperty->Class_Get_Interface_Setting)(pInformation->USBwIndex0,pInformation->USBwValue0);
+       pInformation->USBwValue0);
+  if (pInformation->Current_Configuration != 0 )
+  {
-        if(pInformation->Current_Configuration!=0 )
+    if (Re != USB_SUCCESS || pInformation->USBwIndex1 != 0
+        || pInformation->USBwValue1 != 0)
+    {
-                if (Re!= USB_SUCCESS || pInformation->USBwIndex1!=0 || pInformation->USBwValue1!=0)
+      return  USB_UNSUPPORT;
                                 return  USB_UNSUPPORT;
-                else if ( Re == USB_SUCCESS)
+    else if (Re == USB_SUCCESS)
+    {
-                 pUser_Standard_Requests->User_SetInterface();
+      pUser_Standard_Requests->User_SetInterface();
-                 pInformation->Current_Interface = pInformation->USBwIndex0;
+      pInformation->Current_Interface = pInformation->USBwIndex0;
-                 pInformation->Current_AlternateSetting = pInformation->USBwValue0;
-                 return USB_SUCCESS;
+      pInformation->Current_AlternateSetting = pInformation->USBwValue0;
-                }
       return USB_SUCCESS;
+    }
+  }
   return USB_UNSUPPORT;
- return USB_UNSUPPORT;
+}
-}
 /*******************************************************************************
-* Function Name  : Standard_GetStatus
+* Function Name  : Standard_GetStatus.
-* Description    : Copy the device request data to "StatusInfo buffer"
-* Input          : Length - How many bytes are needed
+* Description    : Copy the device request data to "StatusInfo buffer".
-* Output         : If "Length" is 0, return the length of status data
+* Input          : - Length - How many bytes are needed.
-                   If "Length" is not 0, return number of bytes have been copied
+* Output         : None.
 * Return         : Return 0, if the request is at end of data block,
-                   or is invalid when "Length" is 0
+*                  or is invalid when "Length" is 0.
 *******************************************************************************/
+u8 *Standard_GetStatus(u16 Length)
 u8 *Standard_GetStatus(u16 Length)
   if (Length == 0)
   if (Length == 0){
-          pInformation->Ctrl_Info.Usb_wLength =2;
+    pInformation->Ctrl_Info.Usb_wLength = 2;
-                return 0;
+    return 0;
   }
+  StatusInfo.w = 0;
   /* Reset Status Information */
-        StatusInfo.w = 0;
+  if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT))
+  {
-                                /* Reset Status Information */
+    /*Get Device Status */
+    u8 Feature = pInformation->Current_Feature;
-        if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) {/*Get Device Status */
+    /* Remote Wakeup enabled */
-                u8      Feature = pInformation->Current_Feature;
+    if (ValBit(Feature, 5))
-                if (ValBit(Feature, 5))
+    {
-                        SetBit(StatusInfo0, 1); /* Remote Wakeup enabled */
+      SetBit(StatusInfo0, 1);
+    }
+    /* Bus-powered */
+    if (ValBit(Feature, 6))
+    {
+      ClrBit(StatusInfo0, 0);
+    }
+    else /* Self-powered */
+    {
-                if (ValBit(Feature, 6))
+      SetBit(StatusInfo0, 0);
+    }
-                        SetBit(StatusInfo0, 0);  /* Self-powered */
+  }
+  /*Interface Status*/
-                else
+  else if (Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT))
                         ClrBit(StatusInfo0, 0); /* Bus-powered */
     return (u8 *)&StatusInfo;
-        else if (Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT))/*Interface Status*/
+  }
+  /*Get EndPoint Status*/
-                        return (u8 *)&StatusInfo;
+  else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT))
+  {
+    u8 Related_Endpoint;
-        else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT)) {/*Get EndPoint Status*/
+    u8 wIndex0 = pInformation->USBwIndex0;
                 u8      Related_Endpoint;
+    Related_Endpoint = (wIndex0 & 0x0f);
-                u8      wIndex0 = pInformation->USBwIndex0;
+    if (ValBit(wIndex0, 7))
+    {
       /* IN endpoint */
-                Related_Endpoint = (wIndex0 & 0x0f);
+      if (_GetTxStallStatus(Related_Endpoint))
+      {
-                        if (ValBit(wIndex0, 7)) {
+        SetBit(StatusInfo0, 0); /* IN Endpoint stalled */
                                 /* IN endpoint */
+    }
-                                if (_GetTxStallStatus( Related_Endpoint ))
+    else
                                 SetBit(StatusInfo0, 0); /* IN Endpoint stalled */
+      /* OUT endpoint */
       if (_GetRxStallStatus(Related_Endpoint))
+      {
-                        else {
+        SetBit(StatusInfo0, 0); /* OUT Endpoint stalled */
                                 /* OUT endpoint */
                                 if (_GetRxStallStatus( Related_Endpoint ))
                                 SetBit(StatusInfo0, 0); /* OUT Endpoint stalled */
-                        }
+  else
+  {
-        }
+    return NULL;
-        else
+  }
-                return NULL;
+  pUser_Standard_Requests->User_GetStatus();
+  return (u8 *)&StatusInfo;
         pUser_Standard_Requests->User_GetStatus();
         return (u8 *)&StatusInfo;
 /*******************************************************************************
-/*******************************************************************************
+* Function Name  : Standard_ClearFeature.
-* Function Name  : Standard_ClearFeature
+* Description    : Clear or disable a specific feature.
-* Description    : Clear or disable a specific feature
+* Input          : None.
+* Output         : None.
-* Input          :
+* Return         : - Return USB_SUCCESS, if the request is performed.
+*                  - Return USB_UNSUPPORT, if the request is invalid.
-* Output         :
+*******************************************************************************/
-* Return         :
+RESULT Standard_ClearFeature(void)
-*******************************************************************************/
+{
-RESULT Standard_ClearFeature(void)
+  u32 Type_Rec = Type_Recipient;
   u32 Status;
         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;
+  }
-        if ( Type_Rec == (STANDARD_REQUEST | DEVICE_RECIPIENT) ) {/*Device Clear Feature*/
+  else if (Type_Rec == (STANDARD_REQUEST | ENDPOINT_RECIPIENT))
-                ClrBit(pInformation->Current_Feature, 5);
+  {/*EndPoint Clear Feature*/
-                return USB_SUCCESS;
+    DEVICE* pDev;
+    u32 Related_Endpoint;
-        }
+    u32 wIndex0;
+    u32 rEP;
-        else if ( Type_Rec == (STANDARD_REQUEST | ENDPOINT_RECIPIENT) ) {/*EndPoint Clear Feature*/
+    if (pInformation->USBwValue != ENDPOINT_STALL
+        || pInformation->USBwIndex1 != 0)
+    {
-                DEVICE* pDev;
+      return USB_UNSUPPORT;
+    }
-                u32     Related_Endpoint;
+    pDev = &Device_Table;
+    wIndex0 = pInformation->USBwIndex0;
-                u32     wIndex0;
+    rEP = wIndex0 & ~0x80;
+    Related_Endpoint = ENDP0 + rEP;
-                u32     rEP;
+    if (ValBit(pInformation->USBwIndex0, 7))
+    { /*Get Status of endpoint & stall the request if the related_ENdpoint is
+            Disabled*/
-                if (pInformation->USBwValue != ENDPOINT_STALL || pInformation->USBwIndex1!=0)
+      Status = _GetEPTxStatus(Related_Endpoint);
                         return USB_UNSUPPORT;
     else
                 pDev = &Device_Table;
+      Status = _GetEPRxStatus(Related_Endpoint);
-                wIndex0 = pInformation->USBwIndex0;
+    }
-                rEP = wIndex0 & ~0x80;
+    if (rEP >= pDev->Total_Endpoint || Status == 0
-                Related_Endpoint = ENDP0 + rEP;
+        || pInformation->Current_Configuration == 0)
+    {
       return USB_UNSUPPORT;
                 if (ValBit(pInformation->USBwIndex0, 7)) Status =_GetEPTxStatus(Related_Endpoint);/*Get Status of endpoint & stall the request if
                                                                                                       the related_ENdpoint is Disabled*/
                 else Status =_GetEPRxStatus(Related_Endpoint);
     if (wIndex0 & 0x80)
-                return USB_SUCCESS;
+    return USB_SUCCESS;
+  }
-        return USB_UNSUPPORT;
+  return USB_UNSUPPORT;
+}
 /*******************************************************************************
 * Function Name  : Standard_SetEndPointFeature
 * Description    : Set or enable a specific feature of EndPoint
-* Input          :
+* Input          : None.
-* Output         :
+* Output         : None.
+* Return         : - Return USB_SUCCESS, if the request is performed.
-* Return         :
+*                  - Return USB_UNSUPPORT, if the request is invalid.
 *******************************************************************************/
 RESULT Standard_SetEndPointFeature(void)
+{
-        u32    wIndex0;
+  u32    wIndex0;
-                wIndex0 = pInformation->USBwIndex0;
+  wIndex0 = pInformation->USBwIndex0;
-                rEP = wIndex0 & ~0x80;
+  rEP = wIndex0 & ~0x80;
-                Related_Endpoint = ENDP0 + rEP;
+  Related_Endpoint = ENDP0 + rEP;
+  if (ValBit(pInformation->USBwIndex0, 7))
-                if (ValBit(pInformation->USBwIndex0, 7)) Status =_GetEPTxStatus(Related_Endpoint);/* get Status of endpoint & stall the request if
+  { /* get Status of endpoint & stall the request if the related_ENdpoint is
-                                                                                                    the related_ENdpoint is Disabled*/
+        Disabled*/
+    Status = _GetEPTxStatus(Related_Endpoint);
-                else Status =_GetEPRxStatus(Related_Endpoint);
+  }
+  else
+  {
+    Status = _GetEPRxStatus(Related_Endpoint);
+  }
+  if (Related_Endpoint >= Device_Table.Total_Endpoint
+      || pInformation->USBwValue != 0 || Status == 0
-                if (Related_Endpoint >= Device_Table.Total_Endpoint || pInformation->USBwValue !=0 || Status==0 ||
+      || pInformation->Current_Configuration == 0)
+  {
-                        pInformation->Current_Configuration==0 /*&& Related_Endpoint!=ENDP0)*/)
+    return USB_UNSUPPORT;
-                        return USB_UNSUPPORT;
+  }
+  else
-                else {
+  {
     if (wIndex0 & 0x80)
-                        if (wIndex0 & 0x80) {           /* IN endpoint */
+    {  /* IN endpoint */
+      _SetEPTxStatus(Related_Endpoint, EP_TX_STALL);
-                                _SetEPTxStatus(Related_Endpoint, EP_TX_STALL);
+    }
     else
-                        else {                          /* OUT endpoint */
+    {    /* OUT endpoint */
-                                _SetEPRxStatus(Related_Endpoint, EP_RX_STALL);
+      _SetEPRxStatus(Related_Endpoint, EP_RX_STALL);
+    }
+  }
+  pUser_Standard_Requests->User_SetEndPointFeature();
-        pUser_Standard_Requests->User_SetEndPointFeature();
+  return USB_SUCCESS;
-        return USB_SUCCESS;
+}
-}
 /*******************************************************************************
-* Function Name  : Standard_SetDeviceFeature
+* Function Name  : Standard_SetDeviceFeature.
-* Description    : Set or enable a specific feature of Device
+* Description    : Set or enable a specific feature of Device.
+* Input          : None.
-* Input          :
+* Output         : None.
-* Output         :
+* Return         : - Return USB_SUCCESS, if the request is performed.
-* Return         :
+*                  - Return USB_UNSUPPORT, if the request is invalid.
 *******************************************************************************/
 RESULT Standard_SetDeviceFeature(void)
+{
-                        SetBit(pInformation->Current_Feature, 5);
+  SetBit(pInformation->Current_Feature, 5);
-                        pUser_Standard_Requests->User_SetDeviceFeature();
+  pUser_Standard_Requests->User_SetDeviceFeature();
-                        return USB_SUCCESS;
+  return USB_SUCCESS;
 }
+/*******************************************************************************
-/*******************************************************************************
+* Function Name  : Standard_GetDescriptorData.
-* Function Name  : Standard_GetDescriptorData
+* Description    : Standard_GetDescriptorData is used for descriptors transfer.
+*                : This routine is used for the descriptors resident in Flash
-* Description    : Standard_GetDescriptorData is used for descriptors transfer
+*                  or RAM
-*                : This routine is used for the descriptors resident in Flash or RAM
+*                  pDesc can be in either Flash or RAM
-                  pDesc can be in either Flash or RAM
+*                  The purpose of this routine is to have a versatile way to
-                  The purpose of this routine is to have a versatile way to response
+*                  response descriptors request. It allows user to generate
-                  descriptors request. It allows user to generate certain descriptors
+*                  certain descriptors with software or read descriptors from
+*                  external storage part by part.
-                  with software or read descriptors from external storage part by part.
+* Input          : - Length - Length of the data in this transfer.
-* Input          : Length - Length of the data in this transfer
+*                  - pDesc - A pointer points to descriptor struct.
-                   pDesc - A pointer points to descriptor struct.
+*                  The structure gives the initial address of the descriptor and
-                          The structure gives the initial address of the
+*                  its original size.
-                          descriptor and its original size
-* Output         : Address of a part of the descriptor pointed by the Usb_wOffset
+* Output         : None.
-                   The buffer pointed by this address contains at least Length bytes
+* Return         : Address of a part of the descriptor pointed by the Usb_
-* Return         :
+*                  wOffset The buffer pointed by this address contains at least
-*******************************************************************************/
+*                  Length bytes.
+*******************************************************************************/
+u8 *Standard_GetDescriptorData(u16 Length, ONE_DESCRIPTOR *pDesc)
 u8 *Standard_GetDescriptorData(u16 Length, ONE_DESCRIPTOR *pDesc)
   u32  wOffset;
         u32      wOffset;
   wOffset = pInformation->Ctrl_Info.Usb_wOffset;
-        wOffset = pInformation->Ctrl_Info.Usb_wOffset;
+  if (Length == 0)
+  {
-        if (Length == 0) {
+    pInformation->Ctrl_Info.Usb_wLength = pDesc->Descriptor_Size - wOffset;
-                pInformation->Ctrl_Info.Usb_wLength = pDesc->Descriptor_Size - wOffset;
+    return 0;
-                return 0;
+  }
-        }
+  return pDesc->Descriptor + wOffset;
-        return pDesc->Descriptor + wOffset;
+}
 /*******************************************************************************
-* Function Name  : DataStageOut
+* Function Name  : DataStageOut.
-* Description    : Data stage of a Control Write Transfer
+* Description    : Data stage of a Control Write Transfer.
-* Input          :
+* Input          : None.
-* Output         :
+* Output         : None.
-* Return         :
+* Return         : None.
+*******************************************************************************/
-*******************************************************************************/
+void DataStageOut(void)
 void DataStageOut(void)
   ENDPOINT_INFO *pEPinfo = &pInformation->Ctrl_Info;
-        ENDPOINT_INFO   *pEPinfo = &pInformation->Ctrl_Info;
+  u32 save_rLength;
-        u32     save_rLength;
+  save_rLength = pEPinfo->Usb_rLength;
   if (pEPinfo->CopyData && save_rLength)
         save_rLength = pEPinfo->Usb_rLength;
     u8 *Buffer;
-        if (pEPinfo->CopyData && save_rLength) {
+    u32 Length;
                 u8 *Buffer;
-                u32 Length;
+    Length = pEPinfo->PacketSize;
+    if (Length > save_rLength)
+    {
-                Length = pEPinfo->PacketSize;
+      Length = save_rLength;
                 if (Length > save_rLength)
                         Length = save_rLength;
     Buffer = (*pEPinfo->CopyData)(Length);
-                Buffer = (*pEPinfo->CopyData)(Length);
+    pEPinfo->Usb_rLength -= Length;
+    pEPinfo->Usb_rOffset += Length;
                 pEPinfo->Usb_rLength -= Length;
+    PMAToUserBufferCopy(Buffer, GetEPRxAddr(ENDP0), 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 */
         if(pEPinfo->Usb_rLength !=0){
-                vSetEPRxStatus(EP_RX_VALID);/* re-enable for next data reception */
+  /* Set the next State*/
-                SetEPTxCount(ENDP0, 0);
+  if (pEPinfo->Usb_rLength >= pEPinfo->PacketSize)
                 vSetEPTxStatus(EP_TX_VALID);/* Expect the host to abort the data OUT stage */
     pInformation->ControlState = OUT_DATA;
-/* Set the next State*/
         if (pEPinfo->Usb_rLength >= pEPinfo->PacketSize)
+  else
                 pInformation->ControlState = OUT_DATA;
-        else
+    if (pEPinfo->Usb_rLength > 0)
-                {
+    {
-                        if (pEPinfo->Usb_rLength >0)
+      pInformation->ControlState = LAST_OUT_DATA;
-                                pInformation->ControlState = LAST_OUT_DATA;
+    }
-                        else if (pEPinfo->Usb_rLength == 0)
+    else if (pEPinfo->Usb_rLength == 0)
+    {
-                                pInformation->ControlState = WAIT_STATUS_IN;
+      pInformation->ControlState = WAIT_STATUS_IN;
-                                USB_StatusIn();
+      USB_StatusIn();
+    }
+  }
-        u8      *DataBuffer;
+  u8 *DataBuffer;
-        u32     Length;
+  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
         if ((save_wLength == 0) && (ControlState == LAST_IN_DATA))
-        { /* no more data to send so STALL the TX Status*/
+      /* No more data to send so STALL the TX Status*/
+      ControlState = WAIT_STATUS_OUT;
+      vSetEPTxStatus(EP_TX_STALL);
                 ControlState = WAIT_STATUS_OUT;
                 vSetEPTxStatus(EP_TX_STALL);
-                goto Expect_Status_Out;
+    goto Expect_Status_Out;
+  }
+  Length = pEPinfo->PacketSize;
-        Length = pEPinfo->PacketSize;
+  ControlState = (save_wLength <= Length) ? LAST_IN_DATA : IN_DATA;
-        ControlState = (save_wLength <= Length) ? LAST_IN_DATA : IN_DATA;
+  if (Length > save_wLength)
+  {
-        pEPinfo->Usb_wOffset += Length;
+  pEPinfo->Usb_wOffset += Length;
-        vSetEPTxStatus(EP_TX_VALID);
+  vSetEPTxStatus(EP_TX_VALID);
-        USB_StatusOut();/* Expect the host to abort the data IN stage */
   USB_StatusOut();/* Expect the host to abort the data IN stage */
 Expect_Status_Out:
-        pInformation->ControlState = ControlState;
+  pInformation->ControlState = ControlState;
 }
 /*******************************************************************************
-* Function Name  : NoData_Setup0
+* Function Name  : NoData_Setup0.
-* Description    : Proceed the processing of setup request without data stage
+* Description    : Proceed the processing of setup request without data stage.
-* Input          : None
+* Input          : None.
-* Output         : None
+* Output         : None.
-* Return         : None
+* Return         : None.
 *******************************************************************************/
 void NoData_Setup0(void)
+{
-        RESULT  Result = USB_UNSUPPORT;
+  RESULT Result = USB_UNSUPPORT;
-        u32     RequestNo = pInformation->USBbRequest;
+  u32 RequestNo = pInformation->USBbRequest;
+  u32 ControlState;
         u32     ControlState;
   if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT))
+  {/* Device Request*/
         if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) {/* Device Request*/
+    /* SET_CONFIGURATION*/
     if (RequestNo == SET_CONFIGURATION)
-                /* SET_CONFIGURATION*/
+    {
+      Result = Standard_SetConfiguration();
                 if (RequestNo == SET_CONFIGURATION)
-                        Result = Standard_SetConfiguration();
+    /*SET ADDRESS*/
+    else if (RequestNo == SET_ADDRESS)
                 /*SET ADDRESS*/
-                else if (RequestNo == SET_ADDRESS){
+      if (pInformation->USBwValue0 > 127 || pInformation->USBwValue1 != 0
-                        if(pInformation->USBwValue0 > 127 || pInformation->USBwValue1!=0
+          || pInformation->USBwIndex != 0
-                                ||pInformation->USBwIndex!=0 || pInformation->Current_Configuration!=0) /* Device Address should be 127 or less*/
+          || pInformation->Current_Configuration != 0)
+        /* Device Address should be 127 or less -> call Back spec USB 2.0*/
+      {
-                                                                                          /*call Beck spec USB 2.0*/
+        ControlState = STALLED;
+        goto exit_NoData_Setup0;
+      }
-                                ControlState = STALLED;
+      else
-                                goto exit_NoData_Setup0;
+      {
+        Result = USB_SUCCESS;
+      }
+    }
-                                }
+    /*SET FEATURE for Device*/
+    else if (RequestNo == SET_FEATURE)
                         else Result = USB_SUCCESS;
+      if (pInformation->USBwValue0 == DEVICE_REMOTE_WAKEUP
           && pInformation->USBwIndex == 0
+          && ValBit(pInformation->Current_Feature, 5))
                 /*SET FEATURE for Device*/
-                else if (RequestNo == SET_FEATURE){
+        Result = Standard_SetDeviceFeature();
+      }
-                                if (pInformation->USBwValue0==DEVICE_REMOTE_WAKEUP && pInformation->USBwIndex==0 && ValBit(pInformation->Current_Feature, 5))
+      else
-                                Result = Standard_SetDeviceFeature();
+      {
+        Result = USB_UNSUPPORT;
+      }
+    }
-                                else
+    /*Clear FEATURE for Device */
+    else if (RequestNo == CLEAR_FEATURE)
                                 Result = USB_UNSUPPORT;
+      if (pInformation->USBwValue0 == DEVICE_REMOTE_WAKEUP
           && pInformation->USBwIndex == 0
+          && ValBit(pInformation->Current_Feature, 5))
                 /*Clear FEATURE for Device */
-                else if (RequestNo == CLEAR_FEATURE){
+        Result = Standard_ClearFeature();
+      }
-                        if (pInformation->USBwValue0==DEVICE_REMOTE_WAKEUP && pInformation->USBwIndex==0 && ValBit(pInformation->Current_Feature, 5))
+      else
                         Result = Standard_ClearFeature();
-                        else
+        Result = USB_UNSUPPORT;
+      }
                         Result = USB_UNSUPPORT;
+  }
   /* Interface Request*/
   else if (Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT))
-        /* Interface Request*/
+  {
     /*SET INTERFACE*/
-        else if (Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT)) {
+    if (RequestNo == SET_INTERFACE)
+    {
       Result = Standard_SetInterface();
+    }
                         /*SET INTERFACE*/
-                        if (RequestNo == SET_INTERFACE)
-                                Result = Standard_SetInterface();
+  /* EndPoint Request*/
   else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT))
+  {
+    /*CLEAR FEATURE for EndPoint*/
-        /* EndPoint Request*/
+    if (RequestNo == CLEAR_FEATURE)
+    {
+      Result = Standard_ClearFeature();
+    }
-        else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT)) {
+    /* SET FEATURE for EndPoint*/
-                        /*CLEAR FEATURE for EndPoint*/
+    else if (RequestNo == SET_FEATURE)
+    {
-                        if (RequestNo == CLEAR_FEATURE)
+      Result = Standard_SetEndPointFeature();
                          Result = Standard_ClearFeature();
                         /* SET FEATURE for EndPoint*/
-                         else if (RequestNo == SET_FEATURE){
+  else
-                                Result = Standard_SetEndPointFeature();
+  {
+    Result = USB_UNSUPPORT;
+  }
         else
-                        Result = USB_UNSUPPORT;
+  if (Result != USB_SUCCESS)
 exit_NoData_Setup0:
-        pInformation->ControlState = ControlState;
+  pInformation->ControlState = ControlState;
-        return;
+  return;
+}
 /*******************************************************************************
-* Function Name  : Data_Setup0
+* Function Name  : Data_Setup0.
-* Description    : Proceed the processing of setup request with data stage
+* Description    : Proceed the processing of setup request with data stage.
-* Input          :
+* Input          : None.
-* Output         :
+* Output         : None.
-* Return         :
+* Return         : None.
 *******************************************************************************/
 void Data_Setup0(void)
+{
-        u8      *(*CopyRoutine)(u16);
+  u8 *(*CopyRoutine)(u16);
-        CopyRoutine = NULL;
+  CopyRoutine = NULL;
+  wOffset = 0;
-        wOffset = 0;
+  if (Request_No == GET_DESCRIPTOR)
+  {
-        if (Request_No == GET_DESCRIPTOR) {
+    if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT))
+    {
-                if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) {
+      u8 wValue1 = pInformation->USBwValue1;
+      if (wValue1 == DEVICE_DESCRIPTOR)
                         u8 wValue1 = pInformation->USBwValue1;
+        CopyRoutine = pProperty->GetDeviceDescriptor;
                         if (wValue1 == DEVICE_DESCRIPTOR)
+      else if (wValue1 == CONFIG_DESCRIPTOR)
-                                CopyRoutine = pProperty->GetDeviceDescriptor;
+      {
+        CopyRoutine = pProperty->GetConfigDescriptor;
                         else if (wValue1 == CONFIG_DESCRIPTOR)
-                                CopyRoutine = pProperty->GetConfigDescriptor;
+      else if (wValue1 == STRING_DESCRIPTOR)
                         else if (wValue1 == STRING_DESCRIPTOR) {
-                                CopyRoutine = pProperty->GetStringDescriptor;
+        CopyRoutine = pProperty->GetStringDescriptor;
-                        }               /* End of GET_DESCRIPTOR */
+      }  /* End of GET_DESCRIPTOR */
-                }
+    }
+  }
+  /*GET STATUS*/
   else if ((Request_No == GET_STATUS) && (pInformation->USBwValue == 0)
+           && (pInformation->USBwLength == 0x0002)
+           && (pInformation->USBwIndex1 == 0))
+  {
-        /*GET STATUS*/
+    /* GET STATUS for Device*/
-        else if (Request_No == GET_STATUS && pInformation->USBwValue==0 && pInformation->USBwLength == 0x0002 && pInformation->USBwIndex1==0) {
+    if ((Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT))
-                        /* GET STATUS for Device*/
+        && (pInformation->USBwIndex == 0))
-                if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT) && pInformation->USBwIndex==0) {
+    {
+      CopyRoutine = Standard_GetStatus;
-                        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)
-                        /* GET STATUS for Interface*/
+          && (pInformation->Current_Configuration != 0))
-                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;
                                          CopyRoutine = Standard_GetStatus;
+    }
+    /* GET STATUS for EndPoint*/
+    else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT))
-                        /* 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))
+      {
-                        Related_Endpoint = (pInformation->USBwIndex0 & 0x0f);
+        /*Get Status of endpoint & stall the request if the related_ENdpoint
-                        Reserved= pInformation->USBwIndex0 & 0x70;
+        is Disabled*/
+        Status = _GetEPTxStatus(Related_Endpoint);
+      }
       else
                         if (ValBit(pInformation->USBwIndex0, 7)) Status =_GetEPTxStatus(Related_Endpoint);/*Get Status of endpoint & stall the request if
-                                                                                                            the related_ENdpoint is Disabled*/
+        Status = _GetEPRxStatus(Related_Endpoint);
                         else Status =_GetEPRxStatus(Related_Endpoint);
       if ((Related_Endpoint < Device_Table.Total_Endpoint) && (Reserved == 0)
+          && (Status != 0))
+      {
         CopyRoutine = Standard_GetStatus;
+      }
                         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))
-        }
+    {
-                /*GET CONFIGURATION*/
+      CopyRoutine = Standard_GetConfiguration;
+    }
         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))
-                /*GET INTERFACE*/
+        && (pInformation->Current_Configuration != 0) && (pInformation->USBwValue == 0)
-        else if (Request_No == GET_INTERFACE) {
+        && (pInformation->USBwIndex1 == 0) && (pInformation->USBwLength == 0x0001)
-                if (Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT) && pInformation->Current_Configuration!=0
+        && ((*pProperty->Class_Get_Interface_Setting)(pInformation->USBwIndex0, 0) == USB_SUCCESS))
                    && pInformation->USBwValue==0 && pInformation->USBwIndex1==0 && pInformation->USBwLength == 0x0001
-                   && (*pProperty->Class_Get_Interface_Setting)(pInformation->USBwIndex0,0)==USB_SUCCESS)
+      CopyRoutine = Standard_GetInterface;
                         CopyRoutine = Standard_GetInterface;
-        }
+  }
   if (CopyRoutine)
+  {
+    pInformation->Ctrl_Info.Usb_wOffset = wOffset;
-        if (CopyRoutine) {
+    pInformation->Ctrl_Info.CopyData = CopyRoutine;
-                pInformation->Ctrl_Info.Usb_wOffset = wOffset;
+    /* sb in the original the cast to word was directly */
-                pInformation->Ctrl_Info.CopyData = CopyRoutine;
+    /* now the cast is made step by step */
-                /* sb in the original the cast to word was directly */
+    (*CopyRoutine)(0);
-                /* now the cast is made step by step */
+    Result = USB_SUCCESS;
+  }
+  else
                 (*CopyRoutine)(0);
-                Result = USB_SUCCESS;
+    Result = (*pProperty->Class_Data_Setup)(pInformation->USBbRequest);
     if (Result == USB_NOT_READY)
-       else {
+    {
+      pInformation->ControlState = PAUSE;
-                Result = (*pProperty->Class_Data_Setup)(pInformation->USBbRequest);
+      return;
                 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;
-        if (pInformation->Ctrl_Info.Usb_wLength == 0xFFFF) {    /* Data is not ready, wait it */
+    return;
                 pInformation->ControlState = PAUSE;
+  if ((Result == USB_UNSUPPORT) || (pInformation->Ctrl_Info.Usb_wLength == 0))
                 return;
+    /* 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)
+    {
-        if (Result == USB_UNSUPPORT || pInformation->Ctrl_Info.Usb_wLength == 0) {
+      pInformation->Ctrl_Info.Usb_wLength = wLength;
                 /* Unsupported request */
-                pInformation->ControlState = STALLED;
+    else if (pInformation->Ctrl_Info.Usb_wLength < pInformation->USBwLength)
                 return;
       if (pInformation->Ctrl_Info.Usb_wLength < pProperty->MaxPacketSize)
+      {
         Data_Mul_MaxPacketSize = FALSE;
-        if (ValBit(pInformation->USBbmRequestType, 7)) {
+      }
+      else if ((pInformation->Ctrl_Info.Usb_wLength % pProperty->MaxPacketSize) == 0)
                 /* Device ==> Host */
-                u32     wLength = pInformation->USBwLength;
+        Data_Mul_MaxPacketSize = TRUE;
+      }
-                /* Restrict the data length to be the one host asks */
+    }
-                if (pInformation->Ctrl_Info.Usb_wLength > wLength)
-                        pInformation->Ctrl_Info.Usb_wLength = wLength;
+    pInformation->Ctrl_Info.PacketSize = pProperty->MaxPacketSize;
     DataStageIn();
                 pInformation->Ctrl_Info.PacketSize = pProperty->MaxPacketSize;
-                DataStageIn();
+  else
+  {
-        else {
+    pInformation->ControlState = OUT_DATA;
-                pInformation->ControlState = OUT_DATA;
+    vSetEPRxStatus(EP_RX_VALID); /* enable for next data reception */
                 vSetEPRxStatus(EP_RX_VALID);/* enable for next data reception */
   return;
-        return;
+}
-} /* Data_Setup0 */
+/*******************************************************************************
-/*******************************************************************************
+* Function Name  : Setup0_Process
-* Function Name  : Setup0_Process
+* Description    : Get the device request data and dispatch to individual process.
-* Description    : Get the device request data and dispatch to individual process
+* Input          : None.
-* Input          :
+* Output         : None.
     /* Setup with data stage */
     Data_Setup0();
+  }
   return Post0_Process();
+}
 /*******************************************************************************
 * Function Name  : In0_Process
-* Description    : Process the IN token on all default endpoint
+* Description    : Process the IN token on all default endpoint.
-* Input          :
+* Input          : None.
-* Output         :
+* Output         : None.
-* Return         :
+* Return         : Post0_Process.
 *******************************************************************************/
 u8 In0_Process(void)
+{
-        u32     ControlState = pInformation->ControlState;
+  u32 ControlState = pInformation->ControlState;
-        if (ControlState == IN_DATA || ControlState == LAST_IN_DATA)
+  if ((ControlState == IN_DATA) || (ControlState == LAST_IN_DATA))
+  {
+    DataStageIn();
-                DataStageIn();
+    ControlState = pInformation->ControlState;
-                ControlState = pInformation->ControlState; /* may be changed outside the function */
+    /* may be changed outside the function */
-        }
+  }
+  else if (ControlState == WAIT_STATUS_IN)
         else if (ControlState == WAIT_STATUS_IN) {
-                if (pInformation->USBbRequest == SET_ADDRESS &&
+    if (pInformation->USBbRequest == SET_ADDRESS &&
-                                Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT) )
+        Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT) )
+    {
-                        SetDeviceAddress(pInformation->USBwValue0);
+      SetDeviceAddress(pInformation->USBwValue0);
-                        pUser_Standard_Requests->User_SetDeviceAddress();
+      pUser_Standard_Requests->User_SetDeviceAddress();
+    }
-                (*pProperty->Process_Status_IN)();
+    (*pProperty->Process_Status_IN)();
-                ControlState = STALLED;
+    ControlState = STALLED;
-        }
+  }
+  else
         else
+    ControlState = STALLED;
         ControlState = STALLED;
-        pInformation->ControlState = ControlState;
+  pInformation->ControlState = ControlState;
   return Post0_Process();
         return Post0_Process();
-}
 /*******************************************************************************
 * Function Name  : Out0_Process
-* Description    : Process the OUT token on all default endpoint
+* Description    : Process the OUT token on all default endpoint.
-* Input          :
+* Input          : None.
-* Output         :
+* Output         : None.
-* Return         :
+* Return         : Post0_Process.
 *******************************************************************************/
 u8 Out0_Process(void)
+{
   u32 ControlState = pInformation->ControlState;
+  if ((ControlState == OUT_DATA) || (ControlState == LAST_OUT_DATA))
-        u32     ControlState = pInformation->ControlState;
+  {
+    DataStageOut();
+    ControlState = pInformation->ControlState;
-        if(ControlState == OUT_DATA || ControlState == LAST_OUT_DATA)
+    /* may be changed outside the function */
                 DataStageOut();
   else if (ControlState == WAIT_STATUS_OUT)
-        else if (ControlState == WAIT_STATUS_OUT) {
-                (*pProperty->Process_Status_OUT)();
+  {
+    (*pProperty->Process_Status_OUT)();
-                ControlState = STALLED;
+    ControlState = STALLED;
+  }
   else if ((ControlState == IN_DATA) || (ControlState == LAST_IN_DATA))
-        else if (ControlState == IN_DATA || ControlState == LAST_IN_DATA) {
-                /* host aborts the transfer before finish */
                                 ControlState = STALLED;
-        }
+    /* host aborts the transfer before finish */
+    ControlState = STALLED;
+  }
-        /* Unexpect state, STALL the endpoint */
+  /* Unexpect state, STALL the endpoint */
-        else {
+  else
+  {
-                ControlState = STALLED;
+    ControlState = STALLED;
+  }
-        pInformation->ControlState = ControlState;
+  pInformation->ControlState = ControlState;
-        return Post0_Process();
+  return Post0_Process();
+} /* Out0_Process */
-} /* Out0_Process */
 /*******************************************************************************
-/*******************************************************************************
+* Function Name  : Post0_Process
-* Function Name  : Post0_Process
+* Description    : Stall the Endpoint 0 in case of error.
-* Description    :
+* Input          : None.
-* Input          :
+* Output         : None.
+* Return         : - 0 if the control State is in PAUSE
-* Output         :
+*                  - 1 if not.
-* Return         :
+*******************************************************************************/
-*******************************************************************************/
+u8 Post0_Process(void)
 u8 Post0_Process(void)
   SetEPRxCount(ENDP0, Device_Property.MaxPacketSize);
-        SetEPRxCount(ENDP0, Device_Property.MaxPacketSize);
+  if (pInformation->ControlState == STALLED)
+  {
-        if (pInformation->ControlState == STALLED) {
+    vSetEPRxStatus(EP_RX_STALL);
-                vSetEPRxStatus(EP_RX_STALL);
+    vSetEPTxStatus(EP_TX_STALL);
-                vSetEPTxStatus(EP_TX_STALL);
+  }
-        }
   return (pInformation->ControlState == PAUSE);
         return (pInformation->ControlState == PAUSE);
 /*******************************************************************************
-* Function Name  : SetDeviceAddress
+* Function Name  : SetDeviceAddress.
-* Description    : set the device and all the used Endpoints addresses
+* Description    : Set the device and all the used Endpoints addresses.
-* Input          : Val : device adress
+* Input          : - Val: device adress.
-* Output         :
+* Output         : None.
-* Return         :
+* Return         : None.
 *******************************************************************************/
 void SetDeviceAddress(u8 Val)
+{
+  u32 i;
-  u32 i;
+  u32 nEP = Device_Table.Total_Endpoint;
   u32   nEP = Device_Table.Total_Endpoint;
+  /* set address in every used endpoint */
-        /* set address in every used endpoint */
+  for (i = 0; i < nEP; i++)
-        for(i=0;i<nEP;i++)
+  {
-        {
+    _SetEPAddress((u8)i, (u8)i);
                 _SetEPAddress((u8)i, (u8)i);
-        } /* for */
+  _SetDADDR(Val | DADDR_EF); /* set device address and enable function */
         _SetDADDR(Val|DADDR_EF); /* set device address and enable function */
+}
-}

Subversion Repositories NaviCtrl

(root)/tags/V0.28i/usblibrary/src/usb_core.c @ 506 - Rev 1 → 196