mirror of https://github.com/acidanthera/audk.git
ArmPkg/ArmGicLib: Replaced 'ArmGicAcknowledgeSgiFrom' by 'ArmGicAcknowledgeInterrupt'
The function 'ArmGicAcknowledgeSgiFrom' was actually acknowledging Interrupts (and not only SGIs). ArmPkg/ArmGicLib: Introduced the PCD PcdGicPrimaryCoreId This PCD defines the Id of the primary core in the GIC. Signed-off-by: Olivier Martin <olivier.martin@arm.com> git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@13259 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
parent
4c19ece32a
commit
315649cda2
|
@ -146,6 +146,10 @@
|
|||
gArmTokenSpaceGuid.PcdArmPrimaryCoreMask|0xF03|UINT32|0x00000031
|
||||
# The Primary Core is ClusterId[0] & CoreId[0]
|
||||
gArmTokenSpaceGuid.PcdArmPrimaryCore|0|UINT32|0x00000037
|
||||
# Number of the CPU Interface for the Primary Core (eg: The number for the CPU0 of
|
||||
# Cluster1 might be 4 if the implementer had followed the convention: Cpu Interface
|
||||
# = 4 * Cluster)
|
||||
gArmTokenSpaceGuid.PcdGicPrimaryCoreId|0|UINT32|0x00000043
|
||||
|
||||
#
|
||||
# ARM L2x0 PCDs
|
||||
|
|
|
@ -38,45 +38,33 @@ ArmGicSendSgiTo (
|
|||
MmioWrite32 (GicDistributorBase + ARM_GIC_ICDSGIR, ((TargetListFilter & 0x3) << 24) | ((CPUTargetList & 0xFF) << 16) | SgiId);
|
||||
}
|
||||
|
||||
UINT32
|
||||
RETURN_STATUS
|
||||
EFIAPI
|
||||
ArmGicAcknowledgeSgiFrom (
|
||||
IN INTN GicInterruptInterfaceBase,
|
||||
IN INTN CoreId
|
||||
ArmGicAcknowledgeInterrupt (
|
||||
IN UINTN GicDistributorBase,
|
||||
IN UINTN GicInterruptInterfaceBase,
|
||||
OUT UINTN *CoreId,
|
||||
OUT UINTN *InterruptId
|
||||
)
|
||||
{
|
||||
INTN InterruptId;
|
||||
UINT32 Interrupt;
|
||||
|
||||
InterruptId = MmioRead32 (GicInterruptInterfaceBase + ARM_GIC_ICCIAR);
|
||||
// Read the Interrupt Acknowledge Register
|
||||
Interrupt = MmioRead32 (GicInterruptInterfaceBase + ARM_GIC_ICCIAR);
|
||||
|
||||
// Check if the Interrupt ID is valid, The read from Interrupt Ack register returns CPU ID and Interrupt ID
|
||||
if ((((CoreId & 0x7) << 10) | PcdGet32(PcdGicSgiIntId)) == InterruptId) {
|
||||
// Got SGI number 0 hence signal End of Interrupt by writing to ICCEOIR
|
||||
MmioWrite32 (GicInterruptInterfaceBase + ARM_GIC_ICCEIOR, InterruptId);
|
||||
return 1;
|
||||
// Check if it is a valid interrupt ID
|
||||
if ((Interrupt & 0x3FF) < ArmGicGetMaxNumInterrupts (GicDistributorBase)) {
|
||||
// Got a valid SGI number hence signal End of Interrupt by writing to ICCEOIR
|
||||
MmioWrite32 (GicInterruptInterfaceBase + ARM_GIC_ICCEIOR, Interrupt);
|
||||
|
||||
if (CoreId) {
|
||||
*CoreId = (Interrupt >> 10) & 0x7;
|
||||
}
|
||||
if (InterruptId) {
|
||||
*InterruptId = Interrupt & 0x3FF;
|
||||
}
|
||||
return RETURN_SUCCESS;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
UINT32
|
||||
EFIAPI
|
||||
ArmGicAcknowledgeSgi2From (
|
||||
IN INTN GicInterruptInterfaceBase,
|
||||
IN INTN CoreId,
|
||||
IN INTN SgiId
|
||||
)
|
||||
{
|
||||
INTN InterruptId;
|
||||
|
||||
InterruptId = MmioRead32(GicInterruptInterfaceBase + ARM_GIC_ICCIAR);
|
||||
|
||||
// Check if the Interrupt ID is valid, The read from Interrupt Ack register returns CPU ID and Interrupt ID
|
||||
if((((CoreId & 0x7) << 10) | (SgiId & 0x3FF)) == (InterruptId & 0x1FFF)) {
|
||||
// Got SGI number 0 hence signal End of Interrupt by writing to ICCEOIR
|
||||
MmioWrite32 (GicInterruptInterfaceBase + ARM_GIC_ICCEIOR, InterruptId);
|
||||
return 1;
|
||||
} else {
|
||||
return 0;
|
||||
return RETURN_INVALID_PARAMETER;
|
||||
}
|
||||
}
|
||||
|
|
|
@ -117,19 +117,13 @@ ArmGicSendSgiTo (
|
|||
IN INTN SgiId
|
||||
);
|
||||
|
||||
UINT32
|
||||
RETURN_STATUS
|
||||
EFIAPI
|
||||
ArmGicAcknowledgeSgiFrom (
|
||||
IN INTN GicInterruptInterfaceBase,
|
||||
IN INTN CoreId
|
||||
);
|
||||
|
||||
UINT32
|
||||
EFIAPI
|
||||
ArmGicAcknowledgeSgi2From (
|
||||
IN INTN GicInterruptInterfaceBase,
|
||||
IN INTN CoreId,
|
||||
IN INTN SgiId
|
||||
ArmGicAcknowledgeInterrupt (
|
||||
IN UINTN GicDistributorBase,
|
||||
IN UINTN GicInterruptInterfaceBase,
|
||||
OUT UINTN *CoreId,
|
||||
OUT UINTN *InterruptId
|
||||
);
|
||||
|
||||
UINTN
|
||||
|
|
|
@ -38,7 +38,7 @@ NonSecureWaitForFirmware (
|
|||
ArmCallWFI();
|
||||
|
||||
// Acknowledge the interrupt and send End of Interrupt signal.
|
||||
ArmGicAcknowledgeSgiFrom (PcdGet32(PcdGicInterruptInterfaceBase), PRIMARY_CORE_ID);
|
||||
ArmGicAcknowledgeInterrupt (PcdGet32(PcdGicDistributorBase), PcdGet32(PcdGicInterruptInterfaceBase), NULL, NULL);
|
||||
|
||||
// Jump to secondary core entry point.
|
||||
secondary_start ();
|
||||
|
|
|
@ -45,6 +45,7 @@ SecondaryMain (
|
|||
UINT32 CoreId;
|
||||
VOID (*SecondaryStart)(VOID);
|
||||
UINTN SecondaryEntryAddr;
|
||||
UINTN AcknowledgedCoreId;
|
||||
|
||||
ClusterId = GET_CLUSTER_ID(MpId);
|
||||
CoreId = GET_CORE_ID(MpId);
|
||||
|
@ -80,12 +81,15 @@ SecondaryMain (
|
|||
// Clear Secondary cores MailBox
|
||||
MmioWrite32 (ArmCoreInfoTable[Index].MailboxClearAddress, ArmCoreInfoTable[Index].MailboxClearValue);
|
||||
|
||||
SecondaryEntryAddr = 0;
|
||||
while (SecondaryEntryAddr = MmioRead32 (ArmCoreInfoTable[Index].MailboxGetAddress), SecondaryEntryAddr == 0) {
|
||||
do {
|
||||
ArmCallWFI ();
|
||||
|
||||
// Read the Mailbox
|
||||
SecondaryEntryAddr = MmioRead32 (ArmCoreInfoTable[Index].MailboxGetAddress);
|
||||
|
||||
// Acknowledge the interrupt and send End of Interrupt signal.
|
||||
ArmGicAcknowledgeSgiFrom (PcdGet32(PcdGicInterruptInterfaceBase), PRIMARY_CORE_ID);
|
||||
}
|
||||
ArmGicAcknowledgeInterrupt (PcdGet32(PcdGicDistributorBase), PcdGet32(PcdGicInterruptInterfaceBase), &AcknowledgedCoreId, NULL);
|
||||
} while ((SecondaryEntryAddr == 0) && (AcknowledgedCoreId != PcdGet32 (PcdGicPrimaryCoreId)));
|
||||
|
||||
// Jump to secondary core entry point.
|
||||
SecondaryStart = (VOID (*)())SecondaryEntryAddr;
|
||||
|
@ -107,6 +111,13 @@ PrimaryMain (
|
|||
UINTN TemporaryRamBase;
|
||||
UINTN TemporaryRamSize;
|
||||
|
||||
// Check PcdGicPrimaryCoreId has been set in case the Primary Core is not the core 0 of Cluster 0
|
||||
DEBUG_CODE_BEGIN();
|
||||
if ((PcdGet32(PcdArmPrimaryCore) != 0) && (PcdGet32 (PcdGicPrimaryCoreId) == 0)) {
|
||||
DEBUG((EFI_D_WARN,"Warning: the PCD PcdGicPrimaryCoreId does not seem to be set up for the configuration.\n"));
|
||||
}
|
||||
DEBUG_CODE_END();
|
||||
|
||||
CreatePpiList (&PpiListSize, &PpiList);
|
||||
|
||||
// Enable the GIC Distributor
|
||||
|
|
|
@ -61,6 +61,7 @@
|
|||
|
||||
gArmTokenSpaceGuid.PcdArmPrimaryCoreMask
|
||||
gArmTokenSpaceGuid.PcdArmPrimaryCore
|
||||
gArmTokenSpaceGuid.PcdGicPrimaryCoreId
|
||||
|
||||
gArmPlatformTokenSpaceGuid.PcdCPUCoresStackBase
|
||||
gArmPlatformTokenSpaceGuid.PcdCPUCorePrimaryStackSize
|
||||
|
|
|
@ -59,6 +59,13 @@ PrimaryMain (
|
|||
ASSERT_EFI_ERROR (Status);
|
||||
DEBUG_CODE_END();
|
||||
|
||||
// Check PcdGicPrimaryCoreId has been set in case the Primary Core is not the core 0 of Cluster 0
|
||||
DEBUG_CODE_BEGIN();
|
||||
if ((PcdGet32(PcdArmPrimaryCore) != 0) && (PcdGet32 (PcdGicPrimaryCoreId) == 0)) {
|
||||
DEBUG((EFI_D_WARN,"Warning: the PCD PcdGicPrimaryCoreId does not seem to be set up for the configuration.\n"));
|
||||
}
|
||||
DEBUG_CODE_END();
|
||||
|
||||
// Enable the GIC Distributor
|
||||
ArmGicEnableDistributor(PcdGet32(PcdGicDistributorBase));
|
||||
|
||||
|
@ -88,6 +95,7 @@ SecondaryMain (
|
|||
UINT32 CoreId;
|
||||
VOID (*SecondaryStart)(VOID);
|
||||
UINTN SecondaryEntryAddr;
|
||||
UINTN AcknowledgedCoreId;
|
||||
|
||||
ClusterId = GET_CLUSTER_ID(MpId);
|
||||
CoreId = GET_CORE_ID(MpId);
|
||||
|
@ -113,12 +121,15 @@ SecondaryMain (
|
|||
// Clear Secondary cores MailBox
|
||||
MmioWrite32 (ArmCoreInfoTable[Index].MailboxClearAddress, ArmCoreInfoTable[Index].MailboxClearValue);
|
||||
|
||||
SecondaryEntryAddr = 0;
|
||||
while (SecondaryEntryAddr = MmioRead32 (ArmCoreInfoTable[Index].MailboxGetAddress), SecondaryEntryAddr == 0) {
|
||||
do {
|
||||
ArmCallWFI ();
|
||||
|
||||
// Read the Mailbox
|
||||
SecondaryEntryAddr = MmioRead32 (ArmCoreInfoTable[Index].MailboxGetAddress);
|
||||
|
||||
// Acknowledge the interrupt and send End of Interrupt signal.
|
||||
ArmGicAcknowledgeSgiFrom (PcdGet32(PcdGicInterruptInterfaceBase), PRIMARY_CORE_ID);
|
||||
}
|
||||
ArmGicAcknowledgeInterrupt (PcdGet32(PcdGicDistributorBase), PcdGet32(PcdGicInterruptInterfaceBase), &AcknowledgedCoreId, NULL);
|
||||
} while ((SecondaryEntryAddr == 0) && (AcknowledgedCoreId != PcdGet32 (PcdGicPrimaryCoreId)));
|
||||
|
||||
// Jump to secondary core entry point.
|
||||
SecondaryStart = (VOID (*)())SecondaryEntryAddr;
|
||||
|
|
|
@ -94,6 +94,7 @@
|
|||
gArmPlatformTokenSpaceGuid.PcdClusterCount
|
||||
gArmTokenSpaceGuid.PcdArmPrimaryCoreMask
|
||||
gArmTokenSpaceGuid.PcdArmPrimaryCore
|
||||
gArmTokenSpaceGuid.PcdGicPrimaryCoreId
|
||||
|
||||
gEmbeddedTokenSpaceGuid.PcdPrePiCpuMemorySize
|
||||
gEmbeddedTokenSpaceGuid.PcdPrePiCpuIoSize
|
||||
|
|
Loading…
Reference in New Issue