ArmPlatformPkg/PrePi: Declared the ARM MP Core Info

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

/** @file\r
*\r
*  Copyright (c) 2011-2012, 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 <PiPei.h>\r
\r
#include <Library/DebugAgentLib.h>\r
#include <Library/PrePiLib.h>\r
#include <Library/PrintLib.h>\r
#include <Library/PeCoffGetEntryPointLib.h>\r
#include <Library/PrePiHobListPointerLib.h>\r
#include <Library/TimerLib.h>\r
#include <Library/PerformanceLib.h>\r
\r
#include <Ppi/GuidedSectionExtraction.h>\r
#include <Ppi/ArmMpCoreInfo.h>\r
#include <Guid/LzmaDecompress.h>\r
#include <Guid/ArmGlobalVariableHob.h>\r
\r
#include "PrePi.h"\r
#include "LzmaDecompress.h"\r
\r
#define IS_XIP() (((UINT32)FixedPcdGet32 (PcdFdBaseAddress) > (UINT32)(FixedPcdGet32 (PcdSystemMemoryBase) + FixedPcdGet32 (PcdSystemMemorySize))) || \\r
                  ((FixedPcdGet32 (PcdFdBaseAddress) + FixedPcdGet32 (PcdFdSize)) < FixedPcdGet32 (PcdSystemMemoryBase)))\r
\r
// Not used when PrePi in run in XIP mode\r
UINTN mGlobalVariableBase = 0;\r
\r
VOID\r
PrePiCommonExceptionEntry (\r
  IN UINT32 Entry,\r
  IN UINT32 LR\r
  );\r
\r
EFI_STATUS\r
EFIAPI\r
ExtractGuidedSectionLibConstructor (\r
  VOID\r
  );\r
\r
EFI_STATUS\r
EFIAPI\r
LzmaDecompressLibConstructor (\r
  VOID\r
  );\r
\r
VOID\r
EFIAPI\r
BuildGlobalVariableHob (\r
  IN EFI_PHYSICAL_ADDRESS         GlobalVariableBase,\r
  IN UINT32                       GlobalVariableSize\r
  )\r
{\r
  ARM_HOB_GLOBAL_VARIABLE  *Hob;\r
\r
  Hob = CreateHob (EFI_HOB_TYPE_GUID_EXTENSION, sizeof (ARM_HOB_GLOBAL_VARIABLE));\r
  ASSERT(Hob != NULL);\r
\r
  CopyGuid (&(Hob->Header.Name), &gArmGlobalVariableGuid);\r
  Hob->GlobalVariableBase = GlobalVariableBase;\r
  Hob->GlobalVariableSize = GlobalVariableSize;\r
}\r
\r
EFI_STATUS\r
GetPlatformPpi (\r
  IN  EFI_GUID  *PpiGuid,\r
  OUT VOID      **Ppi\r
  )\r
{\r
  UINTN                   PpiListSize;\r
  UINTN                   PpiListCount;\r
  EFI_PEI_PPI_DESCRIPTOR  *PpiList;\r
  UINTN                   Index;\r
\r
  PpiListSize = 0;\r
  ArmPlatformGetPlatformPpiList (&PpiListSize, &PpiList);\r
  PpiListCount = PpiListSize / sizeof(EFI_PEI_PPI_DESCRIPTOR);\r
  for (Index = 0; Index < PpiListCount; Index++, PpiList++) {\r
    if (CompareGuid (PpiList->Guid, PpiGuid) == TRUE) {\r
      *Ppi = PpiList->Ppi;\r
      return EFI_SUCCESS;\r
    }\r
  }\r
\r
  return EFI_NOT_FOUND;\r
}\r
\r
VOID\r
PrePiMain (\r
  IN  UINTN                     UefiMemoryBase,\r
  IN  UINTN                     StacksBase,\r
  IN  UINTN                     GlobalVariableBase,\r
  IN  UINT64                    StartTimeStamp\r
  )\r
{\r
  EFI_HOB_HANDOFF_INFO_TABLE*   HobList;\r
  ARM_MP_CORE_INFO_PPI*         ArmMpCoreInfoPpi;\r
  UINTN                         ArmCoreCount;\r
  ARM_CORE_INFO*                ArmCoreInfoTable;\r
  EFI_STATUS                    Status;\r
  CHAR8                         Buffer[100];\r
  UINTN                         CharCount;\r
  UINTN                         StacksSize;\r
\r
  // If ensure the FD is either part of the System Memory or totally outside of the System Memory (XIP)\r
  ASSERT (IS_XIP() || \r
          ((FixedPcdGet32 (PcdFdBaseAddress) >= FixedPcdGet32 (PcdSystemMemoryBase)) &&\r
           ((UINT32)(FixedPcdGet32 (PcdFdBaseAddress) + FixedPcdGet32 (PcdFdSize)) <= (UINT32)(FixedPcdGet32 (PcdSystemMemoryBase) + FixedPcdGet32 (PcdSystemMemorySize)))));\r
\r
  // Enable program flow prediction, if supported.\r
  ArmEnableBranchPrediction ();\r
\r
  if (FixedPcdGet32(PcdVFPEnabled)) {\r
    ArmEnableVFP();\r
  }\r
\r
  // Initialize the Serial Port\r
  SerialPortInitialize ();\r
  CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"UEFI firmware (version %s built at %a on %a)\n\r",\r
    (CHAR16*)PcdGetPtr(PcdFirmwareVersionString), __TIME__, __DATE__);\r
  SerialPortWrite ((UINT8 *) Buffer, CharCount);\r
\r
  // Initialize the Debug Agent for Source Level Debugging\r
  InitializeDebugAgent (DEBUG_AGENT_INIT_POSTMEM_SEC, NULL, NULL);\r
  SaveAndSetDebugTimerInterrupt (TRUE);\r
  \r
  // Declare the PI/UEFI memory region\r
  HobList = HobConstructor (\r
    (VOID*)UefiMemoryBase,\r
    FixedPcdGet32 (PcdSystemMemoryUefiRegionSize),\r
    (VOID*)UefiMemoryBase,\r
    (VOID*)StacksBase  // The top of the UEFI Memory is reserved for the stacks\r
    );\r
  PrePeiSetHobList (HobList);\r
\r
  // Initialize MMU and Memory HOBs (Resource Descriptor HOBs)\r
  Status = MemoryPeim (UefiMemoryBase, FixedPcdGet32 (PcdSystemMemoryUefiRegionSize));\r
  ASSERT_EFI_ERROR (Status);\r
\r
  // Create the Stacks HOB (reserve the memory for all stacks)\r
  if (ArmIsMpCore ()) {\r
    StacksSize = PcdGet32 (PcdCPUCorePrimaryStackSize) + (FixedPcdGet32(PcdClusterCount) * 4 * FixedPcdGet32(PcdCPUCoreSecondaryStackSize));\r
  } else {\r
    StacksSize = PcdGet32 (PcdCPUCorePrimaryStackSize);\r
  }\r
  BuildStackHob (StacksBase, StacksSize);\r
\r
  // Declare the Global Variable HOB\r
  BuildGlobalVariableHob (GlobalVariableBase, FixedPcdGet32 (PcdPeiGlobalVariableSize));\r
\r
  //TODO: Call CpuPei as a library\r
  BuildCpuHob (PcdGet8 (PcdPrePiCpuMemorySize), PcdGet8 (PcdPrePiCpuIoSize));\r
\r
  if (ArmIsMpCore ()) {\r
    // Only MP Core platform need to produce gArmMpCoreInfoPpiGuid\r
    Status = GetPlatformPpi (&gArmMpCoreInfoPpiGuid, (VOID**)&ArmMpCoreInfoPpi);\r
\r
    // On MP Core Platform we must implement the ARM MP Core Info PPI (gArmMpCoreInfoPpiGuid)\r
    ASSERT_EFI_ERROR (Status);\r
\r
    // Build the MP Core Info Table\r
    ArmCoreCount = 0;\r
    Status = ArmMpCoreInfoPpi->GetMpCoreInfo (&ArmCoreCount, &ArmCoreInfoTable);\r
    if (!EFI_ERROR(Status) && (ArmCoreCount > 0)) {\r
      // Build MPCore Info HOB\r
      BuildGuidDataHob (&gArmMpCoreInfoGuid, ArmCoreInfoTable, sizeof (ARM_CORE_INFO) * ArmCoreCount);\r
    }\r
  }\r
\r
  // Set the Boot Mode\r
  SetBootMode (ArmPlatformGetBootMode ());\r
\r
  // Initialize Platform HOBs (CpuHob and FvHob)\r
  Status = PlatformPeim ();\r
  ASSERT_EFI_ERROR (Status);\r
\r
  // Now, the HOB List has been initialized, we can register performance information\r
  PERF_START (NULL, "PEI", NULL, StartTimeStamp);\r
\r
  // SEC phase needs to run library constructors by hand.\r
  ExtractGuidedSectionLibConstructor ();\r
  LzmaDecompressLibConstructor ();\r
\r
  // Build HOBs to pass up our version of stuff the DXE Core needs to save space\r
  BuildPeCoffLoaderHob ();\r
  BuildExtractSectionHob (\r
    &gLzmaCustomDecompressGuid,\r
    LzmaGuidedSectionGetInfo,\r
    LzmaGuidedSectionExtraction\r
    );\r
\r
  // Assume the FV that contains the SEC (our code) also contains a compressed FV.\r
  Status = DecompressFirstFv ();\r
  ASSERT_EFI_ERROR (Status);\r
\r
  // Load the DXE Core and transfer control to it\r
  Status = LoadDxeCoreFromFv (NULL, 0);\r
  ASSERT_EFI_ERROR (Status);\r
}\r
\r
VOID\r
CEntryPoint (\r
  IN  UINTN                     MpId,\r
  IN  UINTN                     UefiMemoryBase,\r
  IN  UINTN                     StacksBase,\r
  IN  UINTN                     GlobalVariableBase\r
  )\r
{\r
  UINT64   StartTimeStamp;\r
 \r
  // Initialize the platform specific controllers\r
  ArmPlatformInitialize (MpId);\r
\r
  if (IS_PRIMARY_CORE(MpId) && PerformanceMeasurementEnabled ()) {\r
    // Initialize the Timer Library to setup the Timer HW controller\r
    TimerConstructor ();\r
    // We cannot call yet the PerformanceLib because the HOB List has not been initialized\r
    StartTimeStamp = GetPerformanceCounter ();\r
  } else {\r
    StartTimeStamp = 0;\r
  }\r
\r
  // Clean Data cache\r
  ArmCleanInvalidateDataCache ();\r
\r
  // Invalidate instruction cache\r
  ArmInvalidateInstructionCache ();\r
\r
  //TODO:Drain Write Buffer\r
\r
  // Enable Instruction & Data caches\r
  ArmEnableDataCache ();\r
  ArmEnableInstructionCache ();\r
\r
  // Define the Global Variable region when we are not running in XIP\r
  if (!IS_XIP()) {\r
    if (IS_PRIMARY_CORE(MpId)) {\r
      mGlobalVariableBase = GlobalVariableBase;\r
      if (ArmIsMpCore()) {\r
        // Signal the Global Variable Region is defined (event: ARM_CPU_EVENT_DEFAULT)\r
        ArmCallSEV ();\r
      }\r
    } else {\r
      // Wait the Primay core has defined the address of the Global Variable region (event: ARM_CPU_EVENT_DEFAULT)\r
      ArmCallWFE ();\r
    }\r
  }\r
  \r
  // Write VBAR - The Vector table must be 32-byte aligned\r
  ASSERT (((UINT32)PrePiVectorTable & ((1 << 5)-1)) == 0);\r
  ArmWriteVBar ((UINT32)PrePiVectorTable);\r
\r
  // If not primary Jump to Secondary Main\r
  if (IS_PRIMARY_CORE(MpId)) {\r
    // Goto primary Main.\r
    PrimaryMain (UefiMemoryBase, StacksBase, GlobalVariableBase, StartTimeStamp);\r
  } else {\r
    SecondaryMain (MpId);\r
  }\r
\r
  // DXE Core should always load and never return\r
  ASSERT (FALSE);\r
}\r
\r
VOID\r
PrePiCommonExceptionEntry (\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