[mirror_edk2.git] / MdeModulePkg / Bus / Usb / UsbBusPei / UsbPeim.c

/** @file\r
The module to produce Usb Bus PPI.\r
\r
Copyright (c) 2006 - 2018, Intel Corporation. All rights reserved.<BR>\r
\r
SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "UsbPeim.h"\r
#include "HubPeim.h"\r
#include "PeiUsbLib.h"\r
\r
//\r
// UsbIo PPI interface function\r
//\r
PEI_USB_IO_PPI  mUsbIoPpi = {\r
  PeiUsbControlTransfer,\r
  PeiUsbBulkTransfer,\r
  PeiUsbGetInterfaceDescriptor,\r
  PeiUsbGetEndpointDescriptor,\r
  PeiUsbPortReset\r
};\r
\r
EFI_PEI_PPI_DESCRIPTOR  mUsbIoPpiList = {\r
  (EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST),\r
  &gPeiUsbIoPpiGuid,\r
  NULL\r
};\r
\r
/**\r
  The enumeration routine to detect device change.\r
\r
  @param  PeiServices            Describes the list of possible PEI Services.\r
  @param  UsbHcPpi               The pointer of PEI_USB_HOST_CONTROLLER_PPI instance.\r
  @param  Usb2HcPpi              The pointer of PEI_USB2_HOST_CONTROLLER_PPI instance.\r
\r
  @retval EFI_SUCCESS            The usb is enumerated successfully.\r
  @retval EFI_OUT_OF_RESOURCES   Can't allocate memory resource.\r
  @retval Others                 Other failure occurs.\r
\r
**/\r
EFI_STATUS\r
PeiUsbEnumeration (\r
  IN EFI_PEI_SERVICES              **PeiServices,\r
  IN PEI_USB_HOST_CONTROLLER_PPI   *UsbHcPpi,\r
  IN PEI_USB2_HOST_CONTROLLER_PPI  *Usb2HcPpi\r
  );\r
\r
/**\r
  Configure new detected usb device.\r
\r
  @param  PeiServices            Describes the list of possible PEI Services.\r
  @param  PeiUsbDevice           The pointer of PEI_USB_DEVICE instance.\r
  @param  Port                   The port to be configured.\r
  @param  DeviceAddress          The device address to be configured.\r
\r
  @retval EFI_SUCCESS            The new detected usb device is configured successfully.\r
  @retval EFI_OUT_OF_RESOURCES   Can't allocate memory resource.\r
  @retval Others                 Other failure occurs.\r
\r
**/\r
EFI_STATUS\r
PeiConfigureUsbDevice (\r
  IN     EFI_PEI_SERVICES  **PeiServices,\r
  IN     PEI_USB_DEVICE    *PeiUsbDevice,\r
  IN     UINT8             Port,\r
  IN OUT UINT8             *DeviceAddress\r
  );\r
\r
/**\r
  Get all configurations from a detected usb device.\r
\r
  @param  PeiServices            Describes the list of possible PEI Services.\r
  @param  PeiUsbDevice           The pointer of PEI_USB_DEVICE instance.\r
\r
  @retval EFI_SUCCESS            The new detected usb device is configured successfully.\r
  @retval EFI_OUT_OF_RESOURCES   Can't allocate memory resource.\r
  @retval Others                 Other failure occurs.\r
\r
**/\r
EFI_STATUS\r
PeiUsbGetAllConfiguration (\r
  IN EFI_PEI_SERVICES  **PeiServices,\r
  IN PEI_USB_DEVICE    *PeiUsbDevice\r
  );\r
\r
/**\r
  Get the start position of next wanted descriptor.\r
\r
  @param  Buffer            Buffer containing data to parse.\r
  @param  Length            Buffer length.\r
  @param  DescType          Descriptor type.\r
  @param  DescLength        Descriptor length.\r
  @param  ParsedBytes       Bytes has been parsed.\r
\r
  @retval EFI_SUCCESS       Get wanted descriptor successfully.\r
  @retval EFI_DEVICE_ERROR  Error occurred.\r
\r
**/\r
EFI_STATUS\r
GetExpectedDescriptor (\r
  IN  UINT8  *Buffer,\r
  IN  UINTN  Length,\r
  IN  UINT8  DescType,\r
  IN  UINT8  DescLength,\r
  OUT UINTN  *ParsedBytes\r
  );\r
\r
/**\r
  The entrypoint of the module, it will enumerate all HCs.\r
\r
  @param  FileHandle             Handle of the file being invoked.\r
  @param  PeiServices            Describes the list of possible PEI Services.\r
\r
  @retval EFI_SUCCESS            Usb initialization is done successfully.\r
  @retval EFI_OUT_OF_RESOURCES   Can't allocate memory resource.\r
  @retval EFI_UNSUPPORTED        Can't find required PPI.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PeimInitializeUsb (\r
  IN EFI_PEI_FILE_HANDLE     FileHandle,\r
  IN CONST EFI_PEI_SERVICES  **PeiServices\r
  )\r
{\r
  EFI_STATUS                    Status;\r
  UINTN                         Index;\r
  PEI_USB_HOST_CONTROLLER_PPI   *UsbHcPpi;\r
  PEI_USB2_HOST_CONTROLLER_PPI  *Usb2HcPpi;\r
\r
  if (!EFI_ERROR (PeiServicesRegisterForShadow (FileHandle))) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // gPeiUsbHostControllerPpiGuid and gPeiUsb2HostControllerPpiGuid should not\r
  // be produced at the same time\r
  //\r
  Index = 0;\r
  while (TRUE) {\r
    //\r
    // Get UsbHcPpi at first.\r
    //\r
    Status = PeiServicesLocatePpi (\r
               &gPeiUsbHostControllerPpiGuid,\r
               Index,\r
               NULL,\r
               (VOID **)&UsbHcPpi\r
               );\r
    if (EFI_ERROR (Status)) {\r
      //\r
      // No more host controller, break out\r
      //\r
      break;\r
    }\r
\r
    PeiUsbEnumeration ((EFI_PEI_SERVICES **)PeiServices, UsbHcPpi, NULL);\r
    Index++;\r
  }\r
\r
  if (Index == 0) {\r
    //\r
    // Then try to get Usb2HcPpi.\r
    //\r
    while (TRUE) {\r
      Status = PeiServicesLocatePpi (\r
                 &gPeiUsb2HostControllerPpiGuid,\r
                 Index,\r
                 NULL,\r
                 (VOID **)&Usb2HcPpi\r
                 );\r
      if (EFI_ERROR (Status)) {\r
        //\r
        // No more host controller, break out\r
        //\r
        break;\r
      }\r
\r
      PeiUsbEnumeration ((EFI_PEI_SERVICES **)PeiServices, NULL, Usb2HcPpi);\r
      Index++;\r
    }\r
  }\r
\r
  if (Index == 0) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  The Hub Enumeration just scans the hub ports one time. It also\r
  doesn't support hot-plug.\r
\r
  @param  PeiServices            Describes the list of possible PEI Services.\r
  @param  PeiUsbDevice           The pointer of PEI_USB_DEVICE instance.\r
  @param  CurrentAddress         The DeviceAddress of usb device.\r
\r
  @retval EFI_SUCCESS            The usb hub is enumerated successfully.\r
  @retval EFI_OUT_OF_RESOURCES   Can't allocate memory resource.\r
  @retval Others                 Other failure occurs.\r
\r
**/\r
EFI_STATUS\r
PeiHubEnumeration (\r
  IN EFI_PEI_SERVICES  **PeiServices,\r
  IN PEI_USB_DEVICE    *PeiUsbDevice,\r
  IN UINT8             *CurrentAddress\r
  )\r
{\r
  UINTN                 Index;\r
  EFI_STATUS            Status;\r
  PEI_USB_IO_PPI        *UsbIoPpi;\r
  EFI_USB_PORT_STATUS   PortStatus;\r
  UINTN                 MemPages;\r
  EFI_PHYSICAL_ADDRESS  AllocateAddress;\r
  PEI_USB_DEVICE        *NewPeiUsbDevice;\r
  UINTN                 InterfaceIndex;\r
  UINTN                 EndpointIndex;\r
\r
  UsbIoPpi = &PeiUsbDevice->UsbIoPpi;\r
\r
  DEBUG ((DEBUG_INFO, "PeiHubEnumeration: DownStreamPortNo: %x\n", PeiUsbDevice->DownStreamPortNo));\r
\r
  for (Index = 0; Index < PeiUsbDevice->DownStreamPortNo; Index++) {\r
    Status = PeiHubGetPortStatus (\r
               PeiServices,\r
               UsbIoPpi,\r
               (UINT8)(Index + 1),\r
               (UINT32 *)&PortStatus\r
               );\r
\r
    if (EFI_ERROR (Status)) {\r
      continue;\r
    }\r
\r
    DEBUG ((DEBUG_INFO, "USB Status --- Port: %x ConnectChange[%04x] Status[%04x]\n", Index, PortStatus.PortChangeStatus, PortStatus.PortStatus));\r
    //\r
    // Only handle connection/enable/overcurrent/reset change.\r
    //\r
    if ((PortStatus.PortChangeStatus & (USB_PORT_STAT_C_CONNECTION | USB_PORT_STAT_C_ENABLE | USB_PORT_STAT_C_OVERCURRENT | USB_PORT_STAT_C_RESET)) == 0) {\r
      continue;\r
    } else {\r
      if (IsPortConnect (PortStatus.PortStatus)) {\r
        //\r
        // Begin to deal with the new device\r
        //\r
        MemPages = sizeof (PEI_USB_DEVICE) / EFI_PAGE_SIZE + 1;\r
        Status   = PeiServicesAllocatePages (\r
                     EfiBootServicesCode,\r
                     MemPages,\r
                     &AllocateAddress\r
                     );\r
        if (EFI_ERROR (Status)) {\r
          return EFI_OUT_OF_RESOURCES;\r
        }\r
\r
        NewPeiUsbDevice = (PEI_USB_DEVICE *)((UINTN)AllocateAddress);\r
        ZeroMem (NewPeiUsbDevice, sizeof (PEI_USB_DEVICE));\r
\r
        NewPeiUsbDevice->Signature      = PEI_USB_DEVICE_SIGNATURE;\r
        NewPeiUsbDevice->DeviceAddress  = 0;\r
        NewPeiUsbDevice->MaxPacketSize0 = 8;\r
        NewPeiUsbDevice->DataToggle     = 0;\r
        CopyMem (\r
          &(NewPeiUsbDevice->UsbIoPpi),\r
          &mUsbIoPpi,\r
          sizeof (PEI_USB_IO_PPI)\r
          );\r
        CopyMem (\r
          &(NewPeiUsbDevice->UsbIoPpiList),\r
          &mUsbIoPpiList,\r
          sizeof (EFI_PEI_PPI_DESCRIPTOR)\r
          );\r
        NewPeiUsbDevice->UsbIoPpiList.Ppi = &NewPeiUsbDevice->UsbIoPpi;\r
        NewPeiUsbDevice->AllocateAddress  = (UINTN)AllocateAddress;\r
        NewPeiUsbDevice->UsbHcPpi         = PeiUsbDevice->UsbHcPpi;\r
        NewPeiUsbDevice->Usb2HcPpi        = PeiUsbDevice->Usb2HcPpi;\r
        NewPeiUsbDevice->Tier             = (UINT8)(PeiUsbDevice->Tier + 1);\r
        NewPeiUsbDevice->IsHub            = 0x0;\r
        NewPeiUsbDevice->DownStreamPortNo = 0x0;\r
\r
        if (((PortStatus.PortChangeStatus & USB_PORT_STAT_C_RESET) == 0) ||\r
            ((PortStatus.PortStatus & (USB_PORT_STAT_CONNECTION | USB_PORT_STAT_ENABLE)) == 0))\r
        {\r
          //\r
          // If the port already has reset change flag and is connected and enabled, skip the port reset logic.\r
          //\r
          PeiResetHubPort (PeiServices, UsbIoPpi, (UINT8)(Index + 1));\r
\r
          PeiHubGetPortStatus (\r
            PeiServices,\r
            UsbIoPpi,\r
            (UINT8)(Index + 1),\r
            (UINT32 *)&PortStatus\r
            );\r
        } else {\r
          PeiHubClearPortFeature (\r
            PeiServices,\r
            UsbIoPpi,\r
            (UINT8)(Index + 1),\r
            EfiUsbPortResetChange\r
            );\r
        }\r
\r
        NewPeiUsbDevice->DeviceSpeed = (UINT8)PeiUsbGetDeviceSpeed (PortStatus.PortStatus);\r
        DEBUG ((DEBUG_INFO, "Device Speed =%d\n", PeiUsbDevice->DeviceSpeed));\r
\r
        if (USB_BIT_IS_SET (PortStatus.PortStatus, USB_PORT_STAT_SUPER_SPEED)) {\r
          NewPeiUsbDevice->MaxPacketSize0 = 512;\r
        } else if (USB_BIT_IS_SET (PortStatus.PortStatus, USB_PORT_STAT_HIGH_SPEED)) {\r
          NewPeiUsbDevice->MaxPacketSize0 = 64;\r
        } else if (USB_BIT_IS_SET (PortStatus.PortStatus, USB_PORT_STAT_LOW_SPEED)) {\r
          NewPeiUsbDevice->MaxPacketSize0 = 8;\r
        } else {\r
          NewPeiUsbDevice->MaxPacketSize0 = 8;\r
        }\r
\r
        if (NewPeiUsbDevice->DeviceSpeed != EFI_USB_SPEED_HIGH) {\r
          if (PeiUsbDevice->DeviceSpeed == EFI_USB_SPEED_HIGH) {\r
            NewPeiUsbDevice->Translator.TranslatorPortNumber = (UINT8)Index;\r
            NewPeiUsbDevice->Translator.TranslatorHubAddress = *CurrentAddress;\r
          } else {\r
            CopyMem (&(NewPeiUsbDevice->Translator), &(PeiUsbDevice->Translator), sizeof (EFI_USB2_HC_TRANSACTION_TRANSLATOR));\r
          }\r
        }\r
\r
        //\r
        // Configure that Usb Device\r
        //\r
        Status = PeiConfigureUsbDevice (\r
                   PeiServices,\r
                   NewPeiUsbDevice,\r
                   (UINT8)(Index + 1),\r
                   CurrentAddress\r
                   );\r
\r
        if (EFI_ERROR (Status)) {\r
          continue;\r
        }\r
\r
        DEBUG ((DEBUG_INFO, "PeiHubEnumeration: PeiConfigureUsbDevice Success\n"));\r
\r
        Status = PeiServicesInstallPpi (&NewPeiUsbDevice->UsbIoPpiList);\r
\r
        if (NewPeiUsbDevice->InterfaceDesc->InterfaceClass == 0x09) {\r
          NewPeiUsbDevice->IsHub = 0x1;\r
\r
          Status = PeiDoHubConfig (PeiServices, NewPeiUsbDevice);\r
          if (EFI_ERROR (Status)) {\r
            return Status;\r
          }\r
\r
          PeiHubEnumeration (PeiServices, NewPeiUsbDevice, CurrentAddress);\r
        }\r
\r
        for (InterfaceIndex = 1; InterfaceIndex < NewPeiUsbDevice->ConfigDesc->NumInterfaces; InterfaceIndex++) {\r
          //\r
          // Begin to deal with the new device\r
          //\r
          MemPages = sizeof (PEI_USB_DEVICE) / EFI_PAGE_SIZE + 1;\r
          Status   = PeiServicesAllocatePages (\r
                       EfiBootServicesCode,\r
                       MemPages,\r
                       &AllocateAddress\r
                       );\r
          if (EFI_ERROR (Status)) {\r
            return EFI_OUT_OF_RESOURCES;\r
          }\r
\r
          CopyMem ((VOID *)(UINTN)AllocateAddress, NewPeiUsbDevice, sizeof (PEI_USB_DEVICE));\r
          NewPeiUsbDevice                   = (PEI_USB_DEVICE *)((UINTN)AllocateAddress);\r
          NewPeiUsbDevice->AllocateAddress  = (UINTN)AllocateAddress;\r
          NewPeiUsbDevice->UsbIoPpiList.Ppi = &NewPeiUsbDevice->UsbIoPpi;\r
          NewPeiUsbDevice->InterfaceDesc    = NewPeiUsbDevice->InterfaceDescList[InterfaceIndex];\r
          for (EndpointIndex = 0; EndpointIndex < NewPeiUsbDevice->InterfaceDesc->NumEndpoints; EndpointIndex++) {\r
            NewPeiUsbDevice->EndpointDesc[EndpointIndex] = NewPeiUsbDevice->EndpointDescList[InterfaceIndex][EndpointIndex];\r
          }\r
\r
          Status = PeiServicesInstallPpi (&NewPeiUsbDevice->UsbIoPpiList);\r
\r
          if (NewPeiUsbDevice->InterfaceDesc->InterfaceClass == 0x09) {\r
            NewPeiUsbDevice->IsHub = 0x1;\r
\r
            Status = PeiDoHubConfig (PeiServices, NewPeiUsbDevice);\r
            if (EFI_ERROR (Status)) {\r
              return Status;\r
            }\r
\r
            PeiHubEnumeration (PeiServices, NewPeiUsbDevice, CurrentAddress);\r
          }\r
        }\r
      }\r
    }\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  The enumeration routine to detect device change.\r
\r
  @param  PeiServices            Describes the list of possible PEI Services.\r
  @param  UsbHcPpi               The pointer of PEI_USB_HOST_CONTROLLER_PPI instance.\r
  @param  Usb2HcPpi              The pointer of PEI_USB2_HOST_CONTROLLER_PPI instance.\r
\r
  @retval EFI_SUCCESS            The usb is enumerated successfully.\r
  @retval EFI_OUT_OF_RESOURCES   Can't allocate memory resource.\r
  @retval Others                 Other failure occurs.\r
\r
**/\r
EFI_STATUS\r
PeiUsbEnumeration (\r
  IN EFI_PEI_SERVICES              **PeiServices,\r
  IN PEI_USB_HOST_CONTROLLER_PPI   *UsbHcPpi,\r
  IN PEI_USB2_HOST_CONTROLLER_PPI  *Usb2HcPpi\r
  )\r
{\r
  UINT8                 NumOfRootPort;\r
  EFI_STATUS            Status;\r
  UINT8                 Index;\r
  EFI_USB_PORT_STATUS   PortStatus;\r
  PEI_USB_DEVICE        *PeiUsbDevice;\r
  UINTN                 MemPages;\r
  EFI_PHYSICAL_ADDRESS  AllocateAddress;\r
  UINT8                 CurrentAddress;\r
  UINTN                 InterfaceIndex;\r
  UINTN                 EndpointIndex;\r
\r
  CurrentAddress = 0;\r
  if (Usb2HcPpi != NULL) {\r
    Usb2HcPpi->GetRootHubPortNumber (\r
                 PeiServices,\r
                 Usb2HcPpi,\r
                 (UINT8 *)&NumOfRootPort\r
                 );\r
  } else if (UsbHcPpi != NULL) {\r
    UsbHcPpi->GetRootHubPortNumber (\r
                PeiServices,\r
                UsbHcPpi,\r
                (UINT8 *)&NumOfRootPort\r
                );\r
  } else {\r
    ASSERT (FALSE);\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  DEBUG ((DEBUG_INFO, "PeiUsbEnumeration: NumOfRootPort: %x\n", NumOfRootPort));\r
\r
  for (Index = 0; Index < NumOfRootPort; Index++) {\r
    //\r
    // First get root port status to detect changes happen\r
    //\r
    if (Usb2HcPpi != NULL) {\r
      Usb2HcPpi->GetRootHubPortStatus (\r
                   PeiServices,\r
                   Usb2HcPpi,\r
                   (UINT8)Index,\r
                   &PortStatus\r
                   );\r
    } else {\r
      UsbHcPpi->GetRootHubPortStatus (\r
                  PeiServices,\r
                  UsbHcPpi,\r
                  (UINT8)Index,\r
                  &PortStatus\r
                  );\r
    }\r
\r
    DEBUG ((DEBUG_INFO, "USB Status --- Port: %x ConnectChange[%04x] Status[%04x]\n", Index, PortStatus.PortChangeStatus, PortStatus.PortStatus));\r
    //\r
    // Only handle connection/enable/overcurrent/reset change.\r
    //\r
    if ((PortStatus.PortChangeStatus & (USB_PORT_STAT_C_CONNECTION | USB_PORT_STAT_C_ENABLE | USB_PORT_STAT_C_OVERCURRENT | USB_PORT_STAT_C_RESET)) == 0) {\r
      continue;\r
    } else {\r
      if (IsPortConnect (PortStatus.PortStatus)) {\r
        MemPages = sizeof (PEI_USB_DEVICE) / EFI_PAGE_SIZE + 1;\r
        Status   = PeiServicesAllocatePages (\r
                     EfiBootServicesCode,\r
                     MemPages,\r
                     &AllocateAddress\r
                     );\r
        if (EFI_ERROR (Status)) {\r
          return EFI_OUT_OF_RESOURCES;\r
        }\r
\r
        PeiUsbDevice = (PEI_USB_DEVICE *)((UINTN)AllocateAddress);\r
        ZeroMem (PeiUsbDevice, sizeof (PEI_USB_DEVICE));\r
\r
        PeiUsbDevice->Signature      = PEI_USB_DEVICE_SIGNATURE;\r
        PeiUsbDevice->DeviceAddress  = 0;\r
        PeiUsbDevice->MaxPacketSize0 = 8;\r
        PeiUsbDevice->DataToggle     = 0;\r
        CopyMem (\r
          &(PeiUsbDevice->UsbIoPpi),\r
          &mUsbIoPpi,\r
          sizeof (PEI_USB_IO_PPI)\r
          );\r
        CopyMem (\r
          &(PeiUsbDevice->UsbIoPpiList),\r
          &mUsbIoPpiList,\r
          sizeof (EFI_PEI_PPI_DESCRIPTOR)\r
          );\r
        PeiUsbDevice->UsbIoPpiList.Ppi = &PeiUsbDevice->UsbIoPpi;\r
        PeiUsbDevice->AllocateAddress  = (UINTN)AllocateAddress;\r
        PeiUsbDevice->UsbHcPpi         = UsbHcPpi;\r
        PeiUsbDevice->Usb2HcPpi        = Usb2HcPpi;\r
        PeiUsbDevice->IsHub            = 0x0;\r
        PeiUsbDevice->DownStreamPortNo = 0x0;\r
\r
        if (((PortStatus.PortChangeStatus & USB_PORT_STAT_C_RESET) == 0) ||\r
            ((PortStatus.PortStatus & (USB_PORT_STAT_CONNECTION | USB_PORT_STAT_ENABLE)) == 0))\r
        {\r
          //\r
          // If the port already has reset change flag and is connected and enabled, skip the port reset logic.\r
          //\r
          ResetRootPort (\r
            PeiServices,\r
            PeiUsbDevice->UsbHcPpi,\r
            PeiUsbDevice->Usb2HcPpi,\r
            Index,\r
            0\r
            );\r
\r
          if (Usb2HcPpi != NULL) {\r
            Usb2HcPpi->GetRootHubPortStatus (\r
                         PeiServices,\r
                         Usb2HcPpi,\r
                         (UINT8)Index,\r
                         &PortStatus\r
                         );\r
          } else {\r
            UsbHcPpi->GetRootHubPortStatus (\r
                        PeiServices,\r
                        UsbHcPpi,\r
                        (UINT8)Index,\r
                        &PortStatus\r
                        );\r
          }\r
        } else {\r
          if (Usb2HcPpi != NULL) {\r
            Usb2HcPpi->ClearRootHubPortFeature (\r
                         PeiServices,\r
                         Usb2HcPpi,\r
                         (UINT8)Index,\r
                         EfiUsbPortResetChange\r
                         );\r
          } else {\r
            UsbHcPpi->ClearRootHubPortFeature (\r
                        PeiServices,\r
                        UsbHcPpi,\r
                        (UINT8)Index,\r
                        EfiUsbPortResetChange\r
                        );\r
          }\r
        }\r
\r
        PeiUsbDevice->DeviceSpeed = (UINT8)PeiUsbGetDeviceSpeed (PortStatus.PortStatus);\r
        DEBUG ((DEBUG_INFO, "Device Speed =%d\n", PeiUsbDevice->DeviceSpeed));\r
\r
        if (USB_BIT_IS_SET (PortStatus.PortStatus, USB_PORT_STAT_SUPER_SPEED)) {\r
          PeiUsbDevice->MaxPacketSize0 = 512;\r
        } else if (USB_BIT_IS_SET (PortStatus.PortStatus, USB_PORT_STAT_HIGH_SPEED)) {\r
          PeiUsbDevice->MaxPacketSize0 = 64;\r
        } else if (USB_BIT_IS_SET (PortStatus.PortStatus, USB_PORT_STAT_LOW_SPEED)) {\r
          PeiUsbDevice->MaxPacketSize0 = 8;\r
        } else {\r
          PeiUsbDevice->MaxPacketSize0 = 8;\r
        }\r
\r
        //\r
        // Configure that Usb Device\r
        //\r
        Status = PeiConfigureUsbDevice (\r
                   PeiServices,\r
                   PeiUsbDevice,\r
                   Index,\r
                   &CurrentAddress\r
                   );\r
\r
        if (EFI_ERROR (Status)) {\r
          continue;\r
        }\r
\r
        DEBUG ((DEBUG_INFO, "PeiUsbEnumeration: PeiConfigureUsbDevice Success\n"));\r
\r
        Status = PeiServicesInstallPpi (&PeiUsbDevice->UsbIoPpiList);\r
\r
        if (PeiUsbDevice->InterfaceDesc->InterfaceClass == 0x09) {\r
          PeiUsbDevice->IsHub = 0x1;\r
\r
          Status = PeiDoHubConfig (PeiServices, PeiUsbDevice);\r
          if (EFI_ERROR (Status)) {\r
            return Status;\r
          }\r
\r
          PeiHubEnumeration (PeiServices, PeiUsbDevice, &CurrentAddress);\r
        }\r
\r
        for (InterfaceIndex = 1; InterfaceIndex < PeiUsbDevice->ConfigDesc->NumInterfaces; InterfaceIndex++) {\r
          //\r
          // Begin to deal with the new device\r
          //\r
          MemPages = sizeof (PEI_USB_DEVICE) / EFI_PAGE_SIZE + 1;\r
          Status   = PeiServicesAllocatePages (\r
                       EfiBootServicesCode,\r
                       MemPages,\r
                       &AllocateAddress\r
                       );\r
          if (EFI_ERROR (Status)) {\r
            return EFI_OUT_OF_RESOURCES;\r
          }\r
\r
          CopyMem ((VOID *)(UINTN)AllocateAddress, PeiUsbDevice, sizeof (PEI_USB_DEVICE));\r
          PeiUsbDevice                   = (PEI_USB_DEVICE *)((UINTN)AllocateAddress);\r
          PeiUsbDevice->AllocateAddress  = (UINTN)AllocateAddress;\r
          PeiUsbDevice->UsbIoPpiList.Ppi = &PeiUsbDevice->UsbIoPpi;\r
          PeiUsbDevice->InterfaceDesc    = PeiUsbDevice->InterfaceDescList[InterfaceIndex];\r
          for (EndpointIndex = 0; EndpointIndex < PeiUsbDevice->InterfaceDesc->NumEndpoints; EndpointIndex++) {\r
            PeiUsbDevice->EndpointDesc[EndpointIndex] = PeiUsbDevice->EndpointDescList[InterfaceIndex][EndpointIndex];\r
          }\r
\r
          Status = PeiServicesInstallPpi (&PeiUsbDevice->UsbIoPpiList);\r
\r
          if (PeiUsbDevice->InterfaceDesc->InterfaceClass == 0x09) {\r
            PeiUsbDevice->IsHub = 0x1;\r
\r
            Status = PeiDoHubConfig (PeiServices, PeiUsbDevice);\r
            if (EFI_ERROR (Status)) {\r
              return Status;\r
            }\r
\r
            PeiHubEnumeration (PeiServices, PeiUsbDevice, &CurrentAddress);\r
          }\r
        }\r
      } else {\r
        //\r
        // Disconnect change happen, currently we don't support\r
        //\r
      }\r
    }\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Configure new detected usb device.\r
\r
  @param  PeiServices            Describes the list of possible PEI Services.\r
  @param  PeiUsbDevice           The pointer of PEI_USB_DEVICE instance.\r
  @param  Port                   The port to be configured.\r
  @param  DeviceAddress          The device address to be configured.\r
\r
  @retval EFI_SUCCESS            The new detected usb device is configured successfully.\r
  @retval EFI_OUT_OF_RESOURCES   Can't allocate memory resource.\r
  @retval Others                 Other failure occurs.\r
\r
**/\r
EFI_STATUS\r
PeiConfigureUsbDevice (\r
  IN EFI_PEI_SERVICES  **PeiServices,\r
  IN PEI_USB_DEVICE    *PeiUsbDevice,\r
  IN UINT8             Port,\r
  IN OUT UINT8         *DeviceAddress\r
  )\r
{\r
  EFI_USB_DEVICE_DESCRIPTOR  DeviceDescriptor;\r
  EFI_STATUS                 Status;\r
  PEI_USB_IO_PPI             *UsbIoPpi;\r
  UINT8                      Retry;\r
\r
  UsbIoPpi = &PeiUsbDevice->UsbIoPpi;\r
  Status   = EFI_SUCCESS;\r
  ZeroMem (&DeviceDescriptor, sizeof (EFI_USB_DEVICE_DESCRIPTOR));\r
  //\r
  // Get USB device descriptor\r
  //\r
\r
  for (Retry = 0; Retry < 3; Retry++) {\r
    Status = PeiUsbGetDescriptor (\r
               PeiServices,\r
               UsbIoPpi,\r
               (USB_DT_DEVICE << 8),\r
               0,\r
               8,\r
               &DeviceDescriptor\r
               );\r
\r
    if (!EFI_ERROR (Status)) {\r
      DEBUG ((DEBUG_INFO, "PeiUsbGet Device Descriptor the %d time Success\n", Retry));\r
      break;\r
    }\r
  }\r
\r
  if (Retry == 3) {\r
    DEBUG ((DEBUG_ERROR, "PeiUsbGet Device Descriptor fail: %x %r\n", Retry, Status));\r
    return Status;\r
  }\r
\r
  if ((DeviceDescriptor.BcdUSB >= 0x0300) && (DeviceDescriptor.MaxPacketSize0 == 9)) {\r
    PeiUsbDevice->MaxPacketSize0 = 1 << 9;\r
  } else {\r
    PeiUsbDevice->MaxPacketSize0 = DeviceDescriptor.MaxPacketSize0;\r
  }\r
\r
  (*DeviceAddress)++;\r
\r
  Status = PeiUsbSetDeviceAddress (\r
             PeiServices,\r
             UsbIoPpi,\r
             *DeviceAddress\r
             );\r
\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((DEBUG_ERROR, "PeiUsbSetDeviceAddress Failed: %r\n", Status));\r
    return Status;\r
  }\r
\r
  MicroSecondDelay (USB_SET_DEVICE_ADDRESS_STALL);\r
\r
  PeiUsbDevice->DeviceAddress = *DeviceAddress;\r
\r
  //\r
  // Get whole USB device descriptor\r
  //\r
  Status = PeiUsbGetDescriptor (\r
             PeiServices,\r
             UsbIoPpi,\r
             (USB_DT_DEVICE << 8),\r
             0,\r
             (UINT16)sizeof (EFI_USB_DEVICE_DESCRIPTOR),\r
             &DeviceDescriptor\r
             );\r
\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((DEBUG_ERROR, "PeiUsbGetDescriptor First Failed\n"));\r
    return Status;\r
  }\r
\r
  //\r
  // Get its default configuration and its first interface\r
  //\r
  Status = PeiUsbGetAllConfiguration (\r
             PeiServices,\r
             PeiUsbDevice\r
             );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  MicroSecondDelay (USB_GET_CONFIG_DESCRIPTOR_STALL);\r
\r
  Status = PeiUsbSetConfiguration (\r
             PeiServices,\r
             UsbIoPpi\r
             );\r
\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Get all configurations from a detected usb device.\r
\r
  @param  PeiServices            Describes the list of possible PEI Services.\r
  @param  PeiUsbDevice           The pointer of PEI_USB_DEVICE instance.\r
\r
  @retval EFI_SUCCESS            The new detected usb device is configured successfully.\r
  @retval EFI_OUT_OF_RESOURCES   Can't allocate memory resource.\r
  @retval Others                 Other failure occurs.\r
\r
**/\r
EFI_STATUS\r
PeiUsbGetAllConfiguration (\r
  IN EFI_PEI_SERVICES  **PeiServices,\r
  IN PEI_USB_DEVICE    *PeiUsbDevice\r
  )\r
{\r
  EFI_STATUS                 Status;\r
  EFI_USB_CONFIG_DESCRIPTOR  *ConfigDesc;\r
  PEI_USB_IO_PPI             *UsbIoPpi;\r
  UINT16                     ConfigDescLength;\r
  UINT8                      *Ptr;\r
  UINTN                      SkipBytes;\r
  UINTN                      LengthLeft;\r
  UINTN                      InterfaceIndex;\r
  UINTN                      Index;\r
  UINTN                      NumOfEndpoint;\r
\r
  UsbIoPpi = &PeiUsbDevice->UsbIoPpi;\r
\r
  //\r
  // First get its 4-byte configuration descriptor\r
  //\r
  Status = PeiUsbGetDescriptor (\r
             PeiServices,\r
             UsbIoPpi,\r
             (USB_DT_CONFIG << 8), // Value\r
             0,                    // Index\r
             4,                    // Length\r
             PeiUsbDevice->ConfigurationData\r
             );\r
\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((DEBUG_ERROR, "PeiUsbGet Config Descriptor First Failed\n"));\r
    return Status;\r
  }\r
\r
  MicroSecondDelay (USB_GET_CONFIG_DESCRIPTOR_STALL);\r
\r
  ConfigDesc       = (EFI_USB_CONFIG_DESCRIPTOR *)PeiUsbDevice->ConfigurationData;\r
  ConfigDescLength = ConfigDesc->TotalLength;\r
\r
  //\r
  // Reject if TotalLength even cannot cover itself.\r
  //\r
  if (ConfigDescLength < OFFSET_OF (EFI_USB_CONFIG_DESCRIPTOR, TotalLength) + sizeof (ConfigDesc->TotalLength)) {\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  //\r
  // Reject if TotalLength exceeds the PeiUsbDevice->ConfigurationData.\r
  //\r
  if (ConfigDescLength > sizeof (PeiUsbDevice->ConfigurationData)) {\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  //\r
  // Then we get the total descriptors for this configuration\r
  //\r
  Status = PeiUsbGetDescriptor (\r
             PeiServices,\r
             UsbIoPpi,\r
             (USB_DT_CONFIG << 8),\r
             0,\r
             ConfigDescLength,\r
             PeiUsbDevice->ConfigurationData\r
             );\r
\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((DEBUG_ERROR, "PeiUsbGet Config Descriptor all Failed\n"));\r
    return Status;\r
  }\r
\r
  //\r
  // Parse this configuration descriptor\r
  // First get the current config descriptor;\r
  //\r
  Status = GetExpectedDescriptor (\r
             PeiUsbDevice->ConfigurationData,\r
             ConfigDescLength,\r
             USB_DT_CONFIG,\r
             (UINT8)sizeof (EFI_USB_CONFIG_DESCRIPTOR),\r
             &SkipBytes\r
             );\r
\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Ptr                      = PeiUsbDevice->ConfigurationData + SkipBytes;\r
  PeiUsbDevice->ConfigDesc = (EFI_USB_CONFIG_DESCRIPTOR *)Ptr;\r
\r
  Ptr       += sizeof (EFI_USB_CONFIG_DESCRIPTOR);\r
  LengthLeft = ConfigDescLength - SkipBytes - sizeof (EFI_USB_CONFIG_DESCRIPTOR);\r
\r
  for (InterfaceIndex = 0; InterfaceIndex < PeiUsbDevice->ConfigDesc->NumInterfaces; InterfaceIndex++) {\r
    //\r
    // Get the interface descriptor\r
    //\r
    Status = GetExpectedDescriptor (\r
               Ptr,\r
               LengthLeft,\r
               USB_DT_INTERFACE,\r
               (UINT8)sizeof (EFI_USB_INTERFACE_DESCRIPTOR),\r
               &SkipBytes\r
               );\r
\r
    if (EFI_ERROR (Status)) {\r
      return Status;\r
    }\r
\r
    Ptr += SkipBytes;\r
    if (InterfaceIndex == 0) {\r
      PeiUsbDevice->InterfaceDesc = (EFI_USB_INTERFACE_DESCRIPTOR *)Ptr;\r
    }\r
\r
    PeiUsbDevice->InterfaceDescList[InterfaceIndex] = (EFI_USB_INTERFACE_DESCRIPTOR *)Ptr;\r
\r
    Ptr        += sizeof (EFI_USB_INTERFACE_DESCRIPTOR);\r
    LengthLeft -= SkipBytes;\r
    LengthLeft -= sizeof (EFI_USB_INTERFACE_DESCRIPTOR);\r
\r
    //\r
    // Parse all the endpoint descriptor within this interface\r
    //\r
    NumOfEndpoint = PeiUsbDevice->InterfaceDescList[InterfaceIndex]->NumEndpoints;\r
    ASSERT (NumOfEndpoint <= MAX_ENDPOINT);\r
\r
    for (Index = 0; Index < NumOfEndpoint; Index++) {\r
      //\r
      // Get the endpoint descriptor\r
      //\r
      Status = GetExpectedDescriptor (\r
                 Ptr,\r
                 LengthLeft,\r
                 USB_DT_ENDPOINT,\r
                 (UINT8)sizeof (EFI_USB_ENDPOINT_DESCRIPTOR),\r
                 &SkipBytes\r
                 );\r
\r
      if (EFI_ERROR (Status)) {\r
        return Status;\r
      }\r
\r
      Ptr += SkipBytes;\r
      if (InterfaceIndex == 0) {\r
        PeiUsbDevice->EndpointDesc[Index] = (EFI_USB_ENDPOINT_DESCRIPTOR *)Ptr;\r
      }\r
\r
      PeiUsbDevice->EndpointDescList[InterfaceIndex][Index] = (EFI_USB_ENDPOINT_DESCRIPTOR *)Ptr;\r
\r
      Ptr        += sizeof (EFI_USB_ENDPOINT_DESCRIPTOR);\r
      LengthLeft -= SkipBytes;\r
      LengthLeft -= sizeof (EFI_USB_ENDPOINT_DESCRIPTOR);\r
    }\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Get the start position of next wanted descriptor.\r
\r
  @param  Buffer            Buffer containing data to parse.\r
  @param  Length            Buffer length.\r
  @param  DescType          Descriptor type.\r
  @param  DescLength        Descriptor length.\r
  @param  ParsedBytes       Bytes has been parsed.\r
\r
  @retval EFI_SUCCESS       Get wanted descriptor successfully.\r
  @retval EFI_DEVICE_ERROR  Error occurred.\r
\r
**/\r
EFI_STATUS\r
GetExpectedDescriptor (\r
  IN  UINT8  *Buffer,\r
  IN  UINTN  Length,\r
  IN  UINT8  DescType,\r
  IN  UINT8  DescLength,\r
  OUT UINTN  *ParsedBytes\r
  )\r
{\r
  USB_DESC_HEAD  *Head;\r
  UINTN          Offset;\r
\r
  //\r
  // Total length is too small that cannot hold the single descriptor header plus data.\r
  //\r
  if (Length <= sizeof (USB_DESC_HEAD)) {\r
    DEBUG ((DEBUG_ERROR, "GetExpectedDescriptor: met mal-format descriptor, total length = %d!\n", Length));\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  //\r
  // All the descriptor has a common LTV (Length, Type, Value)\r
  // format. Skip the descriptor that isn't of this Type\r
  //\r
  Offset = 0;\r
  Head   = (USB_DESC_HEAD *)Buffer;\r
  while (Offset < Length - sizeof (USB_DESC_HEAD)) {\r
    //\r
    // Above condition make sure Head->Len and Head->Type are safe to access\r
    //\r
    Head = (USB_DESC_HEAD *)&Buffer[Offset];\r
\r
    if (Head->Len == 0) {\r
      DEBUG ((DEBUG_ERROR, "GetExpectedDescriptor: met mal-format descriptor, Head->Len = 0!\n"));\r
      return EFI_DEVICE_ERROR;\r
    }\r
\r
    //\r
    // Make sure no overflow when adding Head->Len to Offset.\r
    //\r
    if (Head->Len > MAX_UINTN - Offset) {\r
      DEBUG ((DEBUG_ERROR, "GetExpectedDescriptor: met mal-format descriptor, Head->Len = %d!\n", Head->Len));\r
      return EFI_DEVICE_ERROR;\r
    }\r
\r
    if (Head->Type == DescType) {\r
      break;\r
    }\r
\r
    Offset += Head->Len;\r
  }\r
\r
  //\r
  // Head->Len is invalid resulting data beyond boundary, or\r
  // Descriptor cannot be found: No such type.\r
  //\r
  if (Length < Offset) {\r
    DEBUG ((DEBUG_ERROR, "GetExpectedDescriptor: met mal-format descriptor, Offset/Len = %d/%d!\n", Offset, Length));\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  if ((Head->Type != DescType) || (Head->Len < DescLength)) {\r
    DEBUG ((DEBUG_ERROR, "GetExpectedDescriptor: descriptor cannot be found, Header(T/L) = %d/%d!\n", Head->Type, Head->Len));\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  *ParsedBytes = Offset;\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Send reset signal over the given root hub port.\r
\r
  @param  PeiServices       Describes the list of possible PEI Services.\r
  @param  UsbHcPpi          The pointer of PEI_USB_HOST_CONTROLLER_PPI instance.\r
  @param  Usb2HcPpi         The pointer of PEI_USB2_HOST_CONTROLLER_PPI instance.\r
  @param  PortNum           The port to be reset.\r
  @param  RetryIndex        The retry times.\r
\r
**/\r
VOID\r
ResetRootPort (\r
  IN EFI_PEI_SERVICES              **PeiServices,\r
  IN PEI_USB_HOST_CONTROLLER_PPI   *UsbHcPpi,\r
  IN PEI_USB2_HOST_CONTROLLER_PPI  *Usb2HcPpi,\r
  IN UINT8                         PortNum,\r
  IN UINT8                         RetryIndex\r
  )\r
{\r
  EFI_STATUS           Status;\r
  UINTN                Index;\r
  EFI_USB_PORT_STATUS  PortStatus;\r
\r
  if (Usb2HcPpi != NULL) {\r
    MicroSecondDelay (200 * 1000);\r
\r
    //\r
    // reset root port\r
    //\r
    Status = Usb2HcPpi->SetRootHubPortFeature (\r
                          PeiServices,\r
                          Usb2HcPpi,\r
                          PortNum,\r
                          EfiUsbPortReset\r
                          );\r
\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((DEBUG_ERROR, "SetRootHubPortFeature EfiUsbPortReset Failed\n"));\r
      return;\r
    }\r
\r
    //\r
    // Drive the reset signal for at least 50ms. Check USB 2.0 Spec\r
    // section 7.1.7.5 for timing requirements.\r
    //\r
    MicroSecondDelay (USB_SET_ROOT_PORT_RESET_STALL);\r
\r
    //\r
    // clear reset root port\r
    //\r
    Status = Usb2HcPpi->ClearRootHubPortFeature (\r
                          PeiServices,\r
                          Usb2HcPpi,\r
                          PortNum,\r
                          EfiUsbPortReset\r
                          );\r
\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((DEBUG_ERROR, "ClearRootHubPortFeature EfiUsbPortReset Failed\n"));\r
      return;\r
    }\r
\r
    MicroSecondDelay (USB_CLR_ROOT_PORT_RESET_STALL);\r
\r
    //\r
    // USB host controller won't clear the RESET bit until\r
    // reset is actually finished.\r
    //\r
    ZeroMem (&PortStatus, sizeof (EFI_USB_PORT_STATUS));\r
\r
    for (Index = 0; Index < USB_WAIT_PORT_STS_CHANGE_LOOP; Index++) {\r
      Status = Usb2HcPpi->GetRootHubPortStatus (\r
                            PeiServices,\r
                            Usb2HcPpi,\r
                            PortNum,\r
                            &PortStatus\r
                            );\r
      if (EFI_ERROR (Status)) {\r
        return;\r
      }\r
\r
      if (!USB_BIT_IS_SET (PortStatus.PortStatus, USB_PORT_STAT_RESET)) {\r
        break;\r
      }\r
\r
      MicroSecondDelay (USB_WAIT_PORT_STS_CHANGE_STALL);\r
    }\r
\r
    if (Index == USB_WAIT_PORT_STS_CHANGE_LOOP) {\r
      DEBUG ((DEBUG_ERROR, "ResetRootPort: reset not finished in time on port %d\n", PortNum));\r
      return;\r
    }\r
\r
    Usb2HcPpi->ClearRootHubPortFeature (\r
                 PeiServices,\r
                 Usb2HcPpi,\r
                 PortNum,\r
                 EfiUsbPortResetChange\r
                 );\r
\r
    Usb2HcPpi->ClearRootHubPortFeature (\r
                 PeiServices,\r
                 Usb2HcPpi,\r
                 PortNum,\r
                 EfiUsbPortConnectChange\r
                 );\r
\r
    //\r
    // Set port enable\r
    //\r
    Usb2HcPpi->SetRootHubPortFeature (\r
                 PeiServices,\r
                 Usb2HcPpi,\r
                 PortNum,\r
                 EfiUsbPortEnable\r
                 );\r
\r
    Usb2HcPpi->ClearRootHubPortFeature (\r
                 PeiServices,\r
                 Usb2HcPpi,\r
                 PortNum,\r
                 EfiUsbPortEnableChange\r
                 );\r
\r
    MicroSecondDelay ((RetryIndex + 1) * 50 * 1000);\r
  } else {\r
    MicroSecondDelay (200 * 1000);\r
\r
    //\r
    // reset root port\r
    //\r
    Status = UsbHcPpi->SetRootHubPortFeature (\r
                         PeiServices,\r
                         UsbHcPpi,\r
                         PortNum,\r
                         EfiUsbPortReset\r
                         );\r
\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((DEBUG_ERROR, "SetRootHubPortFeature EfiUsbPortReset Failed\n"));\r
      return;\r
    }\r
\r
    //\r
    // Drive the reset signal for at least 50ms. Check USB 2.0 Spec\r
    // section 7.1.7.5 for timing requirements.\r
    //\r
    MicroSecondDelay (USB_SET_ROOT_PORT_RESET_STALL);\r
\r
    //\r
    // clear reset root port\r
    //\r
    Status = UsbHcPpi->ClearRootHubPortFeature (\r
                         PeiServices,\r
                         UsbHcPpi,\r
                         PortNum,\r
                         EfiUsbPortReset\r
                         );\r
\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((DEBUG_ERROR, "ClearRootHubPortFeature EfiUsbPortReset Failed\n"));\r
      return;\r
    }\r
\r
    MicroSecondDelay (USB_CLR_ROOT_PORT_RESET_STALL);\r
\r
    //\r
    // USB host controller won't clear the RESET bit until\r
    // reset is actually finished.\r
    //\r
    ZeroMem (&PortStatus, sizeof (EFI_USB_PORT_STATUS));\r
\r
    for (Index = 0; Index < USB_WAIT_PORT_STS_CHANGE_LOOP; Index++) {\r
      Status = UsbHcPpi->GetRootHubPortStatus (\r
                           PeiServices,\r
                           UsbHcPpi,\r
                           PortNum,\r
                           &PortStatus\r
                           );\r
      if (EFI_ERROR (Status)) {\r
        return;\r
      }\r
\r
      if (!USB_BIT_IS_SET (PortStatus.PortStatus, USB_PORT_STAT_RESET)) {\r
        break;\r
      }\r
\r
      MicroSecondDelay (USB_WAIT_PORT_STS_CHANGE_STALL);\r
    }\r
\r
    if (Index == USB_WAIT_PORT_STS_CHANGE_LOOP) {\r
      DEBUG ((DEBUG_ERROR, "ResetRootPort: reset not finished in time on port %d\n", PortNum));\r
      return;\r
    }\r
\r
    UsbHcPpi->ClearRootHubPortFeature (\r
                PeiServices,\r
                UsbHcPpi,\r
                PortNum,\r
                EfiUsbPortResetChange\r
                );\r
\r
    UsbHcPpi->ClearRootHubPortFeature (\r
                PeiServices,\r
                UsbHcPpi,\r
                PortNum,\r
                EfiUsbPortConnectChange\r
                );\r
\r
    //\r
    // Set port enable\r
    //\r
    UsbHcPpi->SetRootHubPortFeature (\r
                PeiServices,\r
                UsbHcPpi,\r
                PortNum,\r
                EfiUsbPortEnable\r
                );\r
\r
    UsbHcPpi->ClearRootHubPortFeature (\r
                PeiServices,\r
                UsbHcPpi,\r
                PortNum,\r
                EfiUsbPortEnableChange\r
                );\r
\r
    MicroSecondDelay ((RetryIndex + 1) * 50 * 1000);\r
  }\r
\r
  return;\r
}\r