OvmfPkg: Apply uncrustify changes

[mirror_edk2.git] / OvmfPkg / Csm / CsmSupportLib / LegacyRegion.c

/** @file\r
  Legacy Region Support\r
\r
  Copyright (c) 2006 - 2016, Intel Corporation. All rights reserved.<BR>\r
\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "LegacyRegion.h"\r
\r
//\r
// 440/Q35 PAM map.\r
//\r
// PAM Range          Offset    Bits  Operation\r
//                  440   Q35\r
// ===============  ====  ====  ====  ===============================================================\r
// 0xC0000-0xC3FFF  0x5a  0x91  1:0   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xC4000-0xC7FFF  0x5a  0x91  5:4   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xC8000-0xCBFFF  0x5b  0x92  1:0   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xCC000-0xCFFFF  0x5b  0x92  5:4   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xD0000-0xD3FFF  0x5c  0x93  1:0   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xD4000-0xD7FFF  0x5c  0x93  5:4   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xD8000-0xDBFFF  0x5d  0x94  1:0   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xDC000-0xDFFFF  0x5d  0x94  5:4   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xE0000-0xE3FFF  0x5e  0x95  1:0   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xE4000-0xE7FFF  0x5e  0x95  5:4   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xE8000-0xEBFFF  0x5f  0x96  1:0   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xEC000-0xEFFFF  0x5f  0x96  5:4   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
// 0xF0000-0xFFFFF  0x59  0x90  5:4   00 = DRAM Disabled, 01= Read Only, 10 = Write Only, 11 = Normal\r
//\r
STATIC LEGACY_MEMORY_SECTION_INFO  mSectionArray[] = {\r
  { 0xC0000, SIZE_16KB, FALSE, FALSE },\r
  { 0xC4000, SIZE_16KB, FALSE, FALSE },\r
  { 0xC8000, SIZE_16KB, FALSE, FALSE },\r
  { 0xCC000, SIZE_16KB, FALSE, FALSE },\r
  { 0xD0000, SIZE_16KB, FALSE, FALSE },\r
  { 0xD4000, SIZE_16KB, FALSE, FALSE },\r
  { 0xD8000, SIZE_16KB, FALSE, FALSE },\r
  { 0xDC000, SIZE_16KB, FALSE, FALSE },\r
  { 0xE0000, SIZE_16KB, FALSE, FALSE },\r
  { 0xE4000, SIZE_16KB, FALSE, FALSE },\r
  { 0xE8000, SIZE_16KB, FALSE, FALSE },\r
  { 0xEC000, SIZE_16KB, FALSE, FALSE },\r
  { 0xF0000, SIZE_64KB, FALSE, FALSE }\r
};\r
\r
STATIC PAM_REGISTER_VALUE  mRegisterValues440[] = {\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM1), 0x01, 0x02 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM1), 0x10, 0x20 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM2), 0x01, 0x02 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM2), 0x10, 0x20 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM3), 0x01, 0x02 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM3), 0x10, 0x20 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM4), 0x01, 0x02 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM4), 0x10, 0x20 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM5), 0x01, 0x02 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM5), 0x10, 0x20 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM6), 0x01, 0x02 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM6), 0x10, 0x20 },\r
  { PMC_REGISTER_PIIX4 (PIIX4_PAM0), 0x10, 0x20 }\r
};\r
\r
STATIC PAM_REGISTER_VALUE  mRegisterValuesQ35[] = {\r
  { DRAMC_REGISTER_Q35 (MCH_PAM1), 0x01, 0x02 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM1), 0x10, 0x20 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM2), 0x01, 0x02 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM2), 0x10, 0x20 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM3), 0x01, 0x02 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM3), 0x10, 0x20 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM4), 0x01, 0x02 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM4), 0x10, 0x20 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM5), 0x01, 0x02 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM5), 0x10, 0x20 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM6), 0x01, 0x02 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM6), 0x10, 0x20 },\r
  { DRAMC_REGISTER_Q35 (MCH_PAM0), 0x10, 0x20 }\r
};\r
\r
STATIC PAM_REGISTER_VALUE  *mRegisterValues;\r
\r
//\r
// Handle used to install the Legacy Region Protocol\r
//\r
STATIC EFI_HANDLE  mHandle = NULL;\r
\r
//\r
// Instance of the Legacy Region Protocol to install into the handle database\r
//\r
STATIC EFI_LEGACY_REGION2_PROTOCOL  mLegacyRegion2 = {\r
  LegacyRegion2Decode,\r
  LegacyRegion2Lock,\r
  LegacyRegion2BootLock,\r
  LegacyRegion2Unlock,\r
  LegacyRegionGetInfo\r
};\r
\r
STATIC\r
EFI_STATUS\r
LegacyRegionManipulationInternal (\r
  IN  UINT32   Start,\r
  IN  UINT32   Length,\r
  IN  BOOLEAN  *ReadEnable,\r
  IN  BOOLEAN  *WriteEnable,\r
  OUT UINT32   *Granularity\r
  )\r
{\r
  UINT32  EndAddress;\r
  UINTN   Index;\r
  UINTN   StartIndex;\r
\r
  //\r
  // Validate input parameters.\r
  //\r
  if ((Length == 0) || (Granularity == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  EndAddress = Start + Length - 1;\r
  if ((Start < PAM_BASE_ADDRESS) || (EndAddress > PAM_LIMIT_ADDRESS)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // Loop to find the start PAM.\r
  //\r
  StartIndex = 0;\r
  for (Index = 0; Index < ARRAY_SIZE (mSectionArray); Index++) {\r
    if ((Start >= mSectionArray[Index].Start) && (Start < (mSectionArray[Index].Start + mSectionArray[Index].Length))) {\r
      StartIndex = Index;\r
      break;\r
    }\r
  }\r
\r
  ASSERT (Index < ARRAY_SIZE (mSectionArray));\r
\r
  //\r
  // Program PAM until end PAM is encountered\r
  //\r
  for (Index = StartIndex; Index < ARRAY_SIZE (mSectionArray); Index++) {\r
    if (ReadEnable != NULL) {\r
      if (*ReadEnable) {\r
        PciOr8 (\r
          mRegisterValues[Index].PAMRegPciLibAddress,\r
          mRegisterValues[Index].ReadEnableData\r
          );\r
      } else {\r
        PciAnd8 (\r
          mRegisterValues[Index].PAMRegPciLibAddress,\r
          (UINT8)(~mRegisterValues[Index].ReadEnableData)\r
          );\r
      }\r
    }\r
\r
    if (WriteEnable != NULL) {\r
      if (*WriteEnable) {\r
        PciOr8 (\r
          mRegisterValues[Index].PAMRegPciLibAddress,\r
          mRegisterValues[Index].WriteEnableData\r
          );\r
      } else {\r
        PciAnd8 (\r
          mRegisterValues[Index].PAMRegPciLibAddress,\r
          (UINT8)(~mRegisterValues[Index].WriteEnableData)\r
          );\r
      }\r
    }\r
\r
    //\r
    // If the end PAM is encountered, record its length as granularity and jump out.\r
    //\r
    if ((EndAddress >= mSectionArray[Index].Start) && (EndAddress < (mSectionArray[Index].Start + mSectionArray[Index].Length))) {\r
      *Granularity = mSectionArray[Index].Length;\r
      break;\r
    }\r
  }\r
\r
  ASSERT (Index < ARRAY_SIZE (mSectionArray));\r
\r
  return EFI_SUCCESS;\r
}\r
\r
STATIC\r
EFI_STATUS\r
LegacyRegionGetInfoInternal (\r
  OUT UINT32                      *DescriptorCount,\r
  OUT LEGACY_MEMORY_SECTION_INFO  **Descriptor\r
  )\r
{\r
  UINTN  Index;\r
  UINT8  PamValue;\r
\r
  //\r
  // Check input parameters\r
  //\r
  if ((DescriptorCount == NULL) || (Descriptor == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // Fill in current status of legacy region.\r
  //\r
  *DescriptorCount = sizeof (mSectionArray) / sizeof (mSectionArray[0]);\r
  for (Index = 0; Index < *DescriptorCount; Index++) {\r
    PamValue                         = PciRead8 (mRegisterValues[Index].PAMRegPciLibAddress);\r
    mSectionArray[Index].ReadEnabled = FALSE;\r
    if ((PamValue & mRegisterValues[Index].ReadEnableData) != 0) {\r
      mSectionArray[Index].ReadEnabled = TRUE;\r
    }\r
\r
    mSectionArray[Index].WriteEnabled = FALSE;\r
    if ((PamValue & mRegisterValues[Index].WriteEnableData) != 0) {\r
      mSectionArray[Index].WriteEnabled = TRUE;\r
    }\r
  }\r
\r
  *Descriptor = mSectionArray;\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Modify the hardware to allow (decode) or disallow (not decode) memory reads in a region.\r
\r
  If the On parameter evaluates to TRUE, this function enables memory reads in the address range\r
  Start to (Start + Length - 1).\r
  If the On parameter evaluates to FALSE, this function disables memory reads in the address range\r
  Start to (Start + Length - 1).\r
\r
  @param  This[in]              Indicates the EFI_LEGACY_REGION_PROTOCOL instance.\r
  @param  Start[in]             The beginning of the physical address of the region whose attributes\r
                                should be modified.\r
  @param  Length[in]            The number of bytes of memory whose attributes should be modified.\r
                                The actual number of bytes modified may be greater than the number\r
                                specified.\r
  @param  Granularity[out]      The number of bytes in the last region affected. This may be less\r
                                than the total number of bytes affected if the starting address\r
                                was not aligned to a region's starting address or if the length\r
                                was greater than the number of bytes in the first region.\r
  @param  On[in]                Decode / Non-Decode flag.\r
\r
  @retval EFI_SUCCESS           The region's attributes were successfully modified.\r
  @retval EFI_INVALID_PARAMETER If Start or Length describe an address not in the Legacy Region.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
LegacyRegion2Decode (\r
  IN  EFI_LEGACY_REGION2_PROTOCOL  *This,\r
  IN  UINT32                       Start,\r
  IN  UINT32                       Length,\r
  OUT UINT32                       *Granularity,\r
  IN  BOOLEAN                      *On\r
  )\r
{\r
  return LegacyRegionManipulationInternal (Start, Length, On, NULL, Granularity);\r
}\r
\r
/**\r
  Modify the hardware to disallow memory attribute changes in a region.\r
\r
  This function makes the attributes of a region read only. Once a region is boot-locked with this\r
  function, the read and write attributes of that region cannot be changed until a power cycle has\r
  reset the boot-lock attribute. Calls to Decode(), Lock() and Unlock() will have no effect.\r
\r
  @param  This[in]              Indicates the EFI_LEGACY_REGION_PROTOCOL instance.\r
  @param  Start[in]             The beginning of the physical address of the region whose\r
                                attributes should be modified.\r
  @param  Length[in]            The number of bytes of memory whose attributes should be modified.\r
                                The actual number of bytes modified may be greater than the number\r
                                specified.\r
  @param  Granularity[out]      The number of bytes in the last region affected. This may be less\r
                                than the total number of bytes affected if the starting address was\r
                                not aligned to a region's starting address or if the length was\r
                                greater than the number of bytes in the first region.\r
\r
  @retval EFI_SUCCESS           The region's attributes were successfully modified.\r
  @retval EFI_INVALID_PARAMETER If Start or Length describe an address not in the Legacy Region.\r
  @retval EFI_UNSUPPORTED       The chipset does not support locking the configuration registers in\r
                                a way that will not affect memory regions outside the legacy memory\r
                                region.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
LegacyRegion2BootLock (\r
  IN  EFI_LEGACY_REGION2_PROTOCOL  *This,\r
  IN  UINT32                       Start,\r
  IN  UINT32                       Length,\r
  OUT UINT32                       *Granularity\r
  )\r
{\r
  if ((Start < 0xC0000) || ((Start + Length - 1) > 0xFFFFF)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  return EFI_UNSUPPORTED;\r
}\r
\r
/**\r
  Modify the hardware to disallow memory writes in a region.\r
\r
  This function changes the attributes of a memory range to not allow writes.\r
\r
  @param  This[in]              Indicates the EFI_LEGACY_REGION_PROTOCOL instance.\r
  @param  Start[in]             The beginning of the physical address of the region whose\r
                                attributes should be modified.\r
  @param  Length[in]            The number of bytes of memory whose attributes should be modified.\r
                                The actual number of bytes modified may be greater than the number\r
                                specified.\r
  @param  Granularity[out]      The number of bytes in the last region affected. This may be less\r
                                than the total number of bytes affected if the starting address was\r
                                not aligned to a region's starting address or if the length was\r
                                greater than the number of bytes in the first region.\r
\r
  @retval EFI_SUCCESS           The region's attributes were successfully modified.\r
  @retval EFI_INVALID_PARAMETER If Start or Length describe an address not in the Legacy Region.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
LegacyRegion2Lock (\r
  IN  EFI_LEGACY_REGION2_PROTOCOL  *This,\r
  IN  UINT32                       Start,\r
  IN  UINT32                       Length,\r
  OUT UINT32                       *Granularity\r
  )\r
{\r
  BOOLEAN  WriteEnable;\r
\r
  WriteEnable = FALSE;\r
  return LegacyRegionManipulationInternal (Start, Length, NULL, &WriteEnable, Granularity);\r
}\r
\r
/**\r
  Modify the hardware to allow memory writes in a region.\r
\r
  This function changes the attributes of a memory range to allow writes.\r
\r
  @param  This[in]              Indicates the EFI_LEGACY_REGION_PROTOCOL instance.\r
  @param  Start[in]             The beginning of the physical address of the region whose\r
                                attributes should be modified.\r
  @param  Length[in]            The number of bytes of memory whose attributes should be modified.\r
                                The actual number of bytes modified may be greater than the number\r
                                specified.\r
  @param  Granularity[out]      The number of bytes in the last region affected. This may be less\r
                                than the total number of bytes affected if the starting address was\r
                                not aligned to a region's starting address or if the length was\r
                                greater than the number of bytes in the first region.\r
\r
  @retval EFI_SUCCESS           The region's attributes were successfully modified.\r
  @retval EFI_INVALID_PARAMETER If Start or Length describe an address not in the Legacy Region.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
LegacyRegion2Unlock (\r
  IN  EFI_LEGACY_REGION2_PROTOCOL  *This,\r
  IN  UINT32                       Start,\r
  IN  UINT32                       Length,\r
  OUT UINT32                       *Granularity\r
  )\r
{\r
  BOOLEAN  WriteEnable;\r
\r
  WriteEnable = TRUE;\r
  return LegacyRegionManipulationInternal (Start, Length, NULL, &WriteEnable, Granularity);\r
}\r
\r
/**\r
  Get region information for the attributes of the Legacy Region.\r
\r
  This function is used to discover the granularity of the attributes for the memory in the legacy\r
  region. Each attribute may have a different granularity and the granularity may not be the same\r
  for all memory ranges in the legacy region.\r
\r
  @param  This[in]              Indicates the EFI_LEGACY_REGION_PROTOCOL instance.\r
  @param  DescriptorCount[out]  The number of region descriptor entries returned in the Descriptor\r
                                buffer.\r
  @param  Descriptor[out]       A pointer to a pointer used to return a buffer where the legacy\r
                                region information is deposited. This buffer will contain a list of\r
                                DescriptorCount number of region descriptors.  This function will\r
                                provide the memory for the buffer.\r
\r
  @retval EFI_SUCCESS           The region's attributes were successfully modified.\r
  @retval EFI_INVALID_PARAMETER If Start or Length describe an address not in the Legacy Region.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
LegacyRegionGetInfo (\r
  IN  EFI_LEGACY_REGION2_PROTOCOL   *This,\r
  OUT UINT32                        *DescriptorCount,\r
  OUT EFI_LEGACY_REGION_DESCRIPTOR  **Descriptor\r
  )\r
{\r
  LEGACY_MEMORY_SECTION_INFO    *SectionInfo;\r
  UINT32                        SectionCount;\r
  EFI_LEGACY_REGION_DESCRIPTOR  *DescriptorArray;\r
  UINTN                         Index;\r
  UINTN                         DescriptorIndex;\r
\r
  //\r
  // Get section numbers and information\r
  //\r
  LegacyRegionGetInfoInternal (&SectionCount, &SectionInfo);\r
\r
  //\r
  // Each section has 3 descriptors, corresponding to readability, writeability, and lock status.\r
  //\r
  DescriptorArray = AllocatePool (sizeof (EFI_LEGACY_REGION_DESCRIPTOR) * SectionCount * 3);\r
  if (DescriptorArray == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  DescriptorIndex = 0;\r
  for (Index = 0; Index < SectionCount; Index++) {\r
    DescriptorArray[DescriptorIndex].Start       = SectionInfo[Index].Start;\r
    DescriptorArray[DescriptorIndex].Length      = SectionInfo[Index].Length;\r
    DescriptorArray[DescriptorIndex].Granularity = SectionInfo[Index].Length;\r
    if (SectionInfo[Index].ReadEnabled) {\r
      DescriptorArray[DescriptorIndex].Attribute = LegacyRegionDecoded;\r
    } else {\r
      DescriptorArray[DescriptorIndex].Attribute = LegacyRegionNotDecoded;\r
    }\r
\r
    DescriptorIndex++;\r
\r
    //\r
    // Create descriptor for writeability, according to lock status\r
    //\r
    DescriptorArray[DescriptorIndex].Start       = SectionInfo[Index].Start;\r
    DescriptorArray[DescriptorIndex].Length      = SectionInfo[Index].Length;\r
    DescriptorArray[DescriptorIndex].Granularity = SectionInfo[Index].Length;\r
    if (SectionInfo[Index].WriteEnabled) {\r
      DescriptorArray[DescriptorIndex].Attribute = LegacyRegionWriteEnabled;\r
    } else {\r
      DescriptorArray[DescriptorIndex].Attribute = LegacyRegionWriteDisabled;\r
    }\r
\r
    DescriptorIndex++;\r
\r
    //\r
    // Chipset does not support bootlock.\r
    //\r
    DescriptorArray[DescriptorIndex].Start       = SectionInfo[Index].Start;\r
    DescriptorArray[DescriptorIndex].Length      = SectionInfo[Index].Length;\r
    DescriptorArray[DescriptorIndex].Granularity = SectionInfo[Index].Length;\r
    DescriptorArray[DescriptorIndex].Attribute   = LegacyRegionNotLocked;\r
    DescriptorIndex++;\r
  }\r
\r
  *DescriptorCount = (UINT32)DescriptorIndex;\r
  *Descriptor      = DescriptorArray;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Initialize Legacy Region support\r
\r
  @retval EFI_SUCCESS   Successfully initialized\r
\r
**/\r
EFI_STATUS\r
LegacyRegionInit (\r
  VOID\r
  )\r
{\r
  EFI_STATUS  Status;\r
  UINT16      HostBridgeDevId;\r
\r
  //\r
  // Query Host Bridge DID to determine platform type\r
  //\r
  HostBridgeDevId = PcdGet16 (PcdOvmfHostBridgePciDevId);\r
  switch (HostBridgeDevId) {\r
    case INTEL_82441_DEVICE_ID:\r
      mRegisterValues = mRegisterValues440;\r
      break;\r
    case INTEL_Q35_MCH_DEVICE_ID:\r
      mRegisterValues = mRegisterValuesQ35;\r
      break;\r
    default:\r
      DEBUG ((\r
        DEBUG_ERROR,\r
        "%a: Unknown Host Bridge Device ID: 0x%04x\n",\r
        __FUNCTION__,\r
        HostBridgeDevId\r
        ));\r
      ASSERT (FALSE);\r
      return RETURN_UNSUPPORTED;\r
  }\r
\r
  //\r
  // Install the Legacy Region Protocol on a new handle\r
  //\r
  Status = gBS->InstallMultipleProtocolInterfaces (\r
                  &mHandle,\r
                  &gEfiLegacyRegion2ProtocolGuid,\r
                  &mLegacyRegion2,\r
                  NULL\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  return Status;\r
}\r