[mirror_edk2.git] / UefiCpuPkg / Library / MtrrLib / MtrrLib.c

/** @file\r
  MTRR setting library\r
\r
  @par Note:\r
    Most of services in this library instance are suggested to be invoked by BSP only,\r
    except for MtrrSetAllMtrrs() which is used to sync BSP's MTRR setting to APs.\r
\r
  Copyright (c) 2008 - 2020, Intel Corporation. All rights reserved.<BR>\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include <Uefi.h>\r
#include <Register/Intel/Cpuid.h>\r
#include <Register/Intel/Msr.h>\r
\r
#include <Library/MtrrLib.h>\r
#include <Library/BaseLib.h>\r
#include <Library/CpuLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/DebugLib.h>\r
\r
#define OR_SEED              0x0101010101010101ull\r
#define CLEAR_SEED           0xFFFFFFFFFFFFFFFFull\r
#define MAX_WEIGHT           MAX_UINT8\r
#define SCRATCH_BUFFER_SIZE  (4 * SIZE_4KB)\r
#define MTRR_LIB_ASSERT_ALIGNED(B, L)  ASSERT ((B & ~(L - 1)) == B);\r
\r
#define M(x, y)  ((x) * VertexCount + (y))\r
#define O(x, y)  ((y) * VertexCount + (x))\r
\r
//\r
// Context to save and restore when MTRRs are programmed\r
//\r
typedef struct {\r
  UINTN      Cr4;\r
  BOOLEAN    InterruptState;\r
} MTRR_CONTEXT;\r
\r
typedef struct {\r
  UINT64                    Address;\r
  UINT64                    Alignment;\r
  UINT64                    Length;\r
  MTRR_MEMORY_CACHE_TYPE    Type    : 7;\r
\r
  //\r
  // Temprary use for calculating the best MTRR settings.\r
  //\r
  BOOLEAN                   Visited : 1;\r
  UINT8                     Weight;\r
  UINT16                    Previous;\r
} MTRR_LIB_ADDRESS;\r
\r
//\r
// This table defines the offset, base and length of the fixed MTRRs\r
//\r
CONST FIXED_MTRR  mMtrrLibFixedMtrrTable[] = {\r
  {\r
    MSR_IA32_MTRR_FIX64K_00000,\r
    0,\r
    SIZE_64KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX16K_80000,\r
    0x80000,\r
    SIZE_16KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX16K_A0000,\r
    0xA0000,\r
    SIZE_16KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX4K_C0000,\r
    0xC0000,\r
    SIZE_4KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX4K_C8000,\r
    0xC8000,\r
    SIZE_4KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX4K_D0000,\r
    0xD0000,\r
    SIZE_4KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX4K_D8000,\r
    0xD8000,\r
    SIZE_4KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX4K_E0000,\r
    0xE0000,\r
    SIZE_4KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX4K_E8000,\r
    0xE8000,\r
    SIZE_4KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX4K_F0000,\r
    0xF0000,\r
    SIZE_4KB\r
  },\r
  {\r
    MSR_IA32_MTRR_FIX4K_F8000,\r
    0xF8000,\r
    SIZE_4KB\r
  }\r
};\r
\r
//\r
// Lookup table used to print MTRRs\r
//\r
GLOBAL_REMOVE_IF_UNREFERENCED CONST CHAR8  *mMtrrMemoryCacheTypeShortName[] = {\r
  "UC",  // CacheUncacheable\r
  "WC",  // CacheWriteCombining\r
  "R*",  // Invalid\r
  "R*",  // Invalid\r
  "WT",  // CacheWriteThrough\r
  "WP",  // CacheWriteProtected\r
  "WB",  // CacheWriteBack\r
  "R*"   // Invalid\r
};\r
\r
/**\r
  Worker function prints all MTRRs for debugging.\r
\r
  If MtrrSetting is not NULL, print MTRR settings from input MTRR\r
  settings buffer.\r
  If MtrrSetting is NULL, print MTRR settings from MTRRs.\r
\r
  @param  MtrrSetting    A buffer holding all MTRRs content.\r
**/\r
VOID\r
MtrrDebugPrintAllMtrrsWorker (\r
  IN MTRR_SETTINGS  *MtrrSetting\r
  );\r
\r
/**\r
  Worker function returns the variable MTRR count for the CPU.\r
\r
  @return Variable MTRR count\r
\r
**/\r
UINT32\r
GetVariableMtrrCountWorker (\r
  VOID\r
  )\r
{\r
  MSR_IA32_MTRRCAP_REGISTER  MtrrCap;\r
\r
  MtrrCap.Uint64 = AsmReadMsr64 (MSR_IA32_MTRRCAP);\r
  ASSERT (MtrrCap.Bits.VCNT <= ARRAY_SIZE (((MTRR_VARIABLE_SETTINGS *)0)->Mtrr));\r
  return MtrrCap.Bits.VCNT;\r
}\r
\r
/**\r
  Returns the variable MTRR count for the CPU.\r
\r
  @return Variable MTRR count\r
\r
**/\r
UINT32\r
EFIAPI\r
GetVariableMtrrCount (\r
  VOID\r
  )\r
{\r
  if (!IsMtrrSupported ()) {\r
    return 0;\r
  }\r
\r
  return GetVariableMtrrCountWorker ();\r
}\r
\r
/**\r
  Worker function returns the firmware usable variable MTRR count for the CPU.\r
\r
  @return Firmware usable variable MTRR count\r
\r
**/\r
UINT32\r
GetFirmwareVariableMtrrCountWorker (\r
  VOID\r
  )\r
{\r
  UINT32  VariableMtrrCount;\r
  UINT32  ReservedMtrrNumber;\r
\r
  VariableMtrrCount  = GetVariableMtrrCountWorker ();\r
  ReservedMtrrNumber = PcdGet32 (PcdCpuNumberOfReservedVariableMtrrs);\r
  if (VariableMtrrCount < ReservedMtrrNumber) {\r
    return 0;\r
  }\r
\r
  return VariableMtrrCount - ReservedMtrrNumber;\r
}\r
\r
/**\r
  Returns the firmware usable variable MTRR count for the CPU.\r
\r
  @return Firmware usable variable MTRR count\r
\r
**/\r
UINT32\r
EFIAPI\r
GetFirmwareVariableMtrrCount (\r
  VOID\r
  )\r
{\r
  if (!IsMtrrSupported ()) {\r
    return 0;\r
  }\r
\r
  return GetFirmwareVariableMtrrCountWorker ();\r
}\r
\r
/**\r
  Worker function returns the default MTRR cache type for the system.\r
\r
  If MtrrSetting is not NULL, returns the default MTRR cache type from input\r
  MTRR settings buffer.\r
  If MtrrSetting is NULL, returns the default MTRR cache type from MSR.\r
\r
  @param[in]  MtrrSetting    A buffer holding all MTRRs content.\r
\r
  @return  The default MTRR cache type.\r
\r
**/\r
MTRR_MEMORY_CACHE_TYPE\r
MtrrGetDefaultMemoryTypeWorker (\r
  IN MTRR_SETTINGS  *MtrrSetting\r
  )\r
{\r
  MSR_IA32_MTRR_DEF_TYPE_REGISTER  DefType;\r
\r
  if (MtrrSetting == NULL) {\r
    DefType.Uint64 = AsmReadMsr64 (MSR_IA32_MTRR_DEF_TYPE);\r
  } else {\r
    DefType.Uint64 = MtrrSetting->MtrrDefType;\r
  }\r
\r
  return (MTRR_MEMORY_CACHE_TYPE)DefType.Bits.Type;\r
}\r
\r
/**\r
  Returns the default MTRR cache type for the system.\r
\r
  @return  The default MTRR cache type.\r
\r
**/\r
MTRR_MEMORY_CACHE_TYPE\r
EFIAPI\r
MtrrGetDefaultMemoryType (\r
  VOID\r
  )\r
{\r
  if (!IsMtrrSupported ()) {\r
    return CacheUncacheable;\r
  }\r
\r
  return MtrrGetDefaultMemoryTypeWorker (NULL);\r
}\r
\r
/**\r
  Preparation before programming MTRR.\r
\r
  This function will do some preparation for programming MTRRs:\r
  disable cache, invalid cache and disable MTRR caching functionality\r
\r
  @param[out] MtrrContext  Pointer to context to save\r
\r
**/\r
VOID\r
MtrrLibPreMtrrChange (\r
  OUT MTRR_CONTEXT  *MtrrContext\r
  )\r
{\r
  MSR_IA32_MTRR_DEF_TYPE_REGISTER  DefType;\r
\r
  //\r
  // Disable interrupts and save current interrupt state\r
  //\r
  MtrrContext->InterruptState = SaveAndDisableInterrupts ();\r
\r
  //\r
  // Enter no fill cache mode, CD=1(Bit30), NW=0 (Bit29)\r
  //\r
  AsmDisableCache ();\r
\r
  //\r
  // Save original CR4 value and clear PGE flag (Bit 7)\r
  //\r
  MtrrContext->Cr4 = AsmReadCr4 ();\r
  AsmWriteCr4 (MtrrContext->Cr4 & (~BIT7));\r
\r
  //\r
  // Flush all TLBs\r
  //\r
  CpuFlushTlb ();\r
\r
  //\r
  // Disable MTRRs\r
  //\r
  DefType.Uint64 = AsmReadMsr64 (MSR_IA32_MTRR_DEF_TYPE);\r
  DefType.Bits.E = 0;\r
  AsmWriteMsr64 (MSR_IA32_MTRR_DEF_TYPE, DefType.Uint64);\r
}\r
\r
/**\r
  Cleaning up after programming MTRRs.\r
\r
  This function will do some clean up after programming MTRRs:\r
  Flush all TLBs,  re-enable caching, restore CR4.\r
\r
  @param[in] MtrrContext  Pointer to context to restore\r
\r
**/\r
VOID\r
MtrrLibPostMtrrChangeEnableCache (\r
  IN MTRR_CONTEXT  *MtrrContext\r
  )\r
{\r
  //\r
  // Flush all TLBs\r
  //\r
  CpuFlushTlb ();\r
\r
  //\r
  // Enable Normal Mode caching CD=NW=0, CD(Bit30), NW(Bit29)\r
  //\r
  AsmEnableCache ();\r
\r
  //\r
  // Restore original CR4 value\r
  //\r
  AsmWriteCr4 (MtrrContext->Cr4);\r
\r
  //\r
  // Restore original interrupt state\r
  //\r
  SetInterruptState (MtrrContext->InterruptState);\r
}\r
\r
/**\r
  Cleaning up after programming MTRRs.\r
\r
  This function will do some clean up after programming MTRRs:\r
  enable MTRR caching functionality, and enable cache\r
\r
  @param[in] MtrrContext  Pointer to context to restore\r
\r
**/\r
VOID\r
MtrrLibPostMtrrChange (\r
  IN MTRR_CONTEXT  *MtrrContext\r
  )\r
{\r
  MSR_IA32_MTRR_DEF_TYPE_REGISTER  DefType;\r
\r
  //\r
  // Enable Cache MTRR\r
  //\r
  DefType.Uint64  = AsmReadMsr64 (MSR_IA32_MTRR_DEF_TYPE);\r
  DefType.Bits.E  = 1;\r
  DefType.Bits.FE = 1;\r
  AsmWriteMsr64 (MSR_IA32_MTRR_DEF_TYPE, DefType.Uint64);\r
\r
  MtrrLibPostMtrrChangeEnableCache (MtrrContext);\r
}\r
\r
/**\r
  Worker function gets the content in fixed MTRRs\r
\r
  @param[out]  FixedSettings  A buffer to hold fixed MTRRs content.\r
\r
  @retval The pointer of FixedSettings\r
\r
**/\r
MTRR_FIXED_SETTINGS *\r
MtrrGetFixedMtrrWorker (\r
  OUT MTRR_FIXED_SETTINGS  *FixedSettings\r
  )\r
{\r
  UINT32  Index;\r
\r
  for (Index = 0; Index < MTRR_NUMBER_OF_FIXED_MTRR; Index++) {\r
    FixedSettings->Mtrr[Index] =\r
      AsmReadMsr64 (mMtrrLibFixedMtrrTable[Index].Msr);\r
  }\r
\r
  return FixedSettings;\r
}\r
\r
/**\r
  This function gets the content in fixed MTRRs\r
\r
  @param[out]  FixedSettings  A buffer to hold fixed MTRRs content.\r
\r
  @retval The pointer of FixedSettings\r
\r
**/\r
MTRR_FIXED_SETTINGS *\r
EFIAPI\r
MtrrGetFixedMtrr (\r
  OUT MTRR_FIXED_SETTINGS  *FixedSettings\r
  )\r
{\r
  if (!IsMtrrSupported ()) {\r
    return FixedSettings;\r
  }\r
\r
  return MtrrGetFixedMtrrWorker (FixedSettings);\r
}\r
\r
/**\r
  Worker function will get the raw value in variable MTRRs\r
\r
  If MtrrSetting is not NULL, gets the variable MTRRs raw value from input\r
  MTRR settings buffer.\r
  If MtrrSetting is NULL, gets the variable MTRRs raw value from MTRRs.\r
\r
  @param[in]  MtrrSetting        A buffer holding all MTRRs content.\r
  @param[in]  VariableMtrrCount  Number of variable MTRRs.\r
  @param[out] VariableSettings   A buffer to hold variable MTRRs content.\r
\r
  @return The VariableSettings input pointer\r
\r
**/\r
MTRR_VARIABLE_SETTINGS *\r
MtrrGetVariableMtrrWorker (\r
  IN  MTRR_SETTINGS           *MtrrSetting,\r
  IN  UINT32                  VariableMtrrCount,\r
  OUT MTRR_VARIABLE_SETTINGS  *VariableSettings\r
  )\r
{\r
  UINT32  Index;\r
\r
  ASSERT (VariableMtrrCount <= ARRAY_SIZE (VariableSettings->Mtrr));\r
\r
  for (Index = 0; Index < VariableMtrrCount; Index++) {\r
    if (MtrrSetting == NULL) {\r
      VariableSettings->Mtrr[Index].Base =\r
        AsmReadMsr64 (MSR_IA32_MTRR_PHYSBASE0 + (Index << 1));\r
      VariableSettings->Mtrr[Index].Mask =\r
        AsmReadMsr64 (MSR_IA32_MTRR_PHYSMASK0 + (Index << 1));\r
    } else {\r
      VariableSettings->Mtrr[Index].Base = MtrrSetting->Variables.Mtrr[Index].Base;\r
      VariableSettings->Mtrr[Index].Mask = MtrrSetting->Variables.Mtrr[Index].Mask;\r
    }\r
  }\r
\r
  return VariableSettings;\r
}\r
\r
/**\r
  Programs fixed MTRRs registers.\r
\r
  @param[in]      Type             The memory type to set.\r
  @param[in, out] Base             The base address of memory range.\r
  @param[in, out] Length           The length of memory range.\r
  @param[in, out] LastMsrIndex     On input, the last index of the fixed MTRR MSR to program.\r
                                   On return, the current index of the fixed MTRR MSR to program.\r
  @param[out]     ClearMask        The bits to clear in the fixed MTRR MSR.\r
  @param[out]     OrMask           The bits to set in the fixed MTRR MSR.\r
\r
  @retval RETURN_SUCCESS      The cache type was updated successfully\r
  @retval RETURN_UNSUPPORTED  The requested range or cache type was invalid\r
                              for the fixed MTRRs.\r
\r
**/\r
RETURN_STATUS\r
MtrrLibProgramFixedMtrr (\r
  IN     MTRR_MEMORY_CACHE_TYPE  Type,\r
  IN OUT UINT64                  *Base,\r
  IN OUT UINT64                  *Length,\r
  IN OUT UINT32                  *LastMsrIndex,\r
  OUT    UINT64                  *ClearMask,\r
  OUT    UINT64                  *OrMask\r
  )\r
{\r
  UINT32  MsrIndex;\r
  UINT32  LeftByteShift;\r
  UINT32  RightByteShift;\r
  UINT64  SubLength;\r
\r
  //\r
  // Find the fixed MTRR index to be programmed\r
  //\r
  for (MsrIndex = *LastMsrIndex + 1; MsrIndex < ARRAY_SIZE (mMtrrLibFixedMtrrTable); MsrIndex++) {\r
    if ((*Base >= mMtrrLibFixedMtrrTable[MsrIndex].BaseAddress) &&\r
        (*Base <\r
         (\r
          mMtrrLibFixedMtrrTable[MsrIndex].BaseAddress +\r
          (8 * mMtrrLibFixedMtrrTable[MsrIndex].Length)\r
         )\r
        )\r
        )\r
    {\r
      break;\r
    }\r
  }\r
\r
  ASSERT (MsrIndex != ARRAY_SIZE (mMtrrLibFixedMtrrTable));\r
\r
  //\r
  // Find the begin offset in fixed MTRR and calculate byte offset of left shift\r
  //\r
  if ((((UINT32)*Base - mMtrrLibFixedMtrrTable[MsrIndex].BaseAddress) % mMtrrLibFixedMtrrTable[MsrIndex].Length) != 0) {\r
    //\r
    // Base address should be aligned to the begin of a certain Fixed MTRR range.\r
    //\r
    return RETURN_UNSUPPORTED;\r
  }\r
\r
  LeftByteShift = ((UINT32)*Base - mMtrrLibFixedMtrrTable[MsrIndex].BaseAddress) / mMtrrLibFixedMtrrTable[MsrIndex].Length;\r
  ASSERT (LeftByteShift < 8);\r
\r
  //\r
  // Find the end offset in fixed MTRR and calculate byte offset of right shift\r
  //\r
  SubLength = mMtrrLibFixedMtrrTable[MsrIndex].Length * (8 - LeftByteShift);\r
  if (*Length >= SubLength) {\r
    RightByteShift = 0;\r
  } else {\r
    if (((UINT32)(*Length) % mMtrrLibFixedMtrrTable[MsrIndex].Length) != 0) {\r
      //\r
      // Length should be aligned to the end of a certain Fixed MTRR range.\r
      //\r
      return RETURN_UNSUPPORTED;\r
    }\r
\r
    RightByteShift = 8 - LeftByteShift - (UINT32)(*Length) / mMtrrLibFixedMtrrTable[MsrIndex].Length;\r
    //\r
    // Update SubLength by actual length\r
    //\r
    SubLength = *Length;\r
  }\r
\r
  *ClearMask = CLEAR_SEED;\r
  *OrMask    = MultU64x32 (OR_SEED, (UINT32)Type);\r
\r
  if (LeftByteShift != 0) {\r
    //\r
    // Clear the low bits by LeftByteShift\r
    //\r
    *ClearMask &= LShiftU64 (*ClearMask, LeftByteShift * 8);\r
    *OrMask    &= LShiftU64 (*OrMask, LeftByteShift * 8);\r
  }\r
\r
  if (RightByteShift != 0) {\r
    //\r
    // Clear the high bits by RightByteShift\r
    //\r
    *ClearMask &= RShiftU64 (*ClearMask, RightByteShift * 8);\r
    *OrMask    &= RShiftU64 (*OrMask, RightByteShift * 8);\r
  }\r
\r
  *Length -= SubLength;\r
  *Base   += SubLength;\r
\r
  *LastMsrIndex = MsrIndex;\r
\r
  return RETURN_SUCCESS;\r
}\r
\r
/**\r
  Worker function gets the attribute of variable MTRRs.\r
\r
  This function shadows the content of variable MTRRs into an\r
  internal array: VariableMtrr.\r
\r
  @param[in]   VariableSettings      The variable MTRR values to shadow\r
  @param[in]   VariableMtrrCount     The number of variable MTRRs\r
  @param[in]   MtrrValidBitsMask     The mask for the valid bit of the MTRR\r
  @param[in]   MtrrValidAddressMask  The valid address mask for MTRR\r
  @param[out]  VariableMtrr          The array to shadow variable MTRRs content\r
\r
  @return      Number of MTRRs which has been used.\r
\r
**/\r
UINT32\r
MtrrGetMemoryAttributeInVariableMtrrWorker (\r
  IN  MTRR_VARIABLE_SETTINGS  *VariableSettings,\r
  IN  UINTN                   VariableMtrrCount,\r
  IN  UINT64                  MtrrValidBitsMask,\r
  IN  UINT64                  MtrrValidAddressMask,\r
  OUT VARIABLE_MTRR           *VariableMtrr\r
  )\r
{\r
  UINTN   Index;\r
  UINT32  UsedMtrr;\r
\r
  ZeroMem (VariableMtrr, sizeof (VARIABLE_MTRR) * ARRAY_SIZE (VariableSettings->Mtrr));\r
  for (Index = 0, UsedMtrr = 0; Index < VariableMtrrCount; Index++) {\r
    if (((MSR_IA32_MTRR_PHYSMASK_REGISTER *)&VariableSettings->Mtrr[Index].Mask)->Bits.V != 0) {\r
      VariableMtrr[Index].Msr         = (UINT32)Index;\r
      VariableMtrr[Index].BaseAddress = (VariableSettings->Mtrr[Index].Base & MtrrValidAddressMask);\r
      VariableMtrr[Index].Length      =\r
        ((~(VariableSettings->Mtrr[Index].Mask & MtrrValidAddressMask)) & MtrrValidBitsMask) + 1;\r
      VariableMtrr[Index].Type  = (VariableSettings->Mtrr[Index].Base & 0x0ff);\r
      VariableMtrr[Index].Valid = TRUE;\r
      VariableMtrr[Index].Used  = TRUE;\r
      UsedMtrr++;\r
    }\r
  }\r
\r
  return UsedMtrr;\r
}\r
\r
/**\r
  Convert variable MTRRs to a RAW MTRR_MEMORY_RANGE array.\r
  One MTRR_MEMORY_RANGE element is created for each MTRR setting.\r
  The routine doesn't remove the overlap or combine the near-by region.\r
\r
  @param[in]   VariableSettings      The variable MTRR values to shadow\r
  @param[in]   VariableMtrrCount     The number of variable MTRRs\r
  @param[in]   MtrrValidBitsMask     The mask for the valid bit of the MTRR\r
  @param[in]   MtrrValidAddressMask  The valid address mask for MTRR\r
  @param[out]  VariableMtrr          The array to shadow variable MTRRs content\r
\r
  @return      Number of MTRRs which has been used.\r
\r
**/\r
UINT32\r
MtrrLibGetRawVariableRanges (\r
  IN  MTRR_VARIABLE_SETTINGS  *VariableSettings,\r
  IN  UINTN                   VariableMtrrCount,\r
  IN  UINT64                  MtrrValidBitsMask,\r
  IN  UINT64                  MtrrValidAddressMask,\r
  OUT MTRR_MEMORY_RANGE       *VariableMtrr\r
  )\r
{\r
  UINTN   Index;\r
  UINT32  UsedMtrr;\r
\r
  ZeroMem (VariableMtrr, sizeof (MTRR_MEMORY_RANGE) * ARRAY_SIZE (VariableSettings->Mtrr));\r
  for (Index = 0, UsedMtrr = 0; Index < VariableMtrrCount; Index++) {\r
    if (((MSR_IA32_MTRR_PHYSMASK_REGISTER *)&VariableSettings->Mtrr[Index].Mask)->Bits.V != 0) {\r
      VariableMtrr[Index].BaseAddress = (VariableSettings->Mtrr[Index].Base & MtrrValidAddressMask);\r
      VariableMtrr[Index].Length      =\r
        ((~(VariableSettings->Mtrr[Index].Mask & MtrrValidAddressMask)) & MtrrValidBitsMask) + 1;\r
      VariableMtrr[Index].Type = (MTRR_MEMORY_CACHE_TYPE)(VariableSettings->Mtrr[Index].Base & 0x0ff);\r
      UsedMtrr++;\r
    }\r
  }\r
\r
  return UsedMtrr;\r
}\r
\r
/**\r
  Gets the attribute of variable MTRRs.\r
\r
  This function shadows the content of variable MTRRs into an\r
  internal array: VariableMtrr.\r
\r
  @param[in]   MtrrValidBitsMask     The mask for the valid bit of the MTRR\r
  @param[in]   MtrrValidAddressMask  The valid address mask for MTRR\r
  @param[out]  VariableMtrr          The array to shadow variable MTRRs content\r
\r
  @return                       The return value of this parameter indicates the\r
                                number of MTRRs which has been used.\r
\r
**/\r
UINT32\r
EFIAPI\r
MtrrGetMemoryAttributeInVariableMtrr (\r
  IN  UINT64         MtrrValidBitsMask,\r
  IN  UINT64         MtrrValidAddressMask,\r
  OUT VARIABLE_MTRR  *VariableMtrr\r
  )\r
{\r
  MTRR_VARIABLE_SETTINGS  VariableSettings;\r
\r
  if (!IsMtrrSupported ()) {\r
    return 0;\r
  }\r
\r
  MtrrGetVariableMtrrWorker (\r
    NULL,\r
    GetVariableMtrrCountWorker (),\r
    &VariableSettings\r
    );\r
\r
  return MtrrGetMemoryAttributeInVariableMtrrWorker (\r
           &VariableSettings,\r
           GetFirmwareVariableMtrrCountWorker (),\r
           MtrrValidBitsMask,\r
           MtrrValidAddressMask,\r
           VariableMtrr\r
           );\r
}\r
\r
/**\r
  Return the biggest alignment (lowest set bit) of address.\r
  The function is equivalent to: 1 << LowBitSet64 (Address).\r
\r
  @param Address    The address to return the alignment.\r
  @param Alignment0 The alignment to return when Address is 0.\r
\r
  @return The least alignment of the Address.\r
**/\r
UINT64\r
MtrrLibBiggestAlignment (\r
  UINT64  Address,\r
  UINT64  Alignment0\r
  )\r
{\r
  if (Address == 0) {\r
    return Alignment0;\r
  }\r
\r
  return Address & ((~Address) + 1);\r
}\r
\r
/**\r
  Return whether the left MTRR type precedes the right MTRR type.\r
\r
  The MTRR type precedence rules are:\r
    1. UC precedes any other type\r
    2. WT precedes WB\r
  For further details, please refer the IA32 Software Developer's Manual,\r
  Volume 3, Section "MTRR Precedences".\r
\r
  @param Left  The left MTRR type.\r
  @param Right The right MTRR type.\r
\r
  @retval TRUE  Left precedes Right.\r
  @retval FALSE Left doesn't precede Right.\r
**/\r
BOOLEAN\r
MtrrLibTypeLeftPrecedeRight (\r
  IN MTRR_MEMORY_CACHE_TYPE  Left,\r
  IN MTRR_MEMORY_CACHE_TYPE  Right\r
  )\r
{\r
  return (BOOLEAN)(Left == CacheUncacheable || (Left == CacheWriteThrough && Right == CacheWriteBack));\r
}\r
\r
/**\r
  Initializes the valid bits mask and valid address mask for MTRRs.\r
\r
  This function initializes the valid bits mask and valid address mask for MTRRs.\r
\r
  @param[out]  MtrrValidBitsMask     The mask for the valid bit of the MTRR\r
  @param[out]  MtrrValidAddressMask  The valid address mask for the MTRR\r
\r
**/\r
VOID\r
MtrrLibInitializeMtrrMask (\r
  OUT UINT64  *MtrrValidBitsMask,\r
  OUT UINT64  *MtrrValidAddressMask\r
  )\r
{\r
  UINT32                          MaxExtendedFunction;\r
  CPUID_VIR_PHY_ADDRESS_SIZE_EAX  VirPhyAddressSize;\r
\r
  AsmCpuid (CPUID_EXTENDED_FUNCTION, &MaxExtendedFunction, NULL, NULL, NULL);\r
\r
  if (MaxExtendedFunction >= CPUID_VIR_PHY_ADDRESS_SIZE) {\r
    AsmCpuid (CPUID_VIR_PHY_ADDRESS_SIZE, &VirPhyAddressSize.Uint32, NULL, NULL, NULL);\r
  } else {\r
    VirPhyAddressSize.Bits.PhysicalAddressBits = 36;\r
  }\r
\r
  *MtrrValidBitsMask    = LShiftU64 (1, VirPhyAddressSize.Bits.PhysicalAddressBits) - 1;\r
  *MtrrValidAddressMask = *MtrrValidBitsMask & 0xfffffffffffff000ULL;\r
}\r
\r
/**\r
  Determines the real attribute of a memory range.\r
\r
  This function is to arbitrate the real attribute of the memory when\r
  there are 2 MTRRs covers the same memory range. For further details,\r
  please refer the IA32 Software Developer's Manual, Volume 3,\r
  Section "MTRR Precedences".\r
\r
  @param[in]  MtrrType1    The first kind of Memory type\r
  @param[in]  MtrrType2    The second kind of memory type\r
\r
**/\r
MTRR_MEMORY_CACHE_TYPE\r
MtrrLibPrecedence (\r
  IN MTRR_MEMORY_CACHE_TYPE  MtrrType1,\r
  IN MTRR_MEMORY_CACHE_TYPE  MtrrType2\r
  )\r
{\r
  if (MtrrType1 == MtrrType2) {\r
    return MtrrType1;\r
  }\r
\r
  ASSERT (\r
    MtrrLibTypeLeftPrecedeRight (MtrrType1, MtrrType2) ||\r
    MtrrLibTypeLeftPrecedeRight (MtrrType2, MtrrType1)\r
    );\r
\r
  if (MtrrLibTypeLeftPrecedeRight (MtrrType1, MtrrType2)) {\r
    return MtrrType1;\r
  } else {\r
    return MtrrType2;\r
  }\r
}\r
\r
/**\r
  Worker function will get the memory cache type of the specific address.\r
\r
  If MtrrSetting is not NULL, gets the memory cache type from input\r
  MTRR settings buffer.\r
  If MtrrSetting is NULL, gets the memory cache type from MTRRs.\r
\r
  @param[in]  MtrrSetting        A buffer holding all MTRRs content.\r
  @param[in]  Address            The specific address\r
\r
  @return Memory cache type of the specific address\r
\r
**/\r
MTRR_MEMORY_CACHE_TYPE\r
MtrrGetMemoryAttributeByAddressWorker (\r
  IN MTRR_SETTINGS     *MtrrSetting,\r
  IN PHYSICAL_ADDRESS  Address\r
  )\r
{\r
  MSR_IA32_MTRR_DEF_TYPE_REGISTER  DefType;\r
  UINT64                           FixedMtrr;\r
  UINTN                            Index;\r
  UINTN                            SubIndex;\r
  MTRR_MEMORY_CACHE_TYPE           MtrrType;\r
  MTRR_MEMORY_RANGE                VariableMtrr[ARRAY_SIZE (MtrrSetting->Variables.Mtrr)];\r
  UINT64                           MtrrValidBitsMask;\r
  UINT64                           MtrrValidAddressMask;\r
  UINT32                           VariableMtrrCount;\r
  MTRR_VARIABLE_SETTINGS           VariableSettings;\r
\r
  //\r
  // Check if MTRR is enabled, if not, return UC as attribute\r
  //\r
  if (MtrrSetting == NULL) {\r
    DefType.Uint64 = AsmReadMsr64 (MSR_IA32_MTRR_DEF_TYPE);\r
  } else {\r
    DefType.Uint64 = MtrrSetting->MtrrDefType;\r
  }\r
\r
  if (DefType.Bits.E == 0) {\r
    return CacheUncacheable;\r
  }\r
\r
  //\r
  // If address is less than 1M, then try to go through the fixed MTRR\r
  //\r
  if (Address < BASE_1MB) {\r
    if (DefType.Bits.FE != 0) {\r
      //\r
      // Go through the fixed MTRR\r
      //\r
      for (Index = 0; Index < MTRR_NUMBER_OF_FIXED_MTRR; Index++) {\r
        if ((Address >= mMtrrLibFixedMtrrTable[Index].BaseAddress) &&\r
            (Address < mMtrrLibFixedMtrrTable[Index].BaseAddress +\r
             (mMtrrLibFixedMtrrTable[Index].Length * 8)))\r
        {\r
          SubIndex =\r
            ((UINTN)Address - mMtrrLibFixedMtrrTable[Index].BaseAddress) /\r
            mMtrrLibFixedMtrrTable[Index].Length;\r
          if (MtrrSetting == NULL) {\r
            FixedMtrr = AsmReadMsr64 (mMtrrLibFixedMtrrTable[Index].Msr);\r
          } else {\r
            FixedMtrr = MtrrSetting->Fixed.Mtrr[Index];\r
          }\r
\r
          return (MTRR_MEMORY_CACHE_TYPE)(RShiftU64 (FixedMtrr, SubIndex * 8) & 0xFF);\r
        }\r
      }\r
    }\r
  }\r
\r
  VariableMtrrCount = GetVariableMtrrCountWorker ();\r
  ASSERT (VariableMtrrCount <= ARRAY_SIZE (MtrrSetting->Variables.Mtrr));\r
  MtrrGetVariableMtrrWorker (MtrrSetting, VariableMtrrCount, &VariableSettings);\r
\r
  MtrrLibInitializeMtrrMask (&MtrrValidBitsMask, &MtrrValidAddressMask);\r
  MtrrLibGetRawVariableRanges (\r
    &VariableSettings,\r
    VariableMtrrCount,\r
    MtrrValidBitsMask,\r
    MtrrValidAddressMask,\r
    VariableMtrr\r
    );\r
\r
  //\r
  // Go through the variable MTRR\r
  //\r
  MtrrType = CacheInvalid;\r
  for (Index = 0; Index < VariableMtrrCount; Index++) {\r
    if (VariableMtrr[Index].Length != 0) {\r
      if ((Address >= VariableMtrr[Index].BaseAddress) &&\r
          (Address < VariableMtrr[Index].BaseAddress + VariableMtrr[Index].Length))\r
      {\r
        if (MtrrType == CacheInvalid) {\r
          MtrrType = (MTRR_MEMORY_CACHE_TYPE)VariableMtrr[Index].Type;\r
        } else {\r
          MtrrType = MtrrLibPrecedence (MtrrType, (MTRR_MEMORY_CACHE_TYPE)VariableMtrr[Index].Type);\r
        }\r
      }\r
    }\r
  }\r
\r
  //\r
  // If there is no MTRR which covers the Address, use the default MTRR type.\r
  //\r
  if (MtrrType == CacheInvalid) {\r
    MtrrType = (MTRR_MEMORY_CACHE_TYPE)DefType.Bits.Type;\r
  }\r
\r
  return MtrrType;\r
}\r
\r
/**\r
  This function will get the memory cache type of the specific address.\r
\r
  This function is mainly for debug purpose.\r
\r
  @param[in]  Address   The specific address\r
\r
  @return Memory cache type of the specific address\r
\r
**/\r
MTRR_MEMORY_CACHE_TYPE\r
EFIAPI\r
MtrrGetMemoryAttribute (\r
  IN PHYSICAL_ADDRESS  Address\r
  )\r
{\r
  if (!IsMtrrSupported ()) {\r
    return CacheUncacheable;\r
  }\r
\r
  return MtrrGetMemoryAttributeByAddressWorker (NULL, Address);\r
}\r
\r
/**\r
  Update the Ranges array to change the specified range identified by\r
  BaseAddress and Length to Type.\r
\r
  @param Ranges      Array holding memory type settings for all memory regions.\r
  @param Capacity    The maximum count of memory ranges the array can hold.\r
  @param Count       Return the new memory range count in the array.\r
  @param BaseAddress The base address of the memory range to change type.\r
  @param Length      The length of the memory range to change type.\r
  @param Type        The new type of the specified memory range.\r
\r
  @retval RETURN_SUCCESS          The type of the specified memory range is\r
                                  changed successfully.\r
  @retval RETURN_ALREADY_STARTED  The type of the specified memory range equals\r
                                  to the desired type.\r
  @retval RETURN_OUT_OF_RESOURCES The new type set causes the count of memory\r
                                  range exceeds capacity.\r
**/\r
RETURN_STATUS\r
MtrrLibSetMemoryType (\r
  IN MTRR_MEMORY_RANGE       *Ranges,\r
  IN UINTN                   Capacity,\r
  IN OUT UINTN               *Count,\r
  IN UINT64                  BaseAddress,\r
  IN UINT64                  Length,\r
  IN MTRR_MEMORY_CACHE_TYPE  Type\r
  )\r
{\r
  UINTN   Index;\r
  UINT64  Limit;\r
  UINT64  LengthLeft;\r
  UINT64  LengthRight;\r
  UINTN   StartIndex;\r
  UINTN   EndIndex;\r
  UINTN   DeltaCount;\r
\r
  LengthRight = 0;\r
  LengthLeft  = 0;\r
  Limit       = BaseAddress + Length;\r
  StartIndex  = *Count;\r
  EndIndex    = *Count;\r
  for (Index = 0; Index < *Count; Index++) {\r
    if ((StartIndex == *Count) &&\r
        (Ranges[Index].BaseAddress <= BaseAddress) &&\r
        (BaseAddress < Ranges[Index].BaseAddress + Ranges[Index].Length))\r
    {\r
      StartIndex = Index;\r
      LengthLeft = BaseAddress - Ranges[Index].BaseAddress;\r
    }\r
\r
    if ((EndIndex == *Count) &&\r
        (Ranges[Index].BaseAddress < Limit) &&\r
        (Limit <= Ranges[Index].BaseAddress + Ranges[Index].Length))\r
    {\r
      EndIndex    = Index;\r
      LengthRight = Ranges[Index].BaseAddress + Ranges[Index].Length - Limit;\r
      break;\r
    }\r
  }\r
\r
  ASSERT (StartIndex != *Count && EndIndex != *Count);\r
  if ((StartIndex == EndIndex) && (Ranges[StartIndex].Type == Type)) {\r
    return RETURN_ALREADY_STARTED;\r
  }\r
\r
  //\r
  // The type change may cause merging with previous range or next range.\r
  // Update the StartIndex, EndIndex, BaseAddress, Length so that following\r
  // logic doesn't need to consider merging.\r
  //\r
  if (StartIndex != 0) {\r
    if ((LengthLeft == 0) && (Ranges[StartIndex - 1].Type == Type)) {\r
      StartIndex--;\r
      Length      += Ranges[StartIndex].Length;\r
      BaseAddress -= Ranges[StartIndex].Length;\r
    }\r
  }\r
\r
  if (EndIndex != (*Count) - 1) {\r
    if ((LengthRight == 0) && (Ranges[EndIndex + 1].Type == Type)) {\r
      EndIndex++;\r
      Length += Ranges[EndIndex].Length;\r
    }\r
  }\r
\r
  //\r
  // |- 0 -|- 1 -|- 2 -|- 3 -| StartIndex EndIndex DeltaCount  Count (Count = 4)\r
  //   |++++++++++++++++++|    0          3         1=3-0-2    3\r
  //   |+++++++|               0          1        -1=1-0-2    5\r
  //   |+|                     0          0        -2=0-0-2    6\r
  // |+++|                     0          0        -1=0-0-2+1  5\r
  //\r
  //\r
  DeltaCount = EndIndex - StartIndex - 2;\r
  if (LengthLeft == 0) {\r
    DeltaCount++;\r
  }\r
\r
  if (LengthRight == 0) {\r
    DeltaCount++;\r
  }\r
\r
  if (*Count - DeltaCount > Capacity) {\r
    return RETURN_OUT_OF_RESOURCES;\r
  }\r
\r
  //\r
  // Reserve (-DeltaCount) space\r
  //\r
  CopyMem (&Ranges[EndIndex + 1 - DeltaCount], &Ranges[EndIndex + 1], (*Count - EndIndex - 1) * sizeof (Ranges[0]));\r
  *Count -= DeltaCount;\r
\r
  if (LengthLeft != 0) {\r
    Ranges[StartIndex].Length = LengthLeft;\r
    StartIndex++;\r
  }\r
\r
  if (LengthRight != 0) {\r
    Ranges[EndIndex - DeltaCount].BaseAddress = BaseAddress + Length;\r
    Ranges[EndIndex - DeltaCount].Length      = LengthRight;\r
    Ranges[EndIndex - DeltaCount].Type        = Ranges[EndIndex].Type;\r
  }\r
\r
  Ranges[StartIndex].BaseAddress = BaseAddress;\r
  Ranges[StartIndex].Length      = Length;\r
  Ranges[StartIndex].Type        = Type;\r
  return RETURN_SUCCESS;\r
}\r
\r
/**\r
  Return the number of memory types in range [BaseAddress, BaseAddress + Length).\r
\r
  @param Ranges      Array holding memory type settings for all memory regions.\r
  @param RangeCount  The count of memory ranges the array holds.\r
  @param BaseAddress Base address.\r
  @param Length      Length.\r
  @param Types       Return bit mask to indicate all memory types in the specified range.\r
\r
  @retval  Number of memory types.\r
**/\r
UINT8\r
MtrrLibGetNumberOfTypes (\r
  IN CONST MTRR_MEMORY_RANGE  *Ranges,\r
  IN UINTN                    RangeCount,\r
  IN UINT64                   BaseAddress,\r
  IN UINT64                   Length,\r
  IN OUT UINT8                *Types  OPTIONAL\r
  )\r
{\r
  UINTN  Index;\r
  UINT8  TypeCount;\r
  UINT8  LocalTypes;\r
\r
  TypeCount  = 0;\r
  LocalTypes = 0;\r
  for (Index = 0; Index < RangeCount; Index++) {\r
    if ((Ranges[Index].BaseAddress <= BaseAddress) &&\r
        (BaseAddress < Ranges[Index].BaseAddress + Ranges[Index].Length)\r
        )\r
    {\r
      if ((LocalTypes & (1 << Ranges[Index].Type)) == 0) {\r
        LocalTypes |= (UINT8)(1 << Ranges[Index].Type);\r
        TypeCount++;\r
      }\r
\r
      if (BaseAddress + Length > Ranges[Index].BaseAddress + Ranges[Index].Length) {\r
        Length     -= Ranges[Index].BaseAddress + Ranges[Index].Length - BaseAddress;\r
        BaseAddress = Ranges[Index].BaseAddress + Ranges[Index].Length;\r
      } else {\r
        break;\r
      }\r
    }\r
  }\r
\r
  if (Types != NULL) {\r
    *Types = LocalTypes;\r
  }\r
\r
  return TypeCount;\r
}\r
\r
/**\r
  Calculate the least MTRR number from vertex Start to Stop and update\r
  the Previous of all vertices from Start to Stop is updated to reflect\r
  how the memory range is covered by MTRR.\r
\r
  @param VertexCount     The count of vertices in the graph.\r
  @param Vertices        Array holding all vertices.\r
  @param Weight          2-dimention array holding weights between vertices.\r
  @param Start           Start vertex.\r
  @param Stop            Stop vertex.\r
  @param IncludeOptional TRUE to count the optional weight.\r
**/\r
VOID\r
MtrrLibCalculateLeastMtrrs (\r
  IN UINT16            VertexCount,\r
  IN MTRR_LIB_ADDRESS  *Vertices,\r
  IN OUT CONST UINT8   *Weight,\r
  IN UINT16            Start,\r
  IN UINT16            Stop,\r
  IN BOOLEAN           IncludeOptional\r
  )\r
{\r
  UINT16  Index;\r
  UINT8   MinWeight;\r
  UINT16  MinI;\r
  UINT8   Mandatory;\r
  UINT8   Optional;\r
\r
  for (Index = Start; Index <= Stop; Index++) {\r
    Vertices[Index].Visited = FALSE;\r
    Mandatory               = Weight[M (Start, Index)];\r
    Vertices[Index].Weight  = Mandatory;\r
    if (Mandatory != MAX_WEIGHT) {\r
      Optional                = IncludeOptional ? Weight[O (Start, Index)] : 0;\r
      Vertices[Index].Weight += Optional;\r
      ASSERT (Vertices[Index].Weight >= Optional);\r
    }\r
  }\r
\r
  MinI      = Start;\r
  MinWeight = 0;\r
  while (!Vertices[Stop].Visited) {\r
    //\r
    // Update the weight from the shortest vertex to other unvisited vertices\r
    //\r
    for (Index = Start + 1; Index <= Stop; Index++) {\r
      if (!Vertices[Index].Visited) {\r
        Mandatory = Weight[M (MinI, Index)];\r
        if (Mandatory != MAX_WEIGHT) {\r
          Optional = IncludeOptional ? Weight[O (MinI, Index)] : 0;\r
          if (MinWeight + Mandatory + Optional <= Vertices[Index].Weight) {\r
            Vertices[Index].Weight   = MinWeight + Mandatory + Optional;\r
            Vertices[Index].Previous = MinI; // Previous is Start based.\r
          }\r
        }\r
      }\r
    }\r
\r
    //\r
    // Find the shortest vertex from Start\r
    //\r
    MinI      = VertexCount;\r
    MinWeight = MAX_WEIGHT;\r
    for (Index = Start + 1; Index <= Stop; Index++) {\r
      if (!Vertices[Index].Visited && (MinWeight > Vertices[Index].Weight)) {\r
        MinI      = Index;\r
        MinWeight = Vertices[Index].Weight;\r
      }\r
    }\r
\r
    //\r
    // Mark the shortest vertex from Start as visited\r
    //\r
    Vertices[MinI].Visited = TRUE;\r
  }\r
}\r
\r
/**\r
  Append the MTRR setting to MTRR setting array.\r
\r
  @param Mtrrs        Array holding all MTRR settings.\r
  @param MtrrCapacity Capacity of the MTRR array.\r
  @param MtrrCount    The count of MTRR settings in array.\r
  @param BaseAddress  Base address.\r
  @param Length       Length.\r
  @param Type         Memory type.\r
\r
  @retval RETURN_SUCCESS          MTRR setting is appended to array.\r
  @retval RETURN_OUT_OF_RESOURCES Array is full.\r
**/\r
RETURN_STATUS\r
MtrrLibAppendVariableMtrr (\r
  IN OUT MTRR_MEMORY_RANGE       *Mtrrs,\r
  IN     UINT32                  MtrrCapacity,\r
  IN OUT UINT32                  *MtrrCount,\r
  IN     UINT64                  BaseAddress,\r
  IN     UINT64                  Length,\r
  IN     MTRR_MEMORY_CACHE_TYPE  Type\r
  )\r
{\r
  if (*MtrrCount == MtrrCapacity) {\r
    return RETURN_OUT_OF_RESOURCES;\r
  }\r
\r
  Mtrrs[*MtrrCount].BaseAddress = BaseAddress;\r
  Mtrrs[*MtrrCount].Length      = Length;\r
  Mtrrs[*MtrrCount].Type        = Type;\r
  (*MtrrCount)++;\r
  return RETURN_SUCCESS;\r
}\r
\r
/**\r
  Return the memory type that has the least precedence.\r
\r
  @param TypeBits  Bit mask of memory type.\r
\r
  @retval  Memory type that has the least precedence.\r
**/\r
MTRR_MEMORY_CACHE_TYPE\r
MtrrLibLowestType (\r
  IN      UINT8  TypeBits\r
  )\r
{\r
  INT8  Type;\r
\r
  ASSERT (TypeBits != 0);\r
  for (Type = 7; (INT8)TypeBits > 0; Type--, TypeBits <<= 1) {\r
  }\r
\r
  return (MTRR_MEMORY_CACHE_TYPE)Type;\r
}\r
\r
/**\r
  Return TRUE when the Operand is exactly power of 2.\r
\r
  @retval TRUE  Operand is exactly power of 2.\r
  @retval FALSE Operand is not power of 2.\r
**/\r
BOOLEAN\r
MtrrLibIsPowerOfTwo (\r
  IN     UINT64  Operand\r
  )\r
{\r
  ASSERT (Operand != 0);\r
  return (BOOLEAN)((Operand & (Operand - 1)) == 0);\r
}\r
\r
/**\r
  Calculate the subtractive path from vertex Start to Stop.\r
\r
  @param DefaultType  Default memory type.\r
  @param A0           Alignment to use when base address is 0.\r
  @param Ranges       Array holding memory type settings for all memory regions.\r
  @param RangeCount   The count of memory ranges the array holds.\r
  @param VertexCount  The count of vertices in the graph.\r
  @param Vertices     Array holding all vertices.\r
  @param Weight       2-dimention array holding weights between vertices.\r
  @param Start        Start vertex.\r
  @param Stop         Stop vertex.\r
  @param Types        Type bit mask of memory range from Start to Stop.\r
  @param TypeCount    Number of different memory types from Start to Stop.\r
  @param Mtrrs        Array holding all MTRR settings.\r
  @param MtrrCapacity Capacity of the MTRR array.\r
  @param MtrrCount    The count of MTRR settings in array.\r
\r
  @retval RETURN_SUCCESS          The subtractive path is calculated successfully.\r
  @retval RETURN_OUT_OF_RESOURCES The MTRR setting array is full.\r
\r
**/\r
RETURN_STATUS\r
MtrrLibCalculateSubtractivePath (\r
  IN MTRR_MEMORY_CACHE_TYPE   DefaultType,\r
  IN UINT64                   A0,\r
  IN CONST MTRR_MEMORY_RANGE  *Ranges,\r
  IN UINTN                    RangeCount,\r
  IN UINT16                   VertexCount,\r
  IN MTRR_LIB_ADDRESS         *Vertices,\r
  IN OUT UINT8                *Weight,\r
  IN UINT16                   Start,\r
  IN UINT16                   Stop,\r
  IN UINT8                    Types,\r
  IN UINT8                    TypeCount,\r
  IN OUT MTRR_MEMORY_RANGE    *Mtrrs        OPTIONAL,\r
  IN UINT32                   MtrrCapacity  OPTIONAL,\r
  IN OUT UINT32               *MtrrCount    OPTIONAL\r
  )\r
{\r
  RETURN_STATUS           Status;\r
  UINT64                  Base;\r
  UINT64                  Length;\r
  UINT8                   PrecedentTypes;\r
  UINTN                   Index;\r
  UINT64                  HBase;\r
  UINT64                  HLength;\r
  UINT64                  SubLength;\r
  UINT16                  SubStart;\r
  UINT16                  SubStop;\r
  UINT16                  Cur;\r
  UINT16                  Pre;\r
  MTRR_MEMORY_CACHE_TYPE  LowestType;\r
  MTRR_MEMORY_CACHE_TYPE  LowestPrecedentType;\r
\r
  Base   = Vertices[Start].Address;\r
  Length = Vertices[Stop].Address - Base;\r
\r
  LowestType = MtrrLibLowestType (Types);\r
\r
  //\r
  // Clear the lowest type (highest bit) to get the precedent types\r
  //\r
  PrecedentTypes      = ~(1 << LowestType) & Types;\r
  LowestPrecedentType = MtrrLibLowestType (PrecedentTypes);\r
\r
  if (Mtrrs == NULL) {\r
    Weight[M (Start, Stop)] = ((LowestType == DefaultType) ? 0 : 1);\r
    Weight[O (Start, Stop)] = ((LowestType == DefaultType) ? 1 : 0);\r
  }\r
\r
  // Add all high level ranges\r
  HBase   = MAX_UINT64;\r
  HLength = 0;\r
  for (Index = 0; Index < RangeCount; Index++) {\r
    if (Length == 0) {\r
      break;\r
    }\r
\r
    if ((Base < Ranges[Index].BaseAddress) || (Ranges[Index].BaseAddress + Ranges[Index].Length <= Base)) {\r
      continue;\r
    }\r
\r
    //\r
    // Base is in the Range[Index]\r
    //\r
    if (Base + Length > Ranges[Index].BaseAddress + Ranges[Index].Length) {\r
      SubLength = Ranges[Index].BaseAddress + Ranges[Index].Length - Base;\r
    } else {\r
      SubLength = Length;\r
    }\r
\r
    if (((1 << Ranges[Index].Type) & PrecedentTypes) != 0) {\r
      //\r
      // Meet a range whose types take precedence.\r
      // Update the [HBase, HBase + HLength) to include the range,\r
      // [HBase, HBase + HLength) may contain sub ranges with 2 different types, and both take precedence.\r
      //\r
      if (HBase == MAX_UINT64) {\r
        HBase = Base;\r
      }\r
\r
      HLength += SubLength;\r
    }\r
\r
    Base   += SubLength;\r
    Length -= SubLength;\r
\r
    if (HLength == 0) {\r
      continue;\r
    }\r
\r
    if ((Ranges[Index].Type == LowestType) || (Length == 0)) {\r
      // meet low type or end\r
\r
      //\r
      // Add the MTRRs for each high priority type range\r
      // the range[HBase, HBase + HLength) contains only two types.\r
      // We might use positive or subtractive, depending on which way uses less MTRR\r
      //\r
      for (SubStart = Start; SubStart <= Stop; SubStart++) {\r
        if (Vertices[SubStart].Address == HBase) {\r
          break;\r
        }\r
      }\r
\r
      for (SubStop = SubStart; SubStop <= Stop; SubStop++) {\r
        if (Vertices[SubStop].Address == HBase + HLength) {\r
          break;\r
        }\r
      }\r
\r
      ASSERT (Vertices[SubStart].Address == HBase);\r
      ASSERT (Vertices[SubStop].Address == HBase + HLength);\r
\r
      if ((TypeCount == 2) || (SubStart == SubStop - 1)) {\r
        //\r
        // add subtractive MTRRs for [HBase, HBase + HLength)\r
        // [HBase, HBase + HLength) contains only one type.\r
        // while - loop is to split the range to MTRR - compliant aligned range.\r
        //\r
        if (Mtrrs == NULL) {\r
          Weight[M (Start, Stop)] += (UINT8)(SubStop - SubStart);\r
        } else {\r
          while (SubStart != SubStop) {\r
            Status = MtrrLibAppendVariableMtrr (\r
                       Mtrrs,\r
                       MtrrCapacity,\r
                       MtrrCount,\r
                       Vertices[SubStart].Address,\r
                       Vertices[SubStart].Length,\r
                       Vertices[SubStart].Type\r
                       );\r
            if (RETURN_ERROR (Status)) {\r
              return Status;\r
            }\r
\r
            SubStart++;\r
          }\r
        }\r
      } else {\r
        ASSERT (TypeCount == 3);\r
        MtrrLibCalculateLeastMtrrs (VertexCount, Vertices, Weight, SubStart, SubStop, TRUE);\r
\r
        if (Mtrrs == NULL) {\r
          Weight[M (Start, Stop)] += Vertices[SubStop].Weight;\r
        } else {\r
          // When we need to collect the optimal path from SubStart to SubStop\r
          while (SubStop != SubStart) {\r
            Cur     = SubStop;\r
            Pre     = Vertices[Cur].Previous;\r
            SubStop = Pre;\r
\r
            if (Weight[M (Pre, Cur)] + Weight[O (Pre, Cur)] != 0) {\r
              Status = MtrrLibAppendVariableMtrr (\r
                         Mtrrs,\r
                         MtrrCapacity,\r
                         MtrrCount,\r
                         Vertices[Pre].Address,\r
                         Vertices[Cur].Address - Vertices[Pre].Address,\r
                         (Pre != Cur - 1) ? LowestPrecedentType : Vertices[Pre].Type\r
                         );\r
              if (RETURN_ERROR (Status)) {\r
                return Status;\r
              }\r
            }\r
\r
            if (Pre != Cur - 1) {\r
              Status = MtrrLibCalculateSubtractivePath (\r
                         DefaultType,\r
                         A0,\r
                         Ranges,\r
                         RangeCount,\r
                         VertexCount,\r
                         Vertices,\r
                         Weight,\r
                         Pre,\r
                         Cur,\r
                         PrecedentTypes,\r
                         2,\r
                         Mtrrs,\r
                         MtrrCapacity,\r
                         MtrrCount\r
                         );\r
              if (RETURN_ERROR (Status)) {\r
                return Status;\r
              }\r
            }\r
          }\r
        }\r
      }\r
\r
      //\r
      // Reset HBase, HLength\r
      //\r
      HBase   = MAX_UINT64;\r
      HLength = 0;\r
    }\r
  }\r
\r
  return RETURN_SUCCESS;\r
}\r
\r
/**\r
  Calculate MTRR settings to cover the specified memory ranges.\r
\r
  @param DefaultType  Default memory type.\r
  @param A0           Alignment to use when base address is 0.\r
  @param Ranges       Memory range array holding the memory type\r
                      settings for all memory address.\r
  @param RangeCount   Count of memory ranges.\r
  @param Scratch      A temporary scratch buffer that is used to perform the calculation.\r
                      This is an optional parameter that may be NULL.\r
  @param ScratchSize  Pointer to the size in bytes of the scratch buffer.\r
                      It may be updated to the actual required size when the calculation\r
                      needs more scratch buffer.\r
  @param Mtrrs        Array holding all MTRR settings.\r
  @param MtrrCapacity Capacity of the MTRR array.\r
  @param MtrrCount    The count of MTRR settings in array.\r
\r
  @retval RETURN_SUCCESS          Variable MTRRs are allocated successfully.\r
  @retval RETURN_OUT_OF_RESOURCES Count of variable MTRRs exceeds capacity.\r
  @retval RETURN_BUFFER_TOO_SMALL The scratch buffer is too small for MTRR calculation.\r
**/\r
RETURN_STATUS\r
MtrrLibCalculateMtrrs (\r
  IN MTRR_MEMORY_CACHE_TYPE   DefaultType,\r
  IN UINT64                   A0,\r
  IN CONST MTRR_MEMORY_RANGE  *Ranges,\r
  IN UINTN                    RangeCount,\r
  IN VOID                     *Scratch,\r
  IN OUT UINTN                *ScratchSize,\r
  IN OUT MTRR_MEMORY_RANGE    *Mtrrs,\r
  IN UINT32                   MtrrCapacity,\r
  IN OUT UINT32               *MtrrCount\r
  )\r
{\r
  UINT64            Base0;\r
  UINT64            Base1;\r
  UINTN             Index;\r
  UINT64            Base;\r
  UINT64            Length;\r
  UINT64            Alignment;\r
  UINT64            SubLength;\r
  MTRR_LIB_ADDRESS  *Vertices;\r
  UINT8             *Weight;\r
  UINT32            VertexIndex;\r
  UINT32            VertexCount;\r
  UINTN             RequiredScratchSize;\r
  UINT8             TypeCount;\r
  UINT16            Start;\r
  UINT16            Stop;\r
  UINT8             Type;\r
  RETURN_STATUS     Status;\r
\r
  Base0 = Ranges[0].BaseAddress;\r
  Base1 = Ranges[RangeCount - 1].BaseAddress + Ranges[RangeCount - 1].Length;\r
  MTRR_LIB_ASSERT_ALIGNED (Base0, Base1 - Base0);\r
\r
  //\r
  // Count the number of vertices.\r
  //\r
  Vertices = (MTRR_LIB_ADDRESS *)Scratch;\r
  for (VertexIndex = 0, Index = 0; Index < RangeCount; Index++) {\r
    Base   = Ranges[Index].BaseAddress;\r
    Length = Ranges[Index].Length;\r
    while (Length != 0) {\r
      Alignment = MtrrLibBiggestAlignment (Base, A0);\r
      SubLength = Alignment;\r
      if (SubLength > Length) {\r
        SubLength = GetPowerOfTwo64 (Length);\r
      }\r
\r
      if (VertexIndex < *ScratchSize / sizeof (*Vertices)) {\r
        Vertices[VertexIndex].Address   = Base;\r
        Vertices[VertexIndex].Alignment = Alignment;\r
        Vertices[VertexIndex].Type      = Ranges[Index].Type;\r
        Vertices[VertexIndex].Length    = SubLength;\r
      }\r
\r
      Base   += SubLength;\r
      Length -= SubLength;\r
      VertexIndex++;\r
    }\r
  }\r
\r
  //\r
  // Vertices[VertexIndex] = Base1, so whole vertex count is (VertexIndex + 1).\r
  //\r
  VertexCount = VertexIndex + 1;\r
  DEBUG ((\r
    DEBUG_CACHE,\r
    "  Count of vertices (%016llx - %016llx) = %d\n",\r
    Ranges[0].BaseAddress,\r
    Ranges[RangeCount - 1].BaseAddress + Ranges[RangeCount - 1].Length,\r
    VertexCount\r
    ));\r
  ASSERT (VertexCount < MAX_UINT16);\r
\r
  RequiredScratchSize = VertexCount * sizeof (*Vertices) + VertexCount * VertexCount * sizeof (*Weight);\r
  if (*ScratchSize < RequiredScratchSize) {\r
    *ScratchSize = RequiredScratchSize;\r
    return RETURN_BUFFER_TOO_SMALL;\r
  }\r
\r
  Vertices[VertexCount - 1].Address = Base1;\r
\r
  Weight = (UINT8 *)&Vertices[VertexCount];\r
  for (VertexIndex = 0; VertexIndex < VertexCount; VertexIndex++) {\r
    //\r
    // Set optional weight between vertices and self->self to 0\r
    //\r
    SetMem (&Weight[M (VertexIndex, 0)], VertexIndex + 1, 0);\r
    //\r
    // Set mandatory weight between vertices to MAX_WEIGHT\r
    //\r
    SetMem (&Weight[M (VertexIndex, VertexIndex + 1)], VertexCount - VertexIndex - 1, MAX_WEIGHT);\r
\r
    // Final result looks like:\r
    //   00 FF FF FF\r
    //   00 00 FF FF\r
    //   00 00 00 FF\r
    //   00 00 00 00\r
  }\r
\r
  //\r
  // Set mandatory weight and optional weight for adjacent vertices\r
  //\r
  for (VertexIndex = 0; VertexIndex < VertexCount - 1; VertexIndex++) {\r
    if (Vertices[VertexIndex].Type != DefaultType) {\r
      Weight[M (VertexIndex, VertexIndex + 1)] = 1;\r
      Weight[O (VertexIndex, VertexIndex + 1)] = 0;\r
    } else {\r
      Weight[M (VertexIndex, VertexIndex + 1)] = 0;\r
      Weight[O (VertexIndex, VertexIndex + 1)] = 1;\r
    }\r
  }\r
\r
  for (TypeCount = 2; TypeCount <= 3; TypeCount++) {\r
    for (Start = 0; Start < VertexCount; Start++) {\r
      for (Stop = Start + 2; Stop < VertexCount; Stop++) {\r
        ASSERT (Vertices[Stop].Address > Vertices[Start].Address);\r
        Length = Vertices[Stop].Address - Vertices[Start].Address;\r
        if (Length > Vertices[Start].Alignment) {\r
          //\r
          // Pickup a new Start when [Start, Stop) cannot be described by one MTRR.\r
          //\r
          break;\r
        }\r
\r
        if ((Weight[M (Start, Stop)] == MAX_WEIGHT) && MtrrLibIsPowerOfTwo (Length)) {\r
          if (MtrrLibGetNumberOfTypes (\r
                Ranges,\r
                RangeCount,\r
                Vertices[Start].Address,\r
                Vertices[Stop].Address - Vertices[Start].Address,\r
                &Type\r
                ) == TypeCount)\r
          {\r
            //\r
            // Update the Weight[Start, Stop] using subtractive path.\r
            //\r
            MtrrLibCalculateSubtractivePath (\r
              DefaultType,\r
              A0,\r
              Ranges,\r
              RangeCount,\r
              (UINT16)VertexCount,\r
              Vertices,\r
              Weight,\r
              Start,\r
              Stop,\r
              Type,\r
              TypeCount,\r
              NULL,\r
              0,\r
              NULL\r
              );\r
          } else if (TypeCount == 2) {\r
            //\r
            // Pick up a new Start when we expect 2-type range, but 3-type range is met.\r
            // Because no matter how Stop is increased, we always meet 3-type range.\r
            //\r
            break;\r
          }\r
        }\r
      }\r
    }\r
  }\r
\r
  Status = RETURN_SUCCESS;\r
  MtrrLibCalculateLeastMtrrs ((UINT16)VertexCount, Vertices, Weight, 0, (UINT16)VertexCount - 1, FALSE);\r
  Stop = (UINT16)VertexCount - 1;\r
  while (Stop != 0) {\r
    Start     = Vertices[Stop].Previous;\r
    TypeCount = MAX_UINT8;\r
    Type      = 0;\r
    if (Weight[M (Start, Stop)] != 0) {\r
      TypeCount = MtrrLibGetNumberOfTypes (Ranges, RangeCount, Vertices[Start].Address, Vertices[Stop].Address - Vertices[Start].Address, &Type);\r
      Status    = MtrrLibAppendVariableMtrr (\r
                    Mtrrs,\r
                    MtrrCapacity,\r
                    MtrrCount,\r
                    Vertices[Start].Address,\r
                    Vertices[Stop].Address - Vertices[Start].Address,\r
                    MtrrLibLowestType (Type)\r
                    );\r
      if (RETURN_ERROR (Status)) {\r
        break;\r
      }\r
    }\r
\r
    if (Start != Stop - 1) {\r
      //\r
      // substractive path\r
      //\r
      if (TypeCount == MAX_UINT8) {\r
        TypeCount = MtrrLibGetNumberOfTypes (\r
                      Ranges,\r
                      RangeCount,\r
                      Vertices[Start].Address,\r
                      Vertices[Stop].Address - Vertices[Start].Address,\r
                      &Type\r
                      );\r
      }\r
\r
      Status = MtrrLibCalculateSubtractivePath (\r
                 DefaultType,\r
                 A0,\r
                 Ranges,\r
                 RangeCount,\r
                 (UINT16)VertexCount,\r
                 Vertices,\r
                 Weight,\r
                 Start,\r
                 Stop,\r
                 Type,\r
                 TypeCount,\r
                 Mtrrs,\r
                 MtrrCapacity,\r
                 MtrrCount\r
                 );\r
      if (RETURN_ERROR (Status)) {\r
        break;\r
      }\r
    }\r
\r
    Stop = Start;\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Apply the fixed MTRR settings to memory range array.\r
\r
  @param Fixed             The fixed MTRR settings.\r
  @param Ranges            Return the memory range array holding memory type\r
                           settings for all memory address.\r
  @param RangeCapacity     The capacity of memory range array.\r
  @param RangeCount        Return the count of memory range.\r
\r
  @retval RETURN_SUCCESS          The memory range array is returned successfully.\r
  @retval RETURN_OUT_OF_RESOURCES The count of memory ranges exceeds capacity.\r
**/\r
RETURN_STATUS\r
MtrrLibApplyFixedMtrrs (\r
  IN     MTRR_FIXED_SETTINGS  *Fixed,\r
  IN OUT MTRR_MEMORY_RANGE    *Ranges,\r
  IN     UINTN                RangeCapacity,\r
  IN OUT UINTN                *RangeCount\r
  )\r
{\r
  RETURN_STATUS           Status;\r
  UINTN                   MsrIndex;\r
  UINTN                   Index;\r
  MTRR_MEMORY_CACHE_TYPE  MemoryType;\r
  UINT64                  Base;\r
\r
  Base = 0;\r
  for (MsrIndex = 0; MsrIndex < ARRAY_SIZE (mMtrrLibFixedMtrrTable); MsrIndex++) {\r
    ASSERT (Base == mMtrrLibFixedMtrrTable[MsrIndex].BaseAddress);\r
    for (Index = 0; Index < sizeof (UINT64); Index++) {\r
      MemoryType = (MTRR_MEMORY_CACHE_TYPE)((UINT8 *)(&Fixed->Mtrr[MsrIndex]))[Index];\r
      Status     = MtrrLibSetMemoryType (\r
                     Ranges,\r
                     RangeCapacity,\r
                     RangeCount,\r
                     Base,\r
                     mMtrrLibFixedMtrrTable[MsrIndex].Length,\r
                     MemoryType\r
                     );\r
      if (Status == RETURN_OUT_OF_RESOURCES) {\r
        return Status;\r
      }\r
\r
      Base += mMtrrLibFixedMtrrTable[MsrIndex].Length;\r
    }\r
  }\r
\r
  ASSERT (Base == BASE_1MB);\r
  return RETURN_SUCCESS;\r
}\r
\r
/**\r
  Apply the variable MTRR settings to memory range array.\r
\r
  @param VariableMtrr      The variable MTRR array.\r
  @param VariableMtrrCount The count of variable MTRRs.\r
  @param Ranges            Return the memory range array with new MTRR settings applied.\r
  @param RangeCapacity     The capacity of memory range array.\r
  @param RangeCount        Return the count of memory range.\r
\r
  @retval RETURN_SUCCESS          The memory range array is returned successfully.\r
  @retval RETURN_OUT_OF_RESOURCES The count of memory ranges exceeds capacity.\r
**/\r
RETURN_STATUS\r
MtrrLibApplyVariableMtrrs (\r
  IN     CONST MTRR_MEMORY_RANGE  *VariableMtrr,\r
  IN     UINT32                   VariableMtrrCount,\r
  IN OUT MTRR_MEMORY_RANGE        *Ranges,\r
  IN     UINTN                    RangeCapacity,\r
  IN OUT UINTN                    *RangeCount\r
  )\r
{\r
  RETURN_STATUS  Status;\r
  UINTN          Index;\r
\r
  //\r
  // WT > WB\r
  // UC > *\r
  // UC > * (except WB, UC) > WB\r
  //\r
\r
  //\r
  // 1. Set WB\r
  //\r
  for (Index = 0; Index < VariableMtrrCount; Index++) {\r
    if ((VariableMtrr[Index].Length != 0) && (VariableMtrr[Index].Type == CacheWriteBack)) {\r
      Status = MtrrLibSetMemoryType (\r
                 Ranges,\r
                 RangeCapacity,\r
                 RangeCount,\r
                 VariableMtrr[Index].BaseAddress,\r
                 VariableMtrr[Index].Length,\r
                 VariableMtrr[Index].Type\r
                 );\r
      if (Status == RETURN_OUT_OF_RESOURCES) {\r
        return Status;\r
      }\r
    }\r
  }\r
\r
  //\r
  // 2. Set other types than WB or UC\r
  //\r
  for (Index = 0; Index < VariableMtrrCount; Index++) {\r
    if ((VariableMtrr[Index].Length != 0) &&\r
        (VariableMtrr[Index].Type != CacheWriteBack) && (VariableMtrr[Index].Type != CacheUncacheable))\r
    {\r
      Status = MtrrLibSetMemoryType (\r
                 Ranges,\r
                 RangeCapacity,\r
                 RangeCount,\r
                 VariableMtrr[Index].BaseAddress,\r
                 VariableMtrr[Index].Length,\r
                 VariableMtrr[Index].Type\r
                 );\r
      if (Status == RETURN_OUT_OF_RESOURCES) {\r
        return Status;\r
      }\r
    }\r
  }\r
\r
  //\r
  // 3. Set UC\r
  //\r
  for (Index = 0; Index < VariableMtrrCount; Index++) {\r
    if ((VariableMtrr[Index].Length != 0) && (VariableMtrr[Index].Type == CacheUncacheable)) {\r
      Status = MtrrLibSetMemoryType (\r
                 Ranges,\r
                 RangeCapacity,\r
                 RangeCount,\r
                 VariableMtrr[Index].BaseAddress,\r
                 VariableMtrr[Index].Length,\r
                 VariableMtrr[Index].Type\r
                 );\r
      if (Status == RETURN_OUT_OF_RESOURCES) {\r
        return Status;\r
      }\r
    }\r
  }\r
\r
  return RETURN_SUCCESS;\r
}\r
\r
/**\r
  Return the memory type bit mask that's compatible to first type in the Ranges.\r
\r
  @param Ranges     Memory range array holding the memory type\r
                    settings for all memory address.\r
  @param RangeCount Count of memory ranges.\r
\r
  @return Compatible memory type bit mask.\r
**/\r
UINT8\r
MtrrLibGetCompatibleTypes (\r
  IN CONST MTRR_MEMORY_RANGE  *Ranges,\r
  IN UINTN                    RangeCount\r
  )\r
{\r
  ASSERT (RangeCount != 0);\r
\r
  switch (Ranges[0].Type) {\r
    case CacheWriteBack:\r
    case CacheWriteThrough:\r
      return (1 << CacheWriteBack) | (1 << CacheWriteThrough) | (1 << CacheUncacheable);\r
      break;\r
\r
    case CacheWriteCombining:\r
    case CacheWriteProtected:\r
      return (1 << Ranges[0].Type) | (1 << CacheUncacheable);\r
      break;\r
\r
    case CacheUncacheable:\r
      if (RangeCount == 1) {\r
        return (1 << CacheUncacheable);\r
      }\r
\r
      return MtrrLibGetCompatibleTypes (&Ranges[1], RangeCount - 1);\r
      break;\r
\r
    case CacheInvalid:\r
    default:\r
      ASSERT (FALSE);\r
      break;\r
  }\r
\r
  return 0;\r
}\r
\r
/**\r
  Overwrite the destination MTRR settings with the source MTRR settings.\r
  This routine is to make sure the modification to destination MTRR settings\r
  is as small as possible.\r
\r
  @param DstMtrrs     Destination MTRR settings.\r
  @param DstMtrrCount Count of destination MTRR settings.\r
  @param SrcMtrrs     Source MTRR settings.\r
  @param SrcMtrrCount Count of source MTRR settings.\r
  @param Modified     Flag array to indicate which destination MTRR setting is modified.\r
**/\r
VOID\r
MtrrLibMergeVariableMtrr (\r
  MTRR_MEMORY_RANGE  *DstMtrrs,\r
  UINT32             DstMtrrCount,\r
  MTRR_MEMORY_RANGE  *SrcMtrrs,\r
  UINT32             SrcMtrrCount,\r
  BOOLEAN            *Modified\r
  )\r
{\r
  UINT32  DstIndex;\r
  UINT32  SrcIndex;\r
\r
  ASSERT (SrcMtrrCount <= DstMtrrCount);\r
\r
  for (DstIndex = 0; DstIndex < DstMtrrCount; DstIndex++) {\r
    Modified[DstIndex] = FALSE;\r
\r
    if (DstMtrrs[DstIndex].Length == 0) {\r
      continue;\r
    }\r
\r
    for (SrcIndex = 0; SrcIndex < SrcMtrrCount; SrcIndex++) {\r
      if ((DstMtrrs[DstIndex].BaseAddress == SrcMtrrs[SrcIndex].BaseAddress) &&\r
          (DstMtrrs[DstIndex].Length == SrcMtrrs[SrcIndex].Length) &&\r
          (DstMtrrs[DstIndex].Type == SrcMtrrs[SrcIndex].Type))\r
      {\r
        break;\r
      }\r
    }\r
\r
    if (SrcIndex == SrcMtrrCount) {\r
      //\r
      // Remove the one from DstMtrrs which is not in SrcMtrrs\r
      //\r
      DstMtrrs[DstIndex].Length = 0;\r
      Modified[DstIndex]        = TRUE;\r
    } else {\r
      //\r
      // Remove the one from SrcMtrrs which is also in DstMtrrs\r
      //\r
      SrcMtrrs[SrcIndex].Length = 0;\r
    }\r
  }\r
\r
  //\r
  // Now valid MTRR only exists in either DstMtrrs or SrcMtrrs.\r
  // Merge MTRRs from SrcMtrrs to DstMtrrs\r
  //\r
  DstIndex = 0;\r
  for (SrcIndex = 0; SrcIndex < SrcMtrrCount; SrcIndex++) {\r
    if (SrcMtrrs[SrcIndex].Length != 0) {\r
      //\r
      // Find the empty slot in DstMtrrs\r
      //\r
      while (DstIndex < DstMtrrCount) {\r
        if (DstMtrrs[DstIndex].Length == 0) {\r
          break;\r
        }\r
\r
        DstIndex++;\r
      }\r
\r
      ASSERT (DstIndex < DstMtrrCount);\r
      CopyMem (&DstMtrrs[DstIndex], &SrcMtrrs[SrcIndex], sizeof (SrcMtrrs[0]));\r
      Modified[DstIndex] = TRUE;\r
    }\r
  }\r
}\r
\r
/**\r
  Calculate the variable MTRR settings for all memory ranges.\r
\r
  @param DefaultType          Default memory type.\r
  @param A0                   Alignment to use when base address is 0.\r
  @param Ranges               Memory range array holding the memory type\r
                              settings for all memory address.\r
  @param RangeCount           Count of memory ranges.\r
  @param Scratch              Scratch buffer to be used in MTRR calculation.\r
  @param ScratchSize          Pointer to the size of scratch buffer.\r
  @param VariableMtrr         Array holding all MTRR settings.\r
  @param VariableMtrrCapacity Capacity of the MTRR array.\r
  @param VariableMtrrCount    The count of MTRR settings in array.\r
\r
  @retval RETURN_SUCCESS          Variable MTRRs are allocated successfully.\r
  @retval RETURN_OUT_OF_RESOURCES Count of variable MTRRs exceeds capacity.\r
  @retval RETURN_BUFFER_TOO_SMALL The scratch buffer is too small for MTRR calculation.\r
                                  The required scratch buffer size is returned through ScratchSize.\r
**/\r
RETURN_STATUS\r
MtrrLibSetMemoryRanges (\r
  IN MTRR_MEMORY_CACHE_TYPE  DefaultType,\r
  IN UINT64                  A0,\r
  IN MTRR_MEMORY_RANGE       *Ranges,\r
  IN UINTN                   RangeCount,\r
  IN VOID                    *Scratch,\r
  IN OUT UINTN               *ScratchSize,\r
  OUT MTRR_MEMORY_RANGE      *VariableMtrr,\r
  IN UINT32                  VariableMtrrCapacity,\r
  OUT UINT32                 *VariableMtrrCount\r
  )\r
{\r
  RETURN_STATUS  Status;\r
  UINT32         Index;\r
  UINT64         Base0;\r
  UINT64         Base1;\r
  UINT64         Alignment;\r
  UINT8          CompatibleTypes;\r
  UINT64         Length;\r
  UINT32         End;\r
  UINTN          ActualScratchSize;\r
  UINTN          BiggestScratchSize;\r
\r
  *VariableMtrrCount = 0;\r
\r
  //\r
  // Since the whole ranges need multiple calls of MtrrLibCalculateMtrrs().\r
  // Each call needs different scratch buffer size.\r
  // When the provided scratch buffer size is not sufficient in any call,\r
  // set the GetActualScratchSize to TRUE, and following calls will only\r
  // calculate the actual scratch size for the caller.\r
  //\r
  BiggestScratchSize = 0;\r
\r
  for (Index = 0; Index < RangeCount;) {\r
    Base0 = Ranges[Index].BaseAddress;\r
\r
    //\r
    // Full step is optimal\r
    //\r
    while (Index < RangeCount) {\r
      ASSERT (Ranges[Index].BaseAddress == Base0);\r
      Alignment = MtrrLibBiggestAlignment (Base0, A0);\r
      while (Base0 + Alignment <= Ranges[Index].BaseAddress + Ranges[Index].Length) {\r
        if ((BiggestScratchSize <= *ScratchSize) && (Ranges[Index].Type != DefaultType)) {\r
          Status = MtrrLibAppendVariableMtrr (\r
                     VariableMtrr,\r
                     VariableMtrrCapacity,\r
                     VariableMtrrCount,\r
                     Base0,\r
                     Alignment,\r
                     Ranges[Index].Type\r
                     );\r
          if (RETURN_ERROR (Status)) {\r
            return Status;\r
          }\r
        }\r
\r
        Base0    += Alignment;\r
        Alignment = MtrrLibBiggestAlignment (Base0, A0);\r
      }\r
\r
      //\r
      // Remove the above range from Ranges[Index]\r
      //\r
      Ranges[Index].Length     -= Base0 - Ranges[Index].BaseAddress;\r
      Ranges[Index].BaseAddress = Base0;\r
      if (Ranges[Index].Length != 0) {\r
        break;\r
      } else {\r
        Index++;\r
      }\r
    }\r
\r
    if (Index == RangeCount) {\r
      break;\r
    }\r
\r
    //\r
    // Find continous ranges [Base0, Base1) which could be combined by MTRR.\r
    // Per SDM, the compatible types between[B0, B1) are:\r
    //   UC, *\r
    //   WB, WT\r
    //   UC, WB, WT\r
    //\r
    CompatibleTypes = MtrrLibGetCompatibleTypes (&Ranges[Index], RangeCount - Index);\r
\r
    End = Index; // End points to last one that matches the CompatibleTypes.\r
    while (End + 1 < RangeCount) {\r
      if (((1 << Ranges[End + 1].Type) & CompatibleTypes) == 0) {\r
        break;\r
      }\r
\r
      End++;\r
    }\r
\r
    Alignment = MtrrLibBiggestAlignment (Base0, A0);\r
    Length    = GetPowerOfTwo64 (Ranges[End].BaseAddress + Ranges[End].Length - Base0);\r
    Base1     = Base0 + MIN (Alignment, Length);\r
\r
    //\r
    // Base1 may not in Ranges[End]. Update End to the range Base1 belongs to.\r
    //\r
    End = Index;\r
    while (End + 1 < RangeCount) {\r
      if (Base1 <= Ranges[End + 1].BaseAddress) {\r
        break;\r
      }\r
\r
      End++;\r
    }\r
\r
    Length             = Ranges[End].Length;\r
    Ranges[End].Length = Base1 - Ranges[End].BaseAddress;\r
    ActualScratchSize  = *ScratchSize;\r
    Status             = MtrrLibCalculateMtrrs (\r
                           DefaultType,\r
                           A0,\r
                           &Ranges[Index],\r
                           End + 1 - Index,\r
                           Scratch,\r
                           &ActualScratchSize,\r
                           VariableMtrr,\r
                           VariableMtrrCapacity,\r
                           VariableMtrrCount\r
                           );\r
    if (Status == RETURN_BUFFER_TOO_SMALL) {\r
      BiggestScratchSize = MAX (BiggestScratchSize, ActualScratchSize);\r
      //\r
      // Ignore this error, because we need to calculate the biggest\r
      // scratch buffer size.\r
      //\r
      Status = RETURN_SUCCESS;\r
    }\r
\r
    if (RETURN_ERROR (Status)) {\r
      return Status;\r
    }\r
\r
    if (Length != Ranges[End].Length) {\r
      Ranges[End].BaseAddress = Base1;\r
      Ranges[End].Length      = Length - Ranges[End].Length;\r
      Index                   = End;\r
    } else {\r
      Index = End + 1;\r
    }\r
  }\r
\r
  if (*ScratchSize < BiggestScratchSize) {\r
    *ScratchSize = BiggestScratchSize;\r
    return RETURN_BUFFER_TOO_SMALL;\r
  }\r
\r
  return RETURN_SUCCESS;\r
}\r
\r
/**\r
  Set the below-1MB memory attribute to fixed MTRR buffer.\r
  Modified flag array indicates which fixed MTRR is modified.\r
\r
  @param [in, out] ClearMasks    The bits (when set) to clear in the fixed MTRR MSR.\r
  @param [in, out] OrMasks       The bits to set in the fixed MTRR MSR.\r
  @param [in]      BaseAddress   Base address.\r
  @param [in]      Length        Length.\r
  @param [in]      Type          Memory type.\r
\r
  @retval RETURN_SUCCESS      The memory attribute is set successfully.\r
  @retval RETURN_UNSUPPORTED  The requested range or cache type was invalid\r
                              for the fixed MTRRs.\r
**/\r
RETURN_STATUS\r
MtrrLibSetBelow1MBMemoryAttribute (\r
  IN OUT UINT64              *ClearMasks,\r
  IN OUT UINT64              *OrMasks,\r
  IN PHYSICAL_ADDRESS        BaseAddress,\r
  IN UINT64                  Length,\r
  IN MTRR_MEMORY_CACHE_TYPE  Type\r
  )\r
{\r
  RETURN_STATUS  Status;\r
  UINT32         MsrIndex;\r
  UINT64         ClearMask;\r
  UINT64         OrMask;\r
\r
  ASSERT (BaseAddress < BASE_1MB);\r
\r
  MsrIndex = (UINT32)-1;\r
  while ((BaseAddress < BASE_1MB) && (Length != 0)) {\r
    Status = MtrrLibProgramFixedMtrr (Type, &BaseAddress, &Length, &MsrIndex, &ClearMask, &OrMask);\r
    if (RETURN_ERROR (Status)) {\r
      return Status;\r
    }\r
\r
    ClearMasks[MsrIndex] = ClearMasks[MsrIndex] | ClearMask;\r
    OrMasks[MsrIndex]    = (OrMasks[MsrIndex] & ~ClearMask) | OrMask;\r
  }\r
\r
  return RETURN_SUCCESS;\r
}\r
\r
/**\r
  This function attempts to set the attributes into MTRR setting buffer for multiple memory ranges.\r
\r
  @param[in, out]  MtrrSetting  MTRR setting buffer to be set.\r
  @param[in]       Scratch      A temporary scratch buffer that is used to perform the calculation.\r
  @param[in, out]  ScratchSize  Pointer to the size in bytes of the scratch buffer.\r
                                It may be updated to the actual required size when the calculation\r
                                needs more scratch buffer.\r
  @param[in]       Ranges       Pointer to an array of MTRR_MEMORY_RANGE.\r
                                When range overlap happens, the last one takes higher priority.\r
                                When the function returns, either all the attributes are set successfully,\r
                                or none of them is set.\r
  @param[in]       RangeCount   Count of MTRR_MEMORY_RANGE.\r
\r
  @retval RETURN_SUCCESS            The attributes were set for all the memory ranges.\r
  @retval RETURN_INVALID_PARAMETER  Length in any range is zero.\r
  @retval RETURN_UNSUPPORTED        The processor does not support one or more bytes of the\r
                                    memory resource range specified by BaseAddress and Length in any range.\r
  @retval RETURN_UNSUPPORTED        The bit mask of attributes is not support for the memory resource\r
                                    range specified by BaseAddress and Length in any range.\r
  @retval RETURN_OUT_OF_RESOURCES   There are not enough system resources to modify the attributes of\r
                                    the memory resource ranges.\r
  @retval RETURN_ACCESS_DENIED      The attributes for the memory resource range specified by\r
                                    BaseAddress and Length cannot be modified.\r
  @retval RETURN_BUFFER_TOO_SMALL   The scratch buffer is too small for MTRR calculation.\r
**/\r
RETURN_STATUS\r
EFIAPI\r
MtrrSetMemoryAttributesInMtrrSettings (\r
  IN OUT MTRR_SETTINGS            *MtrrSetting,\r
  IN     VOID                     *Scratch,\r
  IN OUT UINTN                    *ScratchSize,\r
  IN     CONST MTRR_MEMORY_RANGE  *Ranges,\r
  IN     UINTN                    RangeCount\r
  )\r
{\r
  RETURN_STATUS  Status;\r
  UINT32         Index;\r
  UINT64         BaseAddress;\r
  UINT64         Length;\r
  BOOLEAN        Above1MbExist;\r
\r
  UINT64                  MtrrValidBitsMask;\r
  UINT64                  MtrrValidAddressMask;\r
  MTRR_MEMORY_CACHE_TYPE  DefaultType;\r
  MTRR_VARIABLE_SETTINGS  VariableSettings;\r
  MTRR_MEMORY_RANGE       WorkingRanges[2 * ARRAY_SIZE (MtrrSetting->Variables.Mtrr) + 2];\r
  UINTN                   WorkingRangeCount;\r
  BOOLEAN                 Modified;\r
  MTRR_VARIABLE_SETTING   VariableSetting;\r
  UINT32                  OriginalVariableMtrrCount;\r
  UINT32                  FirmwareVariableMtrrCount;\r
  UINT32                  WorkingVariableMtrrCount;\r
  MTRR_MEMORY_RANGE       OriginalVariableMtrr[ARRAY_SIZE (MtrrSetting->Variables.Mtrr)];\r
  MTRR_MEMORY_RANGE       WorkingVariableMtrr[ARRAY_SIZE (MtrrSetting->Variables.Mtrr)];\r
  BOOLEAN                 VariableSettingModified[ARRAY_SIZE (MtrrSetting->Variables.Mtrr)];\r
\r
  UINT64  ClearMasks[ARRAY_SIZE (mMtrrLibFixedMtrrTable)];\r
  UINT64  OrMasks[ARRAY_SIZE (mMtrrLibFixedMtrrTable)];\r
\r
  MTRR_CONTEXT  MtrrContext;\r
  BOOLEAN       MtrrContextValid;\r
\r
  Status = RETURN_SUCCESS;\r
  MtrrLibInitializeMtrrMask (&MtrrValidBitsMask, &MtrrValidAddressMask);\r
\r
  //\r
  // TRUE indicating the accordingly Variable setting needs modificaiton in OriginalVariableMtrr.\r
  //\r
  SetMem (VariableSettingModified, ARRAY_SIZE (VariableSettingModified), FALSE);\r
\r
  //\r
  // TRUE indicating the caller requests to set variable MTRRs.\r
  //\r
  Above1MbExist             = FALSE;\r
  OriginalVariableMtrrCount = 0;\r
\r
  //\r
  // 0. Dump the requests.\r
  //\r
  DEBUG_CODE_BEGIN ();\r
  DEBUG ((\r
    DEBUG_CACHE,\r
    "Mtrr: Set Mem Attribute to %a, ScratchSize = %x%a",\r
    (MtrrSetting == NULL) ? "Hardware" : "Buffer",\r
    *ScratchSize,\r
    (RangeCount <= 1) ? "," : "\n"\r
    ));\r
  for (Index = 0; Index < RangeCount; Index++) {\r
    DEBUG ((\r
      DEBUG_CACHE,\r
      " %a: [%016lx, %016lx)\n",\r
      mMtrrMemoryCacheTypeShortName[MIN (Ranges[Index].Type, CacheInvalid)],\r
      Ranges[Index].BaseAddress,\r
      Ranges[Index].BaseAddress + Ranges[Index].Length\r
      ));\r
  }\r
\r
  DEBUG_CODE_END ();\r
\r
  //\r
  // 1. Validate the parameters.\r
  //\r
  if (!IsMtrrSupported ()) {\r
    Status = RETURN_UNSUPPORTED;\r
    goto Exit;\r
  }\r
\r
  for (Index = 0; Index < RangeCount; Index++) {\r
    if (Ranges[Index].Length == 0) {\r
      Status = RETURN_INVALID_PARAMETER;\r
      goto Exit;\r
    }\r
\r
    if (((Ranges[Index].BaseAddress & ~MtrrValidAddressMask) != 0) ||\r
        ((((Ranges[Index].BaseAddress + Ranges[Index].Length) & ~MtrrValidAddressMask) != 0) &&\r
         ((Ranges[Index].BaseAddress + Ranges[Index].Length) != MtrrValidBitsMask + 1))\r
        )\r
    {\r
      //\r
      // Either the BaseAddress or the Limit doesn't follow the alignment requirement.\r
      // Note: It's still valid if Limit doesn't follow the alignment requirement but equals to MAX Address.\r
      //\r
      Status = RETURN_UNSUPPORTED;\r
      goto Exit;\r
    }\r
\r
    if ((Ranges[Index].Type != CacheUncacheable) &&\r
        (Ranges[Index].Type != CacheWriteCombining) &&\r
        (Ranges[Index].Type != CacheWriteThrough) &&\r
        (Ranges[Index].Type != CacheWriteProtected) &&\r
        (Ranges[Index].Type != CacheWriteBack))\r
    {\r
      Status = RETURN_INVALID_PARAMETER;\r
      goto Exit;\r
    }\r
\r
    if (Ranges[Index].BaseAddress + Ranges[Index].Length > BASE_1MB) {\r
      Above1MbExist = TRUE;\r
    }\r
  }\r
\r
  //\r
  // 2. Apply the above-1MB memory attribute settings.\r
  //\r
  if (Above1MbExist) {\r
    //\r
    // 2.1. Read all variable MTRRs and convert to Ranges.\r
    //\r
    OriginalVariableMtrrCount = GetVariableMtrrCountWorker ();\r
    MtrrGetVariableMtrrWorker (MtrrSetting, OriginalVariableMtrrCount, &VariableSettings);\r
    MtrrLibGetRawVariableRanges (\r
      &VariableSettings,\r
      OriginalVariableMtrrCount,\r
      MtrrValidBitsMask,\r
      MtrrValidAddressMask,\r
      OriginalVariableMtrr\r
      );\r
\r
    DefaultType                  = MtrrGetDefaultMemoryTypeWorker (MtrrSetting);\r
    WorkingRangeCount            = 1;\r
    WorkingRanges[0].BaseAddress = 0;\r
    WorkingRanges[0].Length      = MtrrValidBitsMask + 1;\r
    WorkingRanges[0].Type        = DefaultType;\r
\r
    Status = MtrrLibApplyVariableMtrrs (\r
               OriginalVariableMtrr,\r
               OriginalVariableMtrrCount,\r
               WorkingRanges,\r
               ARRAY_SIZE (WorkingRanges),\r
               &WorkingRangeCount\r
               );\r
    ASSERT_RETURN_ERROR (Status);\r
\r
    ASSERT (OriginalVariableMtrrCount >= PcdGet32 (PcdCpuNumberOfReservedVariableMtrrs));\r
    FirmwareVariableMtrrCount = OriginalVariableMtrrCount - PcdGet32 (PcdCpuNumberOfReservedVariableMtrrs);\r
    ASSERT (WorkingRangeCount <= 2 * FirmwareVariableMtrrCount + 1);\r
\r
    //\r
    // 2.2. Force [0, 1M) to UC, so that it doesn't impact subtraction algorithm.\r
    //\r
    Status = MtrrLibSetMemoryType (\r
               WorkingRanges,\r
               ARRAY_SIZE (WorkingRanges),\r
               &WorkingRangeCount,\r
               0,\r
               SIZE_1MB,\r
               CacheUncacheable\r
               );\r
    ASSERT (Status != RETURN_OUT_OF_RESOURCES);\r
\r
    //\r
    // 2.3. Apply the new memory attribute settings to Ranges.\r
    //\r
    Modified = FALSE;\r
    for (Index = 0; Index < RangeCount; Index++) {\r
      BaseAddress = Ranges[Index].BaseAddress;\r
      Length      = Ranges[Index].Length;\r
      if (BaseAddress < BASE_1MB) {\r
        if (Length <= BASE_1MB - BaseAddress) {\r
          continue;\r
        }\r
\r
        Length     -= BASE_1MB - BaseAddress;\r
        BaseAddress = BASE_1MB;\r
      }\r
\r
      Status = MtrrLibSetMemoryType (\r
                 WorkingRanges,\r
                 ARRAY_SIZE (WorkingRanges),\r
                 &WorkingRangeCount,\r
                 BaseAddress,\r
                 Length,\r
                 Ranges[Index].Type\r
                 );\r
      if (Status == RETURN_ALREADY_STARTED) {\r
        Status = RETURN_SUCCESS;\r
      } else if (Status == RETURN_OUT_OF_RESOURCES) {\r
        goto Exit;\r
      } else {\r
        ASSERT_RETURN_ERROR (Status);\r
        Modified = TRUE;\r
      }\r
    }\r
\r
    if (Modified) {\r
      //\r
      // 2.4. Calculate the Variable MTRR settings based on the Ranges.\r
      //      Buffer Too Small may be returned if the scratch buffer size is insufficient.\r
      //\r
      Status = MtrrLibSetMemoryRanges (\r
                 DefaultType,\r
                 LShiftU64 (1, (UINTN)HighBitSet64 (MtrrValidBitsMask)),\r
                 WorkingRanges,\r
                 WorkingRangeCount,\r
                 Scratch,\r
                 ScratchSize,\r
                 WorkingVariableMtrr,\r
                 FirmwareVariableMtrrCount + 1,\r
                 &WorkingVariableMtrrCount\r
                 );\r
      if (RETURN_ERROR (Status)) {\r
        goto Exit;\r
      }\r
\r
      //\r
      // 2.5. Remove the [0, 1MB) MTRR if it still exists (not merged with other range)\r
      //\r
      for (Index = 0; Index < WorkingVariableMtrrCount; Index++) {\r
        if ((WorkingVariableMtrr[Index].BaseAddress == 0) && (WorkingVariableMtrr[Index].Length == SIZE_1MB)) {\r
          ASSERT (WorkingVariableMtrr[Index].Type == CacheUncacheable);\r
          WorkingVariableMtrrCount--;\r
          CopyMem (\r
            &WorkingVariableMtrr[Index],\r
            &WorkingVariableMtrr[Index + 1],\r
            (WorkingVariableMtrrCount - Index) * sizeof (WorkingVariableMtrr[0])\r
            );\r
          break;\r
        }\r
      }\r
\r
      if (WorkingVariableMtrrCount > FirmwareVariableMtrrCount) {\r
        Status = RETURN_OUT_OF_RESOURCES;\r
        goto Exit;\r
      }\r
\r
      //\r
      // 2.6. Merge the WorkingVariableMtrr to OriginalVariableMtrr\r
      //      Make sure least modification is made to OriginalVariableMtrr.\r
      //\r
      MtrrLibMergeVariableMtrr (\r
        OriginalVariableMtrr,\r
        OriginalVariableMtrrCount,\r
        WorkingVariableMtrr,\r
        WorkingVariableMtrrCount,\r
        VariableSettingModified\r
        );\r
    }\r
  }\r
\r
  //\r
  // 3. Apply the below-1MB memory attribute settings.\r
  //\r
  // (Value & ~0 | 0) still equals to (Value)\r
  //\r
  ZeroMem (ClearMasks, sizeof (ClearMasks));\r
  ZeroMem (OrMasks, sizeof (OrMasks));\r
  for (Index = 0; Index < RangeCount; Index++) {\r
    if (Ranges[Index].BaseAddress >= BASE_1MB) {\r
      continue;\r
    }\r
\r
    Status = MtrrLibSetBelow1MBMemoryAttribute (\r
               ClearMasks,\r
               OrMasks,\r
               Ranges[Index].BaseAddress,\r
               Ranges[Index].Length,\r
               Ranges[Index].Type\r
               );\r
    if (RETURN_ERROR (Status)) {\r
      goto Exit;\r
    }\r
  }\r
\r
  MtrrContextValid = FALSE;\r
  //\r
  // 4. Write fixed MTRRs that have been modified\r
  //\r
  for (Index = 0; Index < ARRAY_SIZE (ClearMasks); Index++) {\r
    if (ClearMasks[Index] != 0) {\r
      if (MtrrSetting != NULL) {\r
        MtrrSetting->Fixed.Mtrr[Index] = (MtrrSetting->Fixed.Mtrr[Index] & ~ClearMasks[Index]) | OrMasks[Index];\r
      } else {\r
        if (!MtrrContextValid) {\r
          MtrrLibPreMtrrChange (&MtrrContext);\r
          MtrrContextValid = TRUE;\r
        }\r
\r
        AsmMsrAndThenOr64 (mMtrrLibFixedMtrrTable[Index].Msr, ~ClearMasks[Index], OrMasks[Index]);\r
      }\r
    }\r
  }\r
\r
  //\r
  // 5. Write variable MTRRs that have been modified\r
  //\r
  for (Index = 0; Index < OriginalVariableMtrrCount; Index++) {\r
    if (VariableSettingModified[Index]) {\r
      if (OriginalVariableMtrr[Index].Length != 0) {\r
        VariableSetting.Base = (OriginalVariableMtrr[Index].BaseAddress & MtrrValidAddressMask)\r
                               | (UINT8)OriginalVariableMtrr[Index].Type;\r
        VariableSetting.Mask = ((~(OriginalVariableMtrr[Index].Length - 1)) & MtrrValidAddressMask) | BIT11;\r
      } else {\r
        VariableSetting.Base = 0;\r
        VariableSetting.Mask = 0;\r
      }\r
\r
      if (MtrrSetting != NULL) {\r
        CopyMem (&MtrrSetting->Variables.Mtrr[Index], &VariableSetting, sizeof (VariableSetting));\r
      } else {\r
        if (!MtrrContextValid) {\r
          MtrrLibPreMtrrChange (&MtrrContext);\r
          MtrrContextValid = TRUE;\r
        }\r
\r
        AsmWriteMsr64 (\r
          MSR_IA32_MTRR_PHYSBASE0 + (Index << 1),\r
          VariableSetting.Base\r
          );\r
        AsmWriteMsr64 (\r
          MSR_IA32_MTRR_PHYSMASK0 + (Index << 1),\r
          VariableSetting.Mask\r
          );\r
      }\r
    }\r
  }\r
\r
  if (MtrrSetting != NULL) {\r
    ((MSR_IA32_MTRR_DEF_TYPE_REGISTER *)&MtrrSetting->MtrrDefType)->Bits.E  = 1;\r
    ((MSR_IA32_MTRR_DEF_TYPE_REGISTER *)&MtrrSetting->MtrrDefType)->Bits.FE = 1;\r
  } else {\r
    if (MtrrContextValid) {\r
      MtrrLibPostMtrrChange (&MtrrContext);\r
    }\r
  }\r
\r
Exit:\r
  DEBUG ((DEBUG_CACHE, "  Result = %r\n", Status));\r
  if (!RETURN_ERROR (Status)) {\r
    MtrrDebugPrintAllMtrrsWorker (MtrrSetting);\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  This function attempts to set the attributes into MTRR setting buffer for a memory range.\r
\r
  @param[in, out]  MtrrSetting  MTRR setting buffer to be set.\r
  @param[in]       BaseAddress  The physical address that is the start address\r
                                of a memory range.\r
  @param[in]       Length       The size in bytes of the memory range.\r
  @param[in]       Attribute    The bit mask of attributes to set for the\r
                                memory range.\r
\r
  @retval RETURN_SUCCESS            The attributes were set for the memory range.\r
  @retval RETURN_INVALID_PARAMETER  Length is zero.\r
  @retval RETURN_UNSUPPORTED        The processor does not support one or more bytes of the\r
                                    memory resource range specified by BaseAddress and Length.\r
  @retval RETURN_UNSUPPORTED        The bit mask of attributes is not support for the memory resource\r
                                    range specified by BaseAddress and Length.\r
  @retval RETURN_ACCESS_DENIED      The attributes for the memory resource range specified by\r
                                    BaseAddress and Length cannot be modified.\r
  @retval RETURN_OUT_OF_RESOURCES   There are not enough system resources to modify the attributes of\r
                                    the memory resource range.\r
                                    Multiple memory range attributes setting by calling this API multiple\r
                                    times may fail with status RETURN_OUT_OF_RESOURCES. It may not mean\r
                                    the number of CPU MTRRs are too small to set such memory attributes.\r
                                    Pass the multiple memory range attributes to one call of\r
                                    MtrrSetMemoryAttributesInMtrrSettings() may succeed.\r
  @retval RETURN_BUFFER_TOO_SMALL   The fixed internal scratch buffer is too small for MTRR calculation.\r
                                    Caller should use MtrrSetMemoryAttributesInMtrrSettings() to specify\r
                                    external scratch buffer.\r
**/\r
RETURN_STATUS\r
EFIAPI\r
MtrrSetMemoryAttributeInMtrrSettings (\r
  IN OUT MTRR_SETTINGS       *MtrrSetting,\r
  IN PHYSICAL_ADDRESS        BaseAddress,\r
  IN UINT64                  Length,\r
  IN MTRR_MEMORY_CACHE_TYPE  Attribute\r
  )\r
{\r
  UINT8              Scratch[SCRATCH_BUFFER_SIZE];\r
  UINTN              ScratchSize;\r
  MTRR_MEMORY_RANGE  Range;\r
\r
  Range.BaseAddress = BaseAddress;\r
  Range.Length      = Length;\r
  Range.Type        = Attribute;\r
  ScratchSize       = sizeof (Scratch);\r
  return MtrrSetMemoryAttributesInMtrrSettings (MtrrSetting, Scratch, &ScratchSize, &Range, 1);\r
}\r
\r
/**\r
  This function attempts to set the attributes for a memory range.\r
\r
  @param[in]  BaseAddress        The physical address that is the start\r
                                 address of a memory range.\r
  @param[in]  Length             The size in bytes of the memory range.\r
  @param[in]  Attributes         The bit mask of attributes to set for the\r
                                 memory range.\r
\r
  @retval RETURN_SUCCESS            The attributes were set for the memory\r
                                    range.\r
  @retval RETURN_INVALID_PARAMETER  Length is zero.\r
  @retval RETURN_UNSUPPORTED        The processor does not support one or\r
                                    more bytes of the memory resource range\r
                                    specified by BaseAddress and Length.\r
  @retval RETURN_UNSUPPORTED        The bit mask of attributes is not support\r
                                    for the memory resource range specified\r
                                    by BaseAddress and Length.\r
  @retval RETURN_ACCESS_DENIED      The attributes for the memory resource\r
                                    range specified by BaseAddress and Length\r
                                    cannot be modified.\r
  @retval RETURN_OUT_OF_RESOURCES   There are not enough system resources to\r
                                    modify the attributes of the memory\r
                                    resource range.\r
                                    Multiple memory range attributes setting by calling this API multiple\r
                                    times may fail with status RETURN_OUT_OF_RESOURCES. It may not mean\r
                                    the number of CPU MTRRs are too small to set such memory attributes.\r
                                    Pass the multiple memory range attributes to one call of\r
                                    MtrrSetMemoryAttributesInMtrrSettings() may succeed.\r
  @retval RETURN_BUFFER_TOO_SMALL   The fixed internal scratch buffer is too small for MTRR calculation.\r
                                    Caller should use MtrrSetMemoryAttributesInMtrrSettings() to specify\r
                                    external scratch buffer.\r
**/\r
RETURN_STATUS\r
EFIAPI\r
MtrrSetMemoryAttribute (\r
  IN PHYSICAL_ADDRESS        BaseAddress,\r
  IN UINT64                  Length,\r
  IN MTRR_MEMORY_CACHE_TYPE  Attribute\r
  )\r
{\r
  return MtrrSetMemoryAttributeInMtrrSettings (NULL, BaseAddress, Length, Attribute);\r
}\r
\r
/**\r
  Worker function setting variable MTRRs\r
\r
  @param[in]  VariableSettings   A buffer to hold variable MTRRs content.\r
\r
**/\r
VOID\r
MtrrSetVariableMtrrWorker (\r
  IN MTRR_VARIABLE_SETTINGS  *VariableSettings\r
  )\r
{\r
  UINT32  Index;\r
  UINT32  VariableMtrrCount;\r
\r
  VariableMtrrCount = GetVariableMtrrCountWorker ();\r
  ASSERT (VariableMtrrCount <= ARRAY_SIZE (VariableSettings->Mtrr));\r
\r
  for (Index = 0; Index < VariableMtrrCount; Index++) {\r
    AsmWriteMsr64 (\r
      MSR_IA32_MTRR_PHYSBASE0 + (Index << 1),\r
      VariableSettings->Mtrr[Index].Base\r
      );\r
    AsmWriteMsr64 (\r
      MSR_IA32_MTRR_PHYSMASK0 + (Index << 1),\r
      VariableSettings->Mtrr[Index].Mask\r
      );\r
  }\r
}\r
\r
/**\r
  Worker function setting fixed MTRRs\r
\r
  @param[in]  FixedSettings  A buffer to hold fixed MTRRs content.\r
\r
**/\r
VOID\r
MtrrSetFixedMtrrWorker (\r
  IN MTRR_FIXED_SETTINGS  *FixedSettings\r
  )\r
{\r
  UINT32  Index;\r
\r
  for (Index = 0; Index < MTRR_NUMBER_OF_FIXED_MTRR; Index++) {\r
    AsmWriteMsr64 (\r
      mMtrrLibFixedMtrrTable[Index].Msr,\r
      FixedSettings->Mtrr[Index]\r
      );\r
  }\r
}\r
\r
/**\r
  This function gets the content in all MTRRs (variable and fixed)\r
\r
  @param[out]  MtrrSetting  A buffer to hold all MTRRs content.\r
\r
  @retval the pointer of MtrrSetting\r
\r
**/\r
MTRR_SETTINGS *\r
EFIAPI\r
MtrrGetAllMtrrs (\r
  OUT MTRR_SETTINGS  *MtrrSetting\r
  )\r
{\r
  if (!IsMtrrSupported ()) {\r
    return MtrrSetting;\r
  }\r
\r
  //\r
  // Get fixed MTRRs\r
  //\r
  MtrrGetFixedMtrrWorker (&MtrrSetting->Fixed);\r
\r
  //\r
  // Get variable MTRRs\r
  //\r
  MtrrGetVariableMtrrWorker (\r
    NULL,\r
    GetVariableMtrrCountWorker (),\r
    &MtrrSetting->Variables\r
    );\r
\r
  //\r
  // Get MTRR_DEF_TYPE value\r
  //\r
  MtrrSetting->MtrrDefType = AsmReadMsr64 (MSR_IA32_MTRR_DEF_TYPE);\r
\r
  return MtrrSetting;\r
}\r
\r
/**\r
  This function sets all MTRRs (variable and fixed)\r
\r
  @param[in]  MtrrSetting  A buffer holding all MTRRs content.\r
\r
  @retval The pointer of MtrrSetting\r
\r
**/\r
MTRR_SETTINGS *\r
EFIAPI\r
MtrrSetAllMtrrs (\r
  IN MTRR_SETTINGS  *MtrrSetting\r
  )\r
{\r
  MTRR_CONTEXT  MtrrContext;\r
\r
  if (!IsMtrrSupported ()) {\r
    return MtrrSetting;\r
  }\r
\r
  MtrrLibPreMtrrChange (&MtrrContext);\r
\r
  //\r
  // Set fixed MTRRs\r
  //\r
  MtrrSetFixedMtrrWorker (&MtrrSetting->Fixed);\r
\r
  //\r
  // Set variable MTRRs\r
  //\r
  MtrrSetVariableMtrrWorker (&MtrrSetting->Variables);\r
\r
  //\r
  // Set MTRR_DEF_TYPE value\r
  //\r
  AsmWriteMsr64 (MSR_IA32_MTRR_DEF_TYPE, MtrrSetting->MtrrDefType);\r
\r
  MtrrLibPostMtrrChangeEnableCache (&MtrrContext);\r
\r
  return MtrrSetting;\r
}\r
\r
/**\r
  Checks if MTRR is supported.\r
\r
  @retval TRUE  MTRR is supported.\r
  @retval FALSE MTRR is not supported.\r
\r
**/\r
BOOLEAN\r
EFIAPI\r
IsMtrrSupported (\r
  VOID\r
  )\r
{\r
  CPUID_VERSION_INFO_EDX     Edx;\r
  MSR_IA32_MTRRCAP_REGISTER  MtrrCap;\r
\r
  //\r
  // Check CPUID(1).EDX[12] for MTRR capability\r
  //\r
  AsmCpuid (CPUID_VERSION_INFO, NULL, NULL, NULL, &Edx.Uint32);\r
  if (Edx.Bits.MTRR == 0) {\r
    return FALSE;\r
  }\r
\r
  //\r
  // Check number of variable MTRRs and fixed MTRRs existence.\r
  // If number of variable MTRRs is zero, or fixed MTRRs do not\r
  // exist, return false.\r
  //\r
  MtrrCap.Uint64 = AsmReadMsr64 (MSR_IA32_MTRRCAP);\r
  if ((MtrrCap.Bits.VCNT == 0) || (MtrrCap.Bits.FIX == 0)) {\r
    return FALSE;\r
  }\r
\r
  return TRUE;\r
}\r
\r
/**\r
  Worker function prints all MTRRs for debugging.\r
\r
  If MtrrSetting is not NULL, print MTRR settings from input MTRR\r
  settings buffer.\r
  If MtrrSetting is NULL, print MTRR settings from MTRRs.\r
\r
  @param  MtrrSetting    A buffer holding all MTRRs content.\r
**/\r
VOID\r
MtrrDebugPrintAllMtrrsWorker (\r
  IN MTRR_SETTINGS  *MtrrSetting\r
  )\r
{\r
  DEBUG_CODE_BEGIN ();\r
  MTRR_SETTINGS      LocalMtrrs;\r
  MTRR_SETTINGS      *Mtrrs;\r
  UINTN              Index;\r
  UINTN              RangeCount;\r
  UINT64             MtrrValidBitsMask;\r
  UINT64             MtrrValidAddressMask;\r
  UINT32             VariableMtrrCount;\r
  BOOLEAN            ContainVariableMtrr;\r
  MTRR_MEMORY_RANGE  Ranges[\r
                            ARRAY_SIZE (mMtrrLibFixedMtrrTable) * sizeof (UINT64) + 2 * ARRAY_SIZE (Mtrrs->Variables.Mtrr) + 1\r
  ];\r
  MTRR_MEMORY_RANGE  RawVariableRanges[ARRAY_SIZE (Mtrrs->Variables.Mtrr)];\r
\r
  if (!IsMtrrSupported ()) {\r
    return;\r
  }\r
\r
  VariableMtrrCount = GetVariableMtrrCountWorker ();\r
\r
  if (MtrrSetting != NULL) {\r
    Mtrrs = MtrrSetting;\r
  } else {\r
    MtrrGetAllMtrrs (&LocalMtrrs);\r
    Mtrrs = &LocalMtrrs;\r
  }\r
\r
  //\r
  // Dump RAW MTRR contents\r
  //\r
  DEBUG ((DEBUG_CACHE, "MTRR Settings:\n"));\r
  DEBUG ((DEBUG_CACHE, "=============\n"));\r
  DEBUG ((DEBUG_CACHE, "MTRR Default Type: %016lx\n", Mtrrs->MtrrDefType));\r
  for (Index = 0; Index < ARRAY_SIZE (mMtrrLibFixedMtrrTable); Index++) {\r
    DEBUG ((DEBUG_CACHE, "Fixed MTRR[%02d]   : %016lx\n", Index, Mtrrs->Fixed.Mtrr[Index]));\r
  }\r
\r
  ContainVariableMtrr = FALSE;\r
  for (Index = 0; Index < VariableMtrrCount; Index++) {\r
    if ((Mtrrs->Variables.Mtrr[Index].Mask & BIT11) == 0) {\r
      //\r
      // If mask is not valid, then do not display range\r
      //\r
      continue;\r
    }\r
\r
    ContainVariableMtrr = TRUE;\r
    DEBUG ((\r
      DEBUG_CACHE,\r
      "Variable MTRR[%02d]: Base=%016lx Mask=%016lx\n",\r
      Index,\r
      Mtrrs->Variables.Mtrr[Index].Base,\r
      Mtrrs->Variables.Mtrr[Index].Mask\r
      ));\r
  }\r
\r
  if (!ContainVariableMtrr) {\r
    DEBUG ((DEBUG_CACHE, "Variable MTRR    : None.\n"));\r
  }\r
\r
  DEBUG ((DEBUG_CACHE, "\n"));\r
\r
  //\r
  // Dump MTRR setting in ranges\r
  //\r
  DEBUG ((DEBUG_CACHE, "Memory Ranges:\n"));\r
  DEBUG ((DEBUG_CACHE, "====================================\n"));\r
  MtrrLibInitializeMtrrMask (&MtrrValidBitsMask, &MtrrValidAddressMask);\r
  Ranges[0].BaseAddress = 0;\r
  Ranges[0].Length      = MtrrValidBitsMask + 1;\r
  Ranges[0].Type        = MtrrGetDefaultMemoryTypeWorker (Mtrrs);\r
  RangeCount            = 1;\r
\r
  MtrrLibGetRawVariableRanges (\r
    &Mtrrs->Variables,\r
    VariableMtrrCount,\r
    MtrrValidBitsMask,\r
    MtrrValidAddressMask,\r
    RawVariableRanges\r
    );\r
  MtrrLibApplyVariableMtrrs (\r
    RawVariableRanges,\r
    VariableMtrrCount,\r
    Ranges,\r
    ARRAY_SIZE (Ranges),\r
    &RangeCount\r
    );\r
\r
  MtrrLibApplyFixedMtrrs (&Mtrrs->Fixed, Ranges, ARRAY_SIZE (Ranges), &RangeCount);\r
\r
  for (Index = 0; Index < RangeCount; Index++) {\r
    DEBUG ((\r
      DEBUG_CACHE,\r
      "%a:%016lx-%016lx\n",\r
      mMtrrMemoryCacheTypeShortName[Ranges[Index].Type],\r
      Ranges[Index].BaseAddress,\r
      Ranges[Index].BaseAddress + Ranges[Index].Length - 1\r
      ));\r
  }\r
\r
  DEBUG_CODE_END ();\r
}\r
\r
/**\r
  This function prints all MTRRs for debugging.\r
**/\r
VOID\r
EFIAPI\r
MtrrDebugPrintAllMtrrs (\r
  VOID\r
  )\r
{\r
  MtrrDebugPrintAllMtrrsWorker (NULL);\r
}\r