ArmPlatformPkg/PrePi/PrePi.c

   1 /** @file
   2 *
   3 *  Copyright (c) 2011, ARM Limited. All rights reserved.
   4 *
   5 *  This program and the accompanying materials
   6 *  are licensed and made available under the terms and conditions of the BSD License
   7 *  which accompanies this distribution.  The full text of the license may be found at
   8 *  http://opensource.org/licenses/bsd-license.php
   9 *
  10 *  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
  11 *  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
  12 *
  13 **/
  14
  15 #include <PiPei.h>
  16
  17 #include <Library/DebugAgentLib.h>
  18 #include <Library/PrePiLib.h>
  19 #include <Library/IoLib.h>
  20 #include <Library/PrintLib.h>
  21 #include <Library/PeCoffGetEntryPointLib.h>
  22 #include <Library/TimerLib.h>
  23 #include <Library/PerformanceLib.h>
  24
  25 #include <Ppi/GuidedSectionExtraction.h>
  26 #include <Guid/LzmaDecompress.h>
  27
  28 #include "PrePi.h"
  29 #include "LzmaDecompress.h"
  30
  31 VOID
  32 PrePiCommonExceptionEntry (
  33   IN UINT32 Entry,
  34   IN UINT32 LR
  35   );
  36
  37 EFI_STATUS
  38 EFIAPI
  39 ExtractGuidedSectionLibConstructor (
  40   VOID
  41   );
  42
  43 EFI_STATUS
  44 EFIAPI
  45 LzmaDecompressLibConstructor (
  46   VOID
  47   );
  48
  49 VOID
  50 PrePiMain (
  51   IN  UINTN                     UefiMemoryBase,
  52   IN  UINTN                     StackBase,
  53   IN  UINT64                    StartTimeStamp
  54   )
  55 {
  56   EFI_HOB_HANDOFF_INFO_TABLE**   PrePiHobBase;
  57   EFI_STATUS                    Status;
  58   CHAR8                         Buffer[100];
  59   UINTN                         CharCount;
  60
  61   // Enable program flow prediction, if supported.
  62   ArmEnableBranchPrediction ();
  63
  64   if (FixedPcdGet32(PcdVFPEnabled)) {
  65     ArmEnableVFP();
  66   }
  67
  68   // Initialize the Serial Port
  69   SerialPortInitialize ();
  70   CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"UEFI firmware built at %a on %a\n\r",__TIME__, __DATE__);
  71   SerialPortWrite ((UINT8 *) Buffer, CharCount);
  72
  73   // Initialize the Debug Agent for Source Level Debugging
  74   InitializeDebugAgent (DEBUG_AGENT_INIT_POSTMEM_SEC, NULL, NULL);
  75   SaveAndSetDebugTimerInterrupt (TRUE);
  76
  77   PrePiHobBase = (EFI_HOB_HANDOFF_INFO_TABLE**)(PcdGet32 (PcdCPUCoresNonSecStackBase) + (PcdGet32 (PcdCPUCoresNonSecStackSize) / 2) - PcdGet32 (PcdHobListPtrGlobalOffset));
  78
  79   // We leave UINT32 at the top of UEFI memory for PcdPrePiHobBase
  80   *PrePiHobBase = HobConstructor (
  81     (VOID*)UefiMemoryBase,
  82     FixedPcdGet32 (PcdSystemMemoryUefiRegionSize),
  83     (VOID*)UefiMemoryBase,
  84     (VOID*)(UefiMemoryBase + FixedPcdGet32 (PcdSystemMemoryUefiRegionSize) - sizeof(UINT32)));
  85
  86   // Initialize MMU and Memory HOBs (Resource Descriptor HOBs)
  87   Status = MemoryPeim (UefiMemoryBase, FixedPcdGet32 (PcdSystemMemoryUefiRegionSize));
  88   ASSERT_EFI_ERROR (Status);
  89
  90   // Create the Stack HOB
  91   BuildStackHob (StackBase, FixedPcdGet32(PcdCPUCoresNonSecStackSize));
  92
  93   // Set the Boot Mode
  94   SetBootMode (ArmPlatformGetBootMode ());
  95
  96   // Initialize Platform HOBs (CpuHob and FvHob)
  97   Status = PlatformPeim ();
  98   ASSERT_EFI_ERROR (Status);
  99
 100   BuildMemoryTypeInformationHob ();
 101
 102   //InitializeDebugAgent (DEBUG_AGENT_INIT_PREMEM_SEC, NULL, NULL);
 103   //SaveAndSetDebugTimerInterrupt (TRUE);
 104
 105   // Now, the HOB List has been initialized, we can register performance information
 106   PERF_START (NULL, "PEI", NULL, StartTimeStamp);
 107
 108   // SEC phase needs to run library constructors by hand.
 109   ExtractGuidedSectionLibConstructor ();
 110   LzmaDecompressLibConstructor ();
 111
 112   // Build HOBs to pass up our version of stuff the DXE Core needs to save space
 113   BuildPeCoffLoaderHob ();
 114   BuildExtractSectionHob (
 115     &gLzmaCustomDecompressGuid,
 116     LzmaGuidedSectionGetInfo,
 117     LzmaGuidedSectionExtraction
 118     );
 119
 120   // Assume the FV that contains the SEC (our code) also contains a compressed FV.
 121   Status = DecompressFirstFv ();
 122   ASSERT_EFI_ERROR (Status);
 123
 124   // Load the DXE Core and transfer control to it
 125   Status = LoadDxeCoreFromFv (NULL, 0);
 126   ASSERT_EFI_ERROR (Status);
 127 }
 128
 129 VOID
 130 CEntryPoint (
 131   IN  UINTN                     CoreId,
 132   IN  UINTN                     UefiMemoryBase,
 133   IN  UINTN                     StackBase
 134   )
 135 {
 136   UINT64   StartTimeStamp;
 137
 138   if ((CoreId == 0) && PerformanceMeasurementEnabled ()) {
 139     // Initialize the Timer Library to setup the Timer HW controller
 140     TimerConstructor ();
 141     // We cannot call yet the PerformanceLib because the HOB List has not been initialized
 142     StartTimeStamp = GetPerformanceCounter ();
 143   }
 144
 145   //Clean Data cache
 146   ArmCleanInvalidateDataCache();
 147
 148   //Invalidate instruction cache
 149   ArmInvalidateInstructionCache();
 150
 151   //TODO:Drain Write Buffer
 152
 153   // Enable Instruction & Data caches
 154   ArmEnableDataCache();
 155   ArmEnableInstructionCache();
 156
 157   // Write VBAR - The Vector table must be 32-byte aligned
 158   ASSERT(((UINT32)PrePiVectorTable & ((1 << 5)-1)) == 0);
 159   ArmWriteVBar((UINT32)PrePiVectorTable);
 160
 161   //If not primary Jump to Secondary Main
 162   if(0 == CoreId) {
 163     // Goto primary Main.
 164     PrimaryMain (UefiMemoryBase, StackBase, StartTimeStamp);
 165   } else {
 166     SecondaryMain (CoreId);
 167   }
 168
 169   // DXE Core should always load and never return
 170   ASSERT (FALSE);
 171 }
 172
 173 VOID
 174 PrePiCommonExceptionEntry (
 175   IN UINT32 Entry,
 176   IN UINT32 LR
 177   )
 178 {
 179   CHAR8           Buffer[100];
 180   UINTN           CharCount;
 181
 182   switch (Entry) {
 183   case 0:
 184     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Reset Exception at 0x%X\n\r",LR);
 185     break;
 186   case 1:
 187     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Undefined Exception at 0x%X\n\r",LR);
 188     break;
 189   case 2:
 190     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"SWI Exception at 0x%X\n\r",LR);
 191     break;
 192   case 3:
 193     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"PrefetchAbort Exception at 0x%X\n\r",LR);
 194     break;
 195   case 4:
 196     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"DataAbort Exception at 0x%X\n\r",LR);
 197     break;
 198   case 5:
 199     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Reserved Exception at 0x%X\n\r",LR);
 200     break;
 201   case 6:
 202     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"IRQ Exception at 0x%X\n\r",LR);
 203     break;
 204   case 7:
 205     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"FIQ Exception at 0x%X\n\r",LR);
 206     break;
 207   default:
 208     CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Unknown Exception at 0x%X\n\r",LR);
 209     break;
 210   }
 211   SerialPortWrite ((UINT8 *) Buffer, CharCount);
 212   while(1);
 213 }