[mirror_edk2.git] / Vlv2TbltDevicePkg / PlatformInitPei / MemoryPeim.c

/** @file\r
\r
  Copyright (c) 2004  - 2016, Intel Corporation. All rights reserved.<BR>\r
                                                                                   \r\r
  This program and the accompanying materials are licensed and made available under\r\r
  the terms and conditions of the BSD License that accompanies this distribution.  \r\r
  The full text of the license may be found at                                     \r\r
  http://opensource.org/licenses/bsd-license.php.                                  \r\r
                                                                                   \r\r
  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,            \r\r
  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.    \r\r
                                                                                   \r\r
\r
Module Name:\r
\r
\r
  MemoryPeim.c\r
\r
Abstract:\r
\r
  Tiano PEIM to provide the platform support functionality.\r
  This file implements the Platform Memory Range PPI\r
\r
--*/\r
\r
#include "PlatformEarlyInit.h"\r
\r
//\r
// Need min. of 48MB PEI phase\r
//\r
#define  PEI_MIN_MEMORY_SIZE               (6 * 0x800000)\r
#define  PEI_RECOVERY_MIN_MEMORY_SIZE      (6 * 0x800000)\r
\r
//\r
// This is the memory needed for PEI to start up DXE.\r
//\r
// Over-estimating this size will lead to higher fragmentation\r
// of main memory.  Under-estimation of this will cause catastrophic\r
// failure of PEI to load DXE.  Generally, the failure may only be\r
// realized during capsule updates.\r
//\r
#define PRERESERVED_PEI_MEMORY ( \\r
  EFI_SIZE_TO_PAGES (3 * 0x800000)   /* PEI Core memory based stack          */ \\r
  )\r
\r
EFI_MEMORY_TYPE_INFORMATION mDefaultMemoryTypeInformation[] = {\r
  { EfiACPIReclaimMemory,       0x40  },    // 0x40 pages = 256k for ASL\r
  { EfiACPIMemoryNVS,           0x100 },    // 0x100 pages = 1 MB for S3, SMM, HII, etc\r
  { EfiReservedMemoryType,      0x600 },    // 48k for BIOS Reserved\r
  { EfiMemoryMappedIO,          0     },\r
  { EfiMemoryMappedIOPortSpace, 0     },\r
  { EfiPalCode,                 0     },\r
  { EfiRuntimeServicesCode,     0x200 },\r
  { EfiRuntimeServicesData,     0x100 },\r
  { EfiLoaderCode,              0x100 },\r
  { EfiLoaderData,              0x100 },\r
  { EfiBootServicesCode,        0x800 },\r
  { EfiBootServicesData,        0x2500},\r
  { EfiConventionalMemory,      0     },\r
  { EfiUnusableMemory,          0     },\r
  { EfiMaxMemoryType,           0     }\r
};\r
\r
STATIC\r
EFI_STATUS\r
GetMemorySize (\r
  IN  CONST EFI_PEI_SERVICES    **PeiServices,\r
  OUT UINT64              *LowMemoryLength,\r
  OUT UINT64              *HighMemoryLength\r
  );\r
\r
\r
\r
EFI_STATUS\r
EFIAPI\r
SetPeiCacheMode (\r
  IN  CONST EFI_PEI_SERVICES    **PeiServices\r
  )\r
{\r
  EFI_STATUS              Status;\r
  PEI_CACHE_PPI           *CachePpi;\r
\r
  EFI_BOOT_MODE           BootMode;\r
  UINT64                  MemoryLength;\r
  UINT64                  MemOverflow;\r
  UINT64                  MemoryLengthUc;\r
  UINT64                  MaxMemoryLength;\r
  UINT64                  LowMemoryLength;\r
  UINT64                  HighMemoryLength;\r
  UINT8                   Index;\r
  MTRR_SETTINGS           MtrrSetting;\r
\r
  //\r
  // Load Cache PPI\r
  //\r
  Status = (**PeiServices).LocatePpi (\r
             PeiServices,\r
             &gPeiCachePpiGuid,    // GUID\r
             0,                    // Instance\r
             NULL,                 // EFI_PEI_PPI_DESCRIPTOR\r
             (void **)&CachePpi             // PPI\r
             );\r
  if (!EFI_ERROR(Status)) {\r
    //\r
    // Clear the CAR Settings (Default Cache Type => UC)\r
    //\r
    DEBUG ((EFI_D_INFO, "Reset cache attribute and disable CAR. \n"));\r
    CachePpi->ResetCache(\r
                (EFI_PEI_SERVICES**)PeiServices,\r
                CachePpi\r
                );\r
 }\r
\r
\r
  //\r
  // Variable initialization\r
  //\r
  LowMemoryLength = 0;\r
  HighMemoryLength = 0;\r
  MemoryLengthUc = 0;\r
\r
  Status = (*PeiServices)->GetBootMode (\r
                             PeiServices,\r
                             &BootMode\r
                             );\r
\r
  //\r
  // Determine memory usage\r
  //\r
  GetMemorySize (\r
    PeiServices,\r
    &LowMemoryLength,\r
    &HighMemoryLength\r
    );\r
\r
  LowMemoryLength  = (EFI_PHYSICAL_ADDRESS)MmPci32( 0, 0, 2, 0, 0x70);\r
  LowMemoryLength   &=  0xFFF00000ULL;\r
\r
  MaxMemoryLength = LowMemoryLength;\r
\r
  //\r
  // Round up to nearest 256MB with high memory and 64MB w/o high memory\r
  //\r
  if (HighMemoryLength != 0 ) {\r
    MemOverflow = (LowMemoryLength & 0x0fffffff);\r
    if (MemOverflow != 0) {\r
      MaxMemoryLength = LowMemoryLength + (0x10000000 - MemOverflow);\r
    }\r
  } else {\r
    MemOverflow = (LowMemoryLength & 0x03ffffff);\r
    if (MemOverflow != 0) {\r
      MaxMemoryLength = LowMemoryLength + (0x4000000 - MemOverflow);\r
    }\r
  }\r
\r
  ZeroMem (&MtrrSetting, sizeof(MTRR_SETTINGS));\r
  for (Index = 0; Index < 2; Index++) {\r
    MtrrSetting.Fixed.Mtrr[Index]=0x0606060606060606;\r
   }\r
  for (Index = 2; Index < 11; Index++) {\r
    MtrrSetting.Fixed.Mtrr[Index]=0x0505050505050505;\r
   }\r
\r
  //\r
  // Cache the flash area to improve the boot performance in PEI phase\r
  //\r
  Index = 0;\r
  MtrrSetting.Variables.Mtrr[0].Base = (FixedPcdGet32 (PcdFlashAreaBaseAddress) | CacheWriteProtected);\r
  MtrrSetting.Variables.Mtrr[0].Mask = ((~((UINT64)(FixedPcdGet32 (PcdFlashAreaSize) - 1))) & MTRR_LIB_CACHE_VALID_ADDRESS) | MTRR_LIB_CACHE_MTRR_ENABLED;\r
  Index ++;\r
\r
  MemOverflow =0;\r
  while (MaxMemoryLength > MemOverflow){\r
    MtrrSetting.Variables.Mtrr[Index].Base = (MemOverflow & MTRR_LIB_CACHE_VALID_ADDRESS) | CacheWriteBack;\r
    MemoryLength = MaxMemoryLength - MemOverflow;\r
    MemoryLength = GetPowerOfTwo64 (MemoryLength);\r
    MtrrSetting.Variables.Mtrr[Index].Mask = ((~(MemoryLength - 1)) & MTRR_LIB_CACHE_VALID_ADDRESS) | MTRR_LIB_CACHE_MTRR_ENABLED;\r
\r
    MemOverflow += MemoryLength;\r
    Index++;\r
  }\r
\r
  MemoryLength = LowMemoryLength;\r
\r
  while (MaxMemoryLength != MemoryLength) {\r
    MemoryLengthUc = GetPowerOfTwo64 (MaxMemoryLength - MemoryLength);\r
\r
    MtrrSetting.Variables.Mtrr[Index].Base = ((MaxMemoryLength - MemoryLengthUc) & MTRR_LIB_CACHE_VALID_ADDRESS) | CacheUncacheable;\r
    MtrrSetting.Variables.Mtrr[Index].Mask= ((~(MemoryLengthUc   - 1)) & MTRR_LIB_CACHE_VALID_ADDRESS) | MTRR_LIB_CACHE_MTRR_ENABLED;\r
    MaxMemoryLength -= MemoryLengthUc;\r
    Index++;\r
  }\r
\r
  MemOverflow =0x100000000;\r
  while (HighMemoryLength > 0) {\r
    MtrrSetting.Variables.Mtrr[Index].Base = (MemOverflow & MTRR_LIB_CACHE_VALID_ADDRESS) | CacheWriteBack;\r
    MemoryLength = HighMemoryLength;\r
    MemoryLength = GetPowerOfTwo64 (MemoryLength);\r
\r
    if (MemoryLength > MemOverflow){\r
      MemoryLength = MemOverflow;\r
    }\r
\r
    MtrrSetting.Variables.Mtrr[Index].Mask = ((~(MemoryLength - 1)) & MTRR_LIB_CACHE_VALID_ADDRESS) | MTRR_LIB_CACHE_MTRR_ENABLED;\r
\r
    MemOverflow += MemoryLength;\r
    HighMemoryLength -= MemoryLength;\r
    Index++;\r
  }\r
\r
\r
  for (Index = 0; Index < MTRR_NUMBER_OF_VARIABLE_MTRR; Index++) {\r
    if (MtrrSetting.Variables.Mtrr[Index].Base == 0){\r
      break;\r
    }\r
    DEBUG ((EFI_D_INFO, "Base=%lx, Mask=%lx\n",MtrrSetting.Variables.Mtrr[Index].Base ,MtrrSetting.Variables.Mtrr[Index].Mask));\r
  }\r
\r
  //\r
  // set FE/E bits for IA32_MTRR_DEF_TYPE\r
  //\r
  MtrrSetting.MtrrDefType |=  3 <<10;\r
\r
  MtrrSetAllMtrrs(&MtrrSetting);\r
  //\r
  // Dump MTRR Setting\r
  //\r
  MtrrDebugPrintAllMtrrs ();\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
SetDxeCacheMode (\r
  IN  CONST EFI_PEI_SERVICES    **PeiServices\r
  )\r
{\r
  //\r
  // This is not needed for now.\r
  //\r
  return EFI_SUCCESS;\r
}\r
\r
STATIC\r
EFI_STATUS\r
GetMemorySize (\r
  IN  CONST EFI_PEI_SERVICES    **PeiServices,\r
  OUT UINT64              *LowMemoryLength,\r
  OUT UINT64              *HighMemoryLength\r
  )\r
{\r
  EFI_STATUS              Status;\r
  EFI_PEI_HOB_POINTERS    Hob;\r
\r
  *HighMemoryLength = 0;\r
  *LowMemoryLength = 0x100000;\r
\r
  //\r
  // Get the HOB list for processing\r
  //\r
  Status = (*PeiServices)->GetHobList (PeiServices, (void **)&Hob.Raw);\r
  if (EFI_ERROR(Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // Collect memory ranges\r
  //\r
  while (!END_OF_HOB_LIST (Hob)) {\r
    if (Hob.Header->HobType == EFI_HOB_TYPE_RESOURCE_DESCRIPTOR) {\r
      if (Hob.ResourceDescriptor->ResourceType == EFI_RESOURCE_SYSTEM_MEMORY) {\r
        //\r
        // Need memory above 1MB to be collected here\r
        //\r
        if (Hob.ResourceDescriptor->PhysicalStart >= 0x100000 &&\r
            Hob.ResourceDescriptor->PhysicalStart < (EFI_PHYSICAL_ADDRESS) 0x100000000) {\r
          *LowMemoryLength += (UINT64) (Hob.ResourceDescriptor->ResourceLength);\r
        } else if (Hob.ResourceDescriptor->PhysicalStart >= (EFI_PHYSICAL_ADDRESS) 0x100000000) {\r
          *HighMemoryLength += (UINT64) (Hob.ResourceDescriptor->ResourceLength);\r
        }\r
      }\r
    }\r
    Hob.Raw = GET_NEXT_HOB (Hob);\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Publish Memory Type Information.\r
\r
  @param  NULL\r
\r
  @retval EFI_SUCCESS    Success.\r
  @retval Others         Errors have occurred.\r
**/\r
\r
EFI_STATUS\r
EFIAPI\r
PublishMemoryTypeInfo (\r
  void\r
  )\r
{\r
  EFI_STATUS                      Status;\r
  EFI_PEI_READ_ONLY_VARIABLE2_PPI *Variable;\r
  UINTN                           DataSize;\r
  EFI_MEMORY_TYPE_INFORMATION     MemoryData[EfiMaxMemoryType + 1];\r
\r
  Status = PeiServicesLocatePpi (\r
             &gEfiPeiReadOnlyVariable2PpiGuid,\r
             0,\r
             NULL,\r
            (void **)&Variable\r
             );\r
  if (EFI_ERROR(Status)) {\r
    DEBUG((EFI_D_ERROR, "WARNING: Locating Pei variable failed 0x%x \n", Status));\r
    DEBUG((EFI_D_ERROR, "Build Hob from default\n"));\r
    //\r
    // Build the default GUID'd HOB for DXE\r
    //\r
    BuildGuidDataHob (\r
      &gEfiMemoryTypeInformationGuid,\r
      mDefaultMemoryTypeInformation,\r
      sizeof (mDefaultMemoryTypeInformation)\r
      );\r
\r
    return Status;\r
  }\r
\r
\r
  DataSize = sizeof (MemoryData);\r
\r
  //\r
  // This variable is saved in BDS stage. Now read it back\r
  //\r
  Status = Variable->GetVariable (\r
                       Variable,\r
                       EFI_MEMORY_TYPE_INFORMATION_VARIABLE_NAME,\r
                       &gEfiMemoryTypeInformationGuid,\r
                       NULL,\r
                       &DataSize,\r
                       &MemoryData\r
                       );\r
  if (EFI_ERROR (Status)) {\r
  	//\r
    //build default\r
    //\r
    DEBUG((EFI_D_ERROR, "Build Hob from default\n"));\r
    BuildGuidDataHob (\r
      &gEfiMemoryTypeInformationGuid,\r
      mDefaultMemoryTypeInformation,\r
      sizeof (mDefaultMemoryTypeInformation)\r
      );\r
\r
  } else {\r
  	//\r
    // Build the GUID'd HOB for DXE from variable\r
    //\r
    DEBUG((EFI_D_ERROR, "Build Hob from variable \n"));\r
    BuildGuidDataHob (\r
      &gEfiMemoryTypeInformationGuid,\r
      MemoryData,\r
      DataSize\r
      );\r
  }\r
\r
  return Status;\r
}\r
\r
Commit	Line	Data
3cbfba02 DW	1	/** @file\r
3cbfba02 DW	2	\r
5443e7fe	3	Copyright (c) 2004 - 2016, Intel Corporation. All rights reserved.<BR>\r
3cbfba02 DW	4	\r\r
	5	This program and the accompanying materials are licensed and made available under\r\r
	6	the terms and conditions of the BSD License that accompanies this distribution. \r\r
	7	The full text of the license may be found at \r\r
	8	http://opensource.org/licenses/bsd-license.php. \r\r
	9	\r\r
	10	THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, \r\r
	11	WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. \r\r
	12	\r\r
	13	\r
	14	Module Name:\r
	15	\r
	16	\r
	17	MemoryPeim.c\r
	18	\r
	19	Abstract:\r
	20	\r
	21	Tiano PEIM to provide the platform support functionality.\r
	22	This file implements the Platform Memory Range PPI\r
	23	\r
	24	--*/\r
	25	\r
	26	#include "PlatformEarlyInit.h"\r
	27	\r
	28	//\r
	29	// Need min. of 48MB PEI phase\r
	30	//\r
	31	#define PEI_MIN_MEMORY_SIZE (6 * 0x800000)\r
	32	#define PEI_RECOVERY_MIN_MEMORY_SIZE (6 * 0x800000)\r
	33	\r
	34	//\r
	35	// This is the memory needed for PEI to start up DXE.\r
	36	//\r
	37	// Over-estimating this size will lead to higher fragmentation\r
	38	// of main memory. Under-estimation of this will cause catastrophic\r
	39	// failure of PEI to load DXE. Generally, the failure may only be\r
	40	// realized during capsule updates.\r
	41	//\r
	42	#define PRERESERVED_PEI_MEMORY ( \\r
	43	EFI_SIZE_TO_PAGES (3 * 0x800000) /* PEI Core memory based stack */ \\r
	44	)\r
	45	\r
	46	EFI_MEMORY_TYPE_INFORMATION mDefaultMemoryTypeInformation[] = {\r
	47	{ EfiACPIReclaimMemory, 0x40 }, // 0x40 pages = 256k for ASL\r
	48	{ EfiACPIMemoryNVS, 0x100 }, // 0x100 pages = 1 MB for S3, SMM, HII, etc\r
	49	{ EfiReservedMemoryType, 0x600 }, // 48k for BIOS Reserved\r
	50	{ EfiMemoryMappedIO, 0 },\r
	51	{ EfiMemoryMappedIOPortSpace, 0 },\r
	52	{ EfiPalCode, 0 },\r
	53	{ EfiRuntimeServicesCode, 0x200 },\r
	54	{ EfiRuntimeServicesData, 0x100 },\r
	55	{ EfiLoaderCode, 0x100 },\r
	56	{ EfiLoaderData, 0x100 },\r
	57	{ EfiBootServicesCode, 0x800 },\r
	58	{ EfiBootServicesData, 0x2500},\r
	59	{ EfiConventionalMemory, 0 },\r
	60	{ EfiUnusableMemory, 0 },\r
	61	{ EfiMaxMemoryType, 0 }\r
	62	};\r
	63	\r
	64	STATIC\r
	65	EFI_STATUS\r
	66	GetMemorySize (\r
	67	IN CONST EFI_PEI_SERVICES **PeiServices,\r
68	OUT UINT64 *LowMemoryLength,\r
69	OUT UINT64 *HighMemoryLength\r
70	);\r
71	\r
72	\r
73	\r
74	EFI_STATUS\r
75	EFIAPI\r
76	SetPeiCacheMode (\r
77	IN CONST EFI_PEI_SERVICES **PeiServices\r
78	)\r
79	{\r
80	EFI_STATUS Status;\r
81	PEI_CACHE_PPI *CachePpi;\r
82	\r
83	EFI_BOOT_MODE BootMode;\r
84	UINT64 MemoryLength;\r
85	UINT64 MemOverflow;\r
86	UINT64 MemoryLengthUc;\r
87	UINT64 MaxMemoryLength;\r
88	UINT64 LowMemoryLength;\r
89	UINT64 HighMemoryLength;\r
90	UINT8 Index;\r
91	MTRR_SETTINGS MtrrSetting;\r
92	\r
93	//\r
94	// Load Cache PPI\r
95	//\r
96	Status = (**PeiServices).LocatePpi (\r
97	PeiServices,\r
98	&gPeiCachePpiGuid, // GUID\r
99	0, // Instance\r
100	NULL, // EFI_PEI_PPI_DESCRIPTOR\r
101	(void **)&CachePpi // PPI\r
102	);\r
103	if (!EFI_ERROR(Status)) {\r
104	//\r
105	// Clear the CAR Settings (Default Cache Type => UC)\r
106	//\r
107	DEBUG ((EFI_D_INFO, "Reset cache attribute and disable CAR. \n"));\r
108	CachePpi->ResetCache(\r
109	(EFI_PEI_SERVICES**)PeiServices,\r
110	CachePpi\r
111	);\r
112	}\r
113	\r
114	\r
115	//\r
116	// Variable initialization\r
117	//\r
118	LowMemoryLength = 0;\r
119	HighMemoryLength = 0;\r
120	MemoryLengthUc = 0;\r
121	\r
122	Status = (*PeiServices)->GetBootMode (\r
123	PeiServices,\r
124	&BootMode\r
125	);\r
126	\r
127	//\r
128	// Determine memory usage\r
129	//\r
130	GetMemorySize (\r
131	PeiServices,\r
132	&LowMemoryLength,\r
133	&HighMemoryLength\r
134	);\r
135	\r
136	LowMemoryLength = (EFI_PHYSICAL_ADDRESS)MmPci32( 0, 0, 2, 0, 0x70);\r
137	LowMemoryLength &= 0xFFF00000ULL;\r
138	\r
139	MaxMemoryLength = LowMemoryLength;\r
140	\r
141	//\r
142	// Round up to nearest 256MB with high memory and 64MB w/o high memory\r
143	//\r
144	if (HighMemoryLength != 0 ) {\r
145	MemOverflow = (LowMemoryLength & 0x0fffffff);\r
146	if (MemOverflow != 0) {\r
147	MaxMemoryLength = LowMemoryLength + (0x10000000 - MemOverflow);\r
148	}\r
149	} else {\r
150	MemOverflow = (LowMemoryLength & 0x03ffffff);\r
151	if (MemOverflow != 0) {\r
152	MaxMemoryLength = LowMemoryLength + (0x4000000 - MemOverflow);\r
153	}\r
154	}\r
155	\r
156	ZeroMem (&MtrrSetting, sizeof(MTRR_SETTINGS));\r
157	for (Index = 0; Index < 2; Index++) {\r
158	MtrrSetting.Fixed.Mtrr[Index]=0x0606060606060606;\r
159	}\r
160	for (Index = 2; Index < 11; Index++) {\r
161	MtrrSetting.Fixed.Mtrr[Index]=0x0505050505050505;\r
162	}\r
163	\r
164	//\r
165	// Cache the flash area to improve the boot performance in PEI phase\r
166	//\r
167	Index = 0;\r
168	MtrrSetting.Variables.Mtrr[0].Base = (FixedPcdGet32 (PcdFlashAreaBaseAddress) \| CacheWriteProtected);\r
169	MtrrSetting.Variables.Mtrr[0].Mask = ((~((UINT64)(FixedPcdGet32 (PcdFlashAreaSize) - 1))) & MTRR_LIB_CACHE_VALID_ADDRESS) \| MTRR_LIB_CACHE_MTRR_ENABLED;\r
170	Index ++;\r
171	\r
172	MemOverflow =0;\r
173	while (MaxMemoryLength > MemOverflow){\r
174	MtrrSetting.Variables.Mtrr[Index].Base = (MemOverflow & MTRR_LIB_CACHE_VALID_ADDRESS) \| CacheWriteBack;\r
175	MemoryLength = MaxMemoryLength - MemOverflow;\r
176	MemoryLength = GetPowerOfTwo64 (MemoryLength);\r
177	MtrrSetting.Variables.Mtrr[Index].Mask = ((~(MemoryLength - 1)) & MTRR_LIB_CACHE_VALID_ADDRESS) \| MTRR_LIB_CACHE_MTRR_ENABLED;\r
178	\r
179	MemOverflow += MemoryLength;\r
180	Index++;\r
181	}\r
182	\r
183	MemoryLength = LowMemoryLength;\r
184	\r
185	while (MaxMemoryLength != MemoryLength) {\r
186	MemoryLengthUc = GetPowerOfTwo64 (MaxMemoryLength - MemoryLength);\r
187	\r
188	MtrrSetting.Variables.Mtrr[Index].Base = ((MaxMemoryLength - MemoryLengthUc) & MTRR_LIB_CACHE_VALID_ADDRESS) \| CacheUncacheable;\r
189	MtrrSetting.Variables.Mtrr[Index].Mask= ((~(MemoryLengthUc - 1)) & MTRR_LIB_CACHE_VALID_ADDRESS) \| MTRR_LIB_CACHE_MTRR_ENABLED;\r
190	MaxMemoryLength -= MemoryLengthUc;\r
191	Index++;\r
192	}\r
193	\r
194	MemOverflow =0x100000000;\r
195	while (HighMemoryLength > 0) {\r
196	MtrrSetting.Variables.Mtrr[Index].Base = (MemOverflow & MTRR_LIB_CACHE_VALID_ADDRESS) \| CacheWriteBack;\r
197	MemoryLength = HighMemoryLength;\r
198	MemoryLength = GetPowerOfTwo64 (MemoryLength);\r
199	\r
200	if (MemoryLength > MemOverflow){\r
201	MemoryLength = MemOverflow;\r
202	}\r
203	\r
204	MtrrSetting.Variables.Mtrr[Index].Mask = ((~(MemoryLength - 1)) & MTRR_LIB_CACHE_VALID_ADDRESS) \| MTRR_LIB_CACHE_MTRR_ENABLED;\r
205	\r
206	MemOverflow += MemoryLength;\r
207	HighMemoryLength -= MemoryLength;\r
208	Index++;\r
209	}\r
210	\r
211	\r
212	for (Index = 0; Index < MTRR_NUMBER_OF_VARIABLE_MTRR; Index++) {\r
213	if (MtrrSetting.Variables.Mtrr[Index].Base == 0){\r
214	break;\r
215	}\r
216	DEBUG ((EFI_D_INFO, "Base=%lx, Mask=%lx\n",MtrrSetting.Variables.Mtrr[Index].Base ,MtrrSetting.Variables.Mtrr[Index].Mask));\r
217	}\r
218	\r
219	//\r
220	// set FE/E bits for IA32_MTRR_DEF_TYPE\r
221	//\r
222	MtrrSetting.MtrrDefType \|= 3 <<10;\r
223	\r
224	MtrrSetAllMtrrs(&MtrrSetting);\r
5443e7fe JF	225	//\r
	226	// Dump MTRR Setting\r
	227	//\r
	228	MtrrDebugPrintAllMtrrs ();\r
3cbfba02 DW	229	\r
	230	return EFI_SUCCESS;\r
	231	}\r
	232	\r
	233	EFI_STATUS\r
	234	EFIAPI\r
	235	SetDxeCacheMode (\r
	236	IN CONST EFI_PEI_SERVICES **PeiServices\r
	237	)\r
	238	{\r
	239	//\r
	240	// This is not needed for now.\r
	241	//\r
	242	return EFI_SUCCESS;\r
	243	}\r
	244	\r
	245	STATIC\r
	246	EFI_STATUS\r
	247	GetMemorySize (\r
	248	IN CONST EFI_PEI_SERVICES **PeiServices,\r
	249	OUT UINT64 *LowMemoryLength,\r
	250	OUT UINT64 *HighMemoryLength\r
	251	)\r
	252	{\r
	253	EFI_STATUS Status;\r
	254	EFI_PEI_HOB_POINTERS Hob;\r
	255	\r
	256	*HighMemoryLength = 0;\r
	257	*LowMemoryLength = 0x100000;\r
	258	\r
	259	//\r
	260	// Get the HOB list for processing\r
	261	//\r
	262	Status = (PeiServices)->GetHobList (PeiServices, (void *)&Hob.Raw);\r
	263	if (EFI_ERROR(Status)) {\r
	264	return Status;\r
	265	}\r
	266	\r
	267	//\r
	268	// Collect memory ranges\r
	269	//\r
	270	while (!END_OF_HOB_LIST (Hob)) {\r
	271	if (Hob.Header->HobType == EFI_HOB_TYPE_RESOURCE_DESCRIPTOR) {\r
	272	if (Hob.ResourceDescriptor->ResourceType == EFI_RESOURCE_SYSTEM_MEMORY) {\r
	273	//\r
	274	// Need memory above 1MB to be collected here\r
	275	//\r
	276	if (Hob.ResourceDescriptor->PhysicalStart >= 0x100000 &&\r
	277	Hob.ResourceDescriptor->PhysicalStart < (EFI_PHYSICAL_ADDRESS) 0x100000000) {\r
	278	*LowMemoryLength += (UINT64) (Hob.ResourceDescriptor->ResourceLength);\r
	279	} else if (Hob.ResourceDescriptor->PhysicalStart >= (EFI_PHYSICAL_ADDRESS) 0x100000000) {\r
	280	*HighMemoryLength += (UINT64) (Hob.ResourceDescriptor->ResourceLength);\r
	281	}\r
	282	}\r
	283	}\r
	284	Hob.Raw = GET_NEXT_HOB (Hob);\r
	285	}\r
	286	\r
	287	return EFI_SUCCESS;\r
	288	}\r
	289	\r
	290	\r
	291	/**\r
	292	Publish Memory Type Information.\r
293	\r
294	@param NULL\r
295	\r
296	@retval EFI_SUCCESS Success.\r
297	@retval Others Errors have occurred.\r
298	**/\r
299	\r
300	EFI_STATUS\r
301	EFIAPI\r
302	PublishMemoryTypeInfo (\r
303	void\r
304	)\r
305	{\r
306	EFI_STATUS Status;\r
307	EFI_PEI_READ_ONLY_VARIABLE2_PPI *Variable;\r
308	UINTN DataSize;\r
309	EFI_MEMORY_TYPE_INFORMATION MemoryData[EfiMaxMemoryType + 1];\r
310	\r
311	Status = PeiServicesLocatePpi (\r
312	&gEfiPeiReadOnlyVariable2PpiGuid,\r
313	0,\r
314	NULL,\r
315	(void **)&Variable\r
316	);\r
317	if (EFI_ERROR(Status)) {\r
318	DEBUG((EFI_D_ERROR, "WARNING: Locating Pei variable failed 0x%x \n", Status));\r
319	DEBUG((EFI_D_ERROR, "Build Hob from default\n"));\r
320	//\r
321	// Build the default GUID'd HOB for DXE\r
322	//\r
323	BuildGuidDataHob (\r
324	&gEfiMemoryTypeInformationGuid,\r
325	mDefaultMemoryTypeInformation,\r
326	sizeof (mDefaultMemoryTypeInformation)\r
327	);\r
328	\r
329	return Status;\r
330	}\r
331	\r
332	\r
333	DataSize = sizeof (MemoryData);\r
334	\r
335	//\r
336	// This variable is saved in BDS stage. Now read it back\r
337	//\r
338	Status = Variable->GetVariable (\r
339	Variable,\r
340	EFI_MEMORY_TYPE_INFORMATION_VARIABLE_NAME,\r
341	&gEfiMemoryTypeInformationGuid,\r
342	NULL,\r
343	&DataSize,\r
344	&MemoryData\r
345	);\r
346	if (EFI_ERROR (Status)) {\r
347	//\r
348	//build default\r
349	//\r
350	DEBUG((EFI_D_ERROR, "Build Hob from default\n"));\r
351	BuildGuidDataHob (\r
352	&gEfiMemoryTypeInformationGuid,\r
353	mDefaultMemoryTypeInformation,\r
354	sizeof (mDefaultMemoryTypeInformation)\r
355	);\r
356	\r
357	} else {\r
358	//\r
359	// Build the GUID'd HOB for DXE from variable\r
360	//\r
361	DEBUG((EFI_D_ERROR, "Build Hob from variable \n"));\r
362	BuildGuidDataHob (\r
363	&gEfiMemoryTypeInformationGuid,\r
364	MemoryData,\r
365	DataSize\r
366	);\r
367	}\r
368	\r
369	return Status;\r
370	}\r
371	\r