ArmPkg/PL390Gic: Added support for ArmGicDisableInterruptInterface()

[mirror_edk2.git] / ArmPkg / Drivers / PL390Gic / PL390GicSec.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 <Base.h>\r
#include <Library/ArmLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/IoLib.h>\r
#include <Library/ArmGicLib.h>\r
\r
/*\r
 * This function configures the all interrupts to be Non-secure.\r
 *\r
 */\r
VOID\r
EFIAPI\r
ArmGicSetupNonSecure (\r
  IN  UINTN         MpId,\r
  IN  INTN          GicDistributorBase,\r
  IN  INTN          GicInterruptInterfaceBase\r
  )\r
{\r
  UINTN InterruptId;\r
  UINTN CachedPriorityMask;\r
  UINTN Index;\r
\r
  CachedPriorityMask = MmioRead32 (GicInterruptInterfaceBase + ARM_GIC_ICCPMR);\r
\r
  // Set priority Mask so that no interrupts get through to CPU\r
  MmioWrite32 (GicInterruptInterfaceBase + ARM_GIC_ICCPMR, 0);\r
\r
  // Check if there are any pending interrupts\r
  //TODO: could be extended to take Peripheral interrupts into consideration, but at the moment only SGI's are taken into consideration.\r
  while(0 != (MmioRead32 (GicDistributorBase + ARM_GIC_ICDICPR) & 0xF)) {\r
    // Some of the SGI's are still pending, read Ack register and send End of Interrupt Signal\r
    InterruptId = MmioRead32 (GicInterruptInterfaceBase + ARM_GIC_ICCIAR);\r
\r
    // Write to End of interrupt signal\r
    MmioWrite32 (GicInterruptInterfaceBase + ARM_GIC_ICCEIOR, InterruptId);\r
  }\r
\r
  // Only the primary core should set the Non Secure bit to the SPIs (Shared Peripheral Interrupt).\r
  if (IS_PRIMARY_CORE(MpId)) {\r
    // Ensure all GIC interrupts are Non-Secure\r
    for (Index = 0; Index < (ArmGicGetMaxNumInterrupts (GicDistributorBase) / 32); Index++) {\r
      MmioWrite32 (GicDistributorBase + ARM_GIC_ICDISR + (Index * 4), 0xffffffff);\r
    }\r
  } else {\r
    // The secondary cores only set the Non Secure bit to their banked PPIs\r
    MmioWrite32 (GicDistributorBase + ARM_GIC_ICDISR, 0xffffffff);\r
  }\r
\r
  // Ensure all interrupts can get through the priority mask\r
  MmioWrite32 (GicInterruptInterfaceBase + ARM_GIC_ICCPMR, CachedPriorityMask);\r
}\r
\r
/*\r
 * This function configures the interrupts set by the mask to be secure.\r
 *\r
 */\r
VOID\r
EFIAPI\r
ArmGicSetSecureInterrupts (\r
  IN  UINTN         GicDistributorBase,\r
  IN  UINTN*        GicSecureInterruptMask,\r
  IN  UINTN         GicSecureInterruptMaskSize\r
  )\r
{\r
  UINTN  Index;\r
  UINT32 InterruptStatus;\r
\r
  // We must not have more interrupts defined by the mask than the number of available interrupts\r
  ASSERT(GicSecureInterruptMaskSize <= (ArmGicGetMaxNumInterrupts (GicDistributorBase) / 32));\r
\r
  // Set all the interrupts defined by the mask as Secure\r
  for (Index = 0; Index < GicSecureInterruptMaskSize; Index++) {\r
    InterruptStatus = MmioRead32 (GicDistributorBase + ARM_GIC_ICDISR + (Index * 4));\r
    MmioWrite32 (GicDistributorBase + ARM_GIC_ICDISR + (Index * 4), InterruptStatus & (~GicSecureInterruptMask[Index]));\r
  }\r
}\r
\r
VOID\r
EFIAPI\r
ArmGicEnableInterruptInterface (\r
  IN  INTN          GicInterruptInterfaceBase\r
  )\r
{\r
  // Set Priority Mask to allow interrupts\r
  MmioWrite32 (GicInterruptInterfaceBase + ARM_GIC_ICCPMR, 0x000000FF);\r
\r
  // Enable CPU interface in Secure world\r
  // Enable CPU inteface in Non-secure World\r
  // Signal Secure Interrupts to CPU using FIQ line *\r
  MmioWrite32 (GicInterruptInterfaceBase + ARM_GIC_ICCICR,\r
      ARM_GIC_ICCICR_ENABLE_SECURE |\r
      ARM_GIC_ICCICR_ENABLE_NS |\r
      ARM_GIC_ICCICR_SIGNAL_SECURE_TO_FIQ);\r
}\r
\r
VOID\r
EFIAPI\r
ArmGicDisableInterruptInterface (\r
  IN  INTN          GicInterruptInterfaceBase\r
  )\r
{\r
  UINT32    ControlValue;\r
\r
  // Disable CPU interface in Secure world and Non-secure World\r
  ControlValue = MmioRead32 (GicInterruptInterfaceBase + ARM_GIC_ICCICR);\r
  MmioWrite32 (GicInterruptInterfaceBase + ARM_GIC_ICCICR, ControlValue & ~(ARM_GIC_ICCICR_ENABLE_SECURE | ARM_GIC_ICCICR_ENABLE_NS));\r
}\r
\r
VOID\r
EFIAPI\r
ArmGicEnableDistributor (\r
  IN  INTN          GicDistributorBase\r
  )\r
{\r
  // Turn on the GIC distributor\r
  MmioWrite32 (GicDistributorBase + ARM_GIC_ICDDCR, 1);\r
}\r