mirror of
https://github.com/acidanthera/audk.git
synced 2025-07-26 07:04:28 +02:00
ArmPkg/ArmGic: Introduced support for GicV2 to ArmGicDxe
Contributed-under: TianoCore Contribution Agreement 1.0 Signed-off-by: Olivier Martin <olivier.martin@arm.com> git-svn-id: https://svn.code.sf.net/p/edk2/code/trunk/edk2@15627 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
parent
793ca69f50
commit
f5241b5725
@ -1,8 +1,6 @@
|
|||||||
/*++
|
/*++
|
||||||
|
|
||||||
Copyright (c) 2009, Hewlett-Packard Company. All rights reserved.<BR>
|
Copyright (c) 2013-2014, ARM Ltd. All rights reserved.<BR>
|
||||||
Portions copyright (c) 2010, Apple Inc. All rights reserved.<BR>
|
|
||||||
Portions copyright (c) 2011-2014, ARM Ltd. All rights reserved.<BR>
|
|
||||||
|
|
||||||
This program and the accompanying materials
|
This program and the accompanying materials
|
||||||
are licensed and made available under the terms and conditions of the BSD License
|
are licensed and made available under the terms and conditions of the BSD License
|
||||||
@ -24,214 +22,8 @@ Abstract:
|
|||||||
|
|
||||||
#include <PiDxe.h>
|
#include <PiDxe.h>
|
||||||
|
|
||||||
#include <Library/BaseLib.h>
|
|
||||||
#include <Library/BaseMemoryLib.h>
|
|
||||||
#include <Library/UefiLib.h>
|
|
||||||
#include <Library/PcdLib.h>
|
|
||||||
#include <Library/IoLib.h>
|
|
||||||
#include <Library/ArmGicLib.h>
|
|
||||||
|
|
||||||
#include "ArmGicDxe.h"
|
#include "ArmGicDxe.h"
|
||||||
|
|
||||||
#define ARM_GIC_DEFAULT_PRIORITY 0x80
|
|
||||||
|
|
||||||
extern EFI_HARDWARE_INTERRUPT_PROTOCOL gHardwareInterruptProtocol;
|
|
||||||
|
|
||||||
/**
|
|
||||||
Enable interrupt source Source.
|
|
||||||
|
|
||||||
@param This Instance pointer for this protocol
|
|
||||||
@param Source Hardware source of the interrupt
|
|
||||||
|
|
||||||
@retval EFI_SUCCESS Source interrupt enabled.
|
|
||||||
@retval EFI_DEVICE_ERROR Hardware could not be programmed.
|
|
||||||
|
|
||||||
**/
|
|
||||||
EFI_STATUS
|
|
||||||
EFIAPI
|
|
||||||
EnableInterruptSource (
|
|
||||||
IN EFI_HARDWARE_INTERRUPT_PROTOCOL *This,
|
|
||||||
IN HARDWARE_INTERRUPT_SOURCE Source
|
|
||||||
)
|
|
||||||
{
|
|
||||||
if (Source > mGicNumInterrupts) {
|
|
||||||
ASSERT(FALSE);
|
|
||||||
return EFI_UNSUPPORTED;
|
|
||||||
}
|
|
||||||
|
|
||||||
ArmGicEnableInterrupt (FixedPcdGet32 (PcdGicDistributorBase), Source);
|
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
Disable interrupt source Source.
|
|
||||||
|
|
||||||
@param This Instance pointer for this protocol
|
|
||||||
@param Source Hardware source of the interrupt
|
|
||||||
|
|
||||||
@retval EFI_SUCCESS Source interrupt disabled.
|
|
||||||
@retval EFI_DEVICE_ERROR Hardware could not be programmed.
|
|
||||||
|
|
||||||
**/
|
|
||||||
EFI_STATUS
|
|
||||||
EFIAPI
|
|
||||||
DisableInterruptSource (
|
|
||||||
IN EFI_HARDWARE_INTERRUPT_PROTOCOL *This,
|
|
||||||
IN HARDWARE_INTERRUPT_SOURCE Source
|
|
||||||
)
|
|
||||||
{
|
|
||||||
if (Source > mGicNumInterrupts) {
|
|
||||||
ASSERT(FALSE);
|
|
||||||
return EFI_UNSUPPORTED;
|
|
||||||
}
|
|
||||||
|
|
||||||
ArmGicDisableInterrupt (PcdGet32(PcdGicDistributorBase), Source);
|
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
Return current state of interrupt source Source.
|
|
||||||
|
|
||||||
@param This Instance pointer for this protocol
|
|
||||||
@param Source Hardware source of the interrupt
|
|
||||||
@param InterruptState TRUE: source enabled, FALSE: source disabled.
|
|
||||||
|
|
||||||
@retval EFI_SUCCESS InterruptState is valid
|
|
||||||
@retval EFI_DEVICE_ERROR InterruptState is not valid
|
|
||||||
|
|
||||||
**/
|
|
||||||
EFI_STATUS
|
|
||||||
EFIAPI
|
|
||||||
GetInterruptSourceState (
|
|
||||||
IN EFI_HARDWARE_INTERRUPT_PROTOCOL *This,
|
|
||||||
IN HARDWARE_INTERRUPT_SOURCE Source,
|
|
||||||
IN BOOLEAN *InterruptState
|
|
||||||
)
|
|
||||||
{
|
|
||||||
if (Source > mGicNumInterrupts) {
|
|
||||||
ASSERT(FALSE);
|
|
||||||
return EFI_UNSUPPORTED;
|
|
||||||
}
|
|
||||||
|
|
||||||
*InterruptState = ArmGicIsInterruptEnabled (PcdGet32(PcdGicDistributorBase), Source);
|
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
Signal to the hardware that the End Of Intrrupt state
|
|
||||||
has been reached.
|
|
||||||
|
|
||||||
@param This Instance pointer for this protocol
|
|
||||||
@param Source Hardware source of the interrupt
|
|
||||||
|
|
||||||
@retval EFI_SUCCESS Source interrupt EOI'ed.
|
|
||||||
@retval EFI_DEVICE_ERROR Hardware could not be programmed.
|
|
||||||
|
|
||||||
**/
|
|
||||||
EFI_STATUS
|
|
||||||
EFIAPI
|
|
||||||
EndOfInterrupt (
|
|
||||||
IN EFI_HARDWARE_INTERRUPT_PROTOCOL *This,
|
|
||||||
IN HARDWARE_INTERRUPT_SOURCE Source
|
|
||||||
)
|
|
||||||
{
|
|
||||||
if (Source > mGicNumInterrupts) {
|
|
||||||
ASSERT(FALSE);
|
|
||||||
return EFI_UNSUPPORTED;
|
|
||||||
}
|
|
||||||
|
|
||||||
ArmGicEndOfInterrupt (PcdGet32(PcdGicInterruptInterfaceBase), Source);
|
|
||||||
return EFI_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
EFI_CPU_INTERRUPT_HANDLER that is called when a processor interrupt occurs.
|
|
||||||
|
|
||||||
@param InterruptType Defines the type of interrupt or exception that
|
|
||||||
occurred on the processor.This parameter is processor architecture specific.
|
|
||||||
@param SystemContext A pointer to the processor context when
|
|
||||||
the interrupt occurred on the processor.
|
|
||||||
|
|
||||||
@return None
|
|
||||||
|
|
||||||
**/
|
|
||||||
VOID
|
|
||||||
EFIAPI
|
|
||||||
IrqInterruptHandler (
|
|
||||||
IN EFI_EXCEPTION_TYPE InterruptType,
|
|
||||||
IN EFI_SYSTEM_CONTEXT SystemContext
|
|
||||||
)
|
|
||||||
{
|
|
||||||
UINT32 GicInterrupt;
|
|
||||||
HARDWARE_INTERRUPT_HANDLER InterruptHandler;
|
|
||||||
|
|
||||||
GicInterrupt = ArmGicAcknowledgeInterrupt (PcdGet32(PcdGicInterruptInterfaceBase));
|
|
||||||
|
|
||||||
// Special Interrupts (ID1020-ID1023) have an Interrupt ID greater than the number of interrupt (ie: Spurious interrupt).
|
|
||||||
if ((GicInterrupt & ARM_GIC_ICCIAR_ACKINTID) >= mGicNumInterrupts) {
|
|
||||||
// The special interrupt do not need to be acknowledge
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
InterruptHandler = gRegisteredInterruptHandlers[GicInterrupt];
|
|
||||||
if (InterruptHandler != NULL) {
|
|
||||||
// Call the registered interrupt handler.
|
|
||||||
InterruptHandler (GicInterrupt, SystemContext);
|
|
||||||
} else {
|
|
||||||
DEBUG ((EFI_D_ERROR, "Spurious GIC interrupt: 0x%x\n", GicInterrupt));
|
|
||||||
}
|
|
||||||
|
|
||||||
EndOfInterrupt (&gHardwareInterruptProtocol, GicInterrupt);
|
|
||||||
}
|
|
||||||
|
|
||||||
//
|
|
||||||
// The protocol instance produced by this driver
|
|
||||||
//
|
|
||||||
EFI_HARDWARE_INTERRUPT_PROTOCOL gHardwareInterruptProtocol = {
|
|
||||||
RegisterInterruptSource,
|
|
||||||
EnableInterruptSource,
|
|
||||||
DisableInterruptSource,
|
|
||||||
GetInterruptSourceState,
|
|
||||||
EndOfInterrupt
|
|
||||||
};
|
|
||||||
|
|
||||||
/**
|
|
||||||
Shutdown our hardware
|
|
||||||
|
|
||||||
DXE Core will disable interrupts and turn off the timer and disable interrupts
|
|
||||||
after all the event handlers have run.
|
|
||||||
|
|
||||||
@param[in] Event The Event that is being processed
|
|
||||||
@param[in] Context Event Context
|
|
||||||
**/
|
|
||||||
VOID
|
|
||||||
EFIAPI
|
|
||||||
ExitBootServicesEvent (
|
|
||||||
IN EFI_EVENT Event,
|
|
||||||
IN VOID *Context
|
|
||||||
)
|
|
||||||
{
|
|
||||||
UINTN Index;
|
|
||||||
|
|
||||||
// Acknowledge all pending interrupts
|
|
||||||
for (Index = 0; Index < mGicNumInterrupts; Index++) {
|
|
||||||
DisableInterruptSource (&gHardwareInterruptProtocol, Index);
|
|
||||||
}
|
|
||||||
|
|
||||||
for (Index = 0; Index < mGicNumInterrupts; Index++) {
|
|
||||||
EndOfInterrupt (&gHardwareInterruptProtocol, Index);
|
|
||||||
}
|
|
||||||
|
|
||||||
// Disable Gic Interface
|
|
||||||
ArmGicDisableInterruptInterface (PcdGet32(PcdGicInterruptInterfaceBase));
|
|
||||||
|
|
||||||
// Disable Gic Distributor
|
|
||||||
ArmGicDisableDistributor (PcdGet32(PcdGicDistributorBase));
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Initialize the state information for the CPU Architectural Protocol
|
Initialize the state information for the CPU Architectural Protocol
|
||||||
|
|
||||||
@ -250,65 +42,8 @@ InterruptDxeInitialize (
|
|||||||
)
|
)
|
||||||
{
|
{
|
||||||
EFI_STATUS Status;
|
EFI_STATUS Status;
|
||||||
UINTN Index;
|
|
||||||
UINT32 RegOffset;
|
|
||||||
UINTN RegShift;
|
|
||||||
UINT32 CpuTarget;
|
|
||||||
|
|
||||||
// Make sure the Interrupt Controller Protocol is not already installed in the system.
|
Status = GicV2DxeInitialize (ImageHandle, SystemTable);
|
||||||
ASSERT_PROTOCOL_ALREADY_INSTALLED (NULL, &gHardwareInterruptProtocolGuid);
|
|
||||||
|
|
||||||
mGicNumInterrupts = ArmGicGetMaxNumInterrupts (PcdGet32(PcdGicDistributorBase));
|
|
||||||
|
|
||||||
for (Index = 0; Index < mGicNumInterrupts; Index++) {
|
|
||||||
DisableInterruptSource (&gHardwareInterruptProtocol, Index);
|
|
||||||
|
|
||||||
// Set Priority
|
|
||||||
RegOffset = Index / 4;
|
|
||||||
RegShift = (Index % 4) * 8;
|
|
||||||
MmioAndThenOr32 (
|
|
||||||
PcdGet32(PcdGicDistributorBase) + ARM_GIC_ICDIPR + (4*RegOffset),
|
|
||||||
~(0xff << RegShift),
|
|
||||||
ARM_GIC_DEFAULT_PRIORITY << RegShift
|
|
||||||
);
|
|
||||||
}
|
|
||||||
|
|
||||||
//
|
|
||||||
// Targets the interrupts to the Primary Cpu
|
|
||||||
//
|
|
||||||
|
|
||||||
// Only Primary CPU will run this code. We can identify our GIC CPU ID by reading
|
|
||||||
// the GIC Distributor Target register. The 8 first GICD_ITARGETSRn are banked to each
|
|
||||||
// connected CPU. These 8 registers hold the CPU targets fields for interrupts 0-31.
|
|
||||||
// More Info in the GIC Specification about "Interrupt Processor Targets Registers"
|
|
||||||
//
|
|
||||||
// Read the first Interrupt Processor Targets Register (that corresponds to the 4
|
|
||||||
// first SGIs)
|
|
||||||
CpuTarget = MmioRead32 (PcdGet32 (PcdGicDistributorBase) + ARM_GIC_ICDIPTR);
|
|
||||||
|
|
||||||
// The CPU target is a bit field mapping each CPU to a GIC CPU Interface. This value
|
|
||||||
// is 0 when we run on a uniprocessor platform.
|
|
||||||
if (CpuTarget != 0) {
|
|
||||||
// The 8 first Interrupt Processor Targets Registers are read-only
|
|
||||||
for (Index = 8; Index < (mGicNumInterrupts / 4); Index++) {
|
|
||||||
MmioWrite32 (PcdGet32 (PcdGicDistributorBase) + ARM_GIC_ICDIPTR + (Index * 4), CpuTarget);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// Set binary point reg to 0x7 (no preemption)
|
|
||||||
MmioWrite32 (PcdGet32(PcdGicInterruptInterfaceBase) + ARM_GIC_ICCBPR, 0x7);
|
|
||||||
|
|
||||||
// Set priority mask reg to 0xff to allow all priorities through
|
|
||||||
MmioWrite32 (PcdGet32(PcdGicInterruptInterfaceBase) + ARM_GIC_ICCPMR, 0xff);
|
|
||||||
|
|
||||||
// Enable gic cpu interface
|
|
||||||
ArmGicEnableInterruptInterface (PcdGet32(PcdGicInterruptInterfaceBase));
|
|
||||||
|
|
||||||
// Enable gic distributor
|
|
||||||
ArmGicEnableDistributor (PcdGet32(PcdGicDistributorBase));
|
|
||||||
|
|
||||||
Status = InstallAndRegisterInterruptService (
|
|
||||||
&gHardwareInterruptProtocol, IrqInterruptHandler, ExitBootServicesEvent);
|
|
||||||
|
|
||||||
return Status;
|
return Status;
|
||||||
}
|
}
|
||||||
|
@ -15,8 +15,10 @@ WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
|||||||
#ifndef __ARM_GIC_DXE_H__
|
#ifndef __ARM_GIC_DXE_H__
|
||||||
#define __ARM_GIC_DXE_H__
|
#define __ARM_GIC_DXE_H__
|
||||||
|
|
||||||
|
#include <Library/ArmGicLib.h>
|
||||||
#include <Library/ArmLib.h>
|
#include <Library/ArmLib.h>
|
||||||
#include <Library/DebugLib.h>
|
#include <Library/DebugLib.h>
|
||||||
|
#include <Library/IoLib.h>
|
||||||
#include <Library/MemoryAllocationLib.h>
|
#include <Library/MemoryAllocationLib.h>
|
||||||
#include <Library/UefiBootServicesTableLib.h>
|
#include <Library/UefiBootServicesTableLib.h>
|
||||||
|
|
||||||
@ -44,4 +46,13 @@ RegisterInterruptSource (
|
|||||||
IN HARDWARE_INTERRUPT_HANDLER Handler
|
IN HARDWARE_INTERRUPT_HANDLER Handler
|
||||||
);
|
);
|
||||||
|
|
||||||
|
//
|
||||||
|
// GicV2 API
|
||||||
|
//
|
||||||
|
EFI_STATUS
|
||||||
|
GicV2DxeInitialize (
|
||||||
|
IN EFI_HANDLE ImageHandle,
|
||||||
|
IN EFI_SYSTEM_TABLE *SystemTable
|
||||||
|
);
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
@ -26,6 +26,8 @@
|
|||||||
ArmGicDxe.c
|
ArmGicDxe.c
|
||||||
ArmGicCommonDxe.c
|
ArmGicCommonDxe.c
|
||||||
|
|
||||||
|
GicV2/ArmGicV2Dxe.c
|
||||||
|
|
||||||
[Packages]
|
[Packages]
|
||||||
MdePkg/MdePkg.dec
|
MdePkg/MdePkg.dec
|
||||||
EmbeddedPkg/EmbeddedPkg.dec
|
EmbeddedPkg/EmbeddedPkg.dec
|
||||||
|
312
ArmPkg/Drivers/ArmGic/GicV2/ArmGicV2Dxe.c
Normal file
312
ArmPkg/Drivers/ArmGic/GicV2/ArmGicV2Dxe.c
Normal file
@ -0,0 +1,312 @@
|
|||||||
|
/*++
|
||||||
|
|
||||||
|
Copyright (c) 2009, Hewlett-Packard Company. All rights reserved.<BR>
|
||||||
|
Portions copyright (c) 2010, Apple Inc. All rights reserved.<BR>
|
||||||
|
Portions copyright (c) 2011-2014, ARM Ltd. All rights reserved.<BR>
|
||||||
|
|
||||||
|
This program and the accompanying materials
|
||||||
|
are licensed and made available under the terms and conditions of the BSD License
|
||||||
|
which accompanies this distribution. The full text of the license may be found at
|
||||||
|
http://opensource.org/licenses/bsd-license.php
|
||||||
|
|
||||||
|
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
||||||
|
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
||||||
|
|
||||||
|
Module Name:
|
||||||
|
|
||||||
|
GicV2/ArmGicV2Dxe.c
|
||||||
|
|
||||||
|
Abstract:
|
||||||
|
|
||||||
|
Driver implementing the GicV2 interrupt controller protocol
|
||||||
|
|
||||||
|
--*/
|
||||||
|
|
||||||
|
#include "ArmGicDxe.h"
|
||||||
|
#include "GicV2/ArmGicV2Lib.h"
|
||||||
|
|
||||||
|
#define ARM_GIC_DEFAULT_PRIORITY 0x80
|
||||||
|
|
||||||
|
extern EFI_HARDWARE_INTERRUPT_PROTOCOL gHardwareInterruptV2Protocol;
|
||||||
|
|
||||||
|
/**
|
||||||
|
Enable interrupt source Source.
|
||||||
|
|
||||||
|
@param This Instance pointer for this protocol
|
||||||
|
@param Source Hardware source of the interrupt
|
||||||
|
|
||||||
|
@retval EFI_SUCCESS Source interrupt enabled.
|
||||||
|
@retval EFI_UNSUPPORTED Source interrupt is not supported
|
||||||
|
|
||||||
|
**/
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
GicV2EnableInterruptSource (
|
||||||
|
IN EFI_HARDWARE_INTERRUPT_PROTOCOL *This,
|
||||||
|
IN HARDWARE_INTERRUPT_SOURCE Source
|
||||||
|
)
|
||||||
|
{
|
||||||
|
if (Source > mGicNumInterrupts) {
|
||||||
|
ASSERT(FALSE);
|
||||||
|
return EFI_UNSUPPORTED;
|
||||||
|
}
|
||||||
|
|
||||||
|
ArmGicEnableInterrupt (FixedPcdGet32 (PcdGicDistributorBase), Source);
|
||||||
|
|
||||||
|
return EFI_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
Disable interrupt source Source.
|
||||||
|
|
||||||
|
@param This Instance pointer for this protocol
|
||||||
|
@param Source Hardware source of the interrupt
|
||||||
|
|
||||||
|
@retval EFI_SUCCESS Source interrupt disabled.
|
||||||
|
@retval EFI_UNSUPPORTED Source interrupt is not supported
|
||||||
|
|
||||||
|
**/
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
GicV2DisableInterruptSource (
|
||||||
|
IN EFI_HARDWARE_INTERRUPT_PROTOCOL *This,
|
||||||
|
IN HARDWARE_INTERRUPT_SOURCE Source
|
||||||
|
)
|
||||||
|
{
|
||||||
|
if (Source > mGicNumInterrupts) {
|
||||||
|
ASSERT(FALSE);
|
||||||
|
return EFI_UNSUPPORTED;
|
||||||
|
}
|
||||||
|
|
||||||
|
ArmGicDisableInterrupt (FixedPcdGet32 (PcdGicDistributorBase), Source);
|
||||||
|
|
||||||
|
return EFI_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
Return current state of interrupt source Source.
|
||||||
|
|
||||||
|
@param This Instance pointer for this protocol
|
||||||
|
@param Source Hardware source of the interrupt
|
||||||
|
@param InterruptState TRUE: source enabled, FALSE: source disabled.
|
||||||
|
|
||||||
|
@retval EFI_SUCCESS InterruptState is valid
|
||||||
|
@retval EFI_UNSUPPORTED Source interrupt is not supported
|
||||||
|
|
||||||
|
**/
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
GicV2GetInterruptSourceState (
|
||||||
|
IN EFI_HARDWARE_INTERRUPT_PROTOCOL *This,
|
||||||
|
IN HARDWARE_INTERRUPT_SOURCE Source,
|
||||||
|
IN BOOLEAN *InterruptState
|
||||||
|
)
|
||||||
|
{
|
||||||
|
if (Source > mGicNumInterrupts) {
|
||||||
|
ASSERT(FALSE);
|
||||||
|
return EFI_UNSUPPORTED;
|
||||||
|
}
|
||||||
|
|
||||||
|
*InterruptState = ArmGicIsInterruptEnabled (FixedPcdGet32 (PcdGicDistributorBase), Source);
|
||||||
|
|
||||||
|
return EFI_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
Signal to the hardware that the End Of Interrupt state
|
||||||
|
has been reached.
|
||||||
|
|
||||||
|
@param This Instance pointer for this protocol
|
||||||
|
@param Source Hardware source of the interrupt
|
||||||
|
|
||||||
|
@retval EFI_SUCCESS Source interrupt EOI'ed.
|
||||||
|
@retval EFI_UNSUPPORTED Source interrupt is not supported
|
||||||
|
|
||||||
|
**/
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
GicV2EndOfInterrupt (
|
||||||
|
IN EFI_HARDWARE_INTERRUPT_PROTOCOL *This,
|
||||||
|
IN HARDWARE_INTERRUPT_SOURCE Source
|
||||||
|
)
|
||||||
|
{
|
||||||
|
if (Source > mGicNumInterrupts) {
|
||||||
|
ASSERT(FALSE);
|
||||||
|
return EFI_UNSUPPORTED;
|
||||||
|
}
|
||||||
|
|
||||||
|
ArmGicV2EndOfInterrupt (FixedPcdGet32 (PcdGicInterruptInterfaceBase), Source);
|
||||||
|
return EFI_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
EFI_CPU_INTERRUPT_HANDLER that is called when a processor interrupt occurs.
|
||||||
|
|
||||||
|
@param InterruptType Defines the type of interrupt or exception that
|
||||||
|
occurred on the processor.This parameter is processor architecture specific.
|
||||||
|
@param SystemContext A pointer to the processor context when
|
||||||
|
the interrupt occurred on the processor.
|
||||||
|
|
||||||
|
@return None
|
||||||
|
|
||||||
|
**/
|
||||||
|
VOID
|
||||||
|
EFIAPI
|
||||||
|
GicV2IrqInterruptHandler (
|
||||||
|
IN EFI_EXCEPTION_TYPE InterruptType,
|
||||||
|
IN EFI_SYSTEM_CONTEXT SystemContext
|
||||||
|
)
|
||||||
|
{
|
||||||
|
UINT32 GicInterrupt;
|
||||||
|
HARDWARE_INTERRUPT_HANDLER InterruptHandler;
|
||||||
|
|
||||||
|
GicInterrupt = ArmGicV2AcknowledgeInterrupt (FixedPcdGet32 (PcdGicInterruptInterfaceBase));
|
||||||
|
|
||||||
|
// Special Interrupts (ID1020-ID1023) have an Interrupt ID greater than the number of interrupt (ie: Spurious interrupt).
|
||||||
|
if ((GicInterrupt & ARM_GIC_ICCIAR_ACKINTID) >= mGicNumInterrupts) {
|
||||||
|
// The special interrupt do not need to be acknowledge
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
InterruptHandler = gRegisteredInterruptHandlers[GicInterrupt];
|
||||||
|
if (InterruptHandler != NULL) {
|
||||||
|
// Call the registered interrupt handler.
|
||||||
|
InterruptHandler (GicInterrupt, SystemContext);
|
||||||
|
} else {
|
||||||
|
DEBUG ((EFI_D_ERROR, "Spurious GIC interrupt: 0x%x\n", GicInterrupt));
|
||||||
|
}
|
||||||
|
|
||||||
|
GicV2EndOfInterrupt (&gHardwareInterruptV2Protocol, GicInterrupt);
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// The protocol instance produced by this driver
|
||||||
|
//
|
||||||
|
EFI_HARDWARE_INTERRUPT_PROTOCOL gHardwareInterruptV2Protocol = {
|
||||||
|
RegisterInterruptSource,
|
||||||
|
GicV2EnableInterruptSource,
|
||||||
|
GicV2DisableInterruptSource,
|
||||||
|
GicV2GetInterruptSourceState,
|
||||||
|
GicV2EndOfInterrupt
|
||||||
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
Shutdown our hardware
|
||||||
|
|
||||||
|
DXE Core will disable interrupts and turn off the timer and disable interrupts
|
||||||
|
after all the event handlers have run.
|
||||||
|
|
||||||
|
@param[in] Event The Event that is being processed
|
||||||
|
@param[in] Context Event Context
|
||||||
|
**/
|
||||||
|
VOID
|
||||||
|
EFIAPI
|
||||||
|
GicV2ExitBootServicesEvent (
|
||||||
|
IN EFI_EVENT Event,
|
||||||
|
IN VOID *Context
|
||||||
|
)
|
||||||
|
{
|
||||||
|
UINTN Index;
|
||||||
|
UINT32 GicInterrupt;
|
||||||
|
|
||||||
|
// Disable all the interrupts
|
||||||
|
for (Index = 0; Index < mGicNumInterrupts; Index++) {
|
||||||
|
GicV2DisableInterruptSource (&gHardwareInterruptV2Protocol, Index);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Acknowledge all pending interrupts
|
||||||
|
do {
|
||||||
|
GicInterrupt = ArmGicV2AcknowledgeInterrupt (FixedPcdGet32 (PcdGicInterruptInterfaceBase));
|
||||||
|
|
||||||
|
if ((GicInterrupt & ARM_GIC_ICCIAR_ACKINTID) < mGicNumInterrupts) {
|
||||||
|
GicV2EndOfInterrupt (&gHardwareInterruptV2Protocol, GicInterrupt);
|
||||||
|
}
|
||||||
|
} while (!ARM_GIC_IS_SPECIAL_INTERRUPTS (GicInterrupt));
|
||||||
|
|
||||||
|
// Disable Gic Interface
|
||||||
|
ArmGicV2DisableInterruptInterface (FixedPcdGet32 (PcdGicInterruptInterfaceBase));
|
||||||
|
|
||||||
|
// Disable Gic Distributor
|
||||||
|
ArmGicDisableDistributor (FixedPcdGet32 (PcdGicDistributorBase));
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
Initialize the state information for the CPU Architectural Protocol
|
||||||
|
|
||||||
|
@param ImageHandle of the loaded driver
|
||||||
|
@param SystemTable Pointer to the System Table
|
||||||
|
|
||||||
|
@retval EFI_SUCCESS Protocol registered
|
||||||
|
@retval EFI_OUT_OF_RESOURCES Cannot allocate protocol data structure
|
||||||
|
@retval EFI_DEVICE_ERROR Hardware problems
|
||||||
|
|
||||||
|
**/
|
||||||
|
EFI_STATUS
|
||||||
|
GicV2DxeInitialize (
|
||||||
|
IN EFI_HANDLE ImageHandle,
|
||||||
|
IN EFI_SYSTEM_TABLE *SystemTable
|
||||||
|
)
|
||||||
|
{
|
||||||
|
EFI_STATUS Status;
|
||||||
|
UINTN Index;
|
||||||
|
UINT32 RegOffset;
|
||||||
|
UINTN RegShift;
|
||||||
|
UINT32 CpuTarget;
|
||||||
|
|
||||||
|
// Make sure the Interrupt Controller Protocol is not already installed in the system.
|
||||||
|
ASSERT_PROTOCOL_ALREADY_INSTALLED (NULL, &gHardwareInterruptProtocolGuid);
|
||||||
|
|
||||||
|
mGicNumInterrupts = ArmGicGetMaxNumInterrupts (FixedPcdGet32 (PcdGicDistributorBase));
|
||||||
|
|
||||||
|
for (Index = 0; Index < mGicNumInterrupts; Index++) {
|
||||||
|
GicV2DisableInterruptSource (&gHardwareInterruptV2Protocol, Index);
|
||||||
|
|
||||||
|
// Set Priority
|
||||||
|
RegOffset = Index / 4;
|
||||||
|
RegShift = (Index % 4) * 8;
|
||||||
|
MmioAndThenOr32 (
|
||||||
|
FixedPcdGet32 (PcdGicDistributorBase) + ARM_GIC_ICDIPR + (4 * RegOffset),
|
||||||
|
~(0xff << RegShift),
|
||||||
|
ARM_GIC_DEFAULT_PRIORITY << RegShift
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// Targets the interrupts to the Primary Cpu
|
||||||
|
//
|
||||||
|
|
||||||
|
// Only Primary CPU will run this code. We can identify our GIC CPU ID by reading
|
||||||
|
// the GIC Distributor Target register. The 8 first GICD_ITARGETSRn are banked to each
|
||||||
|
// connected CPU. These 8 registers hold the CPU targets fields for interrupts 0-31.
|
||||||
|
// More Info in the GIC Specification about "Interrupt Processor Targets Registers"
|
||||||
|
//
|
||||||
|
// Read the first Interrupt Processor Targets Register (that corresponds to the 4
|
||||||
|
// first SGIs)
|
||||||
|
CpuTarget = MmioRead32 (FixedPcdGet32 (PcdGicDistributorBase) + ARM_GIC_ICDIPTR);
|
||||||
|
|
||||||
|
// The CPU target is a bit field mapping each CPU to a GIC CPU Interface. This value
|
||||||
|
// is 0 when we run on a uniprocessor platform.
|
||||||
|
if (CpuTarget != 0) {
|
||||||
|
// The 8 first Interrupt Processor Targets Registers are read-only
|
||||||
|
for (Index = 8; Index < (mGicNumInterrupts / 4); Index++) {
|
||||||
|
MmioWrite32 (FixedPcdGet32 (PcdGicDistributorBase) + ARM_GIC_ICDIPTR + (Index * 4), CpuTarget);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// Set binary point reg to 0x7 (no preemption)
|
||||||
|
MmioWrite32 (FixedPcdGet32 (PcdGicInterruptInterfaceBase) + ARM_GIC_ICCBPR, 0x7);
|
||||||
|
|
||||||
|
// Set priority mask reg to 0xff to allow all priorities through
|
||||||
|
MmioWrite32 (FixedPcdGet32 (PcdGicInterruptInterfaceBase) + ARM_GIC_ICCPMR, 0xff);
|
||||||
|
|
||||||
|
// Enable gic cpu interface
|
||||||
|
ArmGicEnableInterruptInterface (FixedPcdGet32 (PcdGicInterruptInterfaceBase));
|
||||||
|
|
||||||
|
// Enable gic distributor
|
||||||
|
ArmGicEnableDistributor (FixedPcdGet32 (PcdGicDistributorBase));
|
||||||
|
|
||||||
|
Status = InstallAndRegisterInterruptService (
|
||||||
|
&gHardwareInterruptV2Protocol, GicV2IrqInterruptHandler, GicV2ExitBootServicesEvent);
|
||||||
|
|
||||||
|
return Status;
|
||||||
|
}
|
Loading…
x
Reference in New Issue
Block a user