[mirror_edk2.git] / MdeModulePkg / Bus / Pci / SdMmcPciHcDxe / SdMmcPciHcDxe.c

/** @file\r
  This driver is used to manage SD/MMC PCI host controllers which are compliance\r
  with SD Host Controller Simplified Specification version 3.00 plus the 64-bit\r
  System Addressing support in SD Host Controller Simplified Specification version\r
  4.20.\r
\r
  It would expose EFI_SD_MMC_PASS_THRU_PROTOCOL for upper layer use.\r
\r
  Copyright (c) 2018, NVIDIA CORPORATION. All rights reserved.\r
  Copyright (c) 2015 - 2019, Intel Corporation. All rights reserved.<BR>\r
  This program and the accompanying materials\r
  are licensed and made available under the terms and conditions of the BSD License\r
  which accompanies this distribution.  The full text of the license may be found at\r
  http://opensource.org/licenses/bsd-license.php\r
\r
  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
\r
**/\r
\r
#include "SdMmcPciHcDxe.h"\r
\r
EDKII_SD_MMC_OVERRIDE           *mOverride;\r
\r
//\r
// Driver Global Variables\r
//\r
EFI_DRIVER_BINDING_PROTOCOL gSdMmcPciHcDriverBinding = {\r
  SdMmcPciHcDriverBindingSupported,\r
  SdMmcPciHcDriverBindingStart,\r
  SdMmcPciHcDriverBindingStop,\r
  0x10,\r
  NULL,\r
  NULL\r
};\r
\r
//\r
// Template for SD/MMC host controller private data.\r
//\r
SD_MMC_HC_PRIVATE_DATA gSdMmcPciHcTemplate = {\r
  SD_MMC_HC_PRIVATE_SIGNATURE,      // Signature\r
  NULL,                             // ControllerHandle\r
  NULL,                             // PciIo\r
  {                                 // PassThru\r
    sizeof (UINT32),\r
    SdMmcPassThruPassThru,\r
    SdMmcPassThruGetNextSlot,\r
    SdMmcPassThruBuildDevicePath,\r
    SdMmcPassThruGetSlotNumber,\r
    SdMmcPassThruResetDevice\r
  },\r
  0,                                // PciAttributes\r
  0,                                // PreviousSlot\r
  NULL,                             // TimerEvent\r
  NULL,                             // ConnectEvent\r
                                    // Queue\r
  INITIALIZE_LIST_HEAD_VARIABLE (gSdMmcPciHcTemplate.Queue),\r
  {                                 // Slot\r
    {0, UnknownSlot, 0, 0, 0}, {0, UnknownSlot, 0, 0, 0}, {0, UnknownSlot, 0, 0, 0},\r
    {0, UnknownSlot, 0, 0, 0}, {0, UnknownSlot, 0, 0, 0}, {0, UnknownSlot, 0, 0, 0}\r
  },\r
  {                                 // Capability\r
    {0},\r
  },\r
  {                                 // MaxCurrent\r
    0,\r
  },\r
  {\r
    0                               // ControllerVersion\r
  }\r
};\r
\r
SD_DEVICE_PATH    mSdDpTemplate = {\r
  {\r
    MESSAGING_DEVICE_PATH,\r
    MSG_SD_DP,\r
    {\r
      (UINT8) (sizeof (SD_DEVICE_PATH)),\r
      (UINT8) ((sizeof (SD_DEVICE_PATH)) >> 8)\r
    }\r
  },\r
  0\r
};\r
\r
EMMC_DEVICE_PATH    mEmmcDpTemplate = {\r
  {\r
    MESSAGING_DEVICE_PATH,\r
    MSG_EMMC_DP,\r
    {\r
      (UINT8) (sizeof (EMMC_DEVICE_PATH)),\r
      (UINT8) ((sizeof (EMMC_DEVICE_PATH)) >> 8)\r
    }\r
  },\r
  0\r
};\r
\r
//\r
// Prioritized function list to detect card type.\r
// User could add other card detection logic here.\r
//\r
CARD_TYPE_DETECT_ROUTINE mCardTypeDetectRoutineTable[] = {\r
  EmmcIdentification,\r
  SdCardIdentification,\r
  NULL\r
};\r
\r
/**\r
  The entry point for SD host controller driver, used to install this driver on the ImageHandle.\r
\r
  @param[in]  ImageHandle   The firmware allocated handle for this driver image.\r
  @param[in]  SystemTable   Pointer to the EFI system table.\r
\r
  @retval EFI_SUCCESS   Driver loaded.\r
  @retval other         Driver not loaded.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
InitializeSdMmcPciHcDxe (\r
  IN EFI_HANDLE        ImageHandle,\r
  IN EFI_SYSTEM_TABLE  *SystemTable\r
  )\r
{\r
  EFI_STATUS           Status;\r
\r
  Status = EfiLibInstallDriverBindingComponentName2 (\r
             ImageHandle,\r
             SystemTable,\r
             &gSdMmcPciHcDriverBinding,\r
             ImageHandle,\r
             &gSdMmcPciHcComponentName,\r
             &gSdMmcPciHcComponentName2\r
             );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  return Status;\r
}\r
\r
/**\r
  Call back function when the timer event is signaled.\r
\r
  @param[in]  Event     The Event this notify function registered to.\r
  @param[in]  Context   Pointer to the context data registered to the\r
                        Event.\r
\r
**/\r
VOID\r
EFIAPI\r
ProcessAsyncTaskList (\r
  IN EFI_EVENT          Event,\r
  IN VOID*              Context\r
  )\r
{\r
  SD_MMC_HC_PRIVATE_DATA              *Private;\r
  LIST_ENTRY                          *Link;\r
  SD_MMC_HC_TRB                       *Trb;\r
  EFI_STATUS                          Status;\r
  EFI_SD_MMC_PASS_THRU_COMMAND_PACKET *Packet;\r
  BOOLEAN                             InfiniteWait;\r
  EFI_EVENT                           TrbEvent;\r
\r
  Private = (SD_MMC_HC_PRIVATE_DATA*)Context;\r
\r
  //\r
  // Check if the first entry in the async I/O queue is done or not.\r
  //\r
  Status = EFI_SUCCESS;\r
  Trb    = NULL;\r
  Link   = GetFirstNode (&Private->Queue);\r
  if (!IsNull (&Private->Queue, Link)) {\r
    Trb = SD_MMC_HC_TRB_FROM_THIS (Link);\r
    if (!Private->Slot[Trb->Slot].MediaPresent) {\r
      Status = EFI_NO_MEDIA;\r
      goto Done;\r
    }\r
    if (!Trb->Started) {\r
      //\r
      // Check whether the cmd/data line is ready for transfer.\r
      //\r
      Status = SdMmcCheckTrbEnv (Private, Trb);\r
      if (!EFI_ERROR (Status)) {\r
        Trb->Started = TRUE;\r
        Status = SdMmcExecTrb (Private, Trb);\r
        if (EFI_ERROR (Status)) {\r
          goto Done;\r
        }\r
      } else {\r
        goto Done;\r
      }\r
    }\r
    Status = SdMmcCheckTrbResult (Private, Trb);\r
  }\r
\r
Done:\r
  if ((Trb != NULL) && (Status == EFI_NOT_READY)) {\r
    Packet = Trb->Packet;\r
    if (Packet->Timeout == 0) {\r
      InfiniteWait = TRUE;\r
    } else {\r
      InfiniteWait = FALSE;\r
    }\r
    if ((!InfiniteWait) && (Trb->Timeout-- == 0)) {\r
      RemoveEntryList (Link);\r
      Trb->Packet->TransactionStatus = EFI_TIMEOUT;\r
      TrbEvent = Trb->Event;\r
      SdMmcFreeTrb (Trb);\r
      DEBUG ((DEBUG_VERBOSE, "ProcessAsyncTaskList(): Signal Event %p EFI_TIMEOUT\n", TrbEvent));\r
      gBS->SignalEvent (TrbEvent);\r
      return;\r
    }\r
  }\r
  if ((Trb != NULL) && (Status != EFI_NOT_READY)) {\r
    RemoveEntryList (Link);\r
    Trb->Packet->TransactionStatus = Status;\r
    TrbEvent = Trb->Event;\r
    SdMmcFreeTrb (Trb);\r
    DEBUG ((DEBUG_VERBOSE, "ProcessAsyncTaskList(): Signal Event %p with %r\n", TrbEvent, Status));\r
    gBS->SignalEvent (TrbEvent);\r
  }\r
  return;\r
}\r
\r
/**\r
  Sd removable device enumeration callback function when the timer event is signaled.\r
\r
  @param[in]  Event     The Event this notify function registered to.\r
  @param[in]  Context   Pointer to the context data registered to the\r
                        Event.\r
\r
**/\r
VOID\r
EFIAPI\r
SdMmcPciHcEnumerateDevice (\r
  IN EFI_EVENT          Event,\r
  IN VOID*              Context\r
  )\r
{\r
  SD_MMC_HC_PRIVATE_DATA              *Private;\r
  EFI_STATUS                          Status;\r
  UINT8                               Slot;\r
  BOOLEAN                             MediaPresent;\r
  UINT32                              RoutineNum;\r
  CARD_TYPE_DETECT_ROUTINE            *Routine;\r
  UINTN                               Index;\r
  LIST_ENTRY                          *Link;\r
  LIST_ENTRY                          *NextLink;\r
  SD_MMC_HC_TRB                       *Trb;\r
  EFI_TPL                             OldTpl;\r
\r
  Private = (SD_MMC_HC_PRIVATE_DATA*)Context;\r
\r
  for (Slot = 0; Slot < SD_MMC_HC_MAX_SLOT; Slot++) {\r
    if ((Private->Slot[Slot].Enable) && (Private->Slot[Slot].SlotType == RemovableSlot)) {\r
      Status = SdMmcHcCardDetect (Private->PciIo, Slot, &MediaPresent);\r
      if ((Status == EFI_MEDIA_CHANGED) && !MediaPresent) {\r
        DEBUG ((DEBUG_INFO, "SdMmcPciHcEnumerateDevice: device disconnected at slot %d of pci %p\n", Slot, Private->PciIo));\r
        Private->Slot[Slot].MediaPresent = FALSE;\r
        Private->Slot[Slot].Initialized  = FALSE;\r
        //\r
        // Signal all async task events at the slot with EFI_NO_MEDIA status.\r
        //\r
        OldTpl = gBS->RaiseTPL (TPL_NOTIFY);\r
        for (Link = GetFirstNode (&Private->Queue);\r
             !IsNull (&Private->Queue, Link);\r
             Link = NextLink) {\r
          NextLink = GetNextNode (&Private->Queue, Link);\r
          Trb = SD_MMC_HC_TRB_FROM_THIS (Link);\r
          if (Trb->Slot == Slot) {\r
            RemoveEntryList (Link);\r
            Trb->Packet->TransactionStatus = EFI_NO_MEDIA;\r
            gBS->SignalEvent (Trb->Event);\r
            SdMmcFreeTrb (Trb);\r
          }\r
        }\r
        gBS->RestoreTPL (OldTpl);\r
        //\r
        // Notify the upper layer the connect state change through ReinstallProtocolInterface.\r
        //\r
        gBS->ReinstallProtocolInterface (\r
              Private->ControllerHandle,\r
              &gEfiSdMmcPassThruProtocolGuid,\r
              &Private->PassThru,\r
              &Private->PassThru\r
              );\r
      }\r
      if ((Status == EFI_MEDIA_CHANGED) && MediaPresent) {\r
        DEBUG ((DEBUG_INFO, "SdMmcPciHcEnumerateDevice: device connected at slot %d of pci %p\n", Slot, Private->PciIo));\r
        //\r
        // Reset the specified slot of the SD/MMC Pci Host Controller\r
        //\r
        Status = SdMmcHcReset (Private, Slot);\r
        if (EFI_ERROR (Status)) {\r
          continue;\r
        }\r
        //\r
        // Reinitialize slot and restart identification process for the new attached device\r
        //\r
        Status = SdMmcHcInitHost (Private, Slot);\r
        if (EFI_ERROR (Status)) {\r
          continue;\r
        }\r
\r
        Private->Slot[Slot].MediaPresent = TRUE;\r
        Private->Slot[Slot].Initialized  = TRUE;\r
        RoutineNum = sizeof (mCardTypeDetectRoutineTable) / sizeof (CARD_TYPE_DETECT_ROUTINE);\r
        for (Index = 0; Index < RoutineNum; Index++) {\r
          Routine = &mCardTypeDetectRoutineTable[Index];\r
          if (*Routine != NULL) {\r
            Status = (*Routine) (Private, Slot);\r
            if (!EFI_ERROR (Status)) {\r
              break;\r
            }\r
          }\r
        }\r
        //\r
        // This card doesn't get initialized correctly.\r
        //\r
        if (Index == RoutineNum) {\r
          Private->Slot[Slot].Initialized = FALSE;\r
        }\r
\r
        //\r
        // Notify the upper layer the connect state change through ReinstallProtocolInterface.\r
        //\r
        gBS->ReinstallProtocolInterface (\r
               Private->ControllerHandle,\r
               &gEfiSdMmcPassThruProtocolGuid,\r
               &Private->PassThru,\r
               &Private->PassThru\r
               );\r
      }\r
    }\r
  }\r
\r
  return;\r
}\r
/**\r
  Tests to see if this driver supports a given controller. If a child device is provided,\r
  it further tests to see if this driver supports creating a handle for the specified child device.\r
\r
  This function checks to see if the driver specified by This supports the device specified by\r
  ControllerHandle. Drivers will typically use the device path attached to\r
  ControllerHandle and/or the services from the bus I/O abstraction attached to\r
  ControllerHandle to determine if the driver supports ControllerHandle. This function\r
  may be called many times during platform initialization. In order to reduce boot times, the tests\r
  performed by this function must be very small, and take as little time as possible to execute. This\r
  function must not change the state of any hardware devices, and this function must be aware that the\r
  device specified by ControllerHandle may already be managed by the same driver or a\r
  different driver. This function must match its calls to AllocatePages() with FreePages(),\r
  AllocatePool() with FreePool(), and OpenProtocol() with CloseProtocol().\r
  Since ControllerHandle may have been previously started by the same driver, if a protocol is\r
  already in the opened state, then it must not be closed with CloseProtocol(). This is required\r
  to guarantee the state of ControllerHandle is not modified by this function.\r
\r
  @param[in]  This                 A pointer to the EFI_DRIVER_BINDING_PROTOCOL instance.\r
  @param[in]  ControllerHandle     The handle of the controller to test. This handle\r
                                   must support a protocol interface that supplies\r
                                   an I/O abstraction to the driver.\r
  @param[in]  RemainingDevicePath  A pointer to the remaining portion of a device path.  This\r
                                   parameter is ignored by device drivers, and is optional for bus\r
                                   drivers. For bus drivers, if this parameter is not NULL, then\r
                                   the bus driver must determine if the bus controller specified\r
                                   by ControllerHandle and the child controller specified\r
                                   by RemainingDevicePath are both supported by this\r
                                   bus driver.\r
\r
  @retval EFI_SUCCESS              The device specified by ControllerHandle and\r
                                   RemainingDevicePath is supported by the driver specified by This.\r
  @retval EFI_ALREADY_STARTED      The device specified by ControllerHandle and\r
                                   RemainingDevicePath is already being managed by the driver\r
                                   specified by This.\r
  @retval EFI_ACCESS_DENIED        The device specified by ControllerHandle and\r
                                   RemainingDevicePath is already being managed by a different\r
                                   driver or an application that requires exclusive access.\r
                                   Currently not implemented.\r
  @retval EFI_UNSUPPORTED          The device specified by ControllerHandle and\r
                                   RemainingDevicePath is not supported by the driver specified by This.\r
**/\r
EFI_STATUS\r
EFIAPI\r
SdMmcPciHcDriverBindingSupported (\r
  IN EFI_DRIVER_BINDING_PROTOCOL *This,\r
  IN EFI_HANDLE                  Controller,\r
  IN EFI_DEVICE_PATH_PROTOCOL    *RemainingDevicePath\r
  )\r
{\r
  EFI_STATUS                Status;\r
  EFI_DEVICE_PATH_PROTOCOL  *ParentDevicePath;\r
  EFI_PCI_IO_PROTOCOL       *PciIo;\r
  PCI_TYPE00                PciData;\r
\r
  PciIo            = NULL;\r
  ParentDevicePath = NULL;\r
\r
  //\r
  // SdPciHcDxe is a device driver, and should ingore the\r
  // "RemainingDevicePath" according to EFI spec.\r
  //\r
  Status = gBS->OpenProtocol (\r
                  Controller,\r
                  &gEfiDevicePathProtocolGuid,\r
                  (VOID *) &ParentDevicePath,\r
                  This->DriverBindingHandle,\r
                  Controller,\r
                  EFI_OPEN_PROTOCOL_BY_DRIVER\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    //\r
    // EFI_ALREADY_STARTED is also an error.\r
    //\r
    return Status;\r
  }\r
  //\r
  // Close the protocol because we don't use it here.\r
  //\r
  gBS->CloseProtocol (\r
        Controller,\r
        &gEfiDevicePathProtocolGuid,\r
        This->DriverBindingHandle,\r
        Controller\r
        );\r
\r
  //\r
  // Now test the EfiPciIoProtocol.\r
  //\r
  Status = gBS->OpenProtocol (\r
                  Controller,\r
                  &gEfiPciIoProtocolGuid,\r
                  (VOID **) &PciIo,\r
                  This->DriverBindingHandle,\r
                  Controller,\r
                  EFI_OPEN_PROTOCOL_BY_DRIVER\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // Now further check the PCI header: Base class (offset 0x08) and\r
  // Sub Class (offset 0x05). This controller should be an SD/MMC PCI\r
  // Host Controller.\r
  //\r
  Status = PciIo->Pci.Read (\r
                        PciIo,\r
                        EfiPciIoWidthUint8,\r
                        0,\r
                        sizeof (PciData),\r
                        &PciData\r
                        );\r
  if (EFI_ERROR (Status)) {\r
    gBS->CloseProtocol (\r
          Controller,\r
          &gEfiPciIoProtocolGuid,\r
          This->DriverBindingHandle,\r
          Controller\r
          );\r
    return EFI_UNSUPPORTED;\r
  }\r
  //\r
  // Since we already got the PciData, we can close protocol to avoid to carry it\r
  // on for multiple exit points.\r
  //\r
  gBS->CloseProtocol (\r
        Controller,\r
        &gEfiPciIoProtocolGuid,\r
        This->DriverBindingHandle,\r
        Controller\r
        );\r
\r
  //\r
  // Examine SD PCI Host Controller PCI Configuration table fields.\r
  //\r
  if ((PciData.Hdr.ClassCode[2] == PCI_CLASS_SYSTEM_PERIPHERAL) &&\r
      (PciData.Hdr.ClassCode[1] == PCI_SUBCLASS_SD_HOST_CONTROLLER) &&\r
      ((PciData.Hdr.ClassCode[0] == 0x00) || (PciData.Hdr.ClassCode[0] == 0x01))) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  return EFI_UNSUPPORTED;\r
}\r
\r
/**\r
  Starts a device controller or a bus controller.\r
\r
  The Start() function is designed to be invoked from the EFI boot service ConnectController().\r
  As a result, much of the error checking on the parameters to Start() has been moved into this\r
  common boot service. It is legal to call Start() from other locations,\r
  but the following calling restrictions must be followed or the system behavior will not be deterministic.\r
  1. ControllerHandle must be a valid EFI_HANDLE.\r
  2. If RemainingDevicePath is not NULL, then it must be a pointer to a naturally aligned\r
     EFI_DEVICE_PATH_PROTOCOL.\r
  3. Prior to calling Start(), the Supported() function for the driver specified by This must\r
     have been called with the same calling parameters, and Supported() must have returned EFI_SUCCESS.\r
\r
  @param[in]  This                 A pointer to the EFI_DRIVER_BINDING_PROTOCOL instance.\r
  @param[in]  ControllerHandle     The handle of the controller to start. This handle\r
                                   must support a protocol interface that supplies\r
                                   an I/O abstraction to the driver.\r
  @param[in]  RemainingDevicePath  A pointer to the remaining portion of a device path.  This\r
                                   parameter is ignored by device drivers, and is optional for bus\r
                                   drivers. For a bus driver, if this parameter is NULL, then handles\r
                                   for all the children of Controller are created by this driver.\r
                                   If this parameter is not NULL and the first Device Path Node is\r
                                   not the End of Device Path Node, then only the handle for the\r
                                   child device specified by the first Device Path Node of\r
                                   RemainingDevicePath is created by this driver.\r
                                   If the first Device Path Node of RemainingDevicePath is\r
                                   the End of Device Path Node, no child handle is created by this\r
                                   driver.\r
\r
  @retval EFI_SUCCESS              The device was started.\r
  @retval EFI_DEVICE_ERROR         The device could not be started due to a device error.Currently not implemented.\r
  @retval EFI_OUT_OF_RESOURCES     The request could not be completed due to a lack of resources.\r
  @retval Others                   The driver failded to start the device.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
SdMmcPciHcDriverBindingStart (\r
  IN EFI_DRIVER_BINDING_PROTOCOL     *This,\r
  IN EFI_HANDLE                      Controller,\r
  IN EFI_DEVICE_PATH_PROTOCOL        *RemainingDevicePath\r
  )\r
{\r
  EFI_STATUS                      Status;\r
  SD_MMC_HC_PRIVATE_DATA          *Private;\r
  EFI_PCI_IO_PROTOCOL             *PciIo;\r
  UINT64                          Supports;\r
  UINT64                          PciAttributes;\r
  UINT8                           SlotNum;\r
  UINT8                           FirstBar;\r
  UINT8                           Slot;\r
  UINT8                           Index;\r
  CARD_TYPE_DETECT_ROUTINE        *Routine;\r
  UINT32                          RoutineNum;\r
  BOOLEAN                         MediaPresent;\r
  BOOLEAN                         Support64BitDma;\r
\r
  DEBUG ((DEBUG_INFO, "SdMmcPciHcDriverBindingStart: Start\n"));\r
\r
  //\r
  // Open PCI I/O Protocol and save pointer to open protocol\r
  // in private data area.\r
  //\r
  PciIo  = NULL;\r
  Status = gBS->OpenProtocol (\r
                  Controller,\r
                  &gEfiPciIoProtocolGuid,\r
                  (VOID **) &PciIo,\r
                  This->DriverBindingHandle,\r
                  Controller,\r
                  EFI_OPEN_PROTOCOL_BY_DRIVER\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // Enable the SD Host Controller MMIO space\r
  //\r
  Private = NULL;\r
  Status  = PciIo->Attributes (\r
                     PciIo,\r
                     EfiPciIoAttributeOperationGet,\r
                     0,\r
                     &PciAttributes\r
                     );\r
\r
  if (EFI_ERROR (Status)) {\r
    goto Done;\r
  }\r
\r
  Status = PciIo->Attributes (\r
                    PciIo,\r
                    EfiPciIoAttributeOperationSupported,\r
                    0,\r
                    &Supports\r
                    );\r
\r
  if (!EFI_ERROR (Status)) {\r
    Supports &= (UINT64)EFI_PCI_DEVICE_ENABLE;\r
    Status    = PciIo->Attributes (\r
                         PciIo,\r
                         EfiPciIoAttributeOperationEnable,\r
                         Supports,\r
                         NULL\r
                         );\r
  } else {\r
    goto Done;\r
  }\r
\r
  Private = AllocateCopyPool (sizeof (SD_MMC_HC_PRIVATE_DATA), &gSdMmcPciHcTemplate);\r
  if (Private == NULL) {\r
    Status = EFI_OUT_OF_RESOURCES;\r
    goto Done;\r
  }\r
\r
  Private->ControllerHandle = Controller;\r
  Private->PciIo            = PciIo;\r
  Private->PciAttributes    = PciAttributes;\r
  InitializeListHead (&Private->Queue);\r
\r
  //\r
  // Get SD/MMC Pci Host Controller Slot info\r
  //\r
  Status = SdMmcHcGetSlotInfo (PciIo, &FirstBar, &SlotNum);\r
  if (EFI_ERROR (Status)) {\r
    goto Done;\r
  }\r
\r
  //\r
  // Attempt to locate the singleton instance of the SD/MMC override protocol,\r
  // which implements platform specific workarounds for non-standard SDHCI\r
  // implementations.\r
  //\r
  if (mOverride == NULL) {\r
    Status = gBS->LocateProtocol (&gEdkiiSdMmcOverrideProtocolGuid, NULL,\r
                    (VOID **)&mOverride);\r
    if (!EFI_ERROR (Status)) {\r
      DEBUG ((DEBUG_INFO, "%a: found SD/MMC override protocol\n",\r
        __FUNCTION__));\r
    }\r
  }\r
\r
  Support64BitDma = TRUE;\r
  for (Slot = FirstBar; Slot < (FirstBar + SlotNum); Slot++) {\r
    Private->Slot[Slot].Enable = TRUE;\r
\r
    //\r
    // Get SD/MMC Pci Host Controller Version\r
    //\r
    Status = SdMmcHcGetControllerVersion (PciIo, Slot, &Private->ControllerVersion[Slot]);\r
    if (EFI_ERROR (Status)) {\r
      continue;\r
    }\r
\r
    Status = SdMmcHcGetCapability (PciIo, Slot, &Private->Capability[Slot]);\r
    if (EFI_ERROR (Status)) {\r
      continue;\r
    }\r
\r
    Private->BaseClkFreq[Slot] = Private->Capability[Slot].BaseClkFreq;\r
\r
    if (mOverride != NULL && mOverride->Capability != NULL) {\r
      Status = mOverride->Capability (\r
                            Controller,\r
                            Slot,\r
                            &Private->Capability[Slot],\r
                            &Private->BaseClkFreq[Slot]\r
                            );\r
      if (EFI_ERROR (Status)) {\r
        DEBUG ((DEBUG_WARN, "%a: Failed to override capability - %r\n",\r
          __FUNCTION__, Status));\r
        continue;\r
      }\r
    }\r
    DumpCapabilityReg (Slot, &Private->Capability[Slot]);\r
    DEBUG ((\r
      DEBUG_INFO,\r
      "Slot[%d] Base Clock Frequency: %dMHz\n",\r
      Slot,\r
      Private->BaseClkFreq[Slot]\r
      ));\r
\r
    //\r
    // If any of the slots does not support 64b system bus\r
    // do not enable 64b DMA in the PCI layer.\r
    //\r
    if (Private->Capability[Slot].SysBus64V3 == 0 &&\r
        Private->Capability[Slot].SysBus64V4 == 0) {\r
      Support64BitDma = FALSE;\r
    }\r
\r
    Status = SdMmcHcGetMaxCurrent (PciIo, Slot, &Private->MaxCurrent[Slot]);\r
    if (EFI_ERROR (Status)) {\r
      continue;\r
    }\r
\r
    Private->Slot[Slot].SlotType = Private->Capability[Slot].SlotType;\r
    if ((Private->Slot[Slot].SlotType != RemovableSlot) && (Private->Slot[Slot].SlotType != EmbeddedSlot)) {\r
      DEBUG ((DEBUG_INFO, "SdMmcPciHcDxe doesn't support the slot type [%d]!!!\n", Private->Slot[Slot].SlotType));\r
      continue;\r
    }\r
\r
    //\r
    // Reset the specified slot of the SD/MMC Pci Host Controller\r
    //\r
    Status = SdMmcHcReset (Private, Slot);\r
    if (EFI_ERROR (Status)) {\r
      continue;\r
    }\r
    //\r
    // Check whether there is a SD/MMC card attached\r
    //\r
    if (Private->Slot[Slot].SlotType == RemovableSlot) {\r
      Status = SdMmcHcCardDetect (PciIo, Slot, &MediaPresent);\r
      if (EFI_ERROR (Status) && (Status != EFI_MEDIA_CHANGED)) {\r
        continue;\r
      } else if (!MediaPresent) {\r
        DEBUG ((\r
          DEBUG_INFO,\r
          "SdMmcHcCardDetect: No device attached in Slot[%d]!!!\n",\r
          Slot\r
          ));\r
        continue;\r
      }\r
    }\r
\r
    Status = SdMmcHcInitHost (Private, Slot);\r
    if (EFI_ERROR (Status)) {\r
      continue;\r
    }\r
\r
    Private->Slot[Slot].MediaPresent = TRUE;\r
    Private->Slot[Slot].Initialized  = TRUE;\r
    RoutineNum = sizeof (mCardTypeDetectRoutineTable) / sizeof (CARD_TYPE_DETECT_ROUTINE);\r
    for (Index = 0; Index < RoutineNum; Index++) {\r
      Routine = &mCardTypeDetectRoutineTable[Index];\r
      if (*Routine != NULL) {\r
        Status = (*Routine) (Private, Slot);\r
        if (!EFI_ERROR (Status)) {\r
          break;\r
        }\r
      }\r
    }\r
    //\r
    // This card doesn't get initialized correctly.\r
    //\r
    if (Index == RoutineNum) {\r
      Private->Slot[Slot].Initialized = FALSE;\r
    }\r
  }\r
\r
  //\r
  // Enable 64-bit DMA support in the PCI layer if this controller\r
  // supports it.\r
  //\r
  if (Support64BitDma) {\r
    Status = PciIo->Attributes (\r
                      PciIo,\r
                      EfiPciIoAttributeOperationEnable,\r
                      EFI_PCI_IO_ATTRIBUTE_DUAL_ADDRESS_CYCLE,\r
                      NULL\r
                      );\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((DEBUG_WARN, "SdMmcPciHcDriverBindingStart: failed to enable 64-bit DMA (%r)\n", Status));\r
    }\r
  }\r
\r
  //\r
  // Start the asynchronous I/O monitor\r
  //\r
  Status = gBS->CreateEvent (\r
                  EVT_TIMER | EVT_NOTIFY_SIGNAL,\r
                  TPL_NOTIFY,\r
                  ProcessAsyncTaskList,\r
                  Private,\r
                  &Private->TimerEvent\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto Done;\r
  }\r
\r
  Status = gBS->SetTimer (Private->TimerEvent, TimerPeriodic, SD_MMC_HC_ASYNC_TIMER);\r
  if (EFI_ERROR (Status)) {\r
    goto Done;\r
  }\r
\r
  //\r
  // Start the Sd removable device connection enumeration\r
  //\r
  Status = gBS->CreateEvent (\r
                  EVT_TIMER | EVT_NOTIFY_SIGNAL,\r
                  TPL_CALLBACK,\r
                  SdMmcPciHcEnumerateDevice,\r
                  Private,\r
                  &Private->ConnectEvent\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto Done;\r
  }\r
\r
  Status = gBS->SetTimer (Private->ConnectEvent, TimerPeriodic, SD_MMC_HC_ENUM_TIMER);\r
  if (EFI_ERROR (Status)) {\r
    goto Done;\r
  }\r
\r
  Status = gBS->InstallMultipleProtocolInterfaces (\r
                  &Controller,\r
                  &gEfiSdMmcPassThruProtocolGuid,\r
                  &(Private->PassThru),\r
                  NULL\r
                  );\r
\r
  DEBUG ((DEBUG_INFO, "SdMmcPciHcDriverBindingStart: %r End on %x\n", Status, Controller));\r
\r
Done:\r
  if (EFI_ERROR (Status)) {\r
    if ((Private != NULL) && (Private->PciAttributes != 0)) {\r
      //\r
      // Restore original PCI attributes\r
      //\r
      PciIo->Attributes (\r
               PciIo,\r
               EfiPciIoAttributeOperationSet,\r
               Private->PciAttributes,\r
               NULL\r
               );\r
    }\r
    gBS->CloseProtocol (\r
          Controller,\r
          &gEfiPciIoProtocolGuid,\r
          This->DriverBindingHandle,\r
          Controller\r
          );\r
\r
    if ((Private != NULL) && (Private->TimerEvent != NULL)) {\r
      gBS->CloseEvent (Private->TimerEvent);\r
    }\r
\r
    if ((Private != NULL) && (Private->ConnectEvent != NULL)) {\r
      gBS->CloseEvent (Private->ConnectEvent);\r
    }\r
\r
    if (Private != NULL) {\r
      FreePool (Private);\r
    }\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Stops a device controller or a bus controller.\r
\r
  The Stop() function is designed to be invoked from the EFI boot service DisconnectController().\r
  As a result, much of the error checking on the parameters to Stop() has been moved\r
  into this common boot service. It is legal to call Stop() from other locations,\r
  but the following calling restrictions must be followed or the system behavior will not be deterministic.\r
  1. ControllerHandle must be a valid EFI_HANDLE that was used on a previous call to this\r
     same driver's Start() function.\r
  2. The first NumberOfChildren handles of ChildHandleBuffer must all be a valid\r
     EFI_HANDLE. In addition, all of these handles must have been created in this driver's\r
     Start() function, and the Start() function must have called OpenProtocol() on\r
     ControllerHandle with an Attribute of EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER.\r
\r
  @param[in]  This              A pointer to the EFI_DRIVER_BINDING_PROTOCOL instance.\r
  @param[in]  ControllerHandle  A handle to the device being stopped. The handle must\r
                                support a bus specific I/O protocol for the driver\r
                                to use to stop the device.\r
  @param[in]  NumberOfChildren  The number of child device handles in ChildHandleBuffer.\r
  @param[in]  ChildHandleBuffer An array of child handles to be freed. May be NULL\r
                                if NumberOfChildren is 0.\r
\r
  @retval EFI_SUCCESS           The device was stopped.\r
  @retval EFI_DEVICE_ERROR      The device could not be stopped due to a device error.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
SdMmcPciHcDriverBindingStop (\r
  IN  EFI_DRIVER_BINDING_PROTOCOL     *This,\r
  IN  EFI_HANDLE                      Controller,\r
  IN  UINTN                           NumberOfChildren,\r
  IN  EFI_HANDLE                      *ChildHandleBuffer\r
  )\r
{\r
  EFI_STATUS                          Status;\r
  EFI_SD_MMC_PASS_THRU_PROTOCOL       *PassThru;\r
  SD_MMC_HC_PRIVATE_DATA              *Private;\r
  EFI_PCI_IO_PROTOCOL                 *PciIo;\r
  LIST_ENTRY                          *Link;\r
  LIST_ENTRY                          *NextLink;\r
  SD_MMC_HC_TRB                       *Trb;\r
\r
  DEBUG ((DEBUG_INFO, "SdMmcPciHcDriverBindingStop: Start\n"));\r
\r
  Status = gBS->OpenProtocol (\r
                  Controller,\r
                  &gEfiSdMmcPassThruProtocolGuid,\r
                  (VOID**) &PassThru,\r
                  This->DriverBindingHandle,\r
                  Controller,\r
                  EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Private = SD_MMC_HC_PRIVATE_FROM_THIS (PassThru);\r
  //\r
  // Close Non-Blocking timer and free Task list.\r
  //\r
  if (Private->TimerEvent != NULL) {\r
    gBS->CloseEvent (Private->TimerEvent);\r
    Private->TimerEvent = NULL;\r
  }\r
  if (Private->ConnectEvent != NULL) {\r
    gBS->CloseEvent (Private->ConnectEvent);\r
    Private->ConnectEvent = NULL;\r
  }\r
  //\r
  // As the timer is closed, there is no needs to use TPL lock to\r
  // protect the critical region "queue".\r
  //\r
  for (Link = GetFirstNode (&Private->Queue);\r
       !IsNull (&Private->Queue, Link);\r
       Link = NextLink) {\r
    NextLink = GetNextNode (&Private->Queue, Link);\r
    RemoveEntryList (Link);\r
    Trb = SD_MMC_HC_TRB_FROM_THIS (Link);\r
    Trb->Packet->TransactionStatus = EFI_ABORTED;\r
    gBS->SignalEvent (Trb->Event);\r
    SdMmcFreeTrb (Trb);\r
  }\r
\r
  //\r
  // Uninstall Block I/O protocol from the device handle\r
  //\r
  Status = gBS->UninstallProtocolInterface (\r
                  Controller,\r
                  &gEfiSdMmcPassThruProtocolGuid,\r
                  &(Private->PassThru)\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  gBS->CloseProtocol (\r
         Controller,\r
         &gEfiPciIoProtocolGuid,\r
         This->DriverBindingHandle,\r
         Controller\r
         );\r
  //\r
  // Restore original PCI attributes\r
  //\r
  PciIo  = Private->PciIo;\r
  Status = PciIo->Attributes (\r
                    PciIo,\r
                    EfiPciIoAttributeOperationSet,\r
                    Private->PciAttributes,\r
                    NULL\r
                    );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  FreePool (Private);\r
\r
  DEBUG ((DEBUG_INFO, "SdMmcPciHcDriverBindingStop: End with %r\n", Status));\r
\r
  return Status;\r
}\r
\r
/**\r
  Sends SD command to an SD card that is attached to the SD controller.\r
\r
  The PassThru() function sends the SD command specified by Packet to the SD card\r
  specified by Slot.\r
\r
  If Packet is successfully sent to the SD card, then EFI_SUCCESS is returned.\r
\r
  If a device error occurs while sending the Packet, then EFI_DEVICE_ERROR is returned.\r
\r
  If Slot is not in a valid range for the SD controller, then EFI_INVALID_PARAMETER\r
  is returned.\r
\r
  If Packet defines a data command but both InDataBuffer and OutDataBuffer are NULL,\r
  EFI_INVALID_PARAMETER is returned.\r
\r
  @param[in]     This           A pointer to the EFI_SD_MMC_PASS_THRU_PROTOCOL instance.\r
  @param[in]     Slot           The slot number of the SD card to send the command to.\r
  @param[in,out] Packet         A pointer to the SD command data structure.\r
  @param[in]     Event          If Event is NULL, blocking I/O is performed. If Event is\r
                                not NULL, then nonblocking I/O is performed, and Event\r
                                will be signaled when the Packet completes.\r
\r
  @retval EFI_SUCCESS           The SD Command Packet was sent by the host.\r
  @retval EFI_DEVICE_ERROR      A device error occurred while attempting to send the SD\r
                                command Packet.\r
  @retval EFI_INVALID_PARAMETER Packet, Slot, or the contents of the Packet is invalid.\r
  @retval EFI_INVALID_PARAMETER Packet defines a data command but both InDataBuffer and\r
                                OutDataBuffer are NULL.\r
  @retval EFI_NO_MEDIA          SD Device not present in the Slot.\r
  @retval EFI_UNSUPPORTED       The command described by the SD Command Packet is not\r
                                supported by the host controller.\r
  @retval EFI_BAD_BUFFER_SIZE   The InTransferLength or OutTransferLength exceeds the\r
                                limit supported by SD card ( i.e. if the number of bytes\r
                                exceed the Last LBA).\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
SdMmcPassThruPassThru (\r
  IN     EFI_SD_MMC_PASS_THRU_PROTOCOL         *This,\r
  IN     UINT8                                 Slot,\r
  IN OUT EFI_SD_MMC_PASS_THRU_COMMAND_PACKET   *Packet,\r
  IN     EFI_EVENT                             Event    OPTIONAL\r
  )\r
{\r
  EFI_STATUS                      Status;\r
  SD_MMC_HC_PRIVATE_DATA          *Private;\r
  SD_MMC_HC_TRB                   *Trb;\r
  EFI_TPL                         OldTpl;\r
\r
  if ((This == NULL) || (Packet == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if ((Packet->SdMmcCmdBlk == NULL) || (Packet->SdMmcStatusBlk == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if ((Packet->OutDataBuffer == NULL) && (Packet->OutTransferLength != 0)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if ((Packet->InDataBuffer == NULL) && (Packet->InTransferLength != 0)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Private = SD_MMC_HC_PRIVATE_FROM_THIS (This);\r
\r
  if (!Private->Slot[Slot].Enable) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (!Private->Slot[Slot].MediaPresent) {\r
    return EFI_NO_MEDIA;\r
  }\r
\r
  if (!Private->Slot[Slot].Initialized) {\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  Trb = SdMmcCreateTrb (Private, Slot, Packet, Event);\r
  if (Trb == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
  //\r
  // Immediately return for async I/O.\r
  //\r
  if (Event != NULL) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // Wait async I/O list is empty before execute sync I/O operation.\r
  //\r
  while (TRUE) {\r
    OldTpl = gBS->RaiseTPL (TPL_NOTIFY);\r
    if (IsListEmpty (&Private->Queue)) {\r
      gBS->RestoreTPL (OldTpl);\r
      break;\r
    }\r
    gBS->RestoreTPL (OldTpl);\r
  }\r
\r
  Status = SdMmcWaitTrbEnv (Private, Trb);\r
  if (EFI_ERROR (Status)) {\r
    goto Done;\r
  }\r
\r
  Status = SdMmcExecTrb (Private, Trb);\r
  if (EFI_ERROR (Status)) {\r
    goto Done;\r
  }\r
\r
  Status = SdMmcWaitTrbResult (Private, Trb);\r
  if (EFI_ERROR (Status)) {\r
    goto Done;\r
  }\r
\r
Done:\r
  SdMmcFreeTrb (Trb);\r
\r
  return Status;\r
}\r
\r
/**\r
  Used to retrieve next slot numbers supported by the SD controller. The function\r
  returns information about all available slots (populated or not-populated).\r
\r
  The GetNextSlot() function retrieves the next slot number on an SD controller.\r
  If on input Slot is 0xFF, then the slot number of the first slot on the SD controller\r
  is returned.\r
\r
  If Slot is a slot number that was returned on a previous call to GetNextSlot(), then\r
  the slot number of the next slot on the SD controller is returned.\r
\r
  If Slot is not 0xFF and Slot was not returned on a previous call to GetNextSlot(),\r
  EFI_INVALID_PARAMETER is returned.\r
\r
  If Slot is the slot number of the last slot on the SD controller, then EFI_NOT_FOUND\r
  is returned.\r
\r
  @param[in]     This           A pointer to the EFI_SD_MMMC_PASS_THRU_PROTOCOL instance.\r
  @param[in,out] Slot           On input, a pointer to a slot number on the SD controller.\r
                                On output, a pointer to the next slot number on the SD controller.\r
                                An input value of 0xFF retrieves the first slot number on the SD\r
                                controller.\r
\r
  @retval EFI_SUCCESS           The next slot number on the SD controller was returned in Slot.\r
  @retval EFI_NOT_FOUND         There are no more slots on this SD controller.\r
  @retval EFI_INVALID_PARAMETER Slot is not 0xFF and Slot was not returned on a previous call\r
                                to GetNextSlot().\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
SdMmcPassThruGetNextSlot (\r
  IN     EFI_SD_MMC_PASS_THRU_PROTOCOL        *This,\r
  IN OUT UINT8                                *Slot\r
  )\r
{\r
  SD_MMC_HC_PRIVATE_DATA          *Private;\r
  UINT8                           Index;\r
\r
  if ((This == NULL) || (Slot == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Private = SD_MMC_HC_PRIVATE_FROM_THIS (This);\r
\r
  if (*Slot == 0xFF) {\r
    for (Index = 0; Index < SD_MMC_HC_MAX_SLOT; Index++) {\r
      if (Private->Slot[Index].Enable) {\r
        *Slot = Index;\r
        Private->PreviousSlot = Index;\r
        return EFI_SUCCESS;\r
      }\r
    }\r
    return EFI_NOT_FOUND;\r
  } else if (*Slot == Private->PreviousSlot) {\r
    for (Index = *Slot + 1; Index < SD_MMC_HC_MAX_SLOT; Index++) {\r
      if (Private->Slot[Index].Enable) {\r
        *Slot = Index;\r
        Private->PreviousSlot = Index;\r
        return EFI_SUCCESS;\r
      }\r
    }\r
    return EFI_NOT_FOUND;\r
  } else {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
}\r
\r
/**\r
  Used to allocate and build a device path node for an SD card on the SD controller.\r
\r
  The BuildDevicePath() function allocates and builds a single device node for the SD\r
  card specified by Slot.\r
\r
  If the SD card specified by Slot is not present on the SD controller, then EFI_NOT_FOUND\r
  is returned.\r
\r
  If DevicePath is NULL, then EFI_INVALID_PARAMETER is returned.\r
\r
  If there are not enough resources to allocate the device path node, then EFI_OUT_OF_RESOURCES\r
  is returned.\r
\r
  Otherwise, DevicePath is allocated with the boot service AllocatePool(), the contents of\r
  DevicePath are initialized to describe the SD card specified by Slot, and EFI_SUCCESS is\r
  returned.\r
\r
  @param[in]     This           A pointer to the EFI_SD_MMMC_PASS_THRU_PROTOCOL instance.\r
  @param[in]     Slot           Specifies the slot number of the SD card for which a device\r
                                path node is to be allocated and built.\r
  @param[in,out] DevicePath     A pointer to a single device path node that describes the SD\r
                                card specified by Slot. This function is responsible for\r
                                allocating the buffer DevicePath with the boot service\r
                                AllocatePool(). It is the caller's responsibility to free\r
                                DevicePath when the caller is finished with DevicePath.\r
\r
  @retval EFI_SUCCESS           The device path node that describes the SD card specified by\r
                                Slot was allocated and returned in DevicePath.\r
  @retval EFI_NOT_FOUND         The SD card specified by Slot does not exist on the SD controller.\r
  @retval EFI_INVALID_PARAMETER DevicePath is NULL.\r
  @retval EFI_OUT_OF_RESOURCES  There are not enough resources to allocate DevicePath.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
SdMmcPassThruBuildDevicePath (\r
  IN     EFI_SD_MMC_PASS_THRU_PROTOCOL       *This,\r
  IN     UINT8                               Slot,\r
  IN OUT EFI_DEVICE_PATH_PROTOCOL            **DevicePath\r
  )\r
{\r
  SD_MMC_HC_PRIVATE_DATA          *Private;\r
  SD_DEVICE_PATH                  *SdNode;\r
  EMMC_DEVICE_PATH                *EmmcNode;\r
\r
  if ((This == NULL) || (DevicePath == NULL) || (Slot >= SD_MMC_HC_MAX_SLOT)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Private = SD_MMC_HC_PRIVATE_FROM_THIS (This);\r
\r
  if ((!Private->Slot[Slot].Enable) || (!Private->Slot[Slot].MediaPresent)) {\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  if (Private->Slot[Slot].CardType == SdCardType) {\r
    SdNode = AllocateCopyPool (sizeof (SD_DEVICE_PATH), &mSdDpTemplate);\r
    if (SdNode == NULL) {\r
      return EFI_OUT_OF_RESOURCES;\r
    }\r
    SdNode->SlotNumber = Slot;\r
\r
    *DevicePath = (EFI_DEVICE_PATH_PROTOCOL *) SdNode;\r
  } else if (Private->Slot[Slot].CardType == EmmcCardType) {\r
    EmmcNode = AllocateCopyPool (sizeof (EMMC_DEVICE_PATH), &mEmmcDpTemplate);\r
    if (EmmcNode == NULL) {\r
      return EFI_OUT_OF_RESOURCES;\r
    }\r
    EmmcNode->SlotNumber = Slot;\r
\r
    *DevicePath = (EFI_DEVICE_PATH_PROTOCOL *) EmmcNode;\r
  } else {\r
    //\r
    // Currently we only support SD and EMMC two device nodes.\r
    //\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  This function retrieves an SD card slot number based on the input device path.\r
\r
  The GetSlotNumber() function retrieves slot number for the SD card specified by\r
  the DevicePath node. If DevicePath is NULL, EFI_INVALID_PARAMETER is returned.\r
\r
  If DevicePath is not a device path node type that the SD Pass Thru driver supports,\r
  EFI_UNSUPPORTED is returned.\r
\r
  @param[in]  This              A pointer to the EFI_SD_MMC_PASS_THRU_PROTOCOL instance.\r
  @param[in]  DevicePath        A pointer to the device path node that describes a SD\r
                                card on the SD controller.\r
  @param[out] Slot              On return, points to the slot number of an SD card on\r
                                the SD controller.\r
\r
  @retval EFI_SUCCESS           SD card slot number is returned in Slot.\r
  @retval EFI_INVALID_PARAMETER Slot or DevicePath is NULL.\r
  @retval EFI_UNSUPPORTED       DevicePath is not a device path node type that the SD\r
                                Pass Thru driver supports.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
SdMmcPassThruGetSlotNumber (\r
  IN  EFI_SD_MMC_PASS_THRU_PROTOCOL          *This,\r
  IN  EFI_DEVICE_PATH_PROTOCOL               *DevicePath,\r
  OUT UINT8                                  *Slot\r
  )\r
{\r
  SD_MMC_HC_PRIVATE_DATA          *Private;\r
  SD_DEVICE_PATH                  *SdNode;\r
  EMMC_DEVICE_PATH                *EmmcNode;\r
  UINT8                           SlotNumber;\r
\r
  if ((This == NULL) || (DevicePath == NULL) || (Slot == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Private = SD_MMC_HC_PRIVATE_FROM_THIS (This);\r
\r
  //\r
  // Check whether the DevicePath belongs to SD_DEVICE_PATH or EMMC_DEVICE_PATH\r
  //\r
  if ((DevicePath->Type != MESSAGING_DEVICE_PATH) ||\r
      ((DevicePath->SubType != MSG_SD_DP) &&\r
       (DevicePath->SubType != MSG_EMMC_DP)) ||\r
      (DevicePathNodeLength(DevicePath) != sizeof(SD_DEVICE_PATH)) ||\r
      (DevicePathNodeLength(DevicePath) != sizeof(EMMC_DEVICE_PATH))) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  if (DevicePath->SubType == MSG_SD_DP) {\r
    SdNode = (SD_DEVICE_PATH *) DevicePath;\r
    SlotNumber = SdNode->SlotNumber;\r
  } else {\r
    EmmcNode = (EMMC_DEVICE_PATH *) DevicePath;\r
    SlotNumber = EmmcNode->SlotNumber;\r
  }\r
\r
  if (SlotNumber >= SD_MMC_HC_MAX_SLOT) {\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  if (Private->Slot[SlotNumber].Enable) {\r
    *Slot = SlotNumber;\r
    return EFI_SUCCESS;\r
  } else {\r
    return EFI_NOT_FOUND;\r
  }\r
}\r
\r
/**\r
  Resets an SD card that is connected to the SD controller.\r
\r
  The ResetDevice() function resets the SD card specified by Slot.\r
\r
  If this SD controller does not support a device reset operation, EFI_UNSUPPORTED is\r
  returned.\r
\r
  If Slot is not in a valid slot number for this SD controller, EFI_INVALID_PARAMETER\r
  is returned.\r
\r
  If the device reset operation is completed, EFI_SUCCESS is returned.\r
\r
  @param[in]  This              A pointer to the EFI_SD_MMC_PASS_THRU_PROTOCOL instance.\r
  @param[in]  Slot              Specifies the slot number of the SD card to be reset.\r
\r
  @retval EFI_SUCCESS           The SD card specified by Slot was reset.\r
  @retval EFI_UNSUPPORTED       The SD controller does not support a device reset operation.\r
  @retval EFI_INVALID_PARAMETER Slot number is invalid.\r
  @retval EFI_NO_MEDIA          SD Device not present in the Slot.\r
  @retval EFI_DEVICE_ERROR      The reset command failed due to a device error\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
SdMmcPassThruResetDevice (\r
  IN EFI_SD_MMC_PASS_THRU_PROTOCOL           *This,\r
  IN UINT8                                   Slot\r
  )\r
{\r
  SD_MMC_HC_PRIVATE_DATA          *Private;\r
  LIST_ENTRY                      *Link;\r
  LIST_ENTRY                      *NextLink;\r
  SD_MMC_HC_TRB                   *Trb;\r
  EFI_TPL                         OldTpl;\r
\r
  if (This == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Private = SD_MMC_HC_PRIVATE_FROM_THIS (This);\r
\r
  if (!Private->Slot[Slot].Enable) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (!Private->Slot[Slot].MediaPresent) {\r
    return EFI_NO_MEDIA;\r
  }\r
\r
  if (!Private->Slot[Slot].Initialized) {\r
    return EFI_DEVICE_ERROR;\r
  }\r
  //\r
  // Free all async I/O requests in the queue\r
  //\r
  OldTpl = gBS->RaiseTPL (TPL_NOTIFY);\r
\r
  for (Link = GetFirstNode (&Private->Queue);\r
       !IsNull (&Private->Queue, Link);\r
       Link = NextLink) {\r
    NextLink = GetNextNode (&Private->Queue, Link);\r
    RemoveEntryList (Link);\r
    Trb = SD_MMC_HC_TRB_FROM_THIS (Link);\r
    Trb->Packet->TransactionStatus = EFI_ABORTED;\r
    gBS->SignalEvent (Trb->Event);\r
    SdMmcFreeTrb (Trb);\r
  }\r
\r
  gBS->RestoreTPL (OldTpl);\r
\r
  return EFI_SUCCESS;\r
}\r
\r