]> git.proxmox.com Git - mirror_edk2.git/blobdiff - MdePkg/Library/PeiMemoryAllocationLib/MemoryAllocationLib.c
MdePkg PeiMemoryAllocationLib: Update Free(Aligned)Pages
[mirror_edk2.git] / MdePkg / Library / PeiMemoryAllocationLib / MemoryAllocationLib.c
index 57a4009461b5c821bc5467edc7d8f89348068518..37273dde561ac45e889e8ecc33c0ef089349faf2 100644 (file)
@@ -1,11 +1,12 @@
 /** @file\r
-  Support routines for memory allocation routines for use with drivers.\r
+  Support routines for memory allocation routines \r
+  based on PeiService for PEI phase drivers.\r
 \r
-  Copyright (c) 2006, Intel Corporation<BR>\r
-  All rights reserved. This program and the accompanying materials                          \r
+  Copyright (c) 2006 - 2017, Intel Corporation. All rights reserved.<BR>\r
+  This program and the accompanying materials                          \r
   are licensed and made available under the terms and conditions of the BSD License         \r
   which accompanies this distribution.  The full text of the license may be found at        \r
-  http://opensource.org/licenses/bsd-license.php                                            \r
+  http://opensource.org/licenses/bsd-license.php.                                            \r
 \r
   THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,                     \r
   WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.             \r
 \r
 \r
 #include <Library/MemoryAllocationLib.h>\r
-#include <Library/PeiServicesTablePointerLib.h>\r
+#include <Library/PeiServicesLib.h>\r
 #include <Library/BaseMemoryLib.h>\r
 #include <Library/DebugLib.h>\r
+#include <Library/HobLib.h>\r
 \r
-#include "MemoryAllocationLibInternals.h"\r
 \r
 /**\r
   Allocates one or more 4KB pages of a certain memory type.\r
@@ -44,17 +45,16 @@ InternalAllocatePages (
 {\r
   EFI_STATUS            Status;\r
   EFI_PHYSICAL_ADDRESS  Memory; \r
-  EFI_PEI_SERVICES      **PeiServices;\r
 \r
   if (Pages == 0) {\r
     return NULL;\r
   }\r
 \r
-  PeiServices = GetPeiServicesTablePointer ();\r
-  Status = (*PeiServices)->AllocatePages (PeiServices, MemoryType, Pages, &Memory);\r
+  Status = PeiServicesAllocatePages (MemoryType, Pages, &Memory);\r
   if (EFI_ERROR (Status)) {\r
-    Memory = 0;\r
+    return NULL;\r
   }\r
+\r
   return (VOID *) (UINTN) Memory;\r
 }\r
 \r
@@ -130,12 +130,14 @@ AllocateReservedPages (
 \r
   Frees the number of 4KB pages specified by Pages from the buffer specified by Buffer.  Buffer\r
   must have been allocated on a previous call to the page allocation services of the Memory\r
-  Allocation Library.\r
+  Allocation Library.  If it is not possible to free allocated pages, then this function will\r
+  perform no actions.\r
+  \r
   If Buffer was not allocated with a page allocation function in the Memory Allocation Library,\r
   then ASSERT().\r
   If Pages is zero, then ASSERT().\r
  \r
-  @param  Buffer                Pointer to the buffer of pages to free.\r
+  @param  Buffer                The pointer to the buffer of pages to free.\r
   @param  Pages                 The number of 4 KB pages to free.\r
 \r
 **/\r
@@ -146,9 +148,11 @@ FreePages (
   IN UINTN  Pages\r
   )\r
 {\r
-  //\r
-  // PEI phase does not support to free pages, so leave it as NOP.\r
-  //\r
+  EFI_STATUS  Status;\r
+\r
+  ASSERT (Pages != 0);\r
+  Status = PeiServicesFreePages ((EFI_PHYSICAL_ADDRESS) (UINTN) Buffer, Pages);\r
+  ASSERT_EFI_ERROR (Status);\r
 }\r
 \r
 /**\r
@@ -159,10 +163,12 @@ FreePages (
   If there is not enough memory at the specified alignment remaining to satisfy the request, then\r
   NULL is returned.\r
   If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
+  If Pages plus EFI_SIZE_TO_PAGES (Alignment) overflows, then ASSERT().\r
 \r
   @param  MemoryType            The type of memory to allocate.\r
   @param  Pages                 The number of 4 KB pages to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
+  @param  Alignment             The requested alignment of the allocation.  \r
+                                Must be a power of two.\r
                                 If Alignment is zero, then byte alignment is used.\r
 \r
   @return A pointer to the allocated buffer or NULL if allocation fails.\r
@@ -175,8 +181,15 @@ InternalAllocateAlignedPages (
   IN UINTN            Alignment\r
   )\r
 {\r
-  VOID    *Memory;\r
-  UINTN   AlignmentMask;\r
+  EFI_PHYSICAL_ADDRESS   Memory;\r
+  EFI_PHYSICAL_ADDRESS   AlignedMemory;\r
+  EFI_PEI_HOB_POINTERS   Hob;\r
+  BOOLEAN                SkipBeforeMemHob;\r
+  BOOLEAN                SkipAfterMemHob;\r
+  EFI_PHYSICAL_ADDRESS   HobBaseAddress;\r
+  UINT64                 HobLength;\r
+  EFI_MEMORY_TYPE        HobMemoryType;\r
+  UINTN                  TotalPages;\r
 \r
   //\r
   // Alignment must be a power of two or zero.\r
@@ -189,17 +202,136 @@ InternalAllocateAlignedPages (
   //\r
   // Make sure that Pages plus EFI_SIZE_TO_PAGES (Alignment) does not overflow.\r
   //\r
-  ASSERT (Pages <= (MAX_ADDRESS - EFI_SIZE_TO_PAGES (Alignment)));\r
+  ASSERT (Pages <= (MAX_ADDRESS - EFI_SIZE_TO_PAGES (Alignment))); \r
+\r
   //\r
   // We would rather waste some memory to save PEI code size.\r
+  // meaning in addition to the requested size for the aligned mem,\r
+  // we simply reserve an overhead memory equal to Alignmemt(page-aligned), no matter what.\r
+  // The overhead mem size could be reduced later with more involved malloc mechanisms\r
+  // (e.g., somthing that can detect the alignment boundary before allocating memory or \r
+  //  can request that memory be allocated at a certain address that is aleady aligned).\r
   //\r
-  Memory = InternalAllocatePages (MemoryType, Pages + EFI_SIZE_TO_PAGES (Alignment));\r
-  if (Alignment == 0) {\r
-    AlignmentMask = Alignment;\r
+  TotalPages = Pages + (Alignment <= EFI_PAGE_SIZE ? 0 : EFI_SIZE_TO_PAGES(Alignment));\r
+  Memory = (EFI_PHYSICAL_ADDRESS) (UINTN) InternalAllocatePages (MemoryType, TotalPages);\r
+  if (Memory == 0) {\r
+    DEBUG((DEBUG_INFO, "Out of memory resource! \n"));\r
+    return NULL;\r
+  }\r
+  DEBUG ((DEBUG_INFO, "Allocated Memory unaligned: Address = 0x%LX, Pages = 0x%X, Type = %d \n", Memory, TotalPages, (UINTN) MemoryType));\r
+\r
+  //\r
+  // Alignment calculation\r
+  //\r
+  AlignedMemory = Memory;\r
+  if (Alignment > EFI_PAGE_SIZE) {\r
+    AlignedMemory = ALIGN_VALUE (Memory, Alignment);\r
+  }\r
+  DEBUG ((DEBUG_INFO, "After aligning to 0x%X bytes: Address = 0x%LX, Pages = 0x%X \n", Alignment, AlignedMemory, Pages));\r
+\r
+  //\r
+  // In general three HOBs cover the total allocated space.\r
+  // The aligned portion is covered by the aligned mem HOB and\r
+  // the unaligned(to be freed) portions before and after the aligned portion are covered by newly created HOBs.\r
+  //\r
+  // Before mem HOB covers the region between "Memory" and "AlignedMemory"\r
+  // Aligned mem HOB covers the region between "AlignedMemory" and "AlignedMemory + EFI_PAGES_TO_SIZE(Pages)"\r
+  // After mem HOB covers the region between "AlignedMemory + EFI_PAGES_TO_SIZE(Pages)" and "Memory + EFI_PAGES_TO_SIZE(TotalPages)"\r
+  //\r
+  // The before or after mem HOBs need to be skipped under special cases where the aligned portion\r
+  // touches either the top or bottom of the original allocated space.\r
+  //\r
+  SkipBeforeMemHob = FALSE;\r
+  SkipAfterMemHob  = FALSE;\r
+  if (Memory == AlignedMemory) {\r
+    SkipBeforeMemHob = TRUE;\r
+  }\r
+  if ((Memory + EFI_PAGES_TO_SIZE(TotalPages)) == (AlignedMemory + EFI_PAGES_TO_SIZE(Pages))) {\r
+    //\r
+    // This condition is never met in the current implementation.\r
+    // There is always some after-mem since the overhead mem(used in TotalPages)\r
+    // is no less than Alignment.\r
+    //\r
+    SkipAfterMemHob = TRUE;\r
+  }\r
+\r
+  //  \r
+  // Search for the mem HOB referring to the original(unaligned) allocation \r
+  // and update the size and type if needed.\r
+  //\r
+  Hob.Raw = GetFirstHob (EFI_HOB_TYPE_MEMORY_ALLOCATION);\r
+  while (Hob.Raw != NULL) {\r
+    if (Hob.MemoryAllocation->AllocDescriptor.MemoryBaseAddress == Memory) {\r
+      break;\r
+    }\r
+    Hob.Raw = GET_NEXT_HOB (Hob);\r
+    Hob.Raw = GetNextHob (EFI_HOB_TYPE_MEMORY_ALLOCATION, Hob.Raw);\r
+  }\r
+  ASSERT (Hob.Raw != NULL);\r
+  if (SkipBeforeMemHob) {\r
+    //\r
+    // Use this HOB as aligned mem HOB as there is no portion before it.\r
+    //\r
+    HobLength = EFI_PAGES_TO_SIZE(Pages);\r
+    Hob.MemoryAllocation->AllocDescriptor.MemoryLength = HobLength;\r
+  } else {\r
+    //\r
+    // Use this HOB as before mem HOB and create a new HOB for the aligned portion \r
+    //\r
+    HobLength = (AlignedMemory - Memory); \r
+    Hob.MemoryAllocation->AllocDescriptor.MemoryLength = HobLength;\r
+    Hob.MemoryAllocation->AllocDescriptor.MemoryType = EfiConventionalMemory;\r
+  }\r
+\r
+  HobBaseAddress = Hob.MemoryAllocation->AllocDescriptor.MemoryBaseAddress;\r
+  HobMemoryType = Hob.MemoryAllocation->AllocDescriptor.MemoryType;\r
+\r
+  //\r
+  // Build the aligned mem HOB if needed\r
+  //\r
+  if (!SkipBeforeMemHob) {\r
+    DEBUG((DEBUG_INFO, "Updated before-mem HOB with BaseAddress = %LX, Length = %LX, MemoryType = %d \n",\r
+      HobBaseAddress, HobLength, (UINTN) HobMemoryType));\r
+\r
+    HobBaseAddress = AlignedMemory;\r
+    HobLength = EFI_PAGES_TO_SIZE(Pages);\r
+    HobMemoryType = MemoryType;\r
+\r
+    BuildMemoryAllocationHob (\r
+      HobBaseAddress,\r
+      HobLength,\r
+      HobMemoryType\r
+      );\r
+\r
+    DEBUG((DEBUG_INFO, "Created aligned-mem HOB with BaseAddress = %LX, Length = %LX, MemoryType = %d \n",\r
+      HobBaseAddress, HobLength, (UINTN) HobMemoryType));\r
   } else {\r
-    AlignmentMask = Alignment - 1;  \r
+    if (HobBaseAddress != 0) {\r
+      DEBUG((DEBUG_INFO, "Updated aligned-mem HOB with BaseAddress = %LX, Length = %LX, MemoryType = %d \n",\r
+        HobBaseAddress, HobLength, (UINTN) HobMemoryType));\r
+    }\r
   }\r
-  return (VOID *) (UINTN) (((UINTN) Memory + AlignmentMask) & ~AlignmentMask);\r
+\r
+\r
+  //\r
+  // Build the after mem HOB if needed\r
+  //\r
+  if (!SkipAfterMemHob) {\r
+    HobBaseAddress = AlignedMemory + EFI_PAGES_TO_SIZE(Pages);\r
+    HobLength = (Memory + EFI_PAGES_TO_SIZE(TotalPages)) - (AlignedMemory + EFI_PAGES_TO_SIZE(Pages));\r
+    HobMemoryType = EfiConventionalMemory;\r
+\r
+    BuildMemoryAllocationHob (\r
+      HobBaseAddress,\r
+      HobLength,\r
+      HobMemoryType\r
+      );\r
+\r
+    DEBUG((DEBUG_INFO, "Created after-mem HOB with BaseAddress = %LX, Length = %LX, MemoryType = %d \n",\r
+      HobBaseAddress, HobLength, (UINTN) HobMemoryType));\r
+  }\r
+\r
+  return (VOID *) (UINTN) AlignedMemory;\r
 }\r
 \r
 /**\r
@@ -209,10 +341,13 @@ InternalAllocateAlignedPages (
   alignment specified by Alignment.  The allocated buffer is returned.  If Pages is 0, then NULL is\r
   returned.  If there is not enough memory at the specified alignment remaining to satisfy the\r
   request, then NULL is returned.\r
+  \r
   If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
+  If Pages plus EFI_SIZE_TO_PAGES (Alignment) overflows, then ASSERT().\r
 \r
   @param  Pages                 The number of 4 KB pages to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
+  @param  Alignment             The requested alignment of the allocation.  \r
+                                Must be a power of two.\r
                                 If Alignment is zero, then byte alignment is used.\r
 \r
   @return A pointer to the allocated buffer or NULL if allocation fails.\r
@@ -235,10 +370,13 @@ AllocateAlignedPages (
   alignment specified by Alignment.  The allocated buffer is returned.  If Pages is 0, then NULL is\r
   returned.  If there is not enough memory at the specified alignment remaining to satisfy the\r
   request, then NULL is returned.\r
+  \r
   If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
+  If Pages plus EFI_SIZE_TO_PAGES (Alignment) overflows, then ASSERT().\r
 \r
   @param  Pages                 The number of 4 KB pages to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
+  @param  Alignment             The requested alignment of the allocation.  \r
+                                Must be a power of two.\r
                                 If Alignment is zero, then byte alignment is used.\r
 \r
   @return A pointer to the allocated buffer or NULL if allocation fails.\r
@@ -261,10 +399,13 @@ AllocateAlignedRuntimePages (
   alignment specified by Alignment.  The allocated buffer is returned.  If Pages is 0, then NULL is\r
   returned.  If there is not enough memory at the specified alignment remaining to satisfy the\r
   request, then NULL is returned.\r
+  \r
   If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
+  If Pages plus EFI_SIZE_TO_PAGES (Alignment) overflows, then ASSERT().\r
 \r
   @param  Pages                 The number of 4 KB pages to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
+  @param  Alignment             The requested alignment of the allocation.  \r
+                                Must be a power of two.\r
                                 If Alignment is zero, then byte alignment is used.\r
 \r
   @return A pointer to the allocated buffer or NULL if allocation fails.\r
@@ -286,12 +427,14 @@ AllocateAlignedReservedPages (
 \r
   Frees the number of 4KB pages specified by Pages from the buffer specified by Buffer.  Buffer\r
   must have been allocated on a previous call to the aligned page allocation services of the Memory\r
-  Allocation Library.\r
+  Allocation Library.  If it is not possible to free allocated pages, then this function will \r
+  perform no actions.\r
+  \r
   If Buffer was not allocated with an aligned page allocation function in the Memory Allocation\r
   Library, then ASSERT().\r
   If Pages is zero, then ASSERT().\r
   \r
-  @param  Buffer                Pointer to the buffer of pages to free.\r
+  @param  Buffer                The pointer to the buffer of pages to free.\r
   @param  Pages                 The number of 4 KB pages to free.\r
 \r
 **/\r
@@ -302,9 +445,11 @@ FreeAlignedPages (
   IN UINTN  Pages\r
   )\r
 {\r
-  //\r
-  // PEI phase does not support to free pages, so leave it as NOP.\r
-  //\r
+  EFI_STATUS  Status;\r
+\r
+  ASSERT (Pages != 0);\r
+  Status = PeiServicesFreePages ((EFI_PHYSICAL_ADDRESS) (UINTN) Buffer, Pages);\r
+  ASSERT_EFI_ERROR (Status);\r
 }\r
 \r
 /**\r
@@ -353,12 +498,9 @@ AllocatePool (
   )\r
 {\r
   EFI_STATUS        Status;\r
-  EFI_PEI_SERVICES  **PeiServices;\r
   VOID              *Buffer;\r
   \r
-  PeiServices = GetPeiServicesTablePointer ();\r
-\r
-  Status = (*PeiServices)->AllocatePool (PeiServices, AllocationSize, &Buffer);\r
+  Status = PeiServicesAllocatePool (AllocationSize, &Buffer);\r
   if (EFI_ERROR (Status)) {\r
     Buffer = NULL;\r
   }\r
@@ -387,9 +529,9 @@ AllocateRuntimePool (
 }\r
 \r
 /**\r
-  Allocates a buffer of type EfieservedMemoryType.\r
+  Allocates a buffer of type EfiReservedMemoryType.\r
 \r
-  Allocates the number bytes specified by AllocationSize of type EfieservedMemoryType and returns\r
+  Allocates the number bytes specified by AllocationSize of type EfiReservedMemoryType and returns\r
   a pointer to the allocated buffer.  If AllocationSize is 0, then a valid buffer of 0 size is\r
   returned.  If there is not enough memory remaining to satisfy the request, then NULL is returned.\r
 \r
@@ -408,9 +550,9 @@ AllocateReservedPool (
 }\r
 \r
 /**\r
-  Allocates and zeros a buffer of a certian pool type.\r
+  Allocates and zeros a buffer of a certain pool type.\r
 \r
-  Allocates the number bytes specified by AllocationSize of a certian pool type, clears the buffer\r
+  Allocates the number bytes specified by AllocationSize of a certain pool type, clears the buffer\r
   with zeros, and returns a pointer to the allocated buffer.  If AllocationSize is 0, then a valid\r
   buffer of 0 size is returned.  If there is not enough memory remaining to satisfy the request,\r
   then NULL is returned.\r
@@ -509,14 +651,14 @@ AllocateReservedZeroPool (
 }\r
 \r
 /**\r
-  Copies a buffer to an allocated buffer of a certian pool type.\r
+  Copies a buffer to an allocated buffer of a certain pool type.\r
 \r
-  Allocates the number bytes specified by AllocationSize of a certian pool type, copies\r
+  Allocates the number bytes specified by AllocationSize of a certain pool type, copies\r
   AllocationSize bytes from Buffer to the newly allocated buffer, and returns a pointer to the\r
   allocated buffer.  If AllocationSize is 0, then a valid buffer of 0 size is returned.  If there\r
   is not enough memory remaining to satisfy the request, then NULL is returned.\r
   If Buffer is NULL, then ASSERT().\r
-  If AllocationSize is greater than (MAX_ADDRESS ? Buffer + 1), then ASSERT(). \r
+  If AllocationSize is greater than (MAX_ADDRESS - Buffer + 1), then ASSERT(). \r
 \r
   @param  PoolType              The type of pool to allocate.\r
   @param  AllocationSize        The number of bytes to allocate and zero.\r
@@ -551,8 +693,9 @@ InternalAllocateCopyPool (
   AllocationSize bytes from Buffer to the newly allocated buffer, and returns a pointer to the\r
   allocated buffer.  If AllocationSize is 0, then a valid buffer of 0 size is returned.  If there\r
   is not enough memory remaining to satisfy the request, then NULL is returned.\r
+  \r
   If Buffer is NULL, then ASSERT().\r
-  If AllocationSize is greater than (MAX_ADDRESS ? Buffer + 1), then ASSERT(). \r
+  If AllocationSize is greater than (MAX_ADDRESS - Buffer + 1), then ASSERT(). \r
 \r
   @param  AllocationSize        The number of bytes to allocate and zero.\r
   @param  Buffer                The buffer to copy to the allocated buffer.\r
@@ -586,8 +729,9 @@ AllocateCopyPool (
   AllocationSize bytes from Buffer to the newly allocated buffer, and returns a pointer to the\r
   allocated buffer.  If AllocationSize is 0, then a valid buffer of 0 size is returned.  If there\r
   is not enough memory remaining to satisfy the request, then NULL is returned.\r
+  \r
   If Buffer is NULL, then ASSERT().\r
-  If AllocationSize is greater than (MAX_ADDRESS ? Buffer + 1), then ASSERT(). \r
+  If AllocationSize is greater than (MAX_ADDRESS - Buffer + 1), then ASSERT(). \r
 \r
   @param  AllocationSize        The number of bytes to allocate and zero.\r
   @param  Buffer                The buffer to copy to the allocated buffer.\r
@@ -612,8 +756,9 @@ AllocateRuntimeCopyPool (
   AllocationSize bytes from Buffer to the newly allocated buffer, and returns a pointer to the\r
   allocated buffer.  If AllocationSize is 0, then a valid buffer of 0 size is returned.  If there\r
   is not enough memory remaining to satisfy the request, then NULL is returned.\r
+  \r
   If Buffer is NULL, then ASSERT().\r
-  If AllocationSize is greater than (MAX_ADDRESS ? Buffer + 1), then ASSERT(). \r
+  If AllocationSize is greater than (MAX_ADDRESS - Buffer + 1), then ASSERT(). \r
 \r
   @param  AllocationSize        The number of bytes to allocate and zero.\r
   @param  Buffer                The buffer to copy to the allocated buffer.\r
@@ -632,446 +777,158 @@ AllocateReservedCopyPool (
 }\r
 \r
 /**\r
-  Frees a buffer that was previously allocated with one of the pool allocation functions in the\r
-  Memory Allocation Library.\r
-\r
-  Frees the buffer specified by Buffer.  Buffer must have been allocated on a previous call to the\r
-  pool allocation services of the Memory Allocation Library.\r
-  If Buffer was not allocated with a pool allocation function in the Memory Allocation Library,\r
-  then ASSERT().\r
-\r
-  @param  Buffer                Pointer to the buffer to free.\r
-\r
-**/\r
-VOID\r
-EFIAPI\r
-FreePool (\r
-  IN VOID   *Buffer\r
-  )\r
-{\r
-  //\r
-  // PEI phase does not support to free pool, so leave it as NOP.\r
-  //\r
-}\r
-\r
-/**\r
-  Allocates a buffer of a certain pool type at a specified alignment.\r
-\r
-  Allocates the number bytes specified by AllocationSize of a certain pool type with an alignment\r
-  specified by Alignment.  The allocated buffer is returned.  If AllocationSize is 0, then a valid\r
-  buffer of 0 size is returned.  If there is not enough memory at the specified alignment remaining\r
-  to satisfy the request, then NULL is returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
-\r
-  @param  PoolType              The type of pool to allocate.\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.                            If Alignment is zero, then byte alignment is used.\r
-                                If Alignment is zero, then byte alignment is used.\r
+  Reallocates a buffer of a specified memory type.\r
 \r
-  @return A pointer to the allocated buffer or NULL if allocation fails.\r
-\r
-**/\r
-VOID *\r
-InternalAllocateAlignedPool (\r
-  IN EFI_MEMORY_TYPE  PoolType,\r
-  IN UINTN            AllocationSize,\r
-  IN UINTN            Alignment\r
-  )\r
-{\r
-  VOID    *RawAddress;\r
-  UINTN   AlignedAddress;\r
-  UINTN   AlignmentMask;\r
-\r
-  //\r
-  // Alignment must be a power of two or zero.\r
-  //\r
-  ASSERT ((Alignment & (Alignment - 1)) == 0);\r
-  \r
-  if (Alignment == 0) {\r
-    AlignmentMask = Alignment;\r
-  } else {\r
-    AlignmentMask = Alignment - 1;\r
-  }\r
-  //\r
-  // Make sure that AllocationSize plus AlignmentMask does not overflow.\r
-  //\r
-  ASSERT (AllocationSize <= (MAX_ADDRESS - AlignmentMask));\r
-\r
-  RawAddress      = InternalAllocatePool (PoolType, AllocationSize + AlignmentMask);\r
-  \r
-  AlignedAddress  = ((UINTN) RawAddress + AlignmentMask) & ~AlignmentMask;\r
-    \r
-  return (VOID *) AlignedAddress;\r
-}\r
-\r
-/**\r
-  Allocates a buffer of type EfiBootServicesData at a specified alignment.\r
-\r
-  Allocates the number bytes specified by AllocationSize of type EfiBootServicesData with an\r
-  alignment specified by Alignment.  The allocated buffer is returned.  If AllocationSize is 0,\r
-  then a valid buffer of 0 size is returned.  If there is not enough memory at the specified\r
-  alignment remaining to satisfy the request, then NULL is returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
-\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
-\r
-  @return A pointer to the allocated buffer or NULL if allocation fails.\r
-\r
-**/\r
-VOID *\r
-EFIAPI\r
-AllocateAlignedPool (\r
-  IN UINTN  AllocationSize,\r
-  IN UINTN  Alignment\r
-  )\r
-{\r
-  VOID    *RawAddress;\r
-  UINTN   AlignedAddress;\r
-  UINTN   AlignmentMask;\r
-\r
-  //\r
-  // Alignment must be a power of two or zero.\r
-  //\r
-  ASSERT ((Alignment & (Alignment - 1)) == 0);\r
-\r
-  if (Alignment == 0) {\r
-    AlignmentMask = Alignment;\r
-  } else {\r
-    AlignmentMask = Alignment - 1;\r
-  }\r
-\r
-  //\r
-  // Make sure that AllocationSize plus AlignmentMask does not overflow.\r
-  //\r
-  ASSERT (AllocationSize <= (MAX_ADDRESS - AlignmentMask));\r
-\r
-  RawAddress      = AllocatePool (AllocationSize + AlignmentMask);\r
+  Allocates and zeros the number bytes specified by NewSize from memory of the type\r
+  specified by PoolType.  If OldBuffer is not NULL, then the smaller of OldSize and \r
+  NewSize bytes are copied from OldBuffer to the newly allocated buffer, and \r
+  OldBuffer is freed.  A pointer to the newly allocated buffer is returned.  \r
+  If NewSize is 0, then a valid buffer of 0 size is  returned.  If there is not \r
+  enough memory remaining to satisfy the request, then NULL is returned.\r
   \r
-  AlignedAddress  = ((UINTN) RawAddress + AlignmentMask) & ~AlignmentMask;\r
-    \r
-  return (VOID *) AlignedAddress;\r
-}\r
-\r
-/**\r
-  Allocates a buffer of type EfiRuntimeServicesData at a specified alignment.\r
-\r
-  Allocates the number bytes specified by AllocationSize of type EfiRuntimeServicesData with an\r
-  alignment specified by Alignment.  The allocated buffer is returned.  If AllocationSize is 0,\r
-  then a valid buffer of 0 size is returned.  If there is not enough memory at the specified\r
-  alignment remaining to satisfy the request, then NULL is returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
-\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
-\r
-  @return A pointer to the allocated buffer or NULL if allocation fails.\r
-\r
-**/\r
-VOID *\r
-EFIAPI\r
-AllocateAlignedRuntimePool (\r
-  IN UINTN  AllocationSize,\r
-  IN UINTN  Alignment\r
-  )\r
-{\r
-  return InternalAllocateAlignedPool (EfiRuntimeServicesData, AllocationSize, Alignment);\r
-}\r
-\r
-/**\r
-  Allocates a buffer of type EfieservedMemoryType at a specified alignment.\r
-\r
-  Allocates the number bytes specified by AllocationSize of type EfieservedMemoryType with an\r
-  alignment specified by Alignment.  The allocated buffer is returned.  If AllocationSize is 0,\r
-  then a valid buffer of 0 size is returned.  If there is not enough memory at the specified\r
-  alignment remaining to satisfy the request, then NULL is returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
-\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
+  If the allocation of the new buffer is successful and the smaller of NewSize and OldSize\r
+  is greater than (MAX_ADDRESS - OldBuffer + 1), then ASSERT().\r
 \r
-  @return A pointer to the allocated buffer or NULL if allocation fails.\r
-\r
-**/\r
-VOID *\r
-EFIAPI\r
-AllocateAlignedReservedPool (\r
-  IN UINTN  AllocationSize,\r
-  IN UINTN  Alignment\r
-  )\r
-{\r
-  return InternalAllocateAlignedPool (EfiReservedMemoryType, AllocationSize, Alignment);\r
-}\r
-\r
-/**\r
-  Allocates and zeros a buffer of a certain pool type at a specified alignment.\r
-\r
-  Allocates the number bytes specified by AllocationSize of a certain pool type with an alignment\r
-  specified by Alignment, clears the buffer with zeros, and returns a pointer to the allocated\r
-  buffer.  If AllocationSize is 0, then a valid buffer of 0 size is returned.  If there is not\r
-  enough memory at the specified alignment remaining to satisfy the request, then NULL is returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
-\r
-  @param  PoolType              The type of pool to allocate.\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
+  @param  PoolType       The type of pool to allocate.\r
+  @param  OldSize        The size, in bytes, of OldBuffer.\r
+  @param  NewSize        The size, in bytes, of the buffer to reallocate.\r
+  @param  OldBuffer      The buffer to copy to the allocated buffer.  This is an \r
+                         optional parameter that may be NULL.\r
 \r
   @return A pointer to the allocated buffer or NULL if allocation fails.\r
 \r
 **/\r
 VOID *\r
-InternalAllocateAlignedZeroPool (\r
-  IN EFI_MEMORY_TYPE  PoolType,\r
-  IN UINTN            AllocationSize,\r
-  IN UINTN            Alignment\r
+InternalReallocatePool (\r
+  IN EFI_MEMORY_TYPE  PoolType,  \r
+  IN UINTN            OldSize,\r
+  IN UINTN            NewSize,\r
+  IN VOID             *OldBuffer  OPTIONAL\r
   )\r
 {\r
-  VOID    *Memory;\r
+  VOID  *NewBuffer;\r
 \r
-  Memory = InternalAllocateAlignedPool (PoolType, AllocationSize, Alignment);\r
-  if (Memory != NULL) {\r
-    Memory = ZeroMem (Memory, AllocationSize);\r
+  NewBuffer = InternalAllocateZeroPool (PoolType, NewSize);\r
+  if (NewBuffer != NULL && OldBuffer != NULL) {\r
+    CopyMem (NewBuffer, OldBuffer, MIN (OldSize, NewSize));\r
+    FreePool (OldBuffer);\r
   }\r
-  return Memory;\r
+  return NewBuffer;\r
 }\r
 \r
 /**\r
-  Allocates and zeros a buffer of type EfiBootServicesData at a specified alignment.\r
+  Reallocates a buffer of type EfiBootServicesData.\r
 \r
-  Allocates the number bytes specified by AllocationSize of type EfiBootServicesData with an\r
-  alignment specified by Alignment, clears the buffer with zeros, and returns a pointer to the\r
-  allocated buffer.  If AllocationSize is 0, then a valid buffer of 0 size is returned.  If there\r
-  is not enough memory at the specified alignment remaining to satisfy the request, then NULL is\r
-  returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
+  Allocates and zeros the number bytes specified by NewSize from memory of type\r
+  EfiBootServicesData.  If OldBuffer is not NULL, then the smaller of OldSize and \r
+  NewSize bytes are copied from OldBuffer to the newly allocated buffer, and \r
+  OldBuffer is freed.  A pointer to the newly allocated buffer is returned.  \r
+  If NewSize is 0, then a valid buffer of 0 size is  returned.  If there is not \r
+  enough memory remaining to satisfy the request, then NULL is returned.\r
+  \r
+  If the allocation of the new buffer is successful and the smaller of NewSize and OldSize\r
+  is greater than (MAX_ADDRESS - OldBuffer + 1), then ASSERT().\r
 \r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
+  @param  OldSize        The size, in bytes, of OldBuffer.\r
+  @param  NewSize        The size, in bytes, of the buffer to reallocate.\r
+  @param  OldBuffer      The buffer to copy to the allocated buffer.  This is an optional \r
+                         parameter that may be NULL.\r
 \r
   @return A pointer to the allocated buffer or NULL if allocation fails.\r
 \r
 **/\r
 VOID *\r
 EFIAPI\r
-AllocateAlignedZeroPool (\r
-  IN UINTN  AllocationSize,\r
-  IN UINTN  Alignment\r
+ReallocatePool (\r
+  IN UINTN  OldSize,\r
+  IN UINTN  NewSize,\r
+  IN VOID   *OldBuffer  OPTIONAL\r
   )\r
 {\r
-  VOID    *Memory;\r
-\r
-  Memory = AllocateAlignedPool (AllocationSize, Alignment);\r
-  if (Memory != NULL) {\r
-    Memory = ZeroMem (Memory, AllocationSize);\r
-  }\r
-  return Memory;\r
+  return InternalReallocatePool (EfiBootServicesData, OldSize, NewSize, OldBuffer);\r
 }\r
 \r
 /**\r
-  Allocates and zeros a buffer of type EfiRuntimeServicesData at a specified alignment.\r
+  Reallocates a buffer of type EfiRuntimeServicesData.\r
 \r
-  Allocates the number bytes specified by AllocationSize of type EfiRuntimeServicesData with an\r
-  alignment specified by Alignment, clears the buffer with zeros, and returns a pointer to the\r
-  allocated buffer.  If AllocationSize is 0, then a valid buffer of 0 size is returned.  If there\r
-  is not enough memory at the specified alignment remaining to satisfy the request, then NULL is\r
-  returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
-\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
-\r
-  @return A pointer to the allocated buffer or NULL if allocation fails.\r
-\r
-**/\r
-VOID *\r
-EFIAPI\r
-AllocateAlignedRuntimeZeroPool (\r
-  IN UINTN  AllocationSize,\r
-  IN UINTN  Alignment\r
-  )\r
-{\r
-  return InternalAllocateAlignedZeroPool (EfiRuntimeServicesData, AllocationSize, Alignment);\r
-}\r
-\r
-/**\r
-  Allocates and zeros a buffer of type EfieservedMemoryType at a specified alignment.\r
+  Allocates and zeros the number bytes specified by NewSize from memory of type\r
+  EfiRuntimeServicesData.  If OldBuffer is not NULL, then the smaller of OldSize and \r
+  NewSize bytes are copied from OldBuffer to the newly allocated buffer, and \r
+  OldBuffer is freed.  A pointer to the newly allocated buffer is returned.  \r
+  If NewSize is 0, then a valid buffer of 0 size is  returned.  If there is not \r
+  enough memory remaining to satisfy the request, then NULL is returned.\r
 \r
-  Allocates the number bytes specified by AllocationSize of type EfieservedMemoryType with an\r
-  alignment specified by Alignment, clears the buffer with zeros, and returns a pointer to the\r
-  allocated buffer.  If AllocationSize is 0, then a valid buffer of 0 size is returned.  If there\r
-  is not enough memory at the specified alignment remaining to satisfy the request, then NULL is\r
-  returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
+  If the allocation of the new buffer is successful and the smaller of NewSize and OldSize\r
+  is greater than (MAX_ADDRESS - OldBuffer + 1), then ASSERT().\r
 \r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
+  @param  OldSize        The size, in bytes, of OldBuffer.\r
+  @param  NewSize        The size, in bytes, of the buffer to reallocate.\r
+  @param  OldBuffer      The buffer to copy to the allocated buffer.  This is an optional \r
+                         parameter that may be NULL.\r
 \r
   @return A pointer to the allocated buffer or NULL if allocation fails.\r
 \r
 **/\r
 VOID *\r
 EFIAPI\r
-AllocateAlignedReservedZeroPool (\r
-  IN UINTN  AllocationSize,\r
-  IN UINTN  Alignment\r
+ReallocateRuntimePool (\r
+  IN UINTN  OldSize,\r
+  IN UINTN  NewSize,\r
+  IN VOID   *OldBuffer  OPTIONAL\r
   )\r
 {\r
-  return InternalAllocateAlignedZeroPool (EfiReservedMemoryType, AllocationSize, Alignment);\r
+  return InternalReallocatePool (EfiRuntimeServicesData, OldSize, NewSize, OldBuffer);\r
 }\r
 \r
 /**\r
-  Copies a buffer to an allocated buffer of a certain pool type at a specified alignment.\r
+  Reallocates a buffer of type EfiReservedMemoryType.\r
 \r
-  Allocates the number bytes specified by AllocationSize of a certain pool type with an alignment\r
-  specified by Alignment.  The allocated buffer is returned.  If AllocationSize is 0, then a valid\r
-  buffer of 0 size is returned.  If there is not enough memory at the specified alignment remaining\r
-  to satisfy the request, then NULL is returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
+  Allocates and zeros the number bytes specified by NewSize from memory of type\r
+  EfiReservedMemoryType.  If OldBuffer is not NULL, then the smaller of OldSize and \r
+  NewSize bytes are copied from OldBuffer to the newly allocated buffer, and \r
+  OldBuffer is freed.  A pointer to the newly allocated buffer is returned.  \r
+  If NewSize is 0, then a valid buffer of 0 size is  returned.  If there is not \r
+  enough memory remaining to satisfy the request, then NULL is returned.\r
 \r
-  @param  PoolType              The type of pool to allocate.\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Buffer                The buffer to copy to the allocated buffer.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
+  If the allocation of the new buffer is successful and the smaller of NewSize and OldSize\r
+  is greater than (MAX_ADDRESS - OldBuffer + 1), then ASSERT().\r
 \r
-  @return A pointer to the allocated buffer or NULL if allocation fails.\r
-\r
-**/\r
-VOID *\r
-InternalAllocateAlignedCopyPool (\r
-  IN EFI_MEMORY_TYPE  PoolType,\r
-  IN UINTN            AllocationSize,\r
-  IN CONST VOID       *Buffer,\r
-  IN UINTN            Alignment\r
-  )\r
-{\r
-  VOID  *Memory;\r
-  \r
-  ASSERT (Buffer != NULL);\r
-  ASSERT (AllocationSize <= (MAX_ADDRESS - (UINTN) Buffer + 1));\r
-\r
-  Memory = InternalAllocateAlignedPool (PoolType, AllocationSize, Alignment);\r
-  if (Memory != NULL) {\r
-    Memory = CopyMem (Memory, Buffer, AllocationSize);\r
-  }\r
-  return Memory;\r
-}\r
-\r
-/**\r
-  Copies a buffer to an allocated buffer of type EfiBootServicesData at a specified alignment.\r
-\r
-  Allocates the number bytes specified by AllocationSize of type EfiBootServicesData type with an\r
-  alignment specified by Alignment.  The allocated buffer is returned.  If AllocationSize is 0,\r
-  then a valid buffer of 0 size is returned.  If there is not enough memory at the specified\r
-  alignment remaining to satisfy the request, then NULL is returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
-\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Buffer                The buffer to copy to the allocated buffer.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
-\r
-  @return A pointer to the allocated buffer or NULL if allocation fails.\r
-\r
-**/\r
-VOID *\r
-EFIAPI\r
-AllocateAlignedCopyPool (\r
-  IN UINTN       AllocationSize,\r
-  IN CONST VOID  *Buffer,\r
-  IN UINTN       Alignment\r
-  )\r
-{\r
-  VOID  *Memory;\r
-  \r
-  ASSERT (Buffer != NULL);\r
-  ASSERT (AllocationSize <= (MAX_ADDRESS - (UINTN) Buffer + 1));\r
-\r
-  Memory = AllocateAlignedPool (AllocationSize, Alignment);\r
-  if (Memory != NULL) {\r
-    Memory = CopyMem (Memory, Buffer, AllocationSize);\r
-  }\r
-  return Memory;\r
-}\r
-\r
-/**\r
-  Copies a buffer to an allocated buffer of type EfiRuntimeServicesData at a specified alignment.\r
-\r
-  Allocates the number bytes specified by AllocationSize of type EfiRuntimeServicesData type with an\r
-  alignment specified by Alignment.  The allocated buffer is returned.  If AllocationSize is 0,\r
-  then a valid buffer of 0 size is returned.  If there is not enough memory at the specified\r
-  alignment remaining to satisfy the request, then NULL is returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
-\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Buffer                The buffer to copy to the allocated buffer.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
-\r
-  @return A pointer to the allocated buffer or NULL if allocation fails.\r
-\r
-**/\r
-VOID *\r
-EFIAPI\r
-AllocateAlignedRuntimeCopyPool (\r
-  IN UINTN       AllocationSize,\r
-  IN CONST VOID  *Buffer,\r
-  IN UINTN       Alignment\r
-  )\r
-{\r
-  return InternalAllocateAlignedCopyPool (EfiRuntimeServicesData, AllocationSize, Buffer, Alignment);\r
-}\r
-\r
-/**\r
-  Copies a buffer to an allocated buffer of type EfiReservedMemoryType at a specified alignment.\r
-\r
-  Allocates the number bytes specified by AllocationSize of type EfiReservedMemoryType type with an\r
-  alignment specified by Alignment.  The allocated buffer is returned.  If AllocationSize is 0,\r
-  then a valid buffer of 0 size is returned.  If there is not enough memory at the specified\r
-  alignment remaining to satisfy the request, then NULL is returned.\r
-  If Alignment is not a power of two and Alignment is not zero, then ASSERT().\r
-\r
-  @param  AllocationSize        The number of bytes to allocate.\r
-  @param  Buffer                The buffer to copy to the allocated buffer.\r
-  @param  Alignment             The requested alignment of the allocation.  Must be a power of two.\r
-                                If Alignment is zero, then byte alignment is used.\r
+  @param  OldSize        The size, in bytes, of OldBuffer.\r
+  @param  NewSize        The size, in bytes, of the buffer to reallocate.\r
+  @param  OldBuffer      The buffer to copy to the allocated buffer.  This is an \r
+                         optional parameter that may be NULL.\r
 \r
   @return A pointer to the allocated buffer or NULL if allocation fails.\r
 \r
 **/\r
 VOID *\r
 EFIAPI\r
-AllocateAlignedReservedCopyPool (\r
-  IN UINTN       AllocationSize,\r
-  IN CONST VOID  *Buffer,\r
-  IN UINTN       Alignment\r
+ReallocateReservedPool (\r
+  IN UINTN  OldSize,\r
+  IN UINTN  NewSize,\r
+  IN VOID   *OldBuffer  OPTIONAL\r
   )\r
 {\r
-  return InternalAllocateAlignedCopyPool (EfiReservedMemoryType, AllocationSize, Buffer, Alignment);\r
+  return InternalReallocatePool (EfiReservedMemoryType, OldSize, NewSize, OldBuffer);\r
 }\r
 \r
 /**\r
-  Frees a buffer that was previously allocated with one of the aligned pool allocation functions \r
-  in the Memory Allocation Library.\r
+  Frees a buffer that was previously allocated with one of the pool allocation functions in the\r
+  Memory Allocation Library.\r
 \r
   Frees the buffer specified by Buffer.  Buffer must have been allocated on a previous call to the\r
-  aligned pool allocation services of the Memory Allocation Library.\r
-  If Buffer was not allocated with an aligned pool allocation function in the Memory Allocation\r
-  Library, then ASSERT().\r
+  pool allocation services of the Memory Allocation Library.  If it is not possible to free pool\r
+  resources, then this function will perform no actions.\r
+  \r
+  If Buffer was not allocated with a pool allocation function in the Memory Allocation Library,\r
+  then ASSERT().\r
 \r
-  @param  Buffer                Pointer to the buffer to free.\r
+  @param  Buffer                The pointer to the buffer to free.\r
 \r
 **/\r
 VOID\r
 EFIAPI\r
-FreeAlignedPool (\r
+FreePool (\r
   IN VOID   *Buffer\r
   )\r
 {\r
@@ -1079,3 +936,5 @@ FreeAlignedPool (
   // PEI phase does not support to free pool, so leave it as NOP.\r
   //\r
 }\r
+\r
+\r