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

[mirror_edk2.git] / ArmVirtPkg / Library / ArmVirtPL031FdtClientLib / ArmVirtPL031FdtClientLib.c

/** @file\r
  FDT client library for ARM's PL031 RTC driver\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 <Uefi.h>\r
\r
#include <Library/BaseLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/PcdLib.h>\r
#include <Library/UefiBootServicesTableLib.h>\r
\r
#include <Protocol/FdtClient.h>\r
\r
RETURN_STATUS\r
EFIAPI\r
ArmVirtPL031FdtClientLibConstructor (\r
  VOID\r
  )\r
{\r
  EFI_STATUS           Status;\r
  FDT_CLIENT_PROTOCOL  *FdtClient;\r
  INT32                Node;\r
  CONST UINT64         *Reg;\r
  UINT32               RegSize;\r
  UINT64               RegBase;\r
  RETURN_STATUS        PcdStatus;\r
\r
  Status = gBS->LocateProtocol (\r
                  &gFdtClientProtocolGuid,\r
                  NULL,\r
                  (VOID **)&FdtClient\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  Status = FdtClient->FindCompatibleNode (FdtClient, "arm,pl031", &Node);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((\r
      DEBUG_WARN,\r
      "%a: No 'arm,pl031' compatible DT node found\n",\r
      __FUNCTION__\r
      ));\r
    return EFI_SUCCESS;\r
  }\r
\r
  Status = FdtClient->GetNodeProperty (\r
                        FdtClient,\r
                        Node,\r
                        "reg",\r
                        (CONST VOID **)&Reg,\r
                        &RegSize\r
                        );\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((\r
      DEBUG_WARN,\r
      "%a: No 'reg' property found in 'arm,pl031' compatible DT node\n",\r
      __FUNCTION__\r
      ));\r
    return EFI_SUCCESS;\r
  }\r
\r
  ASSERT (RegSize == 16);\r
\r
  RegBase = SwapBytes64 (Reg[0]);\r
  ASSERT (RegBase < MAX_UINT32);\r
\r
  PcdStatus = PcdSet32S (PcdPL031RtcBase, (UINT32)RegBase);\r
  ASSERT_RETURN_ERROR (PcdStatus);\r
\r
  DEBUG ((DEBUG_INFO, "Found PL031 RTC @ 0x%Lx\n", RegBase));\r
\r
  //\r
  // UEFI takes ownership of the RTC hardware, and exposes its functionality\r
  // through the UEFI Runtime Services GetTime, SetTime, etc. This means we\r
  // need to disable it in the device tree to prevent the OS from attaching\r
  // its device driver as well.\r
  //\r
  Status = FdtClient->SetNodeProperty (\r
                        FdtClient,\r
                        Node,\r
                        "status",\r
                        "disabled",\r
                        sizeof ("disabled")\r
                        );\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((DEBUG_WARN, "Failed to set PL031 status to 'disabled'\n"));\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r