ArmVirtQemuMonitorLib.c

Go to the documentation of this file.

 
#include <PiDxe.h>
 
#include <Library/BaseLib.h>
#include <Library/DebugLib.h>
#include <Library/ArmHvcLib.h>
#include <Library/ArmMonitorLib.h>
#include <Library/ArmSmcLib.h>
#include <Library/UefiBootServicesTableLib.h>
 
#include <Protocol/FdtClient.h>
 
STATIC UINT32  mArmSmcccMethod;
 
RETURN_STATUS
EFIAPI
ArmVirtQemuMonitorLibConstructor (
  VOID
  )
{
  EFI_STATUS           Status;
  FDT_CLIENT_PROTOCOL  *FdtClient;
  CONST VOID           *Prop;
 
  Status = gBS->LocateProtocol (
                  &gFdtClientProtocolGuid,
                  NULL,
                  (VOID **)&FdtClient
                  );
  ASSERT_EFI_ERROR (Status);
 
  Status = FdtClient->FindCompatibleNodeProperty (
                        FdtClient,
                        "arm,psci-0.2",
                        "method",
                        &Prop,
                        NULL
                        );
  if (EFI_ERROR (Status)) {
    return Status;
  }
 
  if (AsciiStrnCmp (Prop, "hvc", 3) == 0) {
    mArmSmcccMethod = 1;
  } else if (AsciiStrnCmp (Prop, "smc", 3) == 0) {
    mArmSmcccMethod = 2;
  } else {
    DEBUG ((
      DEBUG_ERROR,
      "%a: Unknown SMCCC method \"%a\"\n",
      __func__,
      Prop
      ));
    return EFI_NOT_FOUND;
  }
 
  return EFI_SUCCESS;
}
 
VOID
EFIAPI
ArmMonitorCall (
  IN OUT ARM_MONITOR_ARGS  *Args
  )
{
  if (mArmSmcccMethod == 1) {
    ArmCallHvc ((ARM_HVC_ARGS *)Args);
  } else if (mArmSmcccMethod == 2) {
    ArmCallSmc ((ARM_SMC_ARGS *)Args);
  } else {
    ASSERT ((mArmSmcccMethod == 1) || (mArmSmcccMethod == 2));
  }
}