diff -r ffa851df0825 -r 2fb8b9db1c86 symbian-qemu-0.9.1-12/qemu-symbian-svp/hw/virtio-pci.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/symbian-qemu-0.9.1-12/qemu-symbian-svp/hw/virtio-pci.c Fri Jul 31 15:01:17 2009 +0100 @@ -0,0 +1,340 @@ +/* + * Virtio PCI bindings + * + * Copyright IBM, Corp. 2007 + * + * Authors: + * Anthony Liguori + * + * This work is licensed under the terms of the GNU GPL, version 2. See + * the COPYING file in the top-level directory. + * + */ + +#include "virtio-pci.h" +#include "virtio-blk.h" +#include "virtio-net.h" +#include "virtio-balloon.h" + +/* from Linux's linux/virtio_pci.h */ + +/* A 32-bit r/o bitmask of the features supported by the host */ +#define VIRTIO_PCI_HOST_FEATURES 0 + +/* A 32-bit r/w bitmask of features activated by the guest */ +#define VIRTIO_PCI_GUEST_FEATURES 4 + +/* A 32-bit r/w PFN for the currently selected queue */ +#define VIRTIO_PCI_QUEUE_PFN 8 + +/* A 16-bit r/o queue size for the currently selected queue */ +#define VIRTIO_PCI_QUEUE_NUM 12 + +/* A 16-bit r/w queue selector */ +#define VIRTIO_PCI_QUEUE_SEL 14 + +/* A 16-bit r/w queue notifier */ +#define VIRTIO_PCI_QUEUE_NOTIFY 16 + +/* An 8-bit device status register. */ +#define VIRTIO_PCI_STATUS 18 + +/* An 8-bit r/o interrupt status register. Reading the value will return the + * current contents of the ISR and will also clear it. This is effectively + * a read-and-acknowledge. */ +#define VIRTIO_PCI_ISR 19 + +#define VIRTIO_PCI_CONFIG 20 + +/* Virtio ABI version, if we increment this, we break the guest driver. */ +#define VIRTIO_PCI_ABI_VERSION 0 + +/* How many bits to shift physical queue address written to QUEUE_PFN. + * 12 is historical, and due to x86 page size. */ +#define VIRTIO_PCI_QUEUE_ADDR_SHIFT 12 + +/* Proxy device to link the PCIDevice to the VirtIODevice. */ +typedef struct { + PCIDevice pci_dev; + VirtIODevice *vdev; +} VirtIOPCIProxy; + +/* Device independent interface code. */ + +static VirtIODevice *to_virtio_device(PCIDevice *pci_dev) +{ + VirtIOPCIProxy *proxy = (VirtIOPCIProxy *)pci_dev; + return proxy->vdev; +} + +static void virtio_update_irq_pci(VirtIODevice *vdev) +{ + PCIDevice *pci_dev = (PCIDevice *)vdev->binding_dev; + qemu_set_irq(pci_dev->irq[0], vdev->isr & 1); +} + +static void virtio_ioport_write(void *opaque, uint32_t addr, uint32_t val) +{ + VirtIODevice *vdev = to_virtio_device(opaque); + target_phys_addr_t pa; + + addr -= vdev->addr; + + switch (addr) { + case VIRTIO_PCI_GUEST_FEATURES: + if (vdev->set_features) + vdev->set_features(vdev, val); + vdev->features = val; + break; + case VIRTIO_PCI_QUEUE_PFN: + pa = (target_phys_addr_t)val << VIRTIO_PCI_QUEUE_ADDR_SHIFT; + virtio_set_vring_addr(vdev, vdev->queue_sel, pa); + case VIRTIO_PCI_QUEUE_SEL: + if (val < VIRTIO_PCI_QUEUE_MAX) + vdev->queue_sel = val; + break; + case VIRTIO_PCI_QUEUE_NOTIFY: + virtio_kick(vdev, val); + break; + case VIRTIO_PCI_STATUS: + vdev->status = val & 0xFF; + if (vdev->status == 0) + virtio_reset(vdev); + break; + } +} + +static uint32_t virtio_ioport_read(void *opaque, uint32_t addr) +{ + VirtIODevice *vdev = to_virtio_device(opaque); + uint32_t ret = 0xFFFFFFFF; + + addr -= vdev->addr; + + switch (addr) { + case VIRTIO_PCI_HOST_FEATURES: + ret = vdev->get_features(vdev); + ret |= (1 << VIRTIO_F_NOTIFY_ON_EMPTY); + break; + case VIRTIO_PCI_GUEST_FEATURES: + ret = vdev->features; + break; + case VIRTIO_PCI_QUEUE_PFN: + ret = virtio_get_vring_pa(vdev, vdev->queue_sel) + >> VIRTIO_PCI_QUEUE_ADDR_SHIFT; + break; + case VIRTIO_PCI_QUEUE_NUM: + ret = virtio_get_vring_num(vdev, vdev->queue_sel); + break; + case VIRTIO_PCI_QUEUE_SEL: + ret = vdev->queue_sel; + break; + case VIRTIO_PCI_STATUS: + ret = vdev->status; + break; + case VIRTIO_PCI_ISR: + /* reading from the ISR also clears it. */ + ret = vdev->isr; + vdev->isr = 0; + virtio_update_irq(vdev); + break; + default: + break; + } + + return ret; +} + +static uint32_t virtio_pci_config_readb(void *opaque, uint32_t addr) +{ + VirtIODevice *vdev = opaque; + + addr -= vdev->addr + VIRTIO_PCI_CONFIG; + return virtio_config_readb(vdev, addr); +} + +static uint32_t virtio_pci_config_readw(void *opaque, uint32_t addr) +{ + VirtIODevice *vdev = opaque; + + addr -= vdev->addr + VIRTIO_PCI_CONFIG; + return virtio_config_readw(vdev, addr); +} + +static uint32_t virtio_pci_config_readl(void *opaque, uint32_t addr) +{ + VirtIODevice *vdev = opaque; + + addr -= vdev->addr + VIRTIO_PCI_CONFIG; + return virtio_config_readl(vdev, addr); +} + +static void virtio_pci_config_writeb(void *opaque, uint32_t addr, uint32_t data) +{ + VirtIODevice *vdev = opaque; + + addr -= vdev->addr + VIRTIO_PCI_CONFIG; + virtio_config_writeb(vdev, addr, data); +} + +static void virtio_pci_config_writew(void *opaque, uint32_t addr, uint32_t data) +{ + VirtIODevice *vdev = opaque; + + addr -= vdev->addr + VIRTIO_PCI_CONFIG; + virtio_config_writew(vdev, addr, data); +} + +static void virtio_pci_config_writel(void *opaque, uint32_t addr, uint32_t data) +{ + VirtIODevice *vdev = opaque; + + addr -= vdev->addr + VIRTIO_PCI_CONFIG; + virtio_config_writel(vdev, addr, data); +} + +static void virtio_map(PCIDevice *pci_dev, int region_num, + uint32_t addr, uint32_t size, int type) +{ + VirtIODevice *vdev = to_virtio_device(pci_dev); + int i; + + vdev->addr = addr; + for (i = 0; i < 3; i++) { + register_ioport_write(addr, 20, 1 << i, virtio_ioport_write, vdev); + register_ioport_read(addr, 20, 1 << i, virtio_ioport_read, vdev); + } + + if (vdev->config_len) { + register_ioport_write(addr + 20, vdev->config_len, 1, + virtio_pci_config_writeb, vdev); + register_ioport_write(addr + 20, vdev->config_len, 2, + virtio_pci_config_writew, vdev); + register_ioport_write(addr + 20, vdev->config_len, 4, + virtio_pci_config_writel, vdev); + register_ioport_read(addr + 20, vdev->config_len, 1, + virtio_pci_config_readb, vdev); + register_ioport_read(addr + 20, vdev->config_len, 2, + virtio_pci_config_readw, vdev); + register_ioport_read(addr + 20, vdev->config_len, 4, + virtio_pci_config_readl, vdev); + + vdev->get_config(vdev, vdev->config); + } +} + +static void virtio_save_pci(VirtIODevice *vdev, QEMUFile *f) +{ + pci_device_save((PCIDevice *)vdev->binding_dev, f); +} + +static void virtio_load_pci(VirtIODevice *vdev, QEMUFile *f) +{ + pci_device_load((PCIDevice *)vdev->binding_dev, f); +} + +/* FIXME: PCI bindings should go elsewhere. */ +typedef struct { + PCIBus *bus; + int devfn; + uint16_t vendor; + uint16_t device; + uint16_t class_code; + uint16_t subclass_code; + uint8_t pif; +} VirtIOPCIArgs; + +static VirtIODevice *virtio_init_pci(void *args, const char *name, + uint16_t vendor, uint16_t device, + size_t config_size, size_t struct_size) +{ + VirtIODevice *vdev; + PCIDevice *pci_dev; + VirtIOPCIArgs *p = args; + uint8_t *config; + uint32_t size; + + pci_dev = pci_register_device(p->bus, name, sizeof(VirtIOPCIProxy), + p->devfn, NULL, NULL); + if (!pci_dev) + return NULL; + + vdev = virtio_init_common(name, config_size, struct_size); + ((VirtIOPCIProxy *)pci_dev)->vdev = vdev; + + vdev->binding_dev = pci_dev; + vdev->update_irq = virtio_update_irq_pci; + vdev->save_binding = virtio_save_pci; + vdev->load_binding = virtio_load_pci; + + config = pci_dev->config; + config[0x00] = p->vendor & 0xFF; + config[0x01] = (p->vendor >> 8) & 0xFF; + config[0x02] = p->device & 0xFF; + config[0x03] = (p->device >> 8) & 0xFF; + + config[0x08] = VIRTIO_PCI_ABI_VERSION; + + config[0x09] = p->pif; + config[0x0a] = p->subclass_code; + config[0x0b] = p->class_code; + config[0x0e] = 0x00; + + config[0x2c] = vendor & 0xFF; + config[0x2d] = (vendor >> 8) & 0xFF; + config[0x2e] = device & 0xFF; + config[0x2f] = (device >> 8) & 0xFF; + + config[0x3d] = 1; + + size = 20 + config_size; + if (size & (size-1)) + size = 1 << qemu_fls(size); + + pci_register_io_region(pci_dev, 0, size, PCI_ADDRESS_SPACE_IO, + virtio_map); + + return vdev; +} + + +/* Device specific init routines. */ + +void virtio_blk_init_pci(PCIBus *bus, BlockDriverState *bs) +{ + VirtIOPCIArgs args; + args.bus = bus; + args.devfn = -1; + args.vendor = PCI_VENDOR_ID_REDHAT_QUMRANET; + args.device = PCI_DEVICE_ID_VIRTIO_BLOCK; + args.class_code = 0x01; + args.subclass_code = 0x80; + args.pif = 0x00; + virtio_blk_init(virtio_init_pci, &args, bs); +} + +void virtio_net_init_pci(PCIBus *bus, NICInfo *nd, int devfn) +{ + VirtIOPCIArgs args; + args.bus = bus; + args.devfn = devfn; + args.vendor = PCI_VENDOR_ID_REDHAT_QUMRANET; + args.device = PCI_DEVICE_ID_VIRTIO_NET; + args.class_code = 0x02; + args.subclass_code = 0x00; + args.pif = 0x00; + virtio_net_init(virtio_init_pci, &args, nd); +} + +void virtio_balloon_init_pci(PCIBus *bus) +{ + VirtIOPCIArgs args; + args.bus = bus; + args.devfn = -1; + args.vendor = PCI_VENDOR_ID_REDHAT_QUMRANET; + args.device = PCI_DEVICE_ID_VIRTIO_BALLOON; + args.class_code = 0x05; + args.subclass_code = 0x00; + args.pif = 0x00; + virtio_balloon_init(virtio_init_pci, &args); +}