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

[mirror_edk2.git] / OvmfPkg / VirtioPciDeviceDxe / VirtioPciFunctions.c

/** @file\r
\r
  This driver produces Virtio Device Protocol instances for Virtio PCI devices.\r
\r
  Copyright (C) 2012, Red Hat, Inc.\r
  Copyright (c) 2012, Intel Corporation. All rights reserved.<BR>\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
#include <Library/BaseMemoryLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/MemoryAllocationLib.h>\r
#include <Library/UefiBootServicesTableLib.h>\r
#include <Library/UefiLib.h>\r
#include "VirtioPciDevice.h"\r
\r
/**\r
\r
  Read a word from Region 0 of the device specified by VirtIo Device protocol.\r
\r
  The function implements the ReadDevice protocol member of\r
  VIRTIO_DEVICE_PROTOCOL.\r
\r
  @param[in] This         VirtIo Device protocol.\r
\r
  @param[in] FieldOffset  Source offset.\r
\r
  @param[in] FieldSize    Source field size, must be in { 1, 2, 4, 8 }.\r
\r
  @param[in] BufferSize   Number of bytes available in the target buffer. Must\r
                          equal FieldSize.\r
\r
  @param[out] Buffer      Target buffer.\r
\r
\r
  @return  Status code returned by PciIo->Io.Read().\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
VirtioPciDeviceRead (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN  UINTN                   FieldOffset,\r
  IN  UINTN                   FieldSize,\r
  IN  UINTN                   BufferSize,\r
  OUT VOID                    *Buffer\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  return VirtioPciIoRead (\r
           Dev,\r
           Dev->DeviceSpecificConfigurationOffset + FieldOffset,\r
           FieldSize,\r
           BufferSize,\r
           Buffer\r
           );\r
}\r
\r
/**\r
\r
  Write a word into Region 0 of the device specified by VirtIo Device protocol.\r
\r
  @param[in] This         VirtIo Device protocol.\r
\r
  @param[in] FieldOffset  Destination offset.\r
\r
  @param[in] FieldSize    Destination field size, must be in { 1, 2, 4, 8 }.\r
\r
  @param[in] Value        Little endian value to write, converted to UINT64.\r
                          The least significant FieldSize bytes will be used.\r
\r
\r
  @return  Status code returned by PciIo->Io.Write().\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
VirtioPciDeviceWrite (\r
  IN VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN UINTN                   FieldOffset,\r
  IN UINTN                   FieldSize,\r
  IN UINT64                  Value\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  return VirtioPciIoWrite (\r
           Dev,\r
           Dev->DeviceSpecificConfigurationOffset + FieldOffset,\r
           FieldSize,\r
           Value\r
           );\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciGetDeviceFeatures (\r
  IN VIRTIO_DEVICE_PROTOCOL  *This,\r
  OUT UINT64                 *DeviceFeatures\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
  EFI_STATUS         Status;\r
  UINT32             Features32;\r
\r
  if (DeviceFeatures == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  Status = VirtioPciIoRead (\r
             Dev,\r
             VIRTIO_PCI_OFFSET_DEVICE_FEATURES,\r
             sizeof (UINT32),\r
             sizeof (UINT32),\r
             &Features32\r
             );\r
  if (!EFI_ERROR (Status)) {\r
    *DeviceFeatures = Features32;\r
  }\r
\r
  return Status;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciGetQueueSize (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  OUT UINT16                  *QueueNumMax\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
\r
  if (QueueNumMax == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  return VirtioPciIoRead (\r
           Dev,\r
           VIRTIO_PCI_OFFSET_QUEUE_SIZE,\r
           sizeof (UINT16),\r
           sizeof (UINT16),\r
           QueueNumMax\r
           );\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciGetDeviceStatus (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  OUT UINT8                   *DeviceStatus\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
\r
  if (DeviceStatus == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  return VirtioPciIoRead (\r
           Dev,\r
           VIRTIO_PCI_OFFSET_QUEUE_DEVICE_STATUS,\r
           sizeof (UINT8),\r
           sizeof (UINT8),\r
           DeviceStatus\r
           );\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciSetGuestFeatures (\r
  IN VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN UINT64                  Features\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  if (Features > MAX_UINT32) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  return VirtioPciIoWrite (\r
           Dev,\r
           VIRTIO_PCI_OFFSET_GUEST_FEATURES,\r
           sizeof (UINT32),\r
           Features\r
           );\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciSetQueueAddress (\r
  IN VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN VRING                   *Ring,\r
  IN UINT64                  RingBaseShift\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
\r
  ASSERT (RingBaseShift == 0);\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  return VirtioPciIoWrite (\r
           Dev,\r
           VIRTIO_PCI_OFFSET_QUEUE_ADDRESS,\r
           sizeof (UINT32),\r
           (UINT32)((UINTN)Ring->Base >> EFI_PAGE_SHIFT)\r
           );\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciSetQueueSel (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN  UINT16                  Sel\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  return VirtioPciIoWrite (\r
           Dev,\r
           VIRTIO_PCI_OFFSET_QUEUE_SELECT,\r
           sizeof (UINT16),\r
           Sel\r
           );\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciSetQueueAlignment (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN  UINT32                  Alignment\r
  )\r
{\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciSetPageSize (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN  UINT32                  PageSize\r
  )\r
{\r
  return (PageSize == EFI_PAGE_SIZE) ? EFI_SUCCESS : EFI_UNSUPPORTED;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciSetQueueNotify (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN  UINT16                  Index\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  return VirtioPciIoWrite (\r
           Dev,\r
           VIRTIO_PCI_OFFSET_QUEUE_NOTIFY,\r
           sizeof (UINT16),\r
           Index\r
           );\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciSetQueueSize (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN  UINT16                  Size\r
  )\r
{\r
  //\r
  // This function is only applicable in Virtio-MMIO.\r
  // (The QueueSize field is read-only in Virtio proper (PCI))\r
  //\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciSetDeviceStatus (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN  UINT8                   DeviceStatus\r
  )\r
{\r
  VIRTIO_PCI_DEVICE  *Dev;\r
\r
  Dev = VIRTIO_PCI_DEVICE_FROM_VIRTIO_DEVICE (This);\r
\r
  return VirtioPciIoWrite (\r
           Dev,\r
           VIRTIO_PCI_OFFSET_QUEUE_DEVICE_STATUS,\r
           sizeof (UINT8),\r
           DeviceStatus\r
           );\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciAllocateSharedPages (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN  UINTN                   NumPages,\r
  OUT VOID                    **HostAddress\r
  )\r
{\r
  VOID  *Buffer;\r
\r
  Buffer = AllocatePages (NumPages);\r
  if (Buffer == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  *HostAddress = Buffer;\r
  return EFI_SUCCESS;\r
}\r
\r
VOID\r
EFIAPI\r
VirtioPciFreeSharedPages (\r
  IN  VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN  UINTN                   NumPages,\r
  IN  VOID                    *HostAddress\r
  )\r
{\r
  FreePages (HostAddress, NumPages);\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciMapSharedBuffer (\r
  IN      VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN      VIRTIO_MAP_OPERATION    Operation,\r
  IN      VOID                    *HostAddress,\r
  IN OUT  UINTN                   *NumberOfBytes,\r
  OUT     EFI_PHYSICAL_ADDRESS    *DeviceAddress,\r
  OUT     VOID                    **Mapping\r
  )\r
{\r
  *DeviceAddress = (EFI_PHYSICAL_ADDRESS)(UINTN)HostAddress;\r
  *Mapping       = NULL;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
VirtioPciUnmapSharedBuffer (\r
  IN VIRTIO_DEVICE_PROTOCOL  *This,\r
  IN VOID                    *Mapping\r
  )\r
{\r
  return EFI_SUCCESS;\r
}\r