[mirror_edk2.git] / MdeModulePkg / Bus / Pci / PciBusDxe / PciIo.c

/** @file\r
  EFI PCI IO protocol functions implementation for PCI Bus module.\r
\r
Copyright (c) 2006 - 2019, Intel Corporation. All rights reserved.<BR>\r
SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "PciBus.h"\r
\r
extern EDKII_IOMMU_PROTOCOL                          *mIoMmuProtocol;\r
\r
//\r
// Pci Io Protocol Interface\r
//\r
EFI_PCI_IO_PROTOCOL  mPciIoInterface = {\r
  PciIoPollMem,\r
  PciIoPollIo,\r
  {\r
    PciIoMemRead,\r
    PciIoMemWrite\r
  },\r
  {\r
    PciIoIoRead,\r
    PciIoIoWrite\r
  },\r
  {\r
    PciIoConfigRead,\r
    PciIoConfigWrite\r
  },\r
  PciIoCopyMem,\r
  PciIoMap,\r
  PciIoUnmap,\r
  PciIoAllocateBuffer,\r
  PciIoFreeBuffer,\r
  PciIoFlush,\r
  PciIoGetLocation,\r
  PciIoAttributes,\r
  PciIoGetBarAttributes,\r
  PciIoSetBarAttributes,\r
  0,\r
  NULL\r
};\r
\r
/**\r
  Initializes a PCI I/O Instance.\r
\r
  @param PciIoDevice    Pci device instance.\r
\r
**/\r
VOID\r
InitializePciIoInstance (\r
  IN PCI_IO_DEVICE               *PciIoDevice\r
  )\r
{\r
  CopyMem (&PciIoDevice->PciIo, &mPciIoInterface, sizeof (EFI_PCI_IO_PROTOCOL));\r
}\r
\r
/**\r
  Verifies access to a PCI Base Address Register (BAR).\r
\r
  @param PciIoDevice  Pci device instance.\r
  @param BarIndex     The BAR index of the standard PCI Configuration header to use as the\r
                      base address for the memory or I/O operation to perform.\r
  @param Type         Operation type could be memory or I/O.\r
  @param Width        Signifies the width of the memory or I/O operations.\r
  @param Count        The number of memory or I/O operations to perform.\r
  @param Offset       The offset within the PCI configuration space for the PCI controller.\r
\r
  @retval EFI_INVALID_PARAMETER Invalid Width/BarIndex or Bar type.\r
  @retval EFI_SUCCESS           Successfully verified.\r
\r
**/\r
EFI_STATUS\r
PciIoVerifyBarAccess (\r
  IN PCI_IO_DEVICE                   *PciIoDevice,\r
  IN UINT8                           BarIndex,\r
  IN PCI_BAR_TYPE                    Type,\r
  IN IN EFI_PCI_IO_PROTOCOL_WIDTH    Width,\r
  IN IN UINTN                        Count,\r
  IN UINT64                          *Offset\r
  )\r
{\r
  if ((UINT32)Width >= EfiPciIoWidthMaximum) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (BarIndex == EFI_PCI_IO_PASS_THROUGH_BAR) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // BarIndex 0-5 is legal\r
  //\r
  if (BarIndex >= PCI_MAX_BAR) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (!CheckBarType (PciIoDevice, BarIndex, Type)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // If Width is EfiPciIoWidthFifoUintX then convert to EfiPciIoWidthUintX\r
  // If Width is EfiPciIoWidthFillUintX then convert to EfiPciIoWidthUintX\r
  //\r
  if (Width >= EfiPciIoWidthFifoUint8 && Width <= EfiPciIoWidthFifoUint64) {\r
    Count = 1;\r
  }\r
\r
  Width = (EFI_PCI_IO_PROTOCOL_WIDTH) (Width & 0x03);\r
\r
  if ((*Offset + Count * (UINTN)(1 << Width)) - 1 >= PciIoDevice->PciBar[BarIndex].Length) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  *Offset = *Offset + PciIoDevice->PciBar[BarIndex].BaseAddress;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Verifies access to a PCI Configuration Header.\r
\r
  @param PciIoDevice  Pci device instance.\r
  @param Width        Signifies the width of the memory or I/O operations.\r
  @param Count        The number of memory or I/O operations to perform.\r
  @param Offset       The offset within the PCI configuration space for the PCI controller.\r
\r
  @retval EFI_INVALID_PARAMETER  Invalid Width\r
  @retval EFI_UNSUPPORTED        Offset overflowed.\r
  @retval EFI_SUCCESS            Successfully verified.\r
\r
**/\r
EFI_STATUS\r
PciIoVerifyConfigAccess (\r
  IN PCI_IO_DEVICE              *PciIoDevice,\r
  IN EFI_PCI_IO_PROTOCOL_WIDTH  Width,\r
  IN UINTN                      Count,\r
  IN UINT64                     *Offset\r
  )\r
{\r
  UINT64  ExtendOffset;\r
\r
  if ((UINT32)Width >= EfiPciIoWidthMaximum) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // If Width is EfiPciIoWidthFillUintX then convert to EfiPciIoWidthUintX\r
  //\r
  Width = (EFI_PCI_IO_PROTOCOL_WIDTH) (Width & 0x03);\r
\r
  if (PciIoDevice->IsPciExp) {\r
    if ((*Offset + Count * (UINTN)(1 << Width)) - 1 >= PCI_EXP_MAX_CONFIG_OFFSET) {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
    ExtendOffset  = LShiftU64 (*Offset, 32);\r
    *Offset       = EFI_PCI_ADDRESS (PciIoDevice->BusNumber, PciIoDevice->DeviceNumber, PciIoDevice->FunctionNumber, 0);\r
    *Offset       = (*Offset) | ExtendOffset;\r
\r
  } else {\r
    if ((*Offset + Count * (UINTN)(1 << Width)) - 1 >= PCI_MAX_CONFIG_OFFSET) {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
    *Offset = EFI_PCI_ADDRESS (PciIoDevice->BusNumber, PciIoDevice->DeviceNumber, PciIoDevice->FunctionNumber, *Offset);\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Reads from the memory space of a PCI controller. Returns either when the polling exit criteria is\r
  satisfied or after a defined duration.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Width                 Signifies the width of the memory or I/O operations.\r
  @param  BarIndex              The BAR index of the standard PCI Configuration header to use as the\r
                                base address for the memory operation to perform.\r
  @param  Offset                The offset within the selected BAR to start the memory operation.\r
  @param  Mask                  Mask used for the polling criteria.\r
  @param  Value                 The comparison value used for the polling exit criteria.\r
  @param  Delay                 The number of 100 ns units to poll.\r
  @param  Result                Pointer to the last value read from the memory location.\r
\r
  @retval EFI_SUCCESS           The last data returned from the access matched the poll exit criteria.\r
  @retval EFI_UNSUPPORTED       BarIndex not valid for this PCI controller.\r
  @retval EFI_UNSUPPORTED       Offset is not valid for the BarIndex of this PCI controller.\r
  @retval EFI_TIMEOUT           Delay expired before a match occurred.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoPollMem (\r
  IN  EFI_PCI_IO_PROTOCOL        *This,\r
  IN  EFI_PCI_IO_PROTOCOL_WIDTH  Width,\r
  IN  UINT8                      BarIndex,\r
  IN  UINT64                     Offset,\r
  IN  UINT64                     Mask,\r
  IN  UINT64                     Value,\r
  IN  UINT64                     Delay,\r
  OUT UINT64                     *Result\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if ((UINT32)Width >= EfiPciIoWidthMaximum) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Status = PciIoVerifyBarAccess (PciIoDevice, BarIndex, PciBarTypeMem, Width, 1, &Offset);\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  if (Width > EfiPciIoWidthUint64) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // If request is not aligned, then convert request to EfiPciIoWithXXXUint8\r
  //\r
  if (FeaturePcdGet (PcdUnalignedPciIoEnable)) {\r
    if ((Offset & ((1 << (Width & 0x03)) - 1)) != 0) {\r
      Status  = PciIoMemRead (This, Width, BarIndex, Offset, 1, Result);\r
      if (EFI_ERROR (Status)) {\r
        return Status;\r
      }\r
      if ((*Result & Mask) == Value || Delay == 0) {\r
        return EFI_SUCCESS;\r
      }\r
      do {\r
        //\r
        // Stall 10 us = 100 * 100ns\r
        //\r
        gBS->Stall (10);\r
\r
        Status  = PciIoMemRead (This, Width, BarIndex, Offset, 1, Result);\r
        if (EFI_ERROR (Status)) {\r
          return Status;\r
        }\r
        if ((*Result & Mask) == Value) {\r
          return EFI_SUCCESS;\r
        }\r
        if (Delay <= 100) {\r
          return EFI_TIMEOUT;\r
        }\r
        Delay -= 100;\r
      } while (TRUE);\r
    }\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->PollMem (\r
                                           PciIoDevice->PciRootBridgeIo,\r
                                           (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH) Width,\r
                                           Offset,\r
                                           Mask,\r
                                           Value,\r
                                           Delay,\r
                                           Result\r
                                           );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_CONTROLLER_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Reads from the memory space of a PCI controller. Returns either when the polling exit criteria is\r
  satisfied or after a defined duration.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Width                 Signifies the width of the memory or I/O operations.\r
  @param  BarIndex              The BAR index of the standard PCI Configuration header to use as the\r
                                base address for the memory operation to perform.\r
  @param  Offset                The offset within the selected BAR to start the memory operation.\r
  @param  Mask                  Mask used for the polling criteria.\r
  @param  Value                 The comparison value used for the polling exit criteria.\r
  @param  Delay                 The number of 100 ns units to poll.\r
  @param  Result                Pointer to the last value read from the memory location.\r
\r
  @retval EFI_SUCCESS           The last data returned from the access matched the poll exit criteria.\r
  @retval EFI_UNSUPPORTED       BarIndex not valid for this PCI controller.\r
  @retval EFI_UNSUPPORTED       Offset is not valid for the BarIndex of this PCI controller.\r
  @retval EFI_TIMEOUT           Delay expired before a match occurred.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoPollIo (\r
  IN  EFI_PCI_IO_PROTOCOL        *This,\r
  IN  EFI_PCI_IO_PROTOCOL_WIDTH  Width,\r
  IN  UINT8                      BarIndex,\r
  IN  UINT64                     Offset,\r
  IN  UINT64                     Mask,\r
  IN  UINT64                     Value,\r
  IN  UINT64                     Delay,\r
  OUT UINT64                     *Result\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if ((UINT32)Width > EfiPciIoWidthUint64) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Status = PciIoVerifyBarAccess (PciIoDevice, BarIndex, PciBarTypeIo, Width, 1, &Offset);\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // If request is not aligned, then convert request to EfiPciIoWithXXXUint8\r
  //\r
  if (FeaturePcdGet (PcdUnalignedPciIoEnable)) {\r
    if ((Offset & ((1 << (Width & 0x03)) - 1)) != 0) {\r
      Status  = PciIoIoRead (This, Width, BarIndex, Offset, 1, Result);\r
      if (EFI_ERROR (Status)) {\r
        return Status;\r
      }\r
      if ((*Result & Mask) == Value || Delay == 0) {\r
        return EFI_SUCCESS;\r
      }\r
      do {\r
        //\r
        // Stall 10 us = 100 * 100ns\r
        //\r
        gBS->Stall (10);\r
\r
        Status  = PciIoIoRead (This, Width, BarIndex, Offset, 1, Result);\r
        if (EFI_ERROR (Status)) {\r
          return Status;\r
        }\r
        if ((*Result & Mask) == Value) {\r
          return EFI_SUCCESS;\r
        }\r
        if (Delay <= 100) {\r
          return EFI_TIMEOUT;\r
        }\r
        Delay -= 100;\r
      } while (TRUE);\r
    }\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->PollIo (\r
                                           PciIoDevice->PciRootBridgeIo,\r
                                           (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH) Width,\r
                                           Offset,\r
                                           Mask,\r
                                           Value,\r
                                           Delay,\r
                                           Result\r
                                           );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_CONTROLLER_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Enable a PCI driver to access PCI controller registers in the PCI memory or I/O space.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Width                 Signifies the width of the memory or I/O operations.\r
  @param  BarIndex              The BAR index of the standard PCI Configuration header to use as the\r
                                base address for the memory or I/O operation to perform.\r
  @param  Offset                The offset within the selected BAR to start the memory or I/O operation.\r
  @param  Count                 The number of memory or I/O operations to perform.\r
  @param  Buffer                For read operations, the destination buffer to store the results. For write\r
                                operations, the source buffer to write data from.\r
\r
  @retval EFI_SUCCESS           The data was read from or written to the PCI controller.\r
  @retval EFI_UNSUPPORTED       BarIndex not valid for this PCI controller.\r
  @retval EFI_UNSUPPORTED       The address range specified by Offset, Width, and Count is not\r
                                valid for the PCI BAR specified by BarIndex.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoMemRead (\r
  IN     EFI_PCI_IO_PROTOCOL        *This,\r
  IN     EFI_PCI_IO_PROTOCOL_WIDTH  Width,\r
  IN     UINT8                      BarIndex,\r
  IN     UINT64                     Offset,\r
  IN     UINTN                      Count,\r
  IN OUT VOID                       *Buffer\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if ((UINT32)Width >= EfiPciIoWidthMaximum) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (Buffer == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Status = PciIoVerifyBarAccess (PciIoDevice, BarIndex, PciBarTypeMem, Width, Count, &Offset);\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // If request is not aligned, then convert request to EfiPciIoWithXXXUint8\r
  //\r
  if (FeaturePcdGet (PcdUnalignedPciIoEnable)) {\r
    if ((Offset & ((1 << (Width & 0x03)) - 1)) != 0) {\r
      Count *=  (UINTN)(1 << (Width & 0x03));\r
      Width = (EFI_PCI_IO_PROTOCOL_WIDTH) (Width & (~0x03));\r
    }\r
  }\r
\r
\r
  Status = PciIoDevice->PciRootBridgeIo->Mem.Read (\r
                                              PciIoDevice->PciRootBridgeIo,\r
                                              (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH) Width,\r
                                              Offset,\r
                                              Count,\r
                                              Buffer\r
                                              );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_READ_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Enable a PCI driver to access PCI controller registers in the PCI memory or I/O space.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Width                 Signifies the width of the memory or I/O operations.\r
  @param  BarIndex              The BAR index of the standard PCI Configuration header to use as the\r
                                base address for the memory or I/O operation to perform.\r
  @param  Offset                The offset within the selected BAR to start the memory or I/O operation.\r
  @param  Count                 The number of memory or I/O operations to perform.\r
  @param  Buffer                For read operations, the destination buffer to store the results. For write\r
                                operations, the source buffer to write data from.\r
\r
  @retval EFI_SUCCESS           The data was read from or written to the PCI controller.\r
  @retval EFI_UNSUPPORTED       BarIndex not valid for this PCI controller.\r
  @retval EFI_UNSUPPORTED       The address range specified by Offset, Width, and Count is not\r
                                valid for the PCI BAR specified by BarIndex.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoMemWrite (\r
  IN     EFI_PCI_IO_PROTOCOL        *This,\r
  IN     EFI_PCI_IO_PROTOCOL_WIDTH  Width,\r
  IN     UINT8                      BarIndex,\r
  IN     UINT64                     Offset,\r
  IN     UINTN                      Count,\r
  IN OUT VOID                       *Buffer\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if ((UINT32)Width >= EfiPciIoWidthMaximum) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (Buffer == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Status = PciIoVerifyBarAccess (PciIoDevice, BarIndex, PciBarTypeMem, Width, Count, &Offset);\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // If request is not aligned, then convert request to EfiPciIoWithXXXUint8\r
  //\r
  if (FeaturePcdGet (PcdUnalignedPciIoEnable)) {\r
    if ((Offset & ((1 << (Width & 0x03)) - 1)) != 0) {\r
      Count *=  (UINTN)(1 << (Width & 0x03));\r
      Width = (EFI_PCI_IO_PROTOCOL_WIDTH) (Width & (~0x03));\r
    }\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->Mem.Write (\r
                                              PciIoDevice->PciRootBridgeIo,\r
                                              (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH) Width,\r
                                              Offset,\r
                                              Count,\r
                                              Buffer\r
                                              );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_WRITE_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Enable a PCI driver to access PCI controller registers in the PCI memory or I/O space.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Width                 Signifies the width of the memory or I/O operations.\r
  @param  BarIndex              The BAR index of the standard PCI Configuration header to use as the\r
                                base address for the memory or I/O operation to perform.\r
  @param  Offset                The offset within the selected BAR to start the memory or I/O operation.\r
  @param  Count                 The number of memory or I/O operations to perform.\r
  @param  Buffer                For read operations, the destination buffer to store the results. For write\r
                                operations, the source buffer to write data from.\r
\r
  @retval EFI_SUCCESS           The data was read from or written to the PCI controller.\r
  @retval EFI_UNSUPPORTED       BarIndex not valid for this PCI controller.\r
  @retval EFI_UNSUPPORTED       The address range specified by Offset, Width, and Count is not\r
                                valid for the PCI BAR specified by BarIndex.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoIoRead (\r
  IN     EFI_PCI_IO_PROTOCOL        *This,\r
  IN     EFI_PCI_IO_PROTOCOL_WIDTH  Width,\r
  IN     UINT8                      BarIndex,\r
  IN     UINT64                     Offset,\r
  IN     UINTN                      Count,\r
  IN OUT VOID                       *Buffer\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if ((UINT32)Width >= EfiPciIoWidthMaximum) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (Buffer == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Status = PciIoVerifyBarAccess (PciIoDevice, BarIndex, PciBarTypeIo, Width, Count, &Offset);\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // If request is not aligned, then convert request to EfiPciIoWithXXXUint8\r
  //\r
  if (FeaturePcdGet (PcdUnalignedPciIoEnable)) {\r
    if ((Offset & ((1 << (Width & 0x03)) - 1)) != 0) {\r
      Count *=  (UINTN)(1 << (Width & 0x03));\r
      Width = (EFI_PCI_IO_PROTOCOL_WIDTH) (Width & (~0x03));\r
    }\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->Io.Read (\r
                                              PciIoDevice->PciRootBridgeIo,\r
                                              (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH) Width,\r
                                              Offset,\r
                                              Count,\r
                                              Buffer\r
                                              );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_READ_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Enable a PCI driver to access PCI controller registers in the PCI memory or I/O space.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Width                 Signifies the width of the memory or I/O operations.\r
  @param  BarIndex              The BAR index of the standard PCI Configuration header to use as the\r
                                base address for the memory or I/O operation to perform.\r
  @param  Offset                The offset within the selected BAR to start the memory or I/O operation.\r
  @param  Count                 The number of memory or I/O operations to perform.\r
  @param  Buffer                For read operations, the destination buffer to store the results. For write\r
                                operations, the source buffer to write data from.\r
\r
  @retval EFI_SUCCESS           The data was read from or written to the PCI controller.\r
  @retval EFI_UNSUPPORTED       BarIndex not valid for this PCI controller.\r
  @retval EFI_UNSUPPORTED       The address range specified by Offset, Width, and Count is not\r
                                valid for the PCI BAR specified by BarIndex.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoIoWrite (\r
  IN     EFI_PCI_IO_PROTOCOL        *This,\r
  IN     EFI_PCI_IO_PROTOCOL_WIDTH  Width,\r
  IN     UINT8                      BarIndex,\r
  IN     UINT64                     Offset,\r
  IN     UINTN                      Count,\r
  IN OUT VOID                       *Buffer\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if ((UINT32)Width >= EfiPciIoWidthMaximum) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (Buffer == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Status = PciIoVerifyBarAccess (PciIoDevice, BarIndex, PciBarTypeIo, Width, Count, &Offset);\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // If request is not aligned, then convert request to EfiPciIoWithXXXUint8\r
  //\r
  if (FeaturePcdGet (PcdUnalignedPciIoEnable)) {\r
    if ((Offset & ((1 << (Width & 0x03)) - 1)) != 0) {\r
      Count *=  (UINTN)(1 << (Width & 0x03));\r
      Width = (EFI_PCI_IO_PROTOCOL_WIDTH) (Width & (~0x03));\r
    }\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->Io.Write (\r
                                              PciIoDevice->PciRootBridgeIo,\r
                                              (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH) Width,\r
                                              Offset,\r
                                              Count,\r
                                              Buffer\r
                                              );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_WRITE_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Enable a PCI driver to access PCI controller registers in PCI configuration space.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Width                 Signifies the width of the memory operations.\r
  @param  Offset                The offset within the PCI configuration space for the PCI controller.\r
  @param  Count                 The number of PCI configuration operations to perform.\r
  @param  Buffer                For read operations, the destination buffer to store the results. For write\r
                                operations, the source buffer to write data from.\r
\r
\r
  @retval EFI_SUCCESS           The data was read from or written to the PCI controller.\r
  @retval EFI_UNSUPPORTED       The address range specified by Offset, Width, and Count is not\r
                                valid for the PCI configuration header of the PCI controller.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
  @retval EFI_INVALID_PARAMETER Buffer is NULL or Width is invalid.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoConfigRead (\r
  IN     EFI_PCI_IO_PROTOCOL        *This,\r
  IN     EFI_PCI_IO_PROTOCOL_WIDTH  Width,\r
  IN     UINT32                     Offset,\r
  IN     UINTN                      Count,\r
  IN OUT VOID                       *Buffer\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
  UINT64        Address;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  Address     = Offset;\r
  Status      = PciIoVerifyConfigAccess (PciIoDevice, Width, Count, &Address);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // If request is not aligned, then convert request to EfiPciIoWithXXXUint8\r
  //\r
  if (FeaturePcdGet (PcdUnalignedPciIoEnable)) {\r
    if ((Offset & ((1 << (Width & 0x03)) - 1)) != 0) {\r
      Count *=  (UINTN)(1 << (Width & 0x03));\r
      Width = (EFI_PCI_IO_PROTOCOL_WIDTH) (Width & (~0x03));\r
    }\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->Pci.Read (\r
                                               PciIoDevice->PciRootBridgeIo,\r
                                               (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH) Width,\r
                                               Address,\r
                                               Count,\r
                                               Buffer\r
                                               );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_READ_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Enable a PCI driver to access PCI controller registers in PCI configuration space.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Width                 Signifies the width of the memory operations.\r
  @param  Offset                The offset within the PCI configuration space for the PCI controller.\r
  @param  Count                 The number of PCI configuration operations to perform.\r
  @param  Buffer                For read operations, the destination buffer to store the results. For write\r
                                operations, the source buffer to write data from.\r
\r
\r
  @retval EFI_SUCCESS           The data was read from or written to the PCI controller.\r
  @retval EFI_UNSUPPORTED       The address range specified by Offset, Width, and Count is not\r
                                valid for the PCI configuration header of the PCI controller.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
  @retval EFI_INVALID_PARAMETER Buffer is NULL or Width is invalid.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoConfigWrite (\r
  IN     EFI_PCI_IO_PROTOCOL        *This,\r
  IN     EFI_PCI_IO_PROTOCOL_WIDTH  Width,\r
  IN     UINT32                     Offset,\r
  IN     UINTN                      Count,\r
  IN OUT VOID                       *Buffer\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
  UINT64        Address;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  Address     = Offset;\r
  Status      = PciIoVerifyConfigAccess (PciIoDevice, Width, Count, &Address);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // If request is not aligned, then convert request to EfiPciIoWithXXXUint8\r
  //\r
  if (FeaturePcdGet (PcdUnalignedPciIoEnable)) {\r
    if ((Offset & ((1 << (Width & 0x03)) - 1)) != 0) {\r
      Count *=  (UINTN)(1 << (Width & 0x03));\r
      Width = (EFI_PCI_IO_PROTOCOL_WIDTH) (Width & (~0x03));\r
    }\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->Pci.Write (\r
                                              PciIoDevice->PciRootBridgeIo,\r
                                              (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH) Width,\r
                                              Address,\r
                                              Count,\r
                                              Buffer\r
                                              );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_WRITE_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Enables a PCI driver to copy one region of PCI memory space to another region of PCI\r
  memory space.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Width                 Signifies the width of the memory operations.\r
  @param  DestBarIndex          The BAR index in the standard PCI Configuration header to use as the\r
                                base address for the memory operation to perform.\r
  @param  DestOffset            The destination offset within the BAR specified by DestBarIndex to\r
                                start the memory writes for the copy operation.\r
  @param  SrcBarIndex           The BAR index in the standard PCI Configuration header to use as the\r
                                base address for the memory operation to perform.\r
  @param  SrcOffset             The source offset within the BAR specified by SrcBarIndex to start\r
                                the memory reads for the copy operation.\r
  @param  Count                 The number of memory operations to perform. Bytes moved is Width\r
                                size * Count, starting at DestOffset and SrcOffset.\r
\r
  @retval EFI_SUCCESS           The data was copied from one memory region to another memory region.\r
  @retval EFI_UNSUPPORTED       DestBarIndex not valid for this PCI controller.\r
  @retval EFI_UNSUPPORTED       SrcBarIndex not valid for this PCI controller.\r
  @retval EFI_UNSUPPORTED       The address range specified by DestOffset, Width, and Count\r
                                is not valid for the PCI BAR specified by DestBarIndex.\r
  @retval EFI_UNSUPPORTED       The address range specified by SrcOffset, Width, and Count is\r
                                not valid for the PCI BAR specified by SrcBarIndex.\r
  @retval EFI_INVALID_PARAMETER Width is invalid.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoCopyMem (\r
  IN EFI_PCI_IO_PROTOCOL              *This,\r
  IN     EFI_PCI_IO_PROTOCOL_WIDTH    Width,\r
  IN     UINT8                        DestBarIndex,\r
  IN     UINT64                       DestOffset,\r
  IN     UINT8                        SrcBarIndex,\r
  IN     UINT64                       SrcOffset,\r
  IN     UINTN                        Count\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if ((UINT32)Width >= EfiPciIoWidthMaximum) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (Width == EfiPciIoWidthFifoUint8  ||\r
      Width == EfiPciIoWidthFifoUint16 ||\r
      Width == EfiPciIoWidthFifoUint32 ||\r
      Width == EfiPciIoWidthFifoUint64 ||\r
      Width == EfiPciIoWidthFillUint8  ||\r
      Width == EfiPciIoWidthFillUint16 ||\r
      Width == EfiPciIoWidthFillUint32 ||\r
      Width == EfiPciIoWidthFillUint64) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Status = PciIoVerifyBarAccess (PciIoDevice, DestBarIndex, PciBarTypeMem, Width, Count, &DestOffset);\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  Status = PciIoVerifyBarAccess (PciIoDevice, SrcBarIndex, PciBarTypeMem, Width, Count, &SrcOffset);\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // If request is not aligned, then convert request to EfiPciIoWithXXXUint8\r
  //\r
  if (FeaturePcdGet (PcdUnalignedPciIoEnable)) {\r
    if ((SrcOffset & ((1 << (Width & 0x03)) - 1)) != 0 || (DestOffset & ((1 << (Width & 0x03)) - 1)) != 0) {\r
      Count *=  (UINTN)(1 << (Width & 0x03));\r
      Width = (EFI_PCI_IO_PROTOCOL_WIDTH) (Width & (~0x03));\r
    }\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->CopyMem (\r
                                          PciIoDevice->PciRootBridgeIo,\r
                                          (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH) Width,\r
                                          DestOffset,\r
                                          SrcOffset,\r
                                          Count\r
                                          );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_CONTROLLER_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Provides the PCI controller-specific addresses needed to access system memory.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Operation             Indicates if the bus master is going to read or write to system memory.\r
  @param  HostAddress           The system memory address to map to the PCI controller.\r
  @param  NumberOfBytes         On input the number of bytes to map. On output the number of bytes\r
                                that were mapped.\r
  @param  DeviceAddress         The resulting map address for the bus master PCI controller to use to\r
                                access the hosts HostAddress.\r
  @param  Mapping               A resulting value to pass to Unmap().\r
\r
  @retval EFI_SUCCESS           The range was mapped for the returned NumberOfBytes.\r
  @retval EFI_UNSUPPORTED       The HostAddress cannot be mapped as a common buffer.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
  @retval EFI_DEVICE_ERROR      The system hardware could not map the requested address.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoMap (\r
  IN     EFI_PCI_IO_PROTOCOL            *This,\r
  IN     EFI_PCI_IO_PROTOCOL_OPERATION  Operation,\r
  IN     VOID                           *HostAddress,\r
  IN OUT UINTN                          *NumberOfBytes,\r
  OUT    EFI_PHYSICAL_ADDRESS           *DeviceAddress,\r
  OUT    VOID                           **Mapping\r
  )\r
{\r
  EFI_STATUS                                 Status;\r
  PCI_IO_DEVICE                              *PciIoDevice;\r
  UINT64                                     IoMmuAttribute;\r
  EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_OPERATION  RootBridgeIoOperation;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if ((UINT32)Operation >= EfiPciIoOperationMaximum) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (HostAddress == NULL || NumberOfBytes == NULL || DeviceAddress == NULL || Mapping == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  RootBridgeIoOperation = (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_OPERATION)Operation;\r
  if ((PciIoDevice->Attributes & EFI_PCI_IO_ATTRIBUTE_DUAL_ADDRESS_CYCLE) != 0) {\r
    RootBridgeIoOperation = (EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_OPERATION)(Operation + EfiPciOperationBusMasterRead64);\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->Map (\r
                                          PciIoDevice->PciRootBridgeIo,\r
                                          RootBridgeIoOperation,\r
                                          HostAddress,\r
                                          NumberOfBytes,\r
                                          DeviceAddress,\r
                                          Mapping\r
                                          );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_CONTROLLER_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  if (mIoMmuProtocol != NULL) {\r
    if (!EFI_ERROR (Status)) {\r
      switch (Operation) {\r
      case EfiPciIoOperationBusMasterRead:\r
        IoMmuAttribute = EDKII_IOMMU_ACCESS_READ;\r
        break;\r
      case EfiPciIoOperationBusMasterWrite:\r
        IoMmuAttribute = EDKII_IOMMU_ACCESS_WRITE;\r
        break;\r
      case EfiPciIoOperationBusMasterCommonBuffer:\r
        IoMmuAttribute = EDKII_IOMMU_ACCESS_READ | EDKII_IOMMU_ACCESS_WRITE;\r
        break;\r
      default:\r
        ASSERT(FALSE);\r
        return EFI_INVALID_PARAMETER;\r
      }\r
      mIoMmuProtocol->SetAttribute (\r
                        mIoMmuProtocol,\r
                        PciIoDevice->Handle,\r
                        *Mapping,\r
                        IoMmuAttribute\r
                        );\r
    }\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Completes the Map() operation and releases any corresponding resources.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Mapping               The mapping value returned from Map().\r
\r
  @retval EFI_SUCCESS           The range was unmapped.\r
  @retval EFI_DEVICE_ERROR      The data was not committed to the target system memory.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoUnmap (\r
  IN  EFI_PCI_IO_PROTOCOL  *This,\r
  IN  VOID                 *Mapping\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if (mIoMmuProtocol != NULL) {\r
    mIoMmuProtocol->SetAttribute (\r
                      mIoMmuProtocol,\r
                      PciIoDevice->Handle,\r
                      Mapping,\r
                      0\r
                      );\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->Unmap (\r
                                          PciIoDevice->PciRootBridgeIo,\r
                                          Mapping\r
                                          );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_CONTROLLER_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Allocates pages that are suitable for an EfiPciIoOperationBusMasterCommonBuffer\r
  or EfiPciOperationBusMasterCommonBuffer64 mapping.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Type                  This parameter is not used and must be ignored.\r
  @param  MemoryType            The type of memory to allocate, EfiBootServicesData or\r
                                EfiRuntimeServicesData.\r
  @param  Pages                 The number of pages to allocate.\r
  @param  HostAddress           A pointer to store the base system memory address of the\r
                                allocated range.\r
  @param  Attributes            The requested bit mask of attributes for the allocated range.\r
\r
  @retval EFI_SUCCESS           The requested memory pages were allocated.\r
  @retval EFI_UNSUPPORTED       Attributes is unsupported. The only legal attribute bits are\r
                                MEMORY_WRITE_COMBINE, MEMORY_CACHED and DUAL_ADDRESS_CYCLE.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
  @retval EFI_OUT_OF_RESOURCES  The memory pages could not be allocated.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoAllocateBuffer (\r
  IN  EFI_PCI_IO_PROTOCOL   *This,\r
  IN  EFI_ALLOCATE_TYPE     Type,\r
  IN  EFI_MEMORY_TYPE       MemoryType,\r
  IN  UINTN                 Pages,\r
  OUT VOID                  **HostAddress,\r
  IN  UINT64                Attributes\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  if ((Attributes &\r
      (~(EFI_PCI_ATTRIBUTE_MEMORY_WRITE_COMBINE | EFI_PCI_ATTRIBUTE_MEMORY_CACHED))) != 0){\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if ((PciIoDevice->Attributes & EFI_PCI_IO_ATTRIBUTE_DUAL_ADDRESS_CYCLE) != 0) {\r
    Attributes |= EFI_PCI_ATTRIBUTE_DUAL_ADDRESS_CYCLE;\r
  }\r
\r
  Status = PciIoDevice->PciRootBridgeIo->AllocateBuffer (\r
                                          PciIoDevice->PciRootBridgeIo,\r
                                          Type,\r
                                          MemoryType,\r
                                          Pages,\r
                                          HostAddress,\r
                                          Attributes\r
                                          );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_CONTROLLER_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Frees memory that was allocated with AllocateBuffer().\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Pages                 The number of pages to free.\r
  @param  HostAddress           The base system memory address of the allocated range.\r
\r
  @retval EFI_SUCCESS           The requested memory pages were freed.\r
  @retval EFI_INVALID_PARAMETER The memory range specified by HostAddress and Pages\r
                                was not allocated with AllocateBuffer().\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoFreeBuffer (\r
  IN  EFI_PCI_IO_PROTOCOL   *This,\r
  IN  UINTN                 Pages,\r
  IN  VOID                  *HostAddress\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  Status = PciIoDevice->PciRootBridgeIo->FreeBuffer (\r
                                          PciIoDevice->PciRootBridgeIo,\r
                                          Pages,\r
                                          HostAddress\r
                                          );\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_CONTROLLER_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Flushes all PCI posted write transactions from a PCI host bridge to system memory.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
\r
  @retval EFI_SUCCESS           The PCI posted write transactions were flushed from the PCI host\r
                                bridge to system memory.\r
  @retval EFI_DEVICE_ERROR      The PCI posted write transactions were not flushed from the PCI\r
                                host bridge due to a hardware error.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoFlush (\r
  IN  EFI_PCI_IO_PROTOCOL  *This\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  Status = PciIoDevice->PciRootBridgeIo->Flush (\r
                                           PciIoDevice->PciRootBridgeIo\r
                                           );\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_CONTROLLER_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Retrieves this PCI controller's current PCI bus number, device number, and function number.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  SegmentNumber         The PCI controller's current PCI segment number.\r
  @param  BusNumber             The PCI controller's current PCI bus number.\r
  @param  DeviceNumber          The PCI controller's current PCI device number.\r
  @param  FunctionNumber        The PCI controller's current PCI function number.\r
\r
  @retval EFI_SUCCESS           The PCI controller location was returned.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoGetLocation (\r
  IN  EFI_PCI_IO_PROTOCOL  *This,\r
  OUT UINTN                *Segment,\r
  OUT UINTN                *Bus,\r
  OUT UINTN                *Device,\r
  OUT UINTN                *Function\r
  )\r
{\r
  PCI_IO_DEVICE *PciIoDevice;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if (Segment == NULL || Bus == NULL || Device == NULL || Function == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  *Segment  = PciIoDevice->PciRootBridgeIo->SegmentNumber;\r
  *Bus      = PciIoDevice->BusNumber;\r
  *Device   = PciIoDevice->DeviceNumber;\r
  *Function = PciIoDevice->FunctionNumber;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Check BAR type for PCI resource.\r
\r
  @param PciIoDevice   PCI device instance.\r
  @param BarIndex      The BAR index of the standard PCI Configuration header to use as the\r
                       base address for the memory or I/O operation to perform.\r
  @param BarType       Memory or I/O.\r
\r
  @retval TRUE         Pci device's bar type is same with input BarType.\r
  @retval TRUE         Pci device's bar type is not same with input BarType.\r
\r
**/\r
BOOLEAN\r
CheckBarType (\r
  IN PCI_IO_DEVICE          *PciIoDevice,\r
  IN UINT8                  BarIndex,\r
  IN PCI_BAR_TYPE           BarType\r
  )\r
{\r
  switch (BarType) {\r
\r
  case PciBarTypeMem:\r
\r
    if (PciIoDevice->PciBar[BarIndex].BarType != PciBarTypeMem32  &&\r
        PciIoDevice->PciBar[BarIndex].BarType != PciBarTypePMem32 &&\r
        PciIoDevice->PciBar[BarIndex].BarType != PciBarTypePMem64 &&\r
        PciIoDevice->PciBar[BarIndex].BarType != PciBarTypeMem64    ) {\r
      return FALSE;\r
    }\r
\r
    return TRUE;\r
\r
  case PciBarTypeIo:\r
    if (PciIoDevice->PciBar[BarIndex].BarType != PciBarTypeIo32 &&\r
        PciIoDevice->PciBar[BarIndex].BarType != PciBarTypeIo16){\r
      return FALSE;\r
    }\r
\r
    return TRUE;\r
\r
  default:\r
    break;\r
  }\r
\r
  return FALSE;\r
}\r
\r
/**\r
  Set/Disable new attributes to a Root Bridge.\r
\r
  @param  PciIoDevice  Pci device instance.\r
  @param  Attributes   New attribute want to be set.\r
  @param  Operation    Set or Disable.\r
\r
  @retval  EFI_UNSUPPORTED  If root bridge does not support change attribute.\r
  @retval  EFI_SUCCESS      Successfully set new attributes.\r
\r
**/\r
EFI_STATUS\r
ModifyRootBridgeAttributes (\r
  IN  PCI_IO_DEVICE                            *PciIoDevice,\r
  IN  UINT64                                   Attributes,\r
  IN  EFI_PCI_IO_PROTOCOL_ATTRIBUTE_OPERATION  Operation\r
  )\r
{\r
  UINT64      PciRootBridgeSupports;\r
  UINT64      PciRootBridgeAttributes;\r
  UINT64      NewPciRootBridgeAttributes;\r
  EFI_STATUS  Status;\r
\r
  //\r
  // Get the current attributes of this PCI device's PCI Root Bridge\r
  //\r
  Status = PciIoDevice->PciRootBridgeIo->GetAttributes (\r
                                          PciIoDevice->PciRootBridgeIo,\r
                                          &PciRootBridgeSupports,\r
                                          &PciRootBridgeAttributes\r
                                          );\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // Mask off attributes not supported by PCI root bridge.\r
  //\r
  Attributes &= ~(UINT64)(EFI_PCI_IO_ATTRIBUTE_EMBEDDED_DEVICE |\r
                          EFI_PCI_IO_ATTRIBUTE_EMBEDDED_ROM |\r
                          EFI_PCI_IO_ATTRIBUTE_DUAL_ADDRESS_CYCLE);\r
\r
  //\r
  // Record the new attribute of the Root Bridge\r
  //\r
  if (Operation == EfiPciIoAttributeOperationEnable) {\r
    NewPciRootBridgeAttributes = PciRootBridgeAttributes | Attributes;\r
  } else {\r
    NewPciRootBridgeAttributes = PciRootBridgeAttributes & (~Attributes);\r
  }\r
\r
  //\r
  // Call the PCI Root Bridge to attempt to modify the attributes\r
  //\r
  if ((NewPciRootBridgeAttributes ^ PciRootBridgeAttributes) != 0) {\r
\r
    Status = PciIoDevice->PciRootBridgeIo->SetAttributes (\r
                                            PciIoDevice->PciRootBridgeIo,\r
                                            NewPciRootBridgeAttributes,\r
                                            NULL,\r
                                            NULL\r
                                            );\r
    if (EFI_ERROR (Status)) {\r
      //\r
      // The PCI Root Bridge could not modify the attributes, so return the error.\r
      //\r
      return EFI_UNSUPPORTED;\r
    }\r
  }\r
\r
  //\r
  // Also update the attributes for this Root Bridge structure\r
  //\r
  PciIoDevice->Attributes = NewPciRootBridgeAttributes;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Check whether this device can be enable/disable to snoop.\r
\r
  @param PciIoDevice  Pci device instance.\r
  @param Operation    Enable/Disable.\r
\r
  @retval EFI_UNSUPPORTED  Pci device is not GFX device or not support snoop.\r
  @retval EFI_SUCCESS      Snoop can be supported.\r
\r
**/\r
EFI_STATUS\r
SupportPaletteSnoopAttributes (\r
  IN PCI_IO_DEVICE                            *PciIoDevice,\r
  IN EFI_PCI_IO_PROTOCOL_ATTRIBUTE_OPERATION  Operation\r
  )\r
{\r
  PCI_IO_DEVICE *Temp;\r
  UINT16        VGACommand;\r
\r
  //\r
  // Snoop attribute can be only modified by GFX\r
  //\r
  if (!IS_PCI_GFX (&PciIoDevice->Pci)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // Get the boot VGA on the same Host Bridge\r
  //\r
  Temp = LocateVgaDeviceOnHostBridge (PciIoDevice->PciRootBridgeIo->ParentHandle);\r
\r
  if (Temp == NULL) {\r
    //\r
    // If there is no VGA device on the segment, set\r
    // this graphics card to decode the palette range\r
    //\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // Check these two agents are on the same path\r
  //\r
  if (!PciDevicesOnTheSamePath (Temp, PciIoDevice)) {\r
    //\r
    // they are not on the same path, so snoop can be enabled or disabled\r
    //\r
    return EFI_SUCCESS;\r
  }\r
  //\r
  // Check if they are on the same bus\r
  //\r
  if (Temp->Parent == PciIoDevice->Parent) {\r
\r
    PCI_READ_COMMAND_REGISTER (Temp, &VGACommand);\r
\r
    //\r
    // If they are on the same bus, either one can\r
    // be set to snoop, the other set to decode\r
    //\r
    if ((VGACommand & EFI_PCI_COMMAND_VGA_PALETTE_SNOOP) != 0) {\r
      //\r
      // VGA has set to snoop, so GFX can be only set to disable snoop\r
      //\r
      if (Operation == EfiPciIoAttributeOperationEnable) {\r
        return EFI_UNSUPPORTED;\r
      }\r
    } else {\r
      //\r
      // VGA has disabled to snoop, so GFX can be only enabled\r
      //\r
      if (Operation == EfiPciIoAttributeOperationDisable) {\r
        return EFI_UNSUPPORTED;\r
      }\r
    }\r
\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // If they are on  the same path but on the different bus\r
  // The first agent is set to snoop, the second one set to\r
  // decode\r
  //\r
\r
  if (Temp->BusNumber < PciIoDevice->BusNumber) {\r
    //\r
    // GFX should be set to decode\r
    //\r
    if (Operation == EfiPciIoAttributeOperationDisable) {\r
      PCI_ENABLE_COMMAND_REGISTER (Temp, EFI_PCI_COMMAND_VGA_PALETTE_SNOOP);\r
      Temp->Attributes |= EFI_PCI_COMMAND_VGA_PALETTE_SNOOP;\r
    } else {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
  } else {\r
    //\r
    // GFX should be set to snoop\r
    //\r
    if (Operation == EfiPciIoAttributeOperationEnable) {\r
      PCI_DISABLE_COMMAND_REGISTER (Temp, EFI_PCI_COMMAND_VGA_PALETTE_SNOOP);\r
      Temp->Attributes &= (~(UINT64)EFI_PCI_COMMAND_VGA_PALETTE_SNOOP);\r
    } else {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Performs an operation on the attributes that this PCI controller supports. The operations include\r
  getting the set of supported attributes, retrieving the current attributes, setting the current\r
  attributes, enabling attributes, and disabling attributes.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Operation             The operation to perform on the attributes for this PCI controller.\r
  @param  Attributes            The mask of attributes that are used for Set, Enable, and Disable\r
                                operations.\r
  @param  Result                A pointer to the result mask of attributes that are returned for the Get\r
                                and Supported operations.\r
\r
  @retval EFI_SUCCESS           The operation on the PCI controller's attributes was completed.\r
  @retval EFI_INVALID_PARAMETER One or more parameters are invalid.\r
  @retval EFI_UNSUPPORTED       one or more of the bits set in\r
                                Attributes are not supported by this PCI controller or one of\r
                                its parent bridges when Operation is Set, Enable or Disable.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoAttributes (\r
  IN EFI_PCI_IO_PROTOCOL                       * This,\r
  IN  EFI_PCI_IO_PROTOCOL_ATTRIBUTE_OPERATION  Operation,\r
  IN  UINT64                                   Attributes,\r
  OUT UINT64                                   *Result OPTIONAL\r
  )\r
{\r
  EFI_STATUS    Status;\r
\r
  PCI_IO_DEVICE *PciIoDevice;\r
  PCI_IO_DEVICE *UpStreamBridge;\r
  PCI_IO_DEVICE *Temp;\r
\r
  UINT64        Supports;\r
  UINT64        UpStreamAttributes;\r
  UINT16        BridgeControl;\r
  UINT16        Command;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  switch (Operation) {\r
  case EfiPciIoAttributeOperationGet:\r
    if (Result == NULL) {\r
      return EFI_INVALID_PARAMETER;\r
    }\r
\r
    *Result = PciIoDevice->Attributes;\r
    return EFI_SUCCESS;\r
\r
  case EfiPciIoAttributeOperationSupported:\r
    if (Result == NULL) {\r
      return EFI_INVALID_PARAMETER;\r
    }\r
\r
    *Result = PciIoDevice->Supports;\r
    return EFI_SUCCESS;\r
\r
  case EfiPciIoAttributeOperationSet:\r
    Status = PciIoDevice->PciIo.Attributes (\r
                                  &(PciIoDevice->PciIo),\r
                                  EfiPciIoAttributeOperationEnable,\r
                                  Attributes,\r
                                  NULL\r
                                  );\r
    if (EFI_ERROR (Status)) {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
    Status = PciIoDevice->PciIo.Attributes (\r
                                  &(PciIoDevice->PciIo),\r
                                  EfiPciIoAttributeOperationDisable,\r
                                  (~Attributes) & (PciIoDevice->Supports),\r
                                  NULL\r
                                  );\r
    if (EFI_ERROR (Status)) {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
    return EFI_SUCCESS;\r
\r
  case EfiPciIoAttributeOperationEnable:\r
  case EfiPciIoAttributeOperationDisable:\r
    break;\r
\r
  default:\r
    return EFI_INVALID_PARAMETER;\r
  }\r
  //\r
  // Just a trick for ENABLE attribute\r
  // EFI_PCI_DEVICE_ENABLE is not defined in UEFI spec, which is the internal usage.\r
  // So, this logic doesn't conform to UEFI spec, which should be removed.\r
  // But this trick logic is still kept for some binary drivers that depend on it.\r
  //\r
  if ((Attributes & EFI_PCI_DEVICE_ENABLE) == EFI_PCI_DEVICE_ENABLE) {\r
    Attributes &= (PciIoDevice->Supports);\r
\r
    //\r
    // Raise the EFI_P_PC_ENABLE Status code\r
    //\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_PROGRESS_CODE,\r
      EFI_IO_BUS_PCI | EFI_P_PC_ENABLE,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  //\r
  // Check VGA and VGA16, they can not be set at the same time\r
  //\r
  if ((Attributes & (EFI_PCI_IO_ATTRIBUTE_VGA_IO | EFI_PCI_IO_ATTRIBUTE_VGA_PALETTE_IO)) != 0) {\r
    if ((Attributes & (EFI_PCI_IO_ATTRIBUTE_VGA_IO_16 | EFI_PCI_IO_ATTRIBUTE_VGA_PALETTE_IO_16)) != 0) {\r
      return EFI_UNSUPPORTED;\r
    }\r
  }\r
\r
  //\r
  // If no attributes can be supported, then return.\r
  // Otherwise, set the attributes that it can support.\r
  //\r
  Supports = (PciIoDevice->Supports) & Attributes;\r
  if (Supports != Attributes) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // For Root Bridge, just call RootBridgeIo to set attributes;\r
  //\r
  if (PciIoDevice->Parent == NULL) {\r
    Status = ModifyRootBridgeAttributes (PciIoDevice, Attributes, Operation);\r
    return Status;\r
  }\r
\r
  Command       = 0;\r
  BridgeControl = 0;\r
\r
  //\r
  // For PPB & P2C, set relevant attribute bits\r
  //\r
  if (IS_PCI_BRIDGE (&PciIoDevice->Pci) || IS_CARDBUS_BRIDGE (&PciIoDevice->Pci)) {\r
\r
    if ((Attributes & (EFI_PCI_IO_ATTRIBUTE_VGA_IO | EFI_PCI_IO_ATTRIBUTE_VGA_IO_16)) != 0) {\r
      BridgeControl |= EFI_PCI_BRIDGE_CONTROL_VGA;\r
    }\r
\r
    if ((Attributes & EFI_PCI_IO_ATTRIBUTE_ISA_IO) != 0) {\r
      BridgeControl |= EFI_PCI_BRIDGE_CONTROL_ISA;\r
    }\r
\r
    if ((Attributes & (EFI_PCI_IO_ATTRIBUTE_VGA_PALETTE_IO | EFI_PCI_IO_ATTRIBUTE_VGA_PALETTE_IO_16)) != 0) {\r
      Command |= EFI_PCI_IO_ATTRIBUTE_VGA_PALETTE_IO;\r
    }\r
\r
    if ((Attributes & (EFI_PCI_IO_ATTRIBUTE_VGA_PALETTE_IO_16 | EFI_PCI_IO_ATTRIBUTE_VGA_IO_16)) != 0) {\r
      BridgeControl |= EFI_PCI_BRIDGE_CONTROL_VGA_16;\r
    }\r
\r
  } else {\r
    //\r
    // Do with the attributes on VGA\r
    // Only for VGA's legacy resource, we just can enable once.\r
    //\r
    if ((Attributes &\r
        (EFI_PCI_IO_ATTRIBUTE_VGA_IO    |\r
         EFI_PCI_IO_ATTRIBUTE_VGA_IO_16 |\r
         EFI_PCI_IO_ATTRIBUTE_VGA_MEMORY)) != 0) {\r
      //\r
      // Check if a VGA has been enabled before enabling a new one\r
      //\r
      if (Operation == EfiPciIoAttributeOperationEnable) {\r
        //\r
        // Check if there have been an active VGA device on the same Host Bridge\r
        //\r
        Temp = LocateVgaDeviceOnHostBridge (PciIoDevice->PciRootBridgeIo->ParentHandle);\r
        if (Temp != NULL && Temp != PciIoDevice) {\r
          //\r
          // An active VGA has been detected, so can not enable another\r
          //\r
          return EFI_UNSUPPORTED;\r
        }\r
      }\r
    }\r
\r
    //\r
    // Do with the attributes on GFX\r
    //\r
    if ((Attributes & (EFI_PCI_IO_ATTRIBUTE_VGA_PALETTE_IO | EFI_PCI_IO_ATTRIBUTE_VGA_PALETTE_IO_16)) != 0) {\r
\r
      if (Operation == EfiPciIoAttributeOperationEnable) {\r
        //\r
        // Check if snoop can be enabled in current configuration\r
        //\r
        Status = SupportPaletteSnoopAttributes (PciIoDevice, Operation);\r
\r
        if (EFI_ERROR (Status)) {\r
\r
          //\r
          // Enable operation is forbidden, so mask the bit in attributes\r
          // so as to keep consistent with the actual Status\r
          //\r
          // Attributes &= (~EFI_PCI_IO_ATTRIBUTE_VGA_PALETTE_IO);\r
          //\r
          //\r
          //\r
          return EFI_UNSUPPORTED;\r
\r
        }\r
      }\r
\r
      //\r
      // It can be supported, so get ready to set the bit\r
      //\r
      Command |= EFI_PCI_COMMAND_VGA_PALETTE_SNOOP;\r
    }\r
  }\r
\r
  if ((Attributes & EFI_PCI_IO_ATTRIBUTE_IO) != 0) {\r
    Command |= EFI_PCI_COMMAND_IO_SPACE;\r
  }\r
\r
  if ((Attributes & EFI_PCI_IO_ATTRIBUTE_MEMORY) != 0) {\r
    Command |= EFI_PCI_COMMAND_MEMORY_SPACE;\r
  }\r
\r
  if ((Attributes & EFI_PCI_IO_ATTRIBUTE_BUS_MASTER) != 0) {\r
    Command |= EFI_PCI_COMMAND_BUS_MASTER;\r
  }\r
  //\r
  // The upstream bridge should be also set to relevant attribute\r
  // expect for IO, Mem and BusMaster\r
  //\r
  UpStreamAttributes = Attributes &\r
                       (~(EFI_PCI_IO_ATTRIBUTE_IO     |\r
                          EFI_PCI_IO_ATTRIBUTE_MEMORY |\r
                          EFI_PCI_IO_ATTRIBUTE_BUS_MASTER\r
                          )\r
                        );\r
  UpStreamBridge = PciIoDevice->Parent;\r
\r
  if (Operation == EfiPciIoAttributeOperationEnable) {\r
    //\r
    // Enable relevant attributes to command register and bridge control register\r
    //\r
    Status = PCI_ENABLE_COMMAND_REGISTER (PciIoDevice, Command);\r
    if (BridgeControl != 0) {\r
      Status = PCI_ENABLE_BRIDGE_CONTROL_REGISTER (PciIoDevice, BridgeControl);\r
    }\r
\r
    PciIoDevice->Attributes |= Attributes;\r
\r
    //\r
    // Enable attributes of the upstream bridge\r
    //\r
    Status = UpStreamBridge->PciIo.Attributes (\r
                                    &(UpStreamBridge->PciIo),\r
                                    EfiPciIoAttributeOperationEnable,\r
                                    UpStreamAttributes,\r
                                    NULL\r
                                    );\r
  } else {\r
\r
    //\r
    // Disable relevant attributes to command register and bridge control register\r
    //\r
    Status = PCI_DISABLE_COMMAND_REGISTER (PciIoDevice, Command);\r
    if (BridgeControl != 0) {\r
      Status = PCI_DISABLE_BRIDGE_CONTROL_REGISTER (PciIoDevice, BridgeControl);\r
    }\r
\r
    PciIoDevice->Attributes &= (~Attributes);\r
    Status = EFI_SUCCESS;\r
\r
  }\r
\r
  if (EFI_ERROR (Status)) {\r
    REPORT_STATUS_CODE_WITH_DEVICE_PATH (\r
      EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
      EFI_IO_BUS_PCI | EFI_IOB_EC_CONTROLLER_ERROR,\r
      PciIoDevice->DevicePath\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Retrieve the AddrTranslationOffset from RootBridgeIo for the\r
  specified range.\r
\r
  @param RootBridgeIo    Root Bridge IO instance.\r
  @param AddrRangeMin    The base address of the MMIO.\r
  @param AddrLen         The length of the MMIO.\r
\r
  @retval The AddrTranslationOffset from RootBridgeIo for the\r
          specified range, or (UINT64) -1 if the range is not\r
          found in RootBridgeIo.\r
**/\r
UINT64\r
GetMmioAddressTranslationOffset (\r
  EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL   *RootBridgeIo,\r
  UINT64                            AddrRangeMin,\r
  UINT64                            AddrLen\r
  )\r
{\r
  EFI_STATUS                        Status;\r
  EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR *Configuration;\r
\r
  Status = RootBridgeIo->Configuration (\r
                           RootBridgeIo,\r
                           (VOID **) &Configuration\r
                           );\r
  if (EFI_ERROR (Status)) {\r
    return (UINT64) -1;\r
  }\r
\r
  // According to UEFI 2.7, EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL::Configuration()\r
  // returns host address instead of device address, while AddrTranslationOffset\r
  // is not zero, and device address = host address + AddrTranslationOffset, so\r
  // we convert host address to device address for range compare.\r
  while (Configuration->Desc == ACPI_ADDRESS_SPACE_DESCRIPTOR) {\r
    if ((Configuration->ResType == ACPI_ADDRESS_SPACE_TYPE_MEM) &&\r
        (Configuration->AddrRangeMin + Configuration->AddrTranslationOffset <= AddrRangeMin) &&\r
        (Configuration->AddrRangeMin + Configuration->AddrLen + Configuration->AddrTranslationOffset >= AddrRangeMin + AddrLen)\r
        ) {\r
      return Configuration->AddrTranslationOffset;\r
    }\r
    Configuration++;\r
  }\r
\r
  //\r
  // The resource occupied by BAR should be in the range reported by RootBridge.\r
  //\r
  ASSERT (FALSE);\r
  return (UINT64) -1;\r
}\r
\r
/**\r
  Gets the attributes that this PCI controller supports setting on a BAR using\r
  SetBarAttributes(), and retrieves the list of resource descriptors for a BAR.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  BarIndex              The BAR index of the standard PCI Configuration header to use as the\r
                                base address for resource range. The legal range for this field is 0..5.\r
  @param  Supports              A pointer to the mask of attributes that this PCI controller supports\r
                                setting for this BAR with SetBarAttributes().\r
  @param  Resources             A pointer to the resource descriptors that describe the current\r
                                configuration of this BAR of the PCI controller.\r
\r
  @retval EFI_SUCCESS           If Supports is not NULL, then the attributes that the PCI\r
                                controller supports are returned in Supports. If Resources\r
                                is not NULL, then the resource descriptors that the PCI\r
                                controller is currently using are returned in Resources.\r
  @retval EFI_INVALID_PARAMETER Both Supports and Attributes are NULL.\r
  @retval EFI_UNSUPPORTED       BarIndex not valid for this PCI controller.\r
  @retval EFI_OUT_OF_RESOURCES  There are not enough resources available to allocate\r
                                Resources.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoGetBarAttributes (\r
  IN EFI_PCI_IO_PROTOCOL             * This,\r
  IN  UINT8                          BarIndex,\r
  OUT UINT64                         *Supports, OPTIONAL\r
  OUT VOID                           **Resources OPTIONAL\r
  )\r
{\r
  PCI_IO_DEVICE                     *PciIoDevice;\r
  EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR *Descriptor;\r
  EFI_ACPI_END_TAG_DESCRIPTOR       *End;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  if (Supports == NULL && Resources == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if ((BarIndex >= PCI_MAX_BAR) || (PciIoDevice->PciBar[BarIndex].BarType == PciBarTypeUnknown)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // This driver does not support modifications to the WRITE_COMBINE or\r
  // CACHED attributes for BAR ranges.\r
  //\r
  if (Supports != NULL) {\r
    *Supports = PciIoDevice->Supports & EFI_PCI_IO_ATTRIBUTE_MEMORY_CACHED & EFI_PCI_IO_ATTRIBUTE_MEMORY_WRITE_COMBINE;\r
  }\r
\r
  if (Resources != NULL) {\r
    Descriptor = AllocateZeroPool (sizeof (EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR) + sizeof (EFI_ACPI_END_TAG_DESCRIPTOR));\r
    if (Descriptor == NULL) {\r
      return EFI_OUT_OF_RESOURCES;\r
    }\r
\r
    *Resources   = Descriptor;\r
\r
    Descriptor->Desc         = ACPI_ADDRESS_SPACE_DESCRIPTOR;\r
    Descriptor->Len          = (UINT16) (sizeof (EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR) - 3);\r
    Descriptor->AddrRangeMin = PciIoDevice->PciBar[BarIndex].BaseAddress;\r
    Descriptor->AddrLen      = PciIoDevice->PciBar[BarIndex].Length;\r
    Descriptor->AddrRangeMax = PciIoDevice->PciBar[BarIndex].Alignment;\r
\r
    switch (PciIoDevice->PciBar[BarIndex].BarType) {\r
    case PciBarTypeIo16:\r
    case PciBarTypeIo32:\r
      //\r
      // Io\r
      //\r
      Descriptor->ResType = ACPI_ADDRESS_SPACE_TYPE_IO;\r
      break;\r
\r
    case PciBarTypePMem32:\r
      //\r
      // prefetchable\r
      //\r
      Descriptor->SpecificFlag = EFI_ACPI_MEMORY_RESOURCE_SPECIFIC_FLAG_CACHEABLE_PREFETCHABLE;\r
      //\r
      // Fall through\r
      //\r
    case PciBarTypeMem32:\r
      //\r
      // Mem\r
      //\r
      Descriptor->ResType = ACPI_ADDRESS_SPACE_TYPE_MEM;\r
      //\r
      // 32 bit\r
      //\r
      Descriptor->AddrSpaceGranularity = 32;\r
      break;\r
\r
    case PciBarTypePMem64:\r
      //\r
      // prefetchable\r
      //\r
      Descriptor->SpecificFlag = EFI_ACPI_MEMORY_RESOURCE_SPECIFIC_FLAG_CACHEABLE_PREFETCHABLE;\r
      //\r
      // Fall through\r
      //\r
    case PciBarTypeMem64:\r
      //\r
      // Mem\r
      //\r
      Descriptor->ResType = ACPI_ADDRESS_SPACE_TYPE_MEM;\r
      //\r
      // 64 bit\r
      //\r
      Descriptor->AddrSpaceGranularity = 64;\r
      break;\r
\r
    default:\r
      break;\r
    }\r
\r
    //\r
    // put the checksum\r
    //\r
    End           = (EFI_ACPI_END_TAG_DESCRIPTOR *) (Descriptor + 1);\r
    End->Desc     = ACPI_END_TAG_DESCRIPTOR;\r
    End->Checksum = 0;\r
\r
    //\r
    // Get the Address Translation Offset\r
    //\r
    if (Descriptor->ResType == ACPI_ADDRESS_SPACE_TYPE_MEM) {\r
      Descriptor->AddrTranslationOffset = GetMmioAddressTranslationOffset (\r
                                            PciIoDevice->PciRootBridgeIo,\r
                                            Descriptor->AddrRangeMin,\r
                                            Descriptor->AddrLen\r
                                            );\r
      if (Descriptor->AddrTranslationOffset == (UINT64) -1) {\r
        FreePool (Descriptor);\r
        return EFI_UNSUPPORTED;\r
      }\r
    }\r
\r
    // According to UEFI spec 2.7, we need return host address for\r
    // PciIo->GetBarAttributes, and host address = device address - translation.\r
    Descriptor->AddrRangeMin -= Descriptor->AddrTranslationOffset;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Sets the attributes for a range of a BAR on a PCI controller.\r
\r
  @param  This                  A pointer to the EFI_PCI_IO_PROTOCOL instance.\r
  @param  Attributes            The mask of attributes to set for the resource range specified by\r
                                BarIndex, Offset, and Length.\r
  @param  BarIndex              The BAR index of the standard PCI Configuration header to use as the\r
                                base address for resource range. The legal range for this field is 0..5.\r
  @param  Offset                A pointer to the BAR relative base address of the resource range to be\r
                                modified by the attributes specified by Attributes.\r
  @param  Length                A pointer to the length of the resource range to be modified by the\r
                                attributes specified by Attributes.\r
\r
  @retval EFI_SUCCESS           The set of attributes specified by Attributes for the resource\r
                                range specified by BarIndex, Offset, and Length were\r
                                set on the PCI controller, and the actual resource range is returned\r
                                in Offset and Length.\r
  @retval EFI_INVALID_PARAMETER Offset or Length is NULL.\r
  @retval EFI_UNSUPPORTED       BarIndex not valid for this PCI controller.\r
  @retval EFI_OUT_OF_RESOURCES  There are not enough resources to set the attributes on the\r
                                resource range specified by BarIndex, Offset, and\r
                                Length.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PciIoSetBarAttributes (\r
  IN EFI_PCI_IO_PROTOCOL              *This,\r
  IN     UINT64                       Attributes,\r
  IN     UINT8                        BarIndex,\r
  IN OUT UINT64                       *Offset,\r
  IN OUT UINT64                       *Length\r
  )\r
{\r
  EFI_STATUS    Status;\r
  PCI_IO_DEVICE *PciIoDevice;\r
  UINT64        NonRelativeOffset;\r
  UINT64        Supports;\r
\r
  PciIoDevice = PCI_IO_DEVICE_FROM_PCI_IO_THIS (This);\r
\r
  //\r
  // Make sure Offset and Length are not NULL\r
  //\r
  if (Offset == NULL || Length == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (PciIoDevice->PciBar[BarIndex].BarType == PciBarTypeUnknown) {\r
    return EFI_UNSUPPORTED;\r
  }\r
  //\r
  // This driver does not support setting the WRITE_COMBINE or the CACHED attributes.\r
  // If Attributes is not 0, then return EFI_UNSUPPORTED.\r
  //\r
  Supports = PciIoDevice->Supports & EFI_PCI_IO_ATTRIBUTE_MEMORY_CACHED & EFI_PCI_IO_ATTRIBUTE_MEMORY_WRITE_COMBINE;\r
\r
  if (Attributes != (Attributes & Supports)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
  //\r
  // Attributes must be supported.  Make sure the BAR range described by BarIndex, Offset, and\r
  // Length are valid for this PCI device.\r
  //\r
  NonRelativeOffset = *Offset;\r
  Status = PciIoVerifyBarAccess (\r
            PciIoDevice,\r
            BarIndex,\r
            PciBarTypeMem,\r
            EfiPciIoWidthUint8,\r
            (UINT32) *Length,\r
            &NonRelativeOffset\r
            );\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Test whether two Pci devices has same parent bridge.\r
\r
  @param PciDevice1  The first pci device for testing.\r
  @param PciDevice2  The second pci device for testing.\r
\r
  @retval TRUE       Two Pci device has the same parent bridge.\r
  @retval FALSE      Two Pci device has not the same parent bridge.\r
\r
**/\r
BOOLEAN\r
PciDevicesOnTheSamePath (\r
  IN PCI_IO_DEVICE        *PciDevice1,\r
  IN PCI_IO_DEVICE        *PciDevice2\r
  )\r
{\r
  BOOLEAN   Existed1;\r
  BOOLEAN   Existed2;\r
\r
  if (PciDevice1->Parent == PciDevice2->Parent) {\r
    return TRUE;\r
  }\r
\r
  Existed1 = PciDeviceExisted (PciDevice1->Parent, PciDevice2);\r
  Existed2 = PciDeviceExisted (PciDevice2->Parent, PciDevice1);\r
\r
  return (BOOLEAN) (Existed1 || Existed2);\r
}\r
\r