ArmPlatformPkg/PrePeiCore/PrePeiCore.c

   1 /** @file
   2 *  Main file supporting the transition to PEI Core in Normal World for Versatile Express
   3 *
   4 *  Copyright (c) 2011, ARM Limited. All rights reserved.
   5 *
   6 *  This program and the accompanying materials
   7 *  are licensed and made available under the terms and conditions of the BSD License
   8 *  which accompanies this distribution.  The full text of the license may be found at
   9 *  http://opensource.org/licenses/bsd-license.php
  10 *
  11 *  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
  12 *  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
  13 *
  14 **/
  15
  16 #include <Library/BaseLib.h>
  17 #include <Library/DebugAgentLib.h>
  18 #include <Library/PrintLib.h>
  19 #include <Library/ArmLib.h>
  20 #include <Library/SerialPortLib.h>
  21
  22 #include <Ppi/ArmGlobalVariable.h>
  23 #include <Chipset/ArmV7.h>
  24
  25 #include "PrePeiCore.h"
  26
  27 EFI_PEI_TEMPORARY_RAM_SUPPORT_PPI   mSecTemporaryRamSupportPpi = {SecTemporaryRamSupport};
  28 ARM_GLOBAL_VARIABLE_PPI             mGlobalVariablePpi = { PrePeiCoreGetGlobalVariableMemory };
  29
  30 EFI_PEI_PPI_DESCRIPTOR      gCommonPpiTable[] = {
  31   {
  32     EFI_PEI_PPI_DESCRIPTOR_PPI,
  33     &gEfiTemporaryRamSupportPpiGuid,
  34     &mSecTemporaryRamSupportPpi
  35   },
  36   {
  37     EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST,
  38     &gArmGlobalVariablePpiGuid,
  39     &mGlobalVariablePpi
  40   }
  41 };
  42
  43 VOID
  44 CEntryPoint (
  45   IN  UINTN                     MpId,
  46   IN  EFI_PEI_CORE_ENTRY_POINT  PeiCoreEntryPoint
  47   )
  48 {
  49   //Clean Data cache
  50   ArmCleanInvalidateDataCache();
  51
  52   //Invalidate instruction cache
  53   ArmInvalidateInstructionCache();
  54
  55   // Enable Instruction & Data caches
  56   ArmEnableDataCache ();
  57   ArmEnableInstructionCache ();
  58
  59   //
  60   // Note: Doesn't have to Enable CPU interface in non-secure world,
  61   // as Non-secure interface is already enabled in Secure world.
  62   //
  63
  64   // Write VBAR - The Vector table must be 32-byte aligned
  65   ASSERT(((UINT32)PeiVectorTable & ((1 << 5)-1)) == 0);
  66   ArmWriteVBar((UINT32)PeiVectorTable);
  67
  68   //Note: The MMU will be enabled by MemoryPeim. Only the primary core will have the MMU on.
  69
  70   //If not primary Jump to Secondary Main
  71   if (IS_PRIMARY_CORE(MpId)) {
  72     // Initialize the Debug Agent for Source Level Debugging
  73     InitializeDebugAgent (DEBUG_AGENT_INIT_POSTMEM_SEC, NULL, NULL);
  74     SaveAndSetDebugTimerInterrupt (TRUE);
  75
  76     // Goto primary Main.
  77     PrimaryMain (PeiCoreEntryPoint);
  78   } else {
  79     SecondaryMain (MpId);
  80   }
  81
  82   // PEI Core should always load and never return
  83   ASSERT (FALSE);
  84 }
  85
  86 EFI_STATUS
  87 EFIAPI
  88 SecTemporaryRamSupport (
  89   IN CONST EFI_PEI_SERVICES   **PeiServices,
  90   IN EFI_PHYSICAL_ADDRESS     TemporaryMemoryBase,
  91   IN EFI_PHYSICAL_ADDRESS     PermanentMemoryBase,
  92   IN UINTN                    CopySize
  93   )
  94 {
  95   //
  96   // Migrate the whole temporary memory to permenent memory.
  97   //
  98   CopyMem (
  99     (VOID*)(UINTN)PermanentMemoryBase,
 100     (VOID*)(UINTN)TemporaryMemoryBase,
 101     CopySize
 102     );
 103
 104   SecSwitchStack((UINTN)(PermanentMemoryBase - TemporaryMemoryBase));
 105
 106 EFI_STATUS
 107 PrePeiCoreGetGlobalVariableMemory (
 108   OUT EFI_PHYSICAL_ADDRESS    *GlobalVariableBase
 109   )
 110 {
 111   ASSERT (GlobalVariableBase != NULL);
 112
 113   *GlobalVariableBase = (UINTN)PcdGet32 (PcdCPUCoresStackBase) +
 114                         (UINTN)PcdGet32 (PcdCPUCorePrimaryStackSize) -
 115                         (UINTN)PcdGet32 (PcdPeiGlobalVariableSize);
 116
 117   return EFI_SUCCESS;
 118 }
 119
 120 VOID
 121 PeiCommonExceptionEntry (
 122   IN UINT32 Entry,
 123   IN UINT32 LR
 124   )
 125 {
 126   CHAR8           Buffer[100];
 127   UINTN           CharCount;
 128
 129   switch (Entry) {
 130   case 0:
 131     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Reset Exception at 0x%X\n\r",LR);
 132     break;
 133   case 1:
 134     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Undefined Exception at 0x%X\n\r",LR);
 135     break;
 136   case 2:
 137     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"SWI Exception at 0x%X\n\r",LR);
 138     break;
 139   case 3:
 140     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"PrefetchAbort Exception at 0x%X\n\r",LR);
 141     break;
 142   case 4:
 143     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"DataAbort Exception at 0x%X\n\r",LR);
 144     break;
 145   case 5:
 146     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Reserved Exception at 0x%X\n\r",LR);
 147     break;
 148   case 6:
 149     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"IRQ Exception at 0x%X\n\r",LR);
 150     break;
 151   case 7:
 152     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"FIQ Exception at 0x%X\n\r",LR);
 153     break;
 154   default:
 155     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Unknown Exception at 0x%X\n\r",LR);
 156     break;
 157   }
 158   SerialPortWrite ((UINT8 *) Buffer, CharCount);
 159   while(1);
 160 }