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

[mirror_edk2.git] / OvmfPkg / Library / VirtioMmioDeviceLib / VirtioMmioDevice.c

/** @file\r
\r
  This driver produces Virtio Device Protocol instances for Virtio Mmio devices.\r
\r
  Copyright (C) 2013, ARM Ltd.\r
  Copyright (C) 2017, AMD Inc. All rights reserved.<BR>\r
\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/UefiBootServicesTableLib.h>\r
\r
#include "VirtioMmioDevice.h"\r
\r
STATIC CONST VIRTIO_DEVICE_PROTOCOL  mMmioDeviceProtocolTemplate = {\r
  0,                                       // Revision\r
  0,                                       // SubSystemDeviceId\r
  VirtioMmioGetDeviceFeatures,             // GetDeviceFeatures\r
  VirtioMmioSetGuestFeatures,              // SetGuestFeatures\r
  VirtioMmioSetQueueAddress,               // SetQueueAddress\r
  VirtioMmioSetQueueSel,                   // SetQueueSel\r
  VirtioMmioSetQueueNotify,                // SetQueueNotify\r
  VirtioMmioSetQueueAlignment,             // SetQueueAlign\r
  VirtioMmioSetPageSize,                   // SetPageSize\r
  VirtioMmioGetQueueSize,                  // GetQueueNumMax\r
  VirtioMmioSetQueueSize,                  // SetQueueNum\r
  VirtioMmioGetDeviceStatus,               // GetDeviceStatus\r
  VirtioMmioSetDeviceStatus,               // SetDeviceStatus\r
  VirtioMmioDeviceWrite,                   // WriteDevice\r
  VirtioMmioDeviceRead,                    // ReadDevice\r
  VirtioMmioAllocateSharedPages,           // AllocateSharedPages\r
  VirtioMmioFreeSharedPages,               // FreeSharedPages\r
  VirtioMmioMapSharedBuffer,               // MapSharedBuffer\r
  VirtioMmioUnmapSharedBuffer              // UnmapSharedBuffer\r
};\r
\r
/**\r
\r
  Initialize the VirtIo MMIO Device\r
\r
  @param[in] BaseAddress   Base Address of the VirtIo MMIO Device\r
\r
  @param[in, out] Device   The driver instance to configure.\r
\r
  @retval EFI_SUCCESS      Setup complete.\r
\r
  @retval EFI_UNSUPPORTED  The driver is not a VirtIo MMIO device.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
VirtioMmioInit (\r
  IN PHYSICAL_ADDRESS        BaseAddress,\r
  IN OUT VIRTIO_MMIO_DEVICE  *Device\r
  )\r
{\r
  UINT32  MagicValue;\r
\r
  //\r
  // Initialize VirtIo Mmio Device\r
  //\r
  CopyMem (\r
    &Device->VirtioDevice,\r
    &mMmioDeviceProtocolTemplate,\r
    sizeof (VIRTIO_DEVICE_PROTOCOL)\r
    );\r
  Device->BaseAddress                    = BaseAddress;\r
  Device->VirtioDevice.SubSystemDeviceId =\r
    MmioRead32 (BaseAddress + VIRTIO_MMIO_OFFSET_DEVICE_ID);\r
\r
  //\r
  // Double-check MMIO-specific values\r
  //\r
  MagicValue = VIRTIO_CFG_READ (Device, VIRTIO_MMIO_OFFSET_MAGIC);\r
  if (MagicValue != VIRTIO_MMIO_MAGIC) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  Device->Version = VIRTIO_CFG_READ (Device, VIRTIO_MMIO_OFFSET_VERSION);\r
  switch (Device->Version) {\r
    case VIRTIO_MMIO_DEVICE_VERSION_0_95:\r
      DEBUG ((\r
        DEBUG_INFO,\r
        "%a virtio 0.9.5, id %d\n",\r
        __FUNCTION__,\r
        Device->VirtioDevice.SubSystemDeviceId\r
        ));\r
      Device->VirtioDevice.Revision = VIRTIO_SPEC_REVISION (0, 9, 5);\r
      break;\r
    case VIRTIO_MMIO_DEVICE_VERSION_1_00:\r
      DEBUG ((\r
        DEBUG_INFO,\r
        "%a virtio 1.0, id %d\n",\r
        __FUNCTION__,\r
        Device->VirtioDevice.SubSystemDeviceId\r
        ));\r
      Device->VirtioDevice.Revision = VIRTIO_SPEC_REVISION (1, 0, 0);\r
      break;\r
    default:\r
      return EFI_UNSUPPORTED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
\r
  Uninitialize the internals of a virtio-mmio device that has been successfully\r
  set up with VirtioMmioInit().\r
\r
  @param[in, out]  Device  The device to clean up.\r
\r
**/\r
STATIC\r
VOID\r
EFIAPI\r
VirtioMmioUninit (\r
  IN VIRTIO_MMIO_DEVICE  *Device\r
  )\r
{\r
  //\r
  // Note: This function mirrors VirtioMmioInit() that does not allocate any\r
  //       resources - there's nothing to free here.\r
  //\r
}\r
\r
EFI_STATUS\r
VirtioMmioInstallDevice (\r
  IN PHYSICAL_ADDRESS  BaseAddress,\r
  IN EFI_HANDLE        Handle\r
  )\r
{\r
  EFI_STATUS          Status;\r
  VIRTIO_MMIO_DEVICE  *VirtIo;\r
\r
  if (!BaseAddress) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (Handle == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // Allocate VIRTIO_MMIO_DEVICE\r
  //\r
  VirtIo = AllocateZeroPool (sizeof (VIRTIO_MMIO_DEVICE));\r
  if (VirtIo == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  VirtIo->Signature = VIRTIO_MMIO_DEVICE_SIGNATURE;\r
\r
  Status = VirtioMmioInit (BaseAddress, VirtIo);\r
  if (EFI_ERROR (Status)) {\r
    goto FreeVirtioMem;\r
  }\r
\r
  //\r
  // Install VIRTIO_DEVICE_PROTOCOL to Handle\r
  //\r
  Status = gBS->InstallProtocolInterface (\r
                  &Handle,\r
                  &gVirtioDeviceProtocolGuid,\r
                  EFI_NATIVE_INTERFACE,\r
                  &VirtIo->VirtioDevice\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto UninitVirtio;\r
  }\r
\r
  return EFI_SUCCESS;\r
\r
UninitVirtio:\r
  VirtioMmioUninit (VirtIo);\r
\r
FreeVirtioMem:\r
  FreePool (VirtIo);\r
  return Status;\r
}\r
\r
EFI_STATUS\r
VirtioMmioUninstallDevice (\r
  IN EFI_HANDLE  DeviceHandle\r
  )\r
{\r
  VIRTIO_DEVICE_PROTOCOL  *VirtioDevice;\r
  VIRTIO_MMIO_DEVICE      *MmioDevice;\r
  EFI_STATUS              Status;\r
\r
  Status = gBS->OpenProtocol (\r
                  DeviceHandle,                  // candidate device\r
                  &gVirtioDeviceProtocolGuid,    // retrieve the VirtIo iface\r
                  (VOID **)&VirtioDevice,        // target pointer\r
                  DeviceHandle,                  // requestor driver identity\r
                  DeviceHandle,                  // requesting lookup for dev.\r
                  EFI_OPEN_PROTOCOL_GET_PROTOCOL // lookup only, no ref. added\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // Get the MMIO device from the VirtIo Device instance\r
  //\r
  MmioDevice = VIRTIO_MMIO_DEVICE_FROM_VIRTIO_DEVICE (VirtioDevice);\r
\r
  //\r
  // Uninstall the protocol interface\r
  //\r
  Status = gBS->UninstallProtocolInterface (\r
                  DeviceHandle,\r
                  &gVirtioDeviceProtocolGuid,\r
                  &MmioDevice->VirtioDevice\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // Uninitialize the VirtIo Device\r
  //\r
  VirtioMmioUninit (MmioDevice);\r
  FreePool (MmioDevice);\r
\r
  return EFI_SUCCESS;\r
}\r