[mirror_edk2.git] / StandaloneMmPkg / Library / StandaloneMmCoreMemoryAllocationLib / StandaloneMmCoreMemoryAllocationLib.c

/** @file\r
  Support routines for memory allocation routines based on Standalone MM Core internal functions.\r
\r
  Copyright (c) 2015, Intel Corporation. All rights reserved.<BR>\r
  Copyright (c) 2016 - 2018, ARM Limited. All rights reserved.<BR>\r
\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
\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
\r
#include <PiMm.h>\r
\r
#include <Guid/MmramMemoryReserve.h>\r
#include <Library/MemoryAllocationLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/HobLib.h>\r
#include "StandaloneMmCoreMemoryAllocationServices.h"\r
\r
EFI_MM_SYSTEM_TABLE   *gMmst = NULL;\r
\r
/**\r
  Allocates one or more 4KB pages of a certain memory type.\r
\r
  Allocates the number of 4KB pages of a certain memory type and returns a pointer to the allocated\r
  buffer.  The buffer returned is aligned on a 4KB boundary.  If Pages is 0, then NULL is returned.\r
  If there is not enough memory remaining to satisfy the request, then NULL is returned.\r
\r
  @param  MemoryType            The type of memory to allocate.\r
  @param  Pages                 The number of 4 KB pages to allocate.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
InternalAllocatePages (\r
  IN EFI_MEMORY_TYPE  MemoryType,\r
  IN UINTN            Pages\r
  )\r
{\r
  EFI_STATUS            Status;\r
  EFI_PHYSICAL_ADDRESS  Memory;\r
\r
  if (Pages == 0) {\r
    return NULL;\r
  }\r
\r
  Status = gMmst->MmAllocatePages (AllocateAnyPages, MemoryType, Pages, &Memory);\r
  if (EFI_ERROR (Status)) {\r
    return NULL;\r
  }\r
  return (VOID *) (UINTN) Memory;\r
}\r
\r
/**\r
  Allocates one or more 4KB pages of type EfiBootServicesData.\r
\r
  Allocates the number of 4KB pages of type EfiBootServicesData and returns a pointer to the\r
  allocated buffer.  The buffer returned is aligned on a 4KB boundary.  If Pages is 0, then NULL\r
  is returned.  If there is not enough memory remaining to satisfy the request, then NULL is\r
  returned.\r
\r
  @param  Pages                 The number of 4 KB pages to allocate.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocatePages (\r
  IN UINTN  Pages\r
  )\r
{\r
  return InternalAllocatePages (EfiRuntimeServicesData, Pages);\r
}\r
\r
/**\r
  Allocates one or more 4KB pages of type EfiRuntimeServicesData.\r
\r
  Allocates the number of 4KB pages of type EfiRuntimeServicesData and returns a pointer to the\r
  allocated buffer.  The buffer returned is aligned on a 4KB boundary.  If Pages is 0, then NULL\r
  is returned.  If there is not enough memory remaining to satisfy the request, then NULL is\r
  returned.\r
\r
  @param  Pages                 The number of 4 KB pages to allocate.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateRuntimePages (\r
  IN UINTN  Pages\r
  )\r
{\r
  return InternalAllocatePages (EfiRuntimeServicesData, Pages);\r
}\r
\r
/**\r
  Allocates one or more 4KB pages of type EfiReservedMemoryType.\r
\r
  Allocates the number of 4KB pages of type EfiReservedMemoryType and returns a pointer to the\r
  allocated buffer.  The buffer returned is aligned on a 4KB boundary.  If Pages is 0, then NULL\r
  is returned.  If there is not enough memory remaining to satisfy the request, then NULL is\r
  returned.\r
\r
  @param  Pages                 The number of 4 KB pages to allocate.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateReservedPages (\r
  IN UINTN  Pages\r
  )\r
{\r
  return NULL;\r
}\r
\r
/**\r
  Frees one or more 4KB pages that were previously allocated with one of the page allocation\r
  functions in the Memory Allocation Library.\r
\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.  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  Pages                 The number of 4 KB pages to free.\r
\r
**/\r
VOID\r
EFIAPI\r
FreePages (\r
  IN VOID   *Buffer,\r
  IN UINTN  Pages\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  ASSERT (Pages != 0);\r
  Status = gMmst->MmFreePages ((EFI_PHYSICAL_ADDRESS) (UINTN) Buffer, Pages);\r
  ASSERT_EFI_ERROR (Status);\r
}\r
\r
/**\r
  Allocates one or more 4KB pages of a certain memory type at a specified alignment.\r
\r
  Allocates the number of 4KB pages specified by Pages of a certain memory type with an alignment\r
  specified by Alignment.  The allocated buffer is returned.  If Pages is 0, then NULL is returned.\r
  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
                                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
InternalAllocateAlignedPages (\r
  IN EFI_MEMORY_TYPE  MemoryType,\r
  IN UINTN            Pages,\r
  IN UINTN            Alignment\r
  )\r
{\r
  EFI_STATUS            Status;\r
  EFI_PHYSICAL_ADDRESS  Memory;\r
  UINTN                 AlignedMemory;\r
  UINTN                 AlignmentMask;\r
  UINTN                 UnalignedPages;\r
  UINTN                 RealPages;\r
\r
  //\r
  // Alignment must be a power of two or zero.\r
  //\r
  ASSERT ((Alignment & (Alignment - 1)) == 0);\r
\r
  if (Pages == 0) {\r
    return NULL;\r
  }\r
  if (Alignment > EFI_PAGE_SIZE) {\r
    //\r
    // Calculate the total number of pages since alignment is larger than page size.\r
    //\r
    AlignmentMask  = Alignment - 1;\r
    RealPages      = Pages + EFI_SIZE_TO_PAGES (Alignment);\r
    //\r
    // Make sure that Pages plus EFI_SIZE_TO_PAGES (Alignment) does not overflow.\r
    //\r
    ASSERT (RealPages > Pages);\r
\r
    Status = gMmst->MmAllocatePages (AllocateAnyPages, MemoryType, RealPages, &Memory);\r
    if (EFI_ERROR (Status)) {\r
      return NULL;\r
    }\r
    AlignedMemory  = ((UINTN) Memory + AlignmentMask) & ~AlignmentMask;\r
    UnalignedPages = EFI_SIZE_TO_PAGES (AlignedMemory - (UINTN) Memory);\r
    if (UnalignedPages > 0) {\r
      //\r
      // Free first unaligned page(s).\r
      //\r
      Status = gMmst->MmFreePages (Memory, UnalignedPages);\r
      ASSERT_EFI_ERROR (Status);\r
    }\r
    Memory = (EFI_PHYSICAL_ADDRESS) (AlignedMemory + EFI_PAGES_TO_SIZE (Pages));\r
    UnalignedPages = RealPages - Pages - UnalignedPages;\r
    if (UnalignedPages > 0) {\r
      //\r
      // Free last unaligned page(s).\r
      //\r
      Status = gMmst->MmFreePages (Memory, UnalignedPages);\r
      ASSERT_EFI_ERROR (Status);\r
    }\r
  } else {\r
    //\r
    // Do not over-allocate pages in this case.\r
    //\r
    Status = gMmst->MmAllocatePages (AllocateAnyPages, MemoryType, Pages, &Memory);\r
    if (EFI_ERROR (Status)) {\r
      return NULL;\r
    }\r
    AlignedMemory  = (UINTN) Memory;\r
  }\r
  return (VOID *) AlignedMemory;\r
}\r
\r
/**\r
  Allocates one or more 4KB pages of type EfiBootServicesData at a specified alignment.\r
\r
  Allocates the number of 4KB pages specified by Pages of type EfiBootServicesData with an\r
  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
                                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
AllocateAlignedPages (\r
  IN UINTN  Pages,\r
  IN UINTN  Alignment\r
  )\r
{\r
  return InternalAllocateAlignedPages (EfiRuntimeServicesData, Pages, Alignment);\r
}\r
\r
/**\r
  Allocates one or more 4KB pages of type EfiRuntimeServicesData at a specified alignment.\r
\r
  Allocates the number of 4KB pages specified by Pages of type EfiRuntimeServicesData with an\r
  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
                                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
AllocateAlignedRuntimePages (\r
  IN UINTN  Pages,\r
  IN UINTN  Alignment\r
  )\r
{\r
  return InternalAllocateAlignedPages (EfiRuntimeServicesData, Pages, Alignment);\r
}\r
\r
/**\r
  Allocates one or more 4KB pages of type EfiReservedMemoryType at a specified alignment.\r
\r
  Allocates the number of 4KB pages specified by Pages of type EfiReservedMemoryType with an\r
  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
                                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
AllocateAlignedReservedPages (\r
  IN UINTN  Pages,\r
  IN UINTN  Alignment\r
  )\r
{\r
  return NULL;\r
}\r
\r
/**\r
  Frees one or more 4KB pages that were previously allocated with one of the aligned page\r
  allocation functions in the Memory Allocation Library.\r
\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.  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  Pages                 The number of 4 KB pages to free.\r
\r
**/\r
VOID\r
EFIAPI\r
FreeAlignedPages (\r
  IN VOID   *Buffer,\r
  IN UINTN  Pages\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  ASSERT (Pages != 0);\r
  Status = gMmst->MmFreePages ((EFI_PHYSICAL_ADDRESS) (UINTN) Buffer, Pages);\r
  ASSERT_EFI_ERROR (Status);\r
}\r
\r
/**\r
  Allocates a buffer of a certain pool type.\r
\r
  Allocates the number bytes specified by AllocationSize of a certain pool type and returns a\r
  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
  @param  MemoryType            The type of memory to allocate.\r
  @param  AllocationSize        The number of bytes to allocate.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
InternalAllocatePool (\r
  IN EFI_MEMORY_TYPE  MemoryType,\r
  IN UINTN            AllocationSize\r
  )\r
{\r
  EFI_STATUS  Status;\r
  VOID        *Memory;\r
\r
  Memory = NULL;\r
\r
  Status = gMmst->MmAllocatePool (MemoryType, AllocationSize, &Memory);\r
  if (EFI_ERROR (Status)) {\r
    Memory = NULL;\r
  }\r
  return Memory;\r
}\r
\r
/**\r
  Allocates a buffer of type EfiBootServicesData.\r
\r
  Allocates the number bytes specified by AllocationSize of type EfiBootServicesData and returns a\r
  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
  @param  AllocationSize        The number of bytes to allocate.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocatePool (\r
  IN UINTN  AllocationSize\r
  )\r
{\r
  return InternalAllocatePool (EfiRuntimeServicesData, AllocationSize);\r
}\r
\r
/**\r
  Allocates a buffer of type EfiRuntimeServicesData.\r
\r
  Allocates the number bytes specified by AllocationSize of type EfiRuntimeServicesData 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
  @param  AllocationSize        The number of bytes to allocate.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateRuntimePool (\r
  IN UINTN  AllocationSize\r
  )\r
{\r
  return InternalAllocatePool (EfiRuntimeServicesData, AllocationSize);\r
}\r
\r
/**\r
  Allocates a buffer of type EfiReservedMemoryType.\r
\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
  @param  AllocationSize        The number of bytes to allocate.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateReservedPool (\r
  IN UINTN  AllocationSize\r
  )\r
{\r
  return NULL;\r
}\r
\r
/**\r
  Allocates and zeros a buffer of a certain pool type.\r
\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
\r
  @param  PoolType              The type of memory to allocate.\r
  @param  AllocationSize        The number of bytes to allocate and zero.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
InternalAllocateZeroPool (\r
  IN EFI_MEMORY_TYPE  PoolType,\r
  IN UINTN            AllocationSize\r
  )\r
{\r
  VOID  *Memory;\r
\r
  Memory = InternalAllocatePool (PoolType, AllocationSize);\r
  if (Memory != NULL) {\r
    Memory = ZeroMem (Memory, AllocationSize);\r
  }\r
  return Memory;\r
}\r
\r
/**\r
  Allocates and zeros a buffer of type EfiBootServicesData.\r
\r
  Allocates the number bytes specified by AllocationSize of type EfiBootServicesData, clears the\r
  buffer with zeros, and returns a pointer to the allocated buffer.  If AllocationSize is 0, then a\r
  valid buffer of 0 size is returned.  If there is not enough memory remaining to satisfy the\r
  request, then NULL is returned.\r
\r
  @param  AllocationSize        The number of bytes to allocate and zero.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateZeroPool (\r
  IN UINTN  AllocationSize\r
  )\r
{\r
  return InternalAllocateZeroPool (EfiRuntimeServicesData, AllocationSize);\r
}\r
\r
/**\r
  Allocates and zeros a buffer of type EfiRuntimeServicesData.\r
\r
  Allocates the number bytes specified by AllocationSize of type EfiRuntimeServicesData, clears the\r
  buffer with zeros, and returns a pointer to the allocated buffer.  If AllocationSize is 0, then a\r
  valid buffer of 0 size is returned.  If there is not enough memory remaining to satisfy the\r
  request, then NULL is returned.\r
\r
  @param  AllocationSize        The number of bytes to allocate and zero.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateRuntimeZeroPool (\r
  IN UINTN  AllocationSize\r
  )\r
{\r
  return InternalAllocateZeroPool (EfiRuntimeServicesData, AllocationSize);\r
}\r
\r
/**\r
  Allocates and zeros a buffer of type EfiReservedMemoryType.\r
\r
  Allocates the number bytes specified by AllocationSize of type EfiReservedMemoryType, clears the\r
  buffer with zeros, and returns a pointer to the allocated buffer.  If AllocationSize is 0, then a\r
  valid buffer of 0 size is returned.  If there is not enough memory remaining to satisfy the\r
  request, then NULL is returned.\r
\r
  @param  AllocationSize        The number of bytes to allocate and zero.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateReservedZeroPool (\r
  IN UINTN  AllocationSize\r
  )\r
{\r
  return NULL;\r
}\r
\r
/**\r
  Copies a buffer to an allocated buffer of a certain pool type.\r
\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
\r
  @param  PoolType              The type of pool to allocate.\r
  @param  AllocationSize        The number of bytes to allocate and zero.\r
  @param  Buffer                The buffer to copy to the allocated buffer.\r
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
InternalAllocateCopyPool (\r
  IN EFI_MEMORY_TYPE  PoolType,\r
  IN UINTN            AllocationSize,\r
  IN CONST VOID       *Buffer\r
  )\r
{\r
  VOID  *Memory;\r
\r
  ASSERT (Buffer != NULL);\r
  ASSERT (AllocationSize <= (MAX_ADDRESS - (UINTN) Buffer + 1));\r
\r
  Memory = InternalAllocatePool (PoolType, AllocationSize);\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.\r
\r
  Allocates the number bytes specified by AllocationSize of type EfiBootServicesData, 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
\r
  If Buffer is NULL, 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
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateCopyPool (\r
  IN UINTN       AllocationSize,\r
  IN CONST VOID  *Buffer\r
  )\r
{\r
  return InternalAllocateCopyPool (EfiRuntimeServicesData, AllocationSize, Buffer);\r
}\r
\r
/**\r
  Copies a buffer to an allocated buffer of type EfiRuntimeServicesData.\r
\r
  Allocates the number bytes specified by AllocationSize of type EfiRuntimeServicesData, 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
\r
  If Buffer is NULL, 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
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateRuntimeCopyPool (\r
  IN UINTN       AllocationSize,\r
  IN CONST VOID  *Buffer\r
  )\r
{\r
  return InternalAllocateCopyPool (EfiRuntimeServicesData, AllocationSize, Buffer);\r
}\r
\r
/**\r
  Copies a buffer to an allocated buffer of type EfiReservedMemoryType.\r
\r
  Allocates the number bytes specified by AllocationSize of type EfiReservedMemoryType, 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
\r
  If Buffer is NULL, 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
\r
  @return A pointer to the allocated buffer or NULL if allocation fails.\r
\r
**/\r
VOID *\r
EFIAPI\r
AllocateReservedCopyPool (\r
  IN UINTN       AllocationSize,\r
  IN CONST VOID  *Buffer\r
  )\r
{\r
  return NULL;\r
}\r
\r
/**\r
  Reallocates a buffer of a specified memory type.\r
\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
  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  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 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
InternalReallocatePool (\r
  IN EFI_MEMORY_TYPE  PoolType,\r
  IN UINTN            OldSize,\r
  IN UINTN            NewSize,\r
  IN VOID             *OldBuffer  OPTIONAL\r
  )\r
{\r
  VOID  *NewBuffer;\r
\r
  NewBuffer = InternalAllocateZeroPool (PoolType, NewSize);\r
  if (NewBuffer != NULL && OldBuffer != NULL) {\r
    CopyMem (NewBuffer, OldBuffer, MIN (OldSize, NewSize));\r
    FreePool (OldBuffer);\r
  }\r
  return NewBuffer;\r
}\r
\r
/**\r
  Reallocates a buffer of type EfiBootServicesData.\r
\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  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
ReallocatePool (\r
  IN UINTN  OldSize,\r
  IN UINTN  NewSize,\r
  IN VOID   *OldBuffer  OPTIONAL\r
  )\r
{\r
  return InternalReallocatePool (EfiRuntimeServicesData, OldSize, NewSize, OldBuffer);\r
}\r
\r
/**\r
  Reallocates a buffer of type EfiRuntimeServicesData.\r
\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
  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  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
ReallocateRuntimePool (\r
  IN UINTN  OldSize,\r
  IN UINTN  NewSize,\r
  IN VOID   *OldBuffer  OPTIONAL\r
  )\r
{\r
  return InternalReallocatePool (EfiRuntimeServicesData, OldSize, NewSize, OldBuffer);\r
}\r
\r
/**\r
  Reallocates a buffer of type EfiReservedMemoryType.\r
\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
  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  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
ReallocateReservedPool (\r
  IN UINTN  OldSize,\r
  IN UINTN  NewSize,\r
  IN VOID   *OldBuffer  OPTIONAL\r
  )\r
{\r
  return NULL;\r
}\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.  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
\r
**/\r
VOID\r
EFIAPI\r
FreePool (\r
  IN VOID   *Buffer\r
  )\r
{\r
  EFI_STATUS    Status;\r
\r
  Status = gMmst->MmFreePool (Buffer);\r
  ASSERT_EFI_ERROR (Status);\r
}\r
\r
/**\r
  The constructor function calls MmInitializeMemoryServices to initialize\r
  memory in MMRAM and caches EFI_MM_SYSTEM_TABLE pointer.\r
\r
  @param  ImageHandle   The firmware allocated handle for the EFI image.\r
  @param  SystemTable   A pointer to the Management mode System Table.\r
\r
  @retval EFI_SUCCESS   The constructor always returns EFI_SUCCESS.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
MemoryAllocationLibConstructor (\r
  IN EFI_HANDLE             ImageHandle,\r
  IN EFI_MM_SYSTEM_TABLE    *MmSystemTable\r
  )\r
{\r
  MM_CORE_PRIVATE_DATA           *MmCorePrivate;\r
  EFI_HOB_GUID_TYPE               *GuidHob;\r
  MM_CORE_DATA_HOB_DATA          *DataInHob;\r
  VOID                            *HobStart;\r
  EFI_MMRAM_HOB_DESCRIPTOR_BLOCK  *MmramRangesHobData;\r
  EFI_MMRAM_DESCRIPTOR            *MmramRanges;\r
  UINT32                           MmramRangeCount;\r
  EFI_HOB_GUID_TYPE               *MmramRangesHob;\r
\r
  HobStart = GetHobList ();\r
  DEBUG ((DEBUG_INFO, "StandaloneMmCoreMemoryAllocationLibConstructor - 0x%x\n", HobStart));\r
\r
  //\r
  // Extract MM Core Private context from the Hob. If absent search for\r
  // a Hob containing the MMRAM ranges\r
  //\r
  GuidHob = GetNextGuidHob (&gMmCoreDataHobGuid, HobStart);\r
  if (GuidHob == NULL) {\r
    MmramRangesHob = GetNextGuidHob (&gEfiMmPeiMmramMemoryReserveGuid, HobStart);\r
    if (MmramRangesHob == NULL) {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
    MmramRangesHobData = GET_GUID_HOB_DATA (MmramRangesHob);\r
    if (MmramRangesHobData == NULL) {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
    MmramRanges = MmramRangesHobData->Descriptor;\r
    if (MmramRanges == NULL) {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
    MmramRangeCount = MmramRangesHobData->NumberOfMmReservedRegions;\r
    if (MmramRanges == NULL) {\r
      return EFI_UNSUPPORTED;\r
    }\r
\r
  } else {\r
    DataInHob      = GET_GUID_HOB_DATA (GuidHob);\r
    MmCorePrivate = (MM_CORE_PRIVATE_DATA *)(UINTN)DataInHob->Address;\r
    MmramRanges     = (EFI_MMRAM_DESCRIPTOR *)(UINTN)MmCorePrivate->MmramRanges;\r
    MmramRangeCount = MmCorePrivate->MmramRangeCount;\r
  }\r
\r
  {\r
    UINTN                Index;\r
\r
    DEBUG ((DEBUG_INFO, "MmramRangeCount - 0x%x\n", MmramRangeCount));\r
    for (Index = 0; Index < MmramRangeCount; Index++) {\r
      DEBUG ((DEBUG_INFO, "MmramRanges[%d]: 0x%016lx - 0x%016lx\n",\r
              Index, MmramRanges[Index].CpuStart, MmramRanges[Index].PhysicalSize));\r
    }\r
  }\r
\r
  //\r
  // Initialize memory service using free MMRAM\r
  //\r
  DEBUG ((DEBUG_INFO, "MmInitializeMemoryServices\n"));\r
  MmInitializeMemoryServices ((UINTN)MmramRangeCount, (VOID *)(UINTN)MmramRanges);\r
\r
  // Initialize MM Services Table\r
  gMmst = MmSystemTable;\r
  return EFI_SUCCESS;\r
}\r