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 ClrBit(VAR,Place)    (VAR &= ((1<<Place)^255))
+#define Send0LengthData() { \
+    _SetEPTxCount(ENDP0, 0); \
+    vSetEPTxStatus(EP_TX_VALID); \
-#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 vSetEPRxStatus(st)      (SaveRState = st)
+#define USB_StatusIn()       Send0LengthData()
-#define vSetEPTxStatus(st)      (SaveTState = st)
-#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 StatusInfo1          StatusInfo.bw.bb0
 #define StatusInfo0 StatusInfo.bw.bb1   /* Reverse bb0 & bb1 */
+/* Private macro -------------------------------------------------------------*/
+/* Private variables ---------------------------------------------------------*/
+u16_u8 StatusInfo;
+bool Data_Mul_MaxPacketSize = FALSE;
-#define StatusInfo1 StatusInfo.bw.bb0
+/* Private function prototypes -----------------------------------------------*/
-/* Private macro -------------------------------------------------------------*/
+static void DataStageOut(void);
-/* Private variables ---------------------------------------------------------*/
+static void DataStageIn(void);
-u16_u8 StatusInfo;
+static void NoData_Setup0(void);
-/* Private function prototypes -----------------------------------------------*/
+static void Data_Setup0(void);
 /* Private functions ---------------------------------------------------------*/
-/*******************************************************************************
-* Function Name  : Standard_GetConfiguration
+/*******************************************************************************
-* Description    : Return the current configuration variable address
+* Function Name  : Standard_GetConfiguration.
-* Input          : Length - How many bytes are needed.
+* Description    : Return the current configuration variable address.
-* 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 "Buffer" if the "Length" is not 0.
-* Return         : Return 1 , if the request is invalid when "Length" is 0
+*******************************************************************************/
+u8 *Standard_GetConfiguration(u16 Length)
-                   Return "Buffer" if the "Length" is not 0
+{
-*******************************************************************************/
+  if (Length == 0)
-u8 *Standard_GetConfiguration(u16 Length)
+  {
-{
+    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         : 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;
-* Output         :
-* 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();
+  else
-                return USB_SUCCESS;
+  {
-        }
+    return USB_UNSUPPORT;
-        else
+  }
-        return USB_UNSUPPORT;
 }
-/*******************************************************************************
-* Function Name  : Standard_GetInterface
+/*******************************************************************************
-* Description    : Return the Alternate Setting of the current interface
+* Function Name  : Standard_GetInterface.
-* Input          : Length - How many bytes are needed
+* Description    : Return the Alternate Setting of the current interface.
-* Output         : If "Length" is 0, return the length of interface value
+* Input          : Length - How many bytes are needed.
+* Output         : None.
+* Return         : Return 0, if the request is invalid when "Length" is 0.
-                   If "Length" is not 0, return the data buffer address
+*                  Return "Buffer" if the "Length" is not 0.
-* 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)
-*******************************************************************************/
+{
-u8 *Standard_GetInterface(u16 Length)
+  if (Length == 0)
+  {
+    pInformation->Ctrl_Info.Usb_wLength =
-  if (Length == 0){
+      sizeof(pInformation->Current_AlternateSetting);
-        pInformation->Ctrl_Info.Usb_wLength =   sizeof(pInformation->Current_AlternateSetting);
+    return 0;
-    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 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,
-        RESULT                  Re;
+       pInformation->USBwValue0);
-        /*Test if the specified Interface and Alternate Setting are supported by the application Firmware*/
+  if (pInformation->Current_Configuration != 0 )
-        Re = (*pProperty->Class_Get_Interface_Setting)(pInformation->USBwIndex0,pInformation->USBwValue0);
+  {
+    if (Re != USB_SUCCESS || pInformation->USBwIndex1 != 0
-        if(pInformation->Current_Configuration!=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();
-                 pInformation->Current_Interface = pInformation->USBwIndex0;
+    {
-                 pInformation->Current_AlternateSetting = pInformation->USBwValue0;
+      pUser_Standard_Requests->User_SetInterface();
+      pInformation->Current_Interface = pInformation->USBwIndex0;
-                 return USB_SUCCESS;
+      pInformation->Current_AlternateSetting = pInformation->USBwValue0;
-                }
+      return USB_SUCCESS;
+    }
-        }
+  }
+  return USB_UNSUPPORT;
- return USB_UNSUPPORT;
+}
-/*******************************************************************************
-* Function Name  : Standard_GetStatus
+/*******************************************************************************
-* Description    : Copy the device request data to "StatusInfo buffer"
+* Function Name  : Standard_GetStatus.
-* 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.
+* Output         : None.
-                   If "Length" is not 0, return number of bytes have been copied
+* Return         : Return 0, if the request is at end of data block,
-* 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 */
+  if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT))
-        StatusInfo.w = 0;
+  {
-                                /* Reset Status Information */
+    /*Get Device Status */
+    u8 Feature = pInformation->Current_Feature;
-        if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) {/*Get Device Status */
+    /* Remote Wakeup enabled */
+    if (ValBit(Feature, 5))
+    {
+      SetBit(StatusInfo0, 1);
-                u8      Feature = pInformation->Current_Feature;
+    }
-                if (ValBit(Feature, 5))
+    /* Bus-powered */
+    if (ValBit(Feature, 6))
-                        SetBit(StatusInfo0, 1); /* Remote Wakeup enabled */
+    {
+      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*/
+  }
-                        return (u8 *)&StatusInfo;
+  /*Get EndPoint Status*/
+  else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT))
+  {
-        else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT)) {/*Get EndPoint Status*/
+    u8 Related_Endpoint;
+    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 */
-                        else {
+      if (_GetRxStallStatus(Related_Endpoint))
+      {
-                                /* OUT endpoint */
+        SetBit(StatusInfo0, 0); /* OUT Endpoint stalled */
+      }
-                                if (_GetRxStallStatus( Related_Endpoint ))
+    }
-                                SetBit(StatusInfo0, 0); /* OUT Endpoint stalled */
-                        }
+  }
+  else
+  {
-        }
+    return NULL;
-        else
+  }
-                return NULL;
+  pUser_Standard_Requests->User_GetStatus();
-        pUser_Standard_Requests->User_GetStatus();
+  return (u8 *)&StatusInfo;
-        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          :
-* Output         :
-* Return         :
-*******************************************************************************/
-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);
-                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)) Status =_GetEPTxStatus(Related_Endpoint);/*Get Status of endpoint & stall the request if
-                                                                                                      the related_ENdpoint is Disabled*/
-                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);
+* 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);
+          _SetEPRxStatus(Related_Endpoint, EP_RX_VALID);
+        }
+      }
+    }
     pUser_Standard_Requests->User_ClearFeature();
-                pUser_Standard_Requests->User_ClearFeature();
+    return USB_SUCCESS;
-                return USB_SUCCESS;
+  }
-        }
+  return USB_UNSUPPORT;
+}
         return USB_UNSUPPORT;
 /*******************************************************************************
-/*******************************************************************************
+* Function Name  : Standard_SetEndPointFeature
-* Function Name  : Standard_SetEndPointFeature
+* Description    : Set or enable a specific feature of EndPoint
-* Description    : Set or enable a specific feature of EndPoint
+* 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_SetEndPointFeature(void)
 {
-        u32    wIndex0;
+  u32    wIndex0;
+  u32    Related_Endpoint;
-        u32    Related_Endpoint;
+  u32    rEP;
+  u32   Status;
-        u32    rEP;
+  wIndex0 = pInformation->USBwIndex0;
+  rEP = wIndex0 & ~0x80;
+  Related_Endpoint = ENDP0 + rEP;
-        u32   Status;
+  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);
+    }
-                wIndex0 = pInformation->USBwIndex0;
-                rEP = wIndex0 & ~0x80;
-                Related_Endpoint = ENDP0 + rEP;
-                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 (Related_Endpoint >= Device_Table.Total_Endpoint || pInformation->USBwValue !=0 || Status==0 ||
-                        pInformation->Current_Configuration==0 /*&& Related_Endpoint!=ENDP0)*/)
-                        return USB_UNSUPPORT;
-                else {
-                        if (wIndex0 & 0x80) {           /* IN endpoint */
-                                _SetEPTxStatus(Related_Endpoint, EP_TX_STALL);
-                        }
+    else
+    {    /* OUT endpoint */
-                        else {                          /* OUT endpoint */
+      _SetEPRxStatus(Related_Endpoint, EP_RX_STALL);
-                                _SetEPRxStatus(Related_Endpoint, EP_RX_STALL);
+    }
-                        }
+  }
-                }
+  pUser_Standard_Requests->User_SetEndPointFeature();
+  return USB_SUCCESS;
         pUser_Standard_Requests->User_SetEndPointFeature();
         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.
-/*******************************************************************************
+* Description    : Standard_GetDescriptorData is used for descriptors transfer.
+*                : This routine is used for the descriptors resident in Flash
-* Function Name  : Standard_GetDescriptorData
+*                  or RAM
-* Description    : Standard_GetDescriptorData is used for descriptors transfer
+*                  pDesc can be in either Flash or RAM
-*                : This routine is used for the descriptors resident in Flash or RAM
+*                  The purpose of this routine is to have a versatile way to
-                  pDesc can be in either Flash or RAM
+*                  response descriptors request. It allows user to generate
-                  The purpose of this routine is to have a versatile way to response
-                  descriptors request. It allows user to generate certain descriptors
+*                  certain descriptors with software or read descriptors from
-                  with software or read descriptors from external storage part by part.
+*                  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
+*                  The structure gives the initial address of the descriptor and
+*                  its original size.
-                          descriptor and its original size
+* Output         : None.
-* Output         : Address of a part of the descriptor pointed by the Usb_wOffset
+* Return         : Address of a part of the descriptor pointed by the Usb_
-                   The buffer pointed by this address contains at least Length bytes
+*                  wOffset The buffer pointed by this address contains at least
-* Return         :
+*                  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;
+  if (Length == 0)
-        wOffset = pInformation->Ctrl_Info.Usb_wOffset;
+  {
-        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.
+* 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)
-/*******************************************************************************
-* Function Name  : DataStageOut
-* Description    : Data stage of a Control Write Transfer
-* Input          :
-* Output         :
-* Return         :
-*******************************************************************************/
-void DataStageOut(void)
-{
-        ENDPOINT_INFO   *pEPinfo = &pInformation->Ctrl_Info;
-        u32     save_rLength;
-        save_rLength = pEPinfo->Usb_rLength;
+  {
+    u8 *Buffer;
-        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 */
+    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;
 /* 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();
-                                }
+    }
+  }
+}
+/*******************************************************************************
+* 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)
-/*******************************************************************************
+    {
-* Function Name  : DataStageIn
-* Description    : Data stage of a Control Read Transfer
-* Input          :
-* Output         :
-* Return         :
+      /* No more data to send and empty packet */
+      Send0LengthData();
-*******************************************************************************/
+      ControlState = LAST_IN_DATA;
+      Data_Mul_MaxPacketSize = FALSE;
-void DataStageIn(void)
+    }
-{
-        ENDPOINT_INFO   *pEPinfo = &pInformation->Ctrl_Info;
-        u32     save_wLength = pEPinfo->Usb_wLength;
-        u32     ControlState = pInformation->ControlState;
+    else
+    {
-        u8      *DataBuffer;
+      /* No more data to send so STALL the TX Status*/
-        u32     Length;
+      ControlState = WAIT_STATUS_OUT;
+      vSetEPTxStatus(EP_TX_STALL);
-        if ((save_wLength == 0) && (ControlState == LAST_IN_DATA))
+    }
-        { /* no more data to send so STALL the TX Status*/
                 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)
-        if (Length > save_wLength)
+  {
-                Length = save_wLength;
+    Length = save_wLength;
+  }
         DataBuffer = (*pEPinfo->CopyData)(Length);
+  DataBuffer = (*pEPinfo->CopyData)(Length);
-        UserToPMABufferCopy(DataBuffer,GetEPTxAddr(ENDP0),Length);
+  UserToPMABufferCopy(DataBuffer, GetEPTxAddr(ENDP0), Length);
-        SetEPTxCount(ENDP0, Length);
+  SetEPTxCount(ENDP0, Length);
-        pEPinfo->Usb_wLength -= Length;
+  pEPinfo->Usb_wLength -= Length;
-        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;
+}
+/*******************************************************************************
-Expect_Status_Out:
+* Function Name  : NoData_Setup0.
+* Description    : Proceed the processing of setup request without data stage.
-        pInformation->ControlState = ControlState;
+* Input          : None.
-}
+* Output         : None.
-/*******************************************************************************
+* Return         : None.
-* Function Name  : NoData_Setup0
+*******************************************************************************/
-* Description    : Proceed the processing of setup request without data stage
+void NoData_Setup0(void)
-* Input          : None
+{
+  RESULT Result = USB_UNSUPPORT;
+  u32 RequestNo = pInformation->USBbRequest;
-* Output         : None
+  u32 ControlState;
-* Return         : None
+  if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT))
-*******************************************************************************/
+  {/* Device Request*/
-void NoData_Setup0(void)
+    /* SET_CONFIGURATION*/
-{
+    if (RequestNo == SET_CONFIGURATION)
+    {
-        RESULT  Result = USB_UNSUPPORT;
+      Result = Standard_SetConfiguration();
-        u32     RequestNo = pInformation->USBbRequest;
+    }
-        u32     ControlState;
+    /*SET ADDRESS*/
-        if (Type_Recipient == (STANDARD_REQUEST | DEVICE_RECIPIENT)) {/* Device Request*/
+    else if (RequestNo == SET_ADDRESS)
-                /* SET_CONFIGURATION*/
-                if (RequestNo == SET_CONFIGURATION)
-                        Result = Standard_SetConfiguration();
+    {
+      if (pInformation->USBwValue0 > 127 || pInformation->USBwValue1 != 0
-                /*SET ADDRESS*/
+          || pInformation->USBwIndex != 0
-                else if (RequestNo == SET_ADDRESS){
-                        if(pInformation->USBwValue0 > 127 || pInformation->USBwValue1!=0
+          || pInformation->Current_Configuration != 0)
-                                ||pInformation->USBwIndex!=0 || pInformation->Current_Configuration!=0) /* Device Address should be 127 or less*/
-                                                                                          /*call Beck spec USB 2.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*/
+        ControlState = STALLED;
-                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;
+        goto exit_NoData_Setup0;
-                        }
+      }
-                /*Clear FEATURE for Device */
-                else if (RequestNo == CLEAR_FEATURE){
+      else
-                        if (pInformation->USBwValue0==DEVICE_REMOTE_WAKEUP && pInformation->USBwIndex==0 && ValBit(pInformation->Current_Feature, 5))
+      {
-                        Result = Standard_ClearFeature();
-                        else
+        Result = USB_SUCCESS;
-                        Result = USB_UNSUPPORT;
+      }
-                }
+    }
-         }
-        /* Interface Request*/
+    /*SET FEATURE for Device*/
-        else if (Type_Recipient == (STANDARD_REQUEST | INTERFACE_RECIPIENT)) {
+    else if (RequestNo == SET_FEATURE)
-                        /*SET INTERFACE*/
-                        if (RequestNo == SET_INTERFACE)
-                                Result = Standard_SetInterface();
+    {
-        }
-        /* EndPoint Request*/
-        else if (Type_Recipient == (STANDARD_REQUEST | ENDPOINT_RECIPIENT)) {
+      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();
+    }
+  }
-                        /*CLEAR FEATURE for EndPoint*/
+  /* 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();
-                        if (RequestNo == CLEAR_FEATURE)
+    }
                          Result = Standard_ClearFeature();
-                        /* SET FEATURE for EndPoint*/
+  else
-                         else if (RequestNo == SET_FEATURE){
+  {
-                                Result = Standard_SetEndPointFeature();
+    Result = USB_UNSUPPORT;
+  }
-        }
+  if (Result != USB_SUCCESS)
-        else
+  {
-                        Result = USB_UNSUPPORT;
+    Result = (*pProperty->Class_NoData_Setup)(RequestNo);
+    if (Result == USB_NOT_READY)
+    {
-        if (Result != USB_SUCCESS) {
+      ControlState = PAUSE;
-                    Result = (*pProperty->Class_NoData_Setup)(RequestNo);
+      goto exit_NoData_Setup0;
                     if (Result == USB_NOT_READY) {
-        if (pInformation->Ctrl_Info.Usb_wLength == 0xFFFF) {    /* Data is not ready, wait it */
                 pInformation->ControlState = PAUSE;
-                return;
+      pInformation->Ctrl_Info.Usb_wLength = wLength;
-        }
+    }
-        if (Result == USB_UNSUPPORT || pInformation->Ctrl_Info.Usb_wLength == 0) {
-                /* Unsupported request */
+    else if (pInformation->Ctrl_Info.Usb_wLength < pInformation->USBwLength)
-                pInformation->ControlState = STALLED;
+    {
-                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;
+  else
-                DataStageIn();
+  {
-        }
+    pInformation->ControlState = OUT_DATA;
-        else {
+    vSetEPRxStatus(EP_RX_VALID); /* enable for next data reception */
-                pInformation->ControlState = OUT_DATA;
+  }
-                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.
-* Output         :
+* Return         : Post0_Process.
-* Return         :
+*******************************************************************************/
-*******************************************************************************/
+u8 Setup0_Process(void)
-u8 Setup0_Process(void)
+{
-{
+#ifdef STR7xx /* STR7xx family*/
-#ifdef STR7xx /* STR7xx family*/
+  union {
-  union {
+    u8* b;
-        u8*     b;
+    u16* w;
-        u16*    w;
+  } pBuf;
-        } pBuf;
+  pBuf.b = PMAAddr + (u8 *)(_GetEPRxAddr(ENDP0) * 2); /* *2 for 32 bits addr */
   pBuf.b = PMAAddr + (u8 *)(_GetEPRxAddr(ENDP0)*2); /* *2 for 32 bits addr */
     /* 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)
-        {
-                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;
+  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;
+  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)
-                DataStageOut();
-        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 {
+{
+  u32 ControlState = pInformation->ControlState;
-                ControlState = STALLED;
+  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;
+  pInformation->ControlState = ControlState;
-        return Post0_Process();
+  return Post0_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.
-* Output         :
+* Return         : - 0 if the control State is in PAUSE
-* Return         :
+*                  - 1 if not.
+*******************************************************************************/
-*******************************************************************************/
+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   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 */
+}
 /*******************************************************************************
 * Function Name  : NOP_Process

Subversion Repositories NaviCtrl

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