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

[mirror_edk2.git] / ArmVirtPkg / XenioFdtDxe / XenioFdtDxe.c

/** @file\r
*  Xenio FDT client protocol driver for xen,xen DT node\r
*\r
*  Copyright (c) 2016, Linaro Ltd. All rights reserved.<BR>\r
*\r
*  SPDX-License-Identifier: BSD-2-Clause-Patent\r
*\r
**/\r
\r
#include <Library/BaseLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/UefiDriverEntryPoint.h>\r
#include <Library/UefiBootServicesTableLib.h>\r
#include <Library/XenIoMmioLib.h>\r
\r
#include <Protocol/FdtClient.h>\r
\r
EFI_STATUS\r
EFIAPI\r
InitializeXenioFdtDxe (\r
  IN EFI_HANDLE        ImageHandle,\r
  IN EFI_SYSTEM_TABLE  *SystemTable\r
  )\r
{\r
  EFI_STATUS           Status;\r
  FDT_CLIENT_PROTOCOL  *FdtClient;\r
  CONST UINT64         *Reg;\r
  UINT32               RegSize;\r
  UINTN                AddressCells, SizeCells;\r
  EFI_HANDLE           Handle;\r
  UINT64               RegBase;\r
\r
  Status = gBS->LocateProtocol (\r
                  &gFdtClientProtocolGuid,\r
                  NULL,\r
                  (VOID **)&FdtClient\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  Status = FdtClient->FindCompatibleNodeReg (\r
                        FdtClient,\r
                        "xen,xen",\r
                        (CONST VOID **)&Reg,\r
                        &AddressCells,\r
                        &SizeCells,\r
                        &RegSize\r
                        );\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((\r
      DEBUG_WARN,\r
      "%a: No 'xen,xen' compatible DT node found\n",\r
      __FUNCTION__\r
      ));\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  ASSERT (AddressCells == 2);\r
  ASSERT (SizeCells == 2);\r
  ASSERT (RegSize == 2 * sizeof (UINT64));\r
\r
  //\r
  // Retrieve the reg base from this node and wire it up to the\r
  // MMIO flavor of the XenBus root device I/O protocol\r
  //\r
  RegBase = SwapBytes64 (Reg[0]);\r
  Handle  = NULL;\r
  Status  = XenIoMmioInstall (&Handle, RegBase);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((\r
      DEBUG_ERROR,\r
      "%a: XenIoMmioInstall () failed on a new handle "\r
      "(Status == %r)\n",\r
      __FUNCTION__,\r
      Status\r
      ));\r
    return Status;\r
  }\r
\r
  DEBUG ((DEBUG_INFO, "Found Xen node with Grant table @ 0x%Lx\n", RegBase));\r
\r
  return EFI_SUCCESS;\r
}\r