VirtIOPCILegacy.c File Reference

#include "osdep.h"
#include "virtio_pci.h"
#include "VirtIO.h"
#include "kdebugprint.h"
#include "virtio_ring.h"
#include "virtio_pci_common.h"
#include "windows/virtio_ring_allocation.h"

Include dependency graph for VirtIOPCILegacy.c:

Go to the source code of this file.

Functions
void	vio_legacy_dump_registers (VirtIODevice *vdev)
static void	vio_legacy_get_config (VirtIODevice *vdev, unsigned offset, void *buf, unsigned len)
static void	vio_legacy_set_config (VirtIODevice *vdev, unsigned offset, const void *buf, unsigned len)
static u8	vio_legacy_get_status (VirtIODevice *vdev)
static void	vio_legacy_set_status (VirtIODevice *vdev, u8 status)
static void	vio_legacy_reset (VirtIODevice *vdev)
static u64	vio_legacy_get_features (VirtIODevice *vdev)
static NTSTATUS	vio_legacy_set_features (VirtIODevice *vdev, u64 features)
static u16	vio_legacy_set_config_vector (VirtIODevice *vdev, u16 vector)
static u16	vio_legacy_set_queue_vector (struct virtqueue *vq, u16 vector)
static NTSTATUS	vio_legacy_query_vq_alloc (VirtIODevice *vdev, unsigned index, unsigned short *pNumEntries, unsigned long *pRingSize, unsigned long *pHeapSize)
static NTSTATUS	vio_legacy_setup_vq (struct virtqueue **queue, VirtIODevice *vdev, VirtIOQueueInfo *info, unsigned index, u16 msix_vec)
static void	vio_legacy_del_vq (VirtIOQueueInfo *info)
NTSTATUS	vio_legacy_initialize (VirtIODevice *vdev)

Variables
static const struct virtio_device_ops	virtio_pci_device_ops

Function Documentation

vio_legacy_del_vq()

static void vio_legacy_del_vq ( VirtIOQueueInfo *  info )

static

Definition at line 232 of file VirtIOPCILegacy.c.

{
    struct virtqueue *vq = info->vq;
    VirtIODevice *vdev = vq->vdev;

    iowrite16(vdev, (u16)vq->index, vdev->addr + VIRTIO_PCI_QUEUE_SEL);

    if (vdev->msix_used) {
        iowrite16(vdev, VIRTIO_MSI_NO_VECTOR,
            vdev->addr + VIRTIO_MSI_QUEUE_VECTOR);
        /* Flush the write out to device */
        ioread8(vdev, vdev->addr + VIRTIO_PCI_ISR);
    }

    /* Select and deactivate the queue */
    iowrite32(vdev, 0, vdev->addr + VIRTIO_PCI_QUEUE_PFN);

    mem_free_contiguous_pages(vdev, info->queue);
}

vio_legacy_dump_registers()

void vio_legacy_dump_registers

(

VirtIODevice *

vdev

)

Definition at line 50 of file VirtIOPCILegacy.c.

{
    DPrintf(5, "%s\n", __FUNCTION__);

    DPrintf(0, "[VIRTIO_PCI_HOST_FEATURES] = %x\n", ioread32(vdev, vdev->addr + VIRTIO_PCI_HOST_FEATURES));
    DPrintf(0, "[VIRTIO_PCI_GUEST_FEATURES] = %x\n", ioread32(vdev, vdev->addr + VIRTIO_PCI_GUEST_FEATURES));
    DPrintf(0, "[VIRTIO_PCI_QUEUE_PFN] = %x\n", ioread32(vdev, vdev->addr + VIRTIO_PCI_QUEUE_PFN));
    DPrintf(0, "[VIRTIO_PCI_QUEUE_NUM] = %x\n", ioread32(vdev, vdev->addr + VIRTIO_PCI_QUEUE_NUM));
    DPrintf(0, "[VIRTIO_PCI_QUEUE_SEL] = %x\n", ioread32(vdev, vdev->addr + VIRTIO_PCI_QUEUE_SEL));
    DPrintf(0, "[VIRTIO_PCI_QUEUE_NOTIFY] = %x\n", ioread32(vdev, vdev->addr + VIRTIO_PCI_QUEUE_NOTIFY));
    DPrintf(0, "[VIRTIO_PCI_STATUS] = %x\n", ioread32(vdev, vdev->addr + VIRTIO_PCI_STATUS));
    DPrintf(0, "[VIRTIO_PCI_ISR] = %x\n", ioread32(vdev, vdev->addr + VIRTIO_PCI_ISR));
}

vio_legacy_get_config()

static void vio_legacy_get_config ( VirtIODevice *  vdev, unsigned  offset, void *  buf, unsigned  len  )

static

Definition at line 64 of file VirtIOPCILegacy.c.

{
    ULONG_PTR ioaddr = vdev->addr + VIRTIO_PCI_CONFIG(vdev->msix_used) + offset;
    u8 *ptr = buf;
    unsigned i;

    DPrintf(5, "%s\n", __FUNCTION__);

    for (i = 0; i < len; i++) {
        ptr[i] = ioread8(vdev, ioaddr + i);
    }
}

vio_legacy_get_features()

static u64 vio_legacy_get_features ( VirtIODevice *  vdev )

static

Definition at line 114 of file VirtIOPCILegacy.c.

{
    return ioread32(vdev, vdev->addr + VIRTIO_PCI_HOST_FEATURES);
}

vio_legacy_get_status()

static u8 vio_legacy_get_status ( VirtIODevice *  vdev )

static

Definition at line 96 of file VirtIOPCILegacy.c.

{
    DPrintf(6, "%s\n", __FUNCTION__);
    return ioread8(vdev, vdev->addr + VIRTIO_PCI_STATUS);
}

vio_legacy_initialize()

NTSTATUS vio_legacy_initialize

(

VirtIODevice *

vdev

)

Definition at line 269 of file VirtIOPCILegacy.c.

{
    size_t length = pci_get_resource_len(vdev, 0);
    vdev->addr = (ULONG_PTR)pci_map_address_range(vdev, 0, 0, length);

    if (!vdev->addr) {
        return STATUS_INSUFFICIENT_RESOURCES;
    }

    vdev->isr = (u8 *)vdev->addr + VIRTIO_PCI_ISR;

    vdev->device = &virtio_pci_device_ops;

    return STATUS_SUCCESS;
}

Referenced by virtio_device_initialize().

vio_legacy_query_vq_alloc()

static NTSTATUS vio_legacy_query_vq_alloc ( VirtIODevice *  vdev, unsigned  index, unsigned short *  pNumEntries, unsigned long *  pRingSize, unsigned long *  pHeapSize  )

static

Definition at line 149 of file VirtIOPCILegacy.c.

{
    unsigned long ring_size, data_size;
    u16 num;

    /* Select the queue we're interested in */
    iowrite16(vdev, (u16)index, vdev->addr + VIRTIO_PCI_QUEUE_SEL);

    /* Check if queue is either not available or already active. */
    num = ioread16(vdev, vdev->addr + VIRTIO_PCI_QUEUE_NUM);
    if (!num || ioread32(vdev, vdev->addr + VIRTIO_PCI_QUEUE_PFN)) {
        return STATUS_NOT_FOUND;
    }

    ring_size = ROUND_TO_PAGES(vring_size(num, VIRTIO_PCI_VRING_ALIGN, false));
    data_size = ROUND_TO_PAGES(vring_control_block_size(num, false));

    *pNumEntries = num;
    *pRingSize = ring_size + data_size;
    *pHeapSize = 0;

    return STATUS_SUCCESS;
}

Referenced by vio_legacy_setup_vq().

vio_legacy_reset()

static void vio_legacy_reset ( VirtIODevice *  vdev )

static

Definition at line 108 of file VirtIOPCILegacy.c.

{
    /* 0 status means a reset. */
    iowrite8(vdev, 0, vdev->addr + VIRTIO_PCI_STATUS);
}

vio_legacy_set_config()

static void vio_legacy_set_config ( VirtIODevice *  vdev, unsigned  offset, const void *  buf, unsigned  len  )

static

Definition at line 80 of file VirtIOPCILegacy.c.

{
    ULONG_PTR ioaddr = vdev->addr + VIRTIO_PCI_CONFIG(vdev->msix_used) + offset;
    const u8 *ptr = buf;
    unsigned i;

    DPrintf(5, "%s\n", __FUNCTION__);

    for (i = 0; i < len; i++) {
        iowrite8(vdev, ptr[i], ioaddr + i);
    }
}

vio_legacy_set_config_vector()

static u16 vio_legacy_set_config_vector ( VirtIODevice *  vdev, u16  vector  )

static

Definition at line 131 of file VirtIOPCILegacy.c.

{
    /* Setup the vector used for configuration events */
    iowrite16(vdev, vector, vdev->addr + VIRTIO_MSI_CONFIG_VECTOR);
    /* Verify we had enough resources to assign the vector */
    /* Will also flush the write out to device */
    return ioread16(vdev, vdev->addr + VIRTIO_MSI_CONFIG_VECTOR);
}

vio_legacy_set_features()

static NTSTATUS vio_legacy_set_features ( VirtIODevice *  vdev, u64  features  )

static

Definition at line 119 of file VirtIOPCILegacy.c.

{
    /* Give virtio_ring a chance to accept features. */
    vring_transport_features(vdev, &features);

    /* Make sure we don't have any features > 32 bits! */
    ASSERT((u32)features == features);
    iowrite32(vdev, (u32)features, vdev->addr + VIRTIO_PCI_GUEST_FEATURES);

    return STATUS_SUCCESS;
}

vio_legacy_set_queue_vector()

static u16 vio_legacy_set_queue_vector ( struct virtqueue *  vq, u16  vector  )

static

Definition at line 140 of file VirtIOPCILegacy.c.

{
    VirtIODevice *vdev = vq->vdev;

    iowrite16(vdev, (u16)vq->index, vdev->addr + VIRTIO_PCI_QUEUE_SEL);
    iowrite16(vdev, vector, vdev->addr + VIRTIO_MSI_QUEUE_VECTOR);
    return ioread16(vdev, vdev->addr + VIRTIO_MSI_QUEUE_VECTOR);
}

vio_legacy_set_status()

static void vio_legacy_set_status ( VirtIODevice *  vdev, u8  status  )

static

Definition at line 102 of file VirtIOPCILegacy.c.

{
    DPrintf(6, "%s>>> %x\n", __FUNCTION__, status);
    iowrite8(vdev, status, vdev->addr + VIRTIO_PCI_STATUS);
}

vio_legacy_setup_vq()

static NTSTATUS vio_legacy_setup_vq ( struct virtqueue **  queue, VirtIODevice *  vdev, VirtIOQueueInfo *  info, unsigned  index, u16  msix_vec  )

static

Definition at line 177 of file VirtIOPCILegacy.c.

{
    struct virtqueue *vq;
    unsigned long ring_size, heap_size;
    NTSTATUS status;

    /* Select the queue and query allocation parameters */
    status = vio_legacy_query_vq_alloc(vdev, index, &info->num, &ring_size, &heap_size);
    if (!NT_SUCCESS(status)) {
        return status;
    }

    info->queue = mem_alloc_contiguous_pages(vdev, ring_size);
    if (info->queue == NULL) {
        return STATUS_INSUFFICIENT_RESOURCES;
    }

    /* activate the queue */
    iowrite32(vdev, (u32)(mem_get_physical_address(vdev, info->queue) >> VIRTIO_PCI_QUEUE_ADDR_SHIFT),
        vdev->addr + VIRTIO_PCI_QUEUE_PFN);

    /* create the vring */
    vq = vring_new_virtqueue_split(index, info->num,
        VIRTIO_PCI_VRING_ALIGN, vdev,
        info->queue, vp_notify,
        (u8 *)info->queue + ROUND_TO_PAGES(vring_size(info->num, VIRTIO_PCI_VRING_ALIGN, false)));
    if (!vq) {
        status = STATUS_INSUFFICIENT_RESOURCES;
        goto err_activate_queue;
    }

    vq->notification_addr = (void *)(vdev->addr + VIRTIO_PCI_QUEUE_NOTIFY);

    if (msix_vec != VIRTIO_MSI_NO_VECTOR) {
        msix_vec = vdev->device->set_queue_vector(vq, msix_vec);
        if (msix_vec == VIRTIO_MSI_NO_VECTOR) {
            status = STATUS_DEVICE_BUSY;
            goto err_assign;
        }
    }

    *queue = vq;
    return STATUS_SUCCESS;

err_assign:
err_activate_queue:
    iowrite32(vdev, 0, vdev->addr + VIRTIO_PCI_QUEUE_PFN);
    mem_free_contiguous_pages(vdev, info->queue);
    return status;
}

Variable Documentation

virtio_pci_device_ops

const struct virtio_device_ops virtio_pci_device_ops

static

Initial value:

= {
     vio_legacy_get_config,
     vio_legacy_set_config,
     NULL,
     vio_legacy_get_status,
     vio_legacy_set_status,
     vio_legacy_reset,
     vio_legacy_get_features,
     vio_legacy_set_features,
     vio_legacy_set_config_vector,
     vio_legacy_set_queue_vector,
     vio_legacy_query_vq_alloc,
     vio_legacy_setup_vq,
     vio_legacy_del_vq,
}

Definition at line 252 of file VirtIOPCILegacy.c.

Referenced by vio_legacy_initialize().