Merge EDK tracker 892 to EDK II.

[mirror_edk2.git] / MdePkg / Library / PeiServicesTablePointerLibMm7 / PeiServicesTablePointer.c

/** @file\r
  PEI Services Table Pointer Library.\r
\r
  Copyright (c) 2006, Intel Corporation<BR>\r
  All rights reserved. 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
  Module Name:  PeiServicesTablePointer.c\r
\r
**/\r
\r
\r
#include <PiPei.h>\r
\r
\r
#include <Library/PeiServicesTablePointerLib.h>\r
#include <Library/BaseLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/PeiServicesLib.h>\r
\r
VOID\r
EFIAPI\r
SetPeiServicesTablePointer (\r
  IN EFI_PEI_SERVICES     **PeiServices\r
  )\r
{\r
  AsmWriteMm7 ((UINT64)(UINTN)PeiServices);\r
}\r
\r
/**\r
  The function returns the pointer to PeiServices.\r
\r
  The function returns the pointer to PeiServices.\r
  It will ASSERT() if the pointer to PeiServices is NULL.\r
\r
  @retval  The pointer to PeiServices.\r
\r
**/\r
EFI_PEI_SERVICES **\r
EFIAPI\r
GetPeiServicesTablePointer (\r
  VOID\r
  )\r
{\r
  EFI_PEI_SERVICES  **PeiServices;\r
\r
  PeiServices = (EFI_PEI_SERVICES **)(UINTN)AsmReadMm7 ();\r
  ASSERT (PeiServices != NULL);\r
  return PeiServices;\r
}\r
\r
/**\r
  The constructor function caches the pointer to PEI services.\r
\r
  The constructor function caches the pointer to PEI services.\r
  It will always return EFI_SUCCESS.\r
\r
  @param  FfsHeader   Pointer to FFS header the loaded driver.\r
  @param  PeiServices Pointer to the PEI services.\r
\r
  @retval EFI_SUCCESS   The constructor always returns EFI_SUCCESS.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
PeiServicesTablePointerLibConstructor (\r
  IN EFI_PEI_FILE_HANDLE  *FfsHeader,\r
  IN EFI_PEI_SERVICES     **PeiServices\r
  )\r
{\r
  AsmWriteMm7 ((UINT64)(UINTN)PeiServices);\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  After memory initialization in PEI phase, the IDT table in temporary memory should \r
  be migrated to memory, and the address of PeiServicesPointer also need to be updated  \r
  immediately preceding the new IDT table.\r
  \r
  @param    PeiServices   The address of PeiServices pointer.\r
**/\r
VOID\r
MigrateIdtTable (\r
  IN EFI_PEI_SERVICES  **PeiServices\r
  )\r
{\r
  UINTN           Size;\r
  VOID            *NewBase;\r
  EFI_STATUS      Status;\r
  IA32_DESCRIPTOR Idtr;\r
  \r
  AsmReadIdtr (&Idtr);\r
  \r
  Size = Idtr.Limit + 1;\r
  \r
  Status = PeiServicesAllocatePool (Size, &NewBase);\r
  ASSERT_EFI_ERROR (Status);\r
  \r
  CopyMem (NewBase, (VOID*)Idtr.Base, Size);\r
  \r
  Idtr.Base = (UINTN)NewBase;\r
  AsmWriteIdtr (&Idtr);\r
}\r
\r