mirror of https://github.com/acidanthera/audk.git
71 lines
2.1 KiB
C
71 lines
2.1 KiB
C
/** @file
|
|
*
|
|
* Copyright (c) 2011-2012, ARM Limited. All rights reserved.
|
|
*
|
|
* 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.
|
|
*
|
|
**/
|
|
|
|
#include <Uefi.h>
|
|
#include <Library/IoLib.h>
|
|
#include <Library/ArmGicLib.h>
|
|
#include <Library/PcdLib.h>
|
|
|
|
UINTN
|
|
EFIAPI
|
|
ArmGicGetMaxNumInterrupts (
|
|
IN INTN GicDistributorBase
|
|
)
|
|
{
|
|
return 32 * ((MmioRead32 (GicDistributorBase + ARM_GIC_ICDICTR) & 0x1F) + 1);
|
|
}
|
|
|
|
VOID
|
|
EFIAPI
|
|
ArmGicSendSgiTo (
|
|
IN INTN GicDistributorBase,
|
|
IN INTN TargetListFilter,
|
|
IN INTN CPUTargetList,
|
|
IN INTN SgiId
|
|
)
|
|
{
|
|
MmioWrite32 (GicDistributorBase + ARM_GIC_ICDSGIR, ((TargetListFilter & 0x3) << 24) | ((CPUTargetList & 0xFF) << 16) | SgiId);
|
|
}
|
|
|
|
RETURN_STATUS
|
|
EFIAPI
|
|
ArmGicAcknowledgeInterrupt (
|
|
IN UINTN GicDistributorBase,
|
|
IN UINTN GicInterruptInterfaceBase,
|
|
OUT UINTN *CoreId,
|
|
OUT UINTN *InterruptId
|
|
)
|
|
{
|
|
UINT32 Interrupt;
|
|
|
|
// Read the Interrupt Acknowledge Register
|
|
Interrupt = MmioRead32 (GicInterruptInterfaceBase + ARM_GIC_ICCIAR);
|
|
|
|
// 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 RETURN_INVALID_PARAMETER;
|
|
}
|
|
}
|