CpuException: Add InitializeSeparateExceptionStacks

[mirror_edk2.git] / UefiCpuPkg / Library / CpuExceptionHandlerLib / DxeException.c

/** @file\r
  CPU exception handler library implemenation for DXE modules.\r
\r
  Copyright (c) 2013 - 2022, Intel Corporation. All rights reserved.<BR>\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include <PiDxe.h>\r
#include "CpuExceptionCommon.h"\r
#include <Library/DebugLib.h>\r
#include <Library/MemoryAllocationLib.h>\r
#include <Library/UefiBootServicesTableLib.h>\r
\r
CONST UINTN  mDoFarReturnFlag = 0;\r
\r
RESERVED_VECTORS_DATA      mReservedVectorsData[CPU_INTERRUPT_NUM];\r
EFI_CPU_INTERRUPT_HANDLER  mExternalInterruptHandlerTable[CPU_INTERRUPT_NUM];\r
EXCEPTION_HANDLER_DATA     mExceptionHandlerData = {\r
  CPU_INTERRUPT_NUM,\r
  0,                     // To be fixed\r
  mReservedVectorsData,\r
  mExternalInterruptHandlerTable\r
};\r
\r
UINT8  mNewStack[CPU_STACK_SWITCH_EXCEPTION_NUMBER *\r
                 CPU_KNOWN_GOOD_STACK_SIZE];\r
UINT8  mNewGdt[CPU_TSS_GDT_SIZE];\r
\r
/**\r
  Common exception handler.\r
\r
  @param ExceptionType  Exception type.\r
  @param SystemContext  Pointer to EFI_SYSTEM_CONTEXT.\r
**/\r
VOID\r
EFIAPI\r
CommonExceptionHandler (\r
  IN EFI_EXCEPTION_TYPE  ExceptionType,\r
  IN EFI_SYSTEM_CONTEXT  SystemContext\r
  )\r
{\r
  CommonExceptionHandlerWorker (ExceptionType, SystemContext, &mExceptionHandlerData);\r
}\r
\r
/**\r
  Initializes all CPU exceptions entries and provides the default exception handlers.\r
\r
  Caller should try to get an array of interrupt and/or exception vectors that are in use and need to\r
  persist by EFI_VECTOR_HANDOFF_INFO defined in PI 1.3 specification.\r
  If caller cannot get reserved vector list or it does not exists, set VectorInfo to NULL.\r
  If VectorInfo is not NULL, the exception vectors will be initialized per vector attribute accordingly.\r
\r
  @param[in]  VectorInfo    Pointer to reserved vector list.\r
\r
  @retval EFI_SUCCESS           CPU Exception Entries have been successfully initialized\r
                                with default exception handlers.\r
  @retval EFI_INVALID_PARAMETER VectorInfo includes the invalid content if VectorInfo is not NULL.\r
  @retval EFI_UNSUPPORTED       This function is not supported.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
InitializeCpuExceptionHandlers (\r
  IN EFI_VECTOR_HANDOFF_INFO  *VectorInfo OPTIONAL\r
  )\r
{\r
  InitializeSpinLock (&mExceptionHandlerData.DisplayMessageSpinLock);\r
  return InitializeCpuExceptionHandlersWorker (VectorInfo, &mExceptionHandlerData);\r
}\r
\r
/**\r
  Registers a function to be called from the processor interrupt handler.\r
\r
  This function registers and enables the handler specified by InterruptHandler for a processor\r
  interrupt or exception type specified by InterruptType. If InterruptHandler is NULL, then the\r
  handler for the processor interrupt or exception type specified by InterruptType is uninstalled.\r
  The installed handler is called once for each processor interrupt or exception.\r
  NOTE: This function should be invoked after InitializeCpuExceptionHandlers() is invoked,\r
  otherwise EFI_UNSUPPORTED returned.\r
\r
  @param[in]  InterruptType     Defines which interrupt or exception to hook.\r
  @param[in]  InterruptHandler  A pointer to a function of type EFI_CPU_INTERRUPT_HANDLER that is called\r
                                when a processor interrupt occurs. If this parameter is NULL, then the handler\r
                                will be uninstalled.\r
\r
  @retval EFI_SUCCESS           The handler for the processor interrupt was successfully installed or uninstalled.\r
  @retval EFI_ALREADY_STARTED   InterruptHandler is not NULL, and a handler for InterruptType was\r
                                previously installed.\r
  @retval EFI_INVALID_PARAMETER InterruptHandler is NULL, and a handler for InterruptType was not\r
                                previously installed.\r
  @retval EFI_UNSUPPORTED       The interrupt specified by InterruptType is not supported,\r
                                or this function is not supported.\r
**/\r
EFI_STATUS\r
EFIAPI\r
RegisterCpuInterruptHandler (\r
  IN EFI_EXCEPTION_TYPE         InterruptType,\r
  IN EFI_CPU_INTERRUPT_HANDLER  InterruptHandler\r
  )\r
{\r
  return RegisterCpuInterruptHandlerWorker (InterruptType, InterruptHandler, &mExceptionHandlerData);\r
}\r
\r
/**\r
  Setup separate stacks for certain exception handlers.\r
\r
  InitData is optional and processor arch dependent.\r
\r
  @param[in]  InitData      Pointer to data optional for information about how\r
                            to assign stacks for certain exception handlers.\r
\r
  @retval EFI_SUCCESS             The stacks are assigned successfully.\r
  @retval EFI_UNSUPPORTED         This function is not supported.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
InitializeSeparateExceptionStacks (\r
  IN CPU_EXCEPTION_INIT_DATA  *InitData OPTIONAL\r
  )\r
{\r
  CPU_EXCEPTION_INIT_DATA  EssData;\r
  IA32_DESCRIPTOR          Idtr;\r
  IA32_DESCRIPTOR          Gdtr;\r
\r
  if (InitData == NULL) {\r
    SetMem (mNewGdt, sizeof (mNewGdt), 0);\r
\r
    AsmReadIdtr (&Idtr);\r
    AsmReadGdtr (&Gdtr);\r
\r
    EssData.X64.Revision                   = CPU_EXCEPTION_INIT_DATA_REV;\r
    EssData.X64.KnownGoodStackTop          = (UINTN)mNewStack + sizeof (mNewStack);\r
    EssData.X64.KnownGoodStackSize         = CPU_KNOWN_GOOD_STACK_SIZE;\r
    EssData.X64.StackSwitchExceptions      = CPU_STACK_SWITCH_EXCEPTION_LIST;\r
    EssData.X64.StackSwitchExceptionNumber = CPU_STACK_SWITCH_EXCEPTION_NUMBER;\r
    EssData.X64.IdtTable                   = (VOID *)Idtr.Base;\r
    EssData.X64.IdtTableSize               = Idtr.Limit + 1;\r
    EssData.X64.GdtTable                   = mNewGdt;\r
    EssData.X64.GdtTableSize               = sizeof (mNewGdt);\r
    EssData.X64.ExceptionTssDesc           = mNewGdt + Gdtr.Limit + 1;\r
    EssData.X64.ExceptionTssDescSize       = CPU_TSS_DESC_SIZE;\r
    EssData.X64.ExceptionTss               = mNewGdt + Gdtr.Limit + 1 + CPU_TSS_DESC_SIZE;\r
    EssData.X64.ExceptionTssSize           = CPU_TSS_SIZE;\r
\r
    InitData = &EssData;\r
  }\r
\r
  return ArchSetupExceptionStack (InitData);\r
}\r