ArmPlatformPkg/PrePi/MainMPCore.c

   1 /** @file
   2
   3   Copyright (c) 2011-2014, ARM Limited. All rights reserved.
   4
   5   SPDX-License-Identifier: BSD-2-Clause-Patent
   6
   7 **/
   8
   9 #include "PrePi.h"
  10
  11 #include <Library/ArmGicLib.h>
  12
  13 #include <Ppi/ArmMpCoreInfo.h>
  14
  15 VOID
  16 PrimaryMain (
  17   IN  UINTN   UefiMemoryBase,
  18   IN  UINTN   StacksBase,
  19   IN  UINT64  StartTimeStamp
  20   )
  21 {
  22   // Enable the GIC Distributor
  23   ArmGicEnableDistributor (PcdGet64 (PcdGicDistributorBase));
  24
  25   // In some cases, the secondary cores are waiting for an SGI from the next stage boot loader to resume their initialization
  26   if (!FixedPcdGet32 (PcdSendSgiToBringUpSecondaryCores)) {
  27     // Sending SGI to all the Secondary CPU interfaces
  28     ArmGicSendSgiTo (PcdGet64 (PcdGicDistributorBase), ARM_GIC_ICDSGIR_FILTER_EVERYONEELSE, 0x0E, PcdGet32 (PcdGicSgiIntId));
  29   }
  30
  31   PrePiMain (UefiMemoryBase, StacksBase, StartTimeStamp);
  32
  33   // We must never return
  34   ASSERT (FALSE);
  35 }
  36
  37 VOID
  38 SecondaryMain (
  39   IN  UINTN  MpId
  40   )
  41 {
  42   EFI_STATUS            Status;
  43   ARM_MP_CORE_INFO_PPI  *ArmMpCoreInfoPpi;
  44   UINTN                 Index;
  45   UINTN                 ArmCoreCount;
  46   ARM_CORE_INFO         *ArmCoreInfoTable;
  47   UINT32                ClusterId;
  48   UINT32                CoreId;
  49
  50   VOID  (*SecondaryStart)(
  51     VOID
  52     );
  53   UINTN  SecondaryEntryAddr;
  54   UINTN  AcknowledgeInterrupt;
  55   UINTN  InterruptId;
  56
  57   ClusterId = GET_CLUSTER_ID (MpId);
  58   CoreId    = GET_CORE_ID (MpId);
  59
  60   // On MP Core Platform we must implement the ARM MP Core Info PPI (gArmMpCoreInfoPpiGuid)
  61   Status = GetPlatformPpi (&gArmMpCoreInfoPpiGuid, (VOID **)&ArmMpCoreInfoPpi);
  62   ASSERT_EFI_ERROR (Status);
  63
  64   ArmCoreCount = 0;
  65   Status       = ArmMpCoreInfoPpi->GetMpCoreInfo (&ArmCoreCount, &ArmCoreInfoTable);
  66   ASSERT_EFI_ERROR (Status);
  67
  68   // Find the core in the ArmCoreTable
  69   for (Index = 0; Index < ArmCoreCount; Index++) {
  70     if ((ArmCoreInfoTable[Index].ClusterId == ClusterId) && (ArmCoreInfoTable[Index].CoreId == CoreId)) {
  71       break;
  72     }
  73   }
  74
  75   // The ARM Core Info Table must define every core
  76   ASSERT (Index != ArmCoreCount);
  77
  78   // Clear Secondary cores MailBox
  79   MmioWrite32 (ArmCoreInfoTable[Index].MailboxClearAddress, ArmCoreInfoTable[Index].MailboxClearValue);
  80
  81   do {
  82     ArmCallWFI ();
  83
  84     // Read the Mailbox
  85     SecondaryEntryAddr = MmioRead32 (ArmCoreInfoTable[Index].MailboxGetAddress);
  86
  87     // Acknowledge the interrupt and send End of Interrupt signal.
  88     AcknowledgeInterrupt = ArmGicAcknowledgeInterrupt (PcdGet64 (PcdGicInterruptInterfaceBase), &InterruptId);
  89     // Check if it is a valid interrupt ID
  90     if (InterruptId < ArmGicGetMaxNumInterrupts (PcdGet64 (PcdGicDistributorBase))) {
  91       // Got a valid SGI number hence signal End of Interrupt
  92       ArmGicEndOfInterrupt (PcdGet64 (PcdGicInterruptInterfaceBase), AcknowledgeInterrupt);
  93     }
  94   } while (SecondaryEntryAddr == 0);
  95
  96   // Jump to secondary core entry point.
  97   SecondaryStart = (VOID (*)()) SecondaryEntryAddr;
  98   SecondaryStart ();
  99
 100   // The secondaries shouldn't reach here
 101   ASSERT (FALSE);
 102 }