hw/syborg_virtio.c

   1 /*
   2  * Virtio Syborg bindings
   3  *
   4  * Copyright (c) 2009 CodeSourcery
   5  *
   6  * Permission is hereby granted, free of charge, to any person obtaining a copy
   7  * of this software and associated documentation files (the "Software"), to deal
   8  * in the Software without restriction, including without limitation the rights
   9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10  * copies of the Software, and to permit persons to whom the Software is
  11  * furnished to do so, subject to the following conditions:
  12  *
  13  * The above copyright notice and this permission notice shall be included in
  14  * all copies or substantial portions of the Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22  * THE SOFTWARE.
  23  */
  24
  25 #include "syborg.h"
  26 #include "sysbus.h"
  27 #include "virtio.h"
  28 #include "virtio-net.h"
  29 #include "sysemu.h"
  30
  31 //#define DEBUG_SYBORG_VIRTIO
  32
  33 #ifdef DEBUG_SYBORG_VIRTIO
  34 #define DPRINTF(fmt, ...) \
  35 do { printf("syborg_virtio: " fmt , ## __VA_ARGS__); } while (0)
  36 #define BADF(fmt, ...) \
  37 do { fprintf(stderr, "syborg_virtio: error: " fmt , ## __VA_ARGS__); \
  38     exit(1);} while (0)
  39 #else
  40 #define DPRINTF(fmt, ...) do {} while(0)
  41 #define BADF(fmt, ...) \
  42 do { fprintf(stderr, "syborg_virtio: error: " fmt , ## __VA_ARGS__);} while (0)
  43 #endif
  44
  45 enum {
  46     SYBORG_VIRTIO_ID             = 0,
  47     SYBORG_VIRTIO_DEVTYPE        = 1,
  48     SYBORG_VIRTIO_HOST_FEATURES  = 2,
  49     SYBORG_VIRTIO_GUEST_FEATURES = 3,
  50     SYBORG_VIRTIO_QUEUE_BASE     = 4,
  51     SYBORG_VIRTIO_QUEUE_NUM      = 5,
  52     SYBORG_VIRTIO_QUEUE_SEL      = 6,
  53     SYBORG_VIRTIO_QUEUE_NOTIFY   = 7,
  54     SYBORG_VIRTIO_STATUS         = 8,
  55     SYBORG_VIRTIO_INT_ENABLE     = 9,
  56     SYBORG_VIRTIO_INT_STATUS     = 10
  57 };
  58
  59 #define SYBORG_VIRTIO_CONFIG 0x100
  60
  61 /* Device independent interface.  */
  62
  63 typedef struct {
  64     SysBusDevice busdev;
  65     VirtIODevice *vdev;
  66     qemu_irq irq;
  67     uint32_t int_enable;
  68     uint32_t id;
  69     NICConf nic;
  70     uint32_t host_features;
  71 } SyborgVirtIOProxy;
  72
  73 static uint32_t syborg_virtio_readl(void *opaque, target_phys_addr_t offset)
  74 {
  75     SyborgVirtIOProxy *s = opaque;
  76     VirtIODevice *vdev = s->vdev;
  77     uint32_t ret;
  78
  79     DPRINTF("readl 0x%x\n", (int)offset);
  80     if (offset >= SYBORG_VIRTIO_CONFIG) {
  81         return virtio_config_readl(vdev, offset - SYBORG_VIRTIO_CONFIG);
  82     }
  83     switch(offset >> 2) {
  84     case SYBORG_VIRTIO_ID:
  85         ret = SYBORG_ID_VIRTIO;
  86         break;
  87     case SYBORG_VIRTIO_DEVTYPE:
  88         ret = s->id;
  89         break;
  90     case SYBORG_VIRTIO_HOST_FEATURES:
  91         ret = s->host_features;
  92         break;
  93     case SYBORG_VIRTIO_GUEST_FEATURES:
  94         ret = vdev->guest_features;
  95         break;
  96     case SYBORG_VIRTIO_QUEUE_BASE:
  97         ret = virtio_queue_get_addr(vdev, vdev->queue_sel);
  98         break;
  99     case SYBORG_VIRTIO_QUEUE_NUM:
 100         ret = virtio_queue_get_num(vdev, vdev->queue_sel);
 101         break;
 102     case SYBORG_VIRTIO_QUEUE_SEL:
 103         ret = vdev->queue_sel;
 104         break;
 105     case SYBORG_VIRTIO_STATUS:
 106         ret = vdev->status;
 107         break;
 108     case SYBORG_VIRTIO_INT_ENABLE:
 109         ret = s->int_enable;
 110         break;
 111     case SYBORG_VIRTIO_INT_STATUS:
 112         ret = vdev->isr;
 113         break;
 114     default:
 115         BADF("Bad read offset 0x%x\n", (int)offset);
 116         return 0;
 117     }
 118     return ret;
 119 }
 120
 121 static void syborg_virtio_writel(void *opaque, target_phys_addr_t offset,
 122                                  uint32_t value)
 123 {
 124     SyborgVirtIOProxy *s = opaque;
 125     VirtIODevice *vdev = s->vdev;
 126
 127     DPRINTF("writel 0x%x = 0x%x\n", (int)offset, value);
 128     if (offset >= SYBORG_VIRTIO_CONFIG) {
 129         return virtio_config_writel(vdev, offset - SYBORG_VIRTIO_CONFIG,
 130                                     value);
 131     }
 132     switch (offset >> 2) {
 133     case SYBORG_VIRTIO_GUEST_FEATURES:
 134         if (vdev->set_features)
 135             vdev->set_features(vdev, value);
 136         vdev->guest_features = value;
 137         break;
 138     case SYBORG_VIRTIO_QUEUE_BASE:
 139         if (value == 0)
 140             virtio_reset(vdev);
 141         else
 142             virtio_queue_set_addr(vdev, vdev->queue_sel, value);
 143         break;
 144     case SYBORG_VIRTIO_QUEUE_SEL:
 145         if (value < VIRTIO_PCI_QUEUE_MAX)
 146             vdev->queue_sel = value;
 147         break;
 148     case SYBORG_VIRTIO_QUEUE_NOTIFY:
 149         virtio_queue_notify(vdev, value);
 150         break;
 151     case SYBORG_VIRTIO_STATUS:
 152         virtio_set_status(vdev, value & 0xFF);
 153         if (vdev->status == 0)
 154             virtio_reset(vdev);
 155         break;
 156     case SYBORG_VIRTIO_INT_ENABLE:
 157         s->int_enable = value;
 158         virtio_update_irq(vdev);
 159         break;
 160     case SYBORG_VIRTIO_INT_STATUS:
 161         vdev->isr &= ~value;
 162         virtio_update_irq(vdev);
 163         break;
 164     default:
 165         BADF("Bad write offset 0x%x\n", (int)offset);
 166         break;
 167     }
 168 }
 169
 170 static uint32_t syborg_virtio_readw(void *opaque, target_phys_addr_t offset)
 171 {
 172     SyborgVirtIOProxy *s = opaque;
 173     VirtIODevice *vdev = s->vdev;
 174
 175     DPRINTF("readw 0x%x\n", (int)offset);
 176     if (offset >= SYBORG_VIRTIO_CONFIG) {
 177         return virtio_config_readw(vdev, offset - SYBORG_VIRTIO_CONFIG);
 178     }
 179     BADF("Bad halfword read offset 0x%x\n", (int)offset);
 180     return -1;
 181 }
 182
 183 static void syborg_virtio_writew(void *opaque, target_phys_addr_t offset,
 184                                  uint32_t value)
 185 {
 186     SyborgVirtIOProxy *s = opaque;
 187     VirtIODevice *vdev = s->vdev;
 188
 189     DPRINTF("writew 0x%x = 0x%x\n", (int)offset, value);
 190     if (offset >= SYBORG_VIRTIO_CONFIG) {
 191         return virtio_config_writew(vdev, offset - SYBORG_VIRTIO_CONFIG,
 192                                     value);
 193     }
 194     BADF("Bad halfword write offset 0x%x\n", (int)offset);
 195 }
 196
 197 static uint32_t syborg_virtio_readb(void *opaque, target_phys_addr_t offset)
 198 {
 199     SyborgVirtIOProxy *s = opaque;
 200     VirtIODevice *vdev = s->vdev;
 201
 202     DPRINTF("readb 0x%x\n", (int)offset);
 203     if (offset >= SYBORG_VIRTIO_CONFIG) {
 204         return virtio_config_readb(vdev, offset - SYBORG_VIRTIO_CONFIG);
 205     }
 206     BADF("Bad byte read offset 0x%x\n", (int)offset);
 207     return -1;
 208 }
 209
 210 static void syborg_virtio_writeb(void *opaque, target_phys_addr_t offset,
 211                                  uint32_t value)
 212 {
 213     SyborgVirtIOProxy *s = opaque;
 214     VirtIODevice *vdev = s->vdev;
 215
 216     DPRINTF("writeb 0x%x = 0x%x\n", (int)offset, value);
 217     if (offset >= SYBORG_VIRTIO_CONFIG) {
 218         return virtio_config_writeb(vdev, offset - SYBORG_VIRTIO_CONFIG,
 219                                     value);
 220     }
 221     BADF("Bad byte write offset 0x%x\n", (int)offset);
 222 }
 223
 224 static CPUReadMemoryFunc * const syborg_virtio_readfn[] = {
 225      syborg_virtio_readb,
 226      syborg_virtio_readw,
 227      syborg_virtio_readl
 228 };
 229
 230 static CPUWriteMemoryFunc * const syborg_virtio_writefn[] = {
 231      syborg_virtio_writeb,
 232      syborg_virtio_writew,
 233      syborg_virtio_writel
 234 };
 235
 236 static void syborg_virtio_update_irq(void *opaque, uint16_t vector)
 237 {
 238     SyborgVirtIOProxy *proxy = opaque;
 239     int level;
 240
 241     level = proxy->int_enable & proxy->vdev->isr;
 242     DPRINTF("IRQ %d\n", level);
 243     qemu_set_irq(proxy->irq, level != 0);
 244 }
 245
 246 static unsigned syborg_virtio_get_features(void *opaque)
 247 {
 248     SyborgVirtIOProxy *proxy = opaque;
 249     return proxy->host_features;
 250 }
 251
 252 static VirtIOBindings syborg_virtio_bindings = {
 253     .notify = syborg_virtio_update_irq,
 254     .get_features = syborg_virtio_get_features,
 255 };
 256
 257 static int syborg_virtio_init(SyborgVirtIOProxy *proxy, VirtIODevice *vdev)
 258 {
 259     int iomemtype;
 260
 261     proxy->vdev = vdev;
 262
 263     /* Don't support multiple vectors */
 264     proxy->vdev->nvectors = 0;
 265     sysbus_init_irq(&proxy->busdev, &proxy->irq);
 266     iomemtype = cpu_register_io_memory(syborg_virtio_readfn,
 267                                        syborg_virtio_writefn, proxy);
 268     sysbus_init_mmio(&proxy->busdev, 0x1000, iomemtype);
 269
 270     proxy->id = ((uint32_t)0x1af4 << 16) | vdev->device_id;
 271
 272     qemu_register_reset(virtio_reset, vdev);
 273
 274     virtio_bind_device(vdev, &syborg_virtio_bindings, proxy);
 275     proxy->host_features |= (0x1 << VIRTIO_F_NOTIFY_ON_EMPTY);
 276     proxy->host_features = vdev->get_features(vdev, proxy->host_features);
 277     return 0;
 278 }
 279
 280 /* Device specific bindings.  */
 281
 282 static int syborg_virtio_net_init(SysBusDevice *dev)
 283 {
 284     VirtIODevice *vdev;
 285     SyborgVirtIOProxy *proxy = FROM_SYSBUS(SyborgVirtIOProxy, dev);
 286
 287     vdev = virtio_net_init(&dev->qdev, &proxy->nic);
 288     return syborg_virtio_init(proxy, vdev);
 289 }
 290
 291 static SysBusDeviceInfo syborg_virtio_net_info = {
 292     .init = syborg_virtio_net_init,
 293     .qdev.name  = "syborg,virtio-net",
 294     .qdev.size  = sizeof(SyborgVirtIOProxy),
 295     .qdev.props = (Property[]) {
 296         DEFINE_NIC_PROPERTIES(SyborgVirtIOProxy, nic),
 297         DEFINE_VIRTIO_NET_FEATURES(SyborgVirtIOProxy, host_features),
 298         DEFINE_PROP_END_OF_LIST(),
 299     }
 300 };
 301
 302 static void syborg_virtio_register_devices(void)
 303 {
 304     sysbus_register_withprop(&syborg_virtio_net_info);
 305 }
 306
 307 device_init(syborg_virtio_register_devices)