ArmPkg: Fix Ecc error 5003 in ArmExceptionLib

[mirror_edk2.git] / ArmPkg / Library / ArmExceptionLib / AArch64 / AArch64Exception.c

/** @file\r
*  Exception Handling support specific for AArch64\r
*\r
*  Copyright (c) 2016 HP Development Company, L.P.\r
*  Copyright (c) 2021, Arm Limited. All rights reserved.<BR>\r
*\r
*  SPDX-License-Identifier: BSD-2-Clause-Patent\r
*\r
**/\r
\r
#include <Uefi.h>\r
\r
#include <Chipset/AArch64.h>\r
#include <Library/MemoryAllocationLib.h>\r
#include <Protocol/DebugSupport.h> // for MAX_AARCH64_EXCEPTION\r
\r
UINTN                   gMaxExceptionNumber = MAX_AARCH64_EXCEPTION;\r
EFI_EXCEPTION_CALLBACK  gExceptionHandlers[MAX_AARCH64_EXCEPTION + 1] = { 0 };\r
EFI_EXCEPTION_CALLBACK  gDebuggerExceptionHandlers[MAX_AARCH64_EXCEPTION + 1] = { 0 };\r
PHYSICAL_ADDRESS        gExceptionVectorAlignmentMask = ARM_VECTOR_TABLE_ALIGNMENT;\r
UINTN                   gDebuggerNoHandlerValue = 0; // todo: define for AArch64\r
\r
#define EL0_STACK_SIZE  EFI_PAGES_TO_SIZE(2)\r
STATIC UINTN mNewStackBase[EL0_STACK_SIZE / sizeof (UINTN)];\r
\r
VOID\r
RegisterEl0Stack (\r
  IN  VOID    *Stack\r
  );\r
\r
RETURN_STATUS\r
ArchVectorConfig (\r
  IN  UINTN       VectorBaseAddress\r
  )\r
{\r
  UINTN             HcrReg;\r
\r
  // Round down sp by 16 bytes alignment\r
  RegisterEl0Stack (\r
    (VOID *)(((UINTN)mNewStackBase + EL0_STACK_SIZE) & ~0xFUL)\r
    );\r
\r
  if (ArmReadCurrentEL() == AARCH64_EL2) {\r
    HcrReg = ArmReadHcr();\r
\r
    // Trap General Exceptions. All exceptions that would be routed to EL1 are routed to EL2\r
    HcrReg |= ARM_HCR_TGE;\r
\r
    ArmWriteHcr(HcrReg);\r
  }\r
\r
  return RETURN_SUCCESS;\r
}\r