ArmPkg: Move ARM Platform drivers from ArmPkg/Drivers/ to ArmPlatformPkg/Drivers/

[mirror_edk2.git] / ArmPlatformPkg / PrePeiCore / PrePeiCore.c

/** @file\r
*  Main file supporting the transition to PEI Core in Normal World for Versatile Express\r
*\r
*  Copyright (c) 2011, ARM Limited. All rights reserved.\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 <Library/IoLib.h>\r
#include <Library/BaseLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/PrintLib.h>\r
#include <Library/ArmLib.h>\r
#include <Library/SerialPortLib.h>\r
#include <Chipset/ArmV7.h>\r
\r
#include "PrePeiCore.h"\r
\r
EFI_PEI_TEMPORARY_RAM_SUPPORT_PPI   mSecTemporaryRamSupportPpi = {SecTemporaryRamSupport};\r
\r
EFI_PEI_PPI_DESCRIPTOR      gSecPpiTable[] = {\r
  {\r
    EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST,\r
    &gEfiTemporaryRamSupportPpiGuid,\r
    &mSecTemporaryRamSupportPpi\r
  }\r
};\r
\r
VOID\r
CEntryPoint (\r
  IN  UINTN                     CoreId,\r
  IN  EFI_PEI_CORE_ENTRY_POINT  PeiCoreEntryPoint\r
  )\r
{\r
  //Clean Data cache\r
  ArmCleanInvalidateDataCache();\r
\r
  //Invalidate instruction cache\r
  ArmInvalidateInstructionCache();\r
\r
  // Enable Instruction & Data caches\r
  ArmEnableDataCache ();\r
  ArmEnableInstructionCache ();\r
\r
  //\r
  // Note: Doesn't have to Enable CPU interface in non-secure world,\r
  // as Non-secure interface is already enabled in Secure world.\r
  //\r
\r
  // Write VBAR - The Vector table must be 32-byte aligned\r
  ASSERT(((UINT32)PeiVectorTable & ((1 << 5)-1)) == 0);\r
  ArmWriteVBar((UINT32)PeiVectorTable);\r
\r
  //Note: The MMU will be enabled by MemoryPeim. Only the primary core will have the MMU on.\r
\r
  //If not primary Jump to Secondary Main\r
  if(0 == CoreId) {\r
    //Goto primary Main.\r
    PrimaryMain (PeiCoreEntryPoint);\r
  } else {\r
    SecondaryMain (CoreId);\r
  }\r
\r
  // PEI Core should always load and never return\r
  ASSERT (FALSE);\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
SecTemporaryRamSupport (\r
  IN CONST EFI_PEI_SERVICES   **PeiServices,\r
  IN EFI_PHYSICAL_ADDRESS     TemporaryMemoryBase,\r
  IN EFI_PHYSICAL_ADDRESS     PermanentMemoryBase,\r
  IN UINTN                    CopySize\r
  )\r
{\r
  //\r
  // Migrate the whole temporary memory to permenent memory.\r
  //\r
  CopyMem (\r
    (VOID*)(UINTN)PermanentMemoryBase, \r
    (VOID*)(UINTN)TemporaryMemoryBase, \r
    CopySize\r
    );\r
\r
  SecSwitchStack((UINTN)(PermanentMemoryBase - TemporaryMemoryBase));\r
\r
  return EFI_SUCCESS;\r
}\r
\r
VOID\r
PeiCommonExceptionEntry (\r
  IN UINT32 Entry,\r
  IN UINT32 LR\r
  )\r
{\r
  CHAR8           Buffer[100];\r
  UINTN           CharCount;\r
\r
  switch (Entry) {\r
  case 0:\r
    CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Reset Exception at 0x%X\n\r",LR);\r
    break;\r
  case 1:\r
    CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Undefined Exception at 0x%X\n\r",LR);\r
    break;\r
  case 2:\r
    CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"SWI Exception at 0x%X\n\r",LR);\r
    break;\r
  case 3:\r
    CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"PrefetchAbort Exception at 0x%X\n\r",LR);\r
    break;\r
  case 4:\r
    CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"DataAbort Exception at 0x%X\n\r",LR);\r
    break;\r
  case 5:\r
    CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Reserved Exception at 0x%X\n\r",LR);\r
    break;\r
  case 6:\r
    CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"IRQ Exception at 0x%X\n\r",LR);\r
    break;\r
  case 7:\r
    CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"FIQ Exception at 0x%X\n\r",LR);\r
    break;\r
  default:\r
    CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Unknown Exception at 0x%X\n\r",LR);\r
    break;\r
  }\r
  SerialPortWrite ((UINT8 *) Buffer, CharCount);\r
  while(1);\r
}\r