UefiCpuPkg: Move AsmRelocateApLoopStart from Mpfuncs.nasm to AmdSev.nasm

[mirror_edk2.git] / MdeModulePkg / Universal / DebugSupportDxe / DebugSupport.c

/** @file\r
  Top level C file for debug support driver.  Contains initialization function.\r
\r
Copyright (c) 2006 - 2018, Intel Corporation. All rights reserved.<BR>\r
SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "PlDebugSupport.h"\r
\r
EFI_DEBUG_SUPPORT_PROTOCOL  mDebugSupportProtocolInterface = {\r
  EFI_ISA,\r
  GetMaximumProcessorIndex,\r
  RegisterPeriodicCallback,\r
  RegisterExceptionCallback,\r
  InvalidateInstructionCache\r
};\r
\r
\r
/**\r
  Debug Support Driver entry point.\r
\r
  Checks to see if there's not already a Debug Support protocol installed for\r
  the selected processor before installing it.\r
\r
  @param[in] ImageHandle       The firmware allocated handle for the EFI image.\r
  @param[in] SystemTable       A pointer to the EFI System Table.\r
\r
  @retval EFI_SUCCESS          The entry point is executed successfully.\r
  @retval EFI_ALREADY_STARTED  Debug Support protocol is installed already.\r
  @retval other                Some error occurs when executing this entry point.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
InitializeDebugSupportDriver (\r
  IN EFI_HANDLE               ImageHandle,\r
  IN EFI_SYSTEM_TABLE         *SystemTable\r
  )\r
{\r
  EFI_LOADED_IMAGE_PROTOCOL   *LoadedImageProtocolPtr;\r
  EFI_STATUS                  Status;\r
  EFI_HANDLE                  Handle;\r
  EFI_HANDLE                  *HandlePtr;\r
  UINTN                       NumHandles;\r
  EFI_DEBUG_SUPPORT_PROTOCOL  *DebugSupportProtocolPtr;\r
\r
  //\r
  // First check to see that the debug support protocol for this processor\r
  // type is not already installed\r
  //\r
  Status = gBS->LocateHandleBuffer (\r
                  ByProtocol,\r
                  &gEfiDebugSupportProtocolGuid,\r
                  NULL,\r
                  &NumHandles,\r
                  &HandlePtr\r
                  );\r
\r
  if (Status != EFI_NOT_FOUND) {\r
    do {\r
      NumHandles--;\r
      Status = gBS->OpenProtocol (\r
                      HandlePtr[NumHandles],\r
                      &gEfiDebugSupportProtocolGuid,\r
                      (VOID **) &DebugSupportProtocolPtr,\r
                      ImageHandle,\r
                      NULL,\r
                      EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                      );\r
      if ((Status == EFI_SUCCESS) && (DebugSupportProtocolPtr->Isa == EFI_ISA)) {\r
        //\r
        // a Debug Support protocol has been installed for this processor\r
        //\r
        FreePool (HandlePtr);\r
        Status = EFI_ALREADY_STARTED;\r
        goto ErrExit;\r
      }\r
    } while (NumHandles > 0);\r
    FreePool (HandlePtr);\r
  }\r
\r
  //\r
  // Get our image information and install platform specific unload handler\r
  //\r
  Status = gBS->OpenProtocol (\r
                  ImageHandle,\r
                  &gEfiLoadedImageProtocolGuid,\r
                  (VOID **) &LoadedImageProtocolPtr,\r
                  ImageHandle,\r
                  NULL,\r
                  EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                  );\r
  ASSERT (!EFI_ERROR (Status));\r
  if (Status != EFI_SUCCESS) {\r
    goto ErrExit;\r
  }\r
\r
  LoadedImageProtocolPtr->Unload = PlUnloadDebugSupportDriver;\r
\r
  //\r
  // Call hook for processor specific initialization\r
  //\r
  Status = PlInitializeDebugSupportDriver ();\r
  ASSERT (!EFI_ERROR (Status));\r
  if (Status != EFI_SUCCESS) {\r
    goto ErrExit;\r
  }\r
\r
  //\r
  // Install Debug Support protocol to new handle\r
  //\r
  Handle = NULL;\r
  Status = gBS->InstallProtocolInterface (\r
                  &Handle,\r
                  &gEfiDebugSupportProtocolGuid,\r
                  EFI_NATIVE_INTERFACE,\r
                  &mDebugSupportProtocolInterface\r
                  );\r
  ASSERT (!EFI_ERROR (Status));\r
  if (Status != EFI_SUCCESS) {\r
    goto ErrExit;\r
  }\r
\r
ErrExit:\r
  return Status;\r
}\r