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
  30 //#define DEBUG_SYBORG_VIRTIO
  31
  32 #ifdef DEBUG_SYBORG_VIRTIO
  33 #define DPRINTF(fmt, ...) \
  34 do { printf("syborg_virtio: " fmt , ## __VA_ARGS__); } while (0)
  35 #define BADF(fmt, ...) \
  36 do { fprintf(stderr, "syborg_virtio: error: " fmt , ## __VA_ARGS__); \
  37     exit(1);} while (0)
  38 #else
  39 #define DPRINTF(fmt, ...) do {} while(0)
  40 #define BADF(fmt, ...) \
  41 do { fprintf(stderr, "syborg_virtio: error: " fmt , ## __VA_ARGS__);} while (0)
  42 #endif
  43
  44 enum {
  45     SYBORG_VIRTIO_ID             = 0,
  46     SYBORG_VIRTIO_DEVTYPE        = 1,
  47     SYBORG_VIRTIO_HOST_FEATURES  = 2,
  48     SYBORG_VIRTIO_GUEST_FEATURES = 3,
  49     SYBORG_VIRTIO_QUEUE_BASE     = 4,
  50     SYBORG_VIRTIO_QUEUE_NUM      = 5,
  51     SYBORG_VIRTIO_QUEUE_SEL      = 6,
  52     SYBORG_VIRTIO_QUEUE_NOTIFY   = 7,
  53     SYBORG_VIRTIO_STATUS         = 8,
  54     SYBORG_VIRTIO_INT_ENABLE     = 9,
  55     SYBORG_VIRTIO_INT_STATUS     = 10
  56 };
  57
  58 #define SYBORG_VIRTIO_CONFIG 0x100
  59
  60 /* Device independent interface.  */
  61
  62 typedef struct {
  63     SysBusDevice busdev;
  64     VirtIODevice *vdev;
  65     MemoryRegion iomem;
  66     qemu_irq irq;
  67     uint32_t int_enable;
  68     uint32_t id;
  69     NICConf nic;
  70     uint32_t host_features;
  71     virtio_net_conf net;
  72 } SyborgVirtIOProxy;
  73
  74 static uint32_t syborg_virtio_readl(void *opaque, target_phys_addr_t offset)
  75 {
  76     SyborgVirtIOProxy *s = opaque;
  77     VirtIODevice *vdev = s->vdev;
  78     uint32_t ret;
  79
  80     DPRINTF("readl 0x%x\n", (int)offset);
  81     if (offset >= SYBORG_VIRTIO_CONFIG) {
  82         return virtio_config_readl(vdev, offset - SYBORG_VIRTIO_CONFIG);
  83     }
  84     switch(offset >> 2) {
  85     case SYBORG_VIRTIO_ID:
  86         ret = SYBORG_ID_VIRTIO;
  87         break;
  88     case SYBORG_VIRTIO_DEVTYPE:
  89         ret = s->id;
  90         break;
  91     case SYBORG_VIRTIO_HOST_FEATURES:
  92         ret = s->host_features;
  93         break;
  94     case SYBORG_VIRTIO_GUEST_FEATURES:
  95         ret = vdev->guest_features;
  96         break;
  97     case SYBORG_VIRTIO_QUEUE_BASE:
  98         ret = virtio_queue_get_addr(vdev, vdev->queue_sel);
  99         break;
 100     case SYBORG_VIRTIO_QUEUE_NUM:
 101         ret = virtio_queue_get_num(vdev, vdev->queue_sel);
 102         break;
 103     case SYBORG_VIRTIO_QUEUE_SEL:
 104         ret = vdev->queue_sel;
 105         break;
 106     case SYBORG_VIRTIO_STATUS:
 107         ret = vdev->status;
 108         break;
 109     case SYBORG_VIRTIO_INT_ENABLE:
 110         ret = s->int_enable;
 111         break;
 112     case SYBORG_VIRTIO_INT_STATUS:
 113         ret = vdev->isr;
 114         break;
 115     default:
 116         BADF("Bad read offset 0x%x\n", (int)offset);
 117         return 0;
 118     }
 119     return ret;
 120 }
 121
 122 static void syborg_virtio_writel(void *opaque, target_phys_addr_t offset,
 123                                  uint32_t value)
 124 {
 125     SyborgVirtIOProxy *s = opaque;
 126     VirtIODevice *vdev = s->vdev;
 127
 128     DPRINTF("writel 0x%x = 0x%x\n", (int)offset, value);
 129     if (offset >= SYBORG_VIRTIO_CONFIG) {
 130         return virtio_config_writel(vdev, offset - SYBORG_VIRTIO_CONFIG,
 131                                     value);
 132     }
 133     switch (offset >> 2) {
 134     case SYBORG_VIRTIO_GUEST_FEATURES:
 135         virtio_set_features(vdev, value);
 136         break;
 137     case SYBORG_VIRTIO_QUEUE_BASE:
 138         if (value == 0)
 139             virtio_reset(vdev);
 140         else
 141             virtio_queue_set_addr(vdev, vdev->queue_sel, value);
 142         break;
 143     case SYBORG_VIRTIO_QUEUE_SEL:
 144         if (value < VIRTIO_PCI_QUEUE_MAX)
 145             vdev->queue_sel = value;
 146         break;
 147     case SYBORG_VIRTIO_QUEUE_NOTIFY:
 148         if (value < VIRTIO_PCI_QUEUE_MAX) {
 149             virtio_queue_notify(vdev, value);
 150         }
 151         break;
 152     case SYBORG_VIRTIO_STATUS:
 153         virtio_set_status(vdev, value & 0xFF);
 154         if (vdev->status == 0)
 155             virtio_reset(vdev);
 156         break;
 157     case SYBORG_VIRTIO_INT_ENABLE:
 158         s->int_enable = value;
 159         virtio_update_irq(vdev);
 160         break;
 161     case SYBORG_VIRTIO_INT_STATUS:
 162         vdev->isr &= ~value;
 163         virtio_update_irq(vdev);
 164         break;
 165     default:
 166         BADF("Bad write offset 0x%x\n", (int)offset);
 167         break;
 168     }
 169 }
 170
 171 static uint32_t syborg_virtio_readw(void *opaque, target_phys_addr_t offset)
 172 {
 173     SyborgVirtIOProxy *s = opaque;
 174     VirtIODevice *vdev = s->vdev;
 175
 176     DPRINTF("readw 0x%x\n", (int)offset);
 177     if (offset >= SYBORG_VIRTIO_CONFIG) {
 178         return virtio_config_readw(vdev, offset - SYBORG_VIRTIO_CONFIG);
 179     }
 180     BADF("Bad halfword read offset 0x%x\n", (int)offset);
 181     return -1;
 182 }
 183
 184 static void syborg_virtio_writew(void *opaque, target_phys_addr_t offset,
 185                                  uint32_t value)
 186 {
 187     SyborgVirtIOProxy *s = opaque;
 188     VirtIODevice *vdev = s->vdev;
 189
 190     DPRINTF("writew 0x%x = 0x%x\n", (int)offset, value);
 191     if (offset >= SYBORG_VIRTIO_CONFIG) {
 192         return virtio_config_writew(vdev, offset - SYBORG_VIRTIO_CONFIG,
 193                                     value);
 194     }
 195     BADF("Bad halfword write offset 0x%x\n", (int)offset);
 196 }
 197
 198 static uint32_t syborg_virtio_readb(void *opaque, target_phys_addr_t offset)
 199 {
 200     SyborgVirtIOProxy *s = opaque;
 201     VirtIODevice *vdev = s->vdev;
 202
 203     DPRINTF("readb 0x%x\n", (int)offset);
 204     if (offset >= SYBORG_VIRTIO_CONFIG) {
 205         return virtio_config_readb(vdev, offset - SYBORG_VIRTIO_CONFIG);
 206     }
 207     BADF("Bad byte read offset 0x%x\n", (int)offset);
 208     return -1;
 209 }
 210
 211 static void syborg_virtio_writeb(void *opaque, target_phys_addr_t offset,
 212                                  uint32_t value)
 213 {
 214     SyborgVirtIOProxy *s = opaque;
 215     VirtIODevice *vdev = s->vdev;
 216
 217     DPRINTF("writeb 0x%x = 0x%x\n", (int)offset, value);
 218     if (offset >= SYBORG_VIRTIO_CONFIG) {
 219         return virtio_config_writeb(vdev, offset - SYBORG_VIRTIO_CONFIG,
 220                                     value);
 221     }
 222     BADF("Bad byte write offset 0x%x\n", (int)offset);
 223 }
 224
 225 static const MemoryRegionOps syborg_virtio_ops = {
 226     .old_mmio = {
 227         .read = { syborg_virtio_readb, syborg_virtio_readw, syborg_virtio_readl },
 228         .write = { syborg_virtio_writeb, syborg_virtio_writew, syborg_virtio_writel },
 229     },
 230     .endianness = DEVICE_NATIVE_ENDIAN,
 231 };
 232
 233 static void syborg_virtio_update_irq(void *opaque, uint16_t vector)
 234 {
 235     SyborgVirtIOProxy *proxy = opaque;
 236     int level;
 237
 238     level = proxy->int_enable & proxy->vdev->isr;
 239     DPRINTF("IRQ %d\n", level);
 240     qemu_set_irq(proxy->irq, level != 0);
 241 }
 242
 243 static unsigned syborg_virtio_get_features(void *opaque)
 244 {
 245     SyborgVirtIOProxy *proxy = opaque;
 246     return proxy->host_features;
 247 }
 248
 249 static VirtIOBindings syborg_virtio_bindings = {
 250     .notify = syborg_virtio_update_irq,
 251     .get_features = syborg_virtio_get_features,
 252 };
 253
 254 static int syborg_virtio_init(SyborgVirtIOProxy *proxy, VirtIODevice *vdev)
 255 {
 256     proxy->vdev = vdev;
 257
 258     /* Don't support multiple vectors */
 259     proxy->vdev->nvectors = 0;
 260     sysbus_init_irq(&proxy->busdev, &proxy->irq);
 261     memory_region_init_io(&proxy->iomem, &syborg_virtio_ops, proxy,
 262                           "virtio", 0x1000);
 263     sysbus_init_mmio(&proxy->busdev, &proxy->iomem);
 264
 265     proxy->id = ((uint32_t)0x1af4 << 16) | vdev->device_id;
 266
 267     qemu_register_reset(virtio_reset, vdev);
 268
 269     virtio_bind_device(vdev, &syborg_virtio_bindings, proxy);
 270     proxy->host_features |= (0x1 << VIRTIO_F_NOTIFY_ON_EMPTY);
 271     proxy->host_features = vdev->get_features(vdev, proxy->host_features);
 272     return 0;
 273 }
 274
 275 /* Device specific bindings.  */
 276
 277 static int syborg_virtio_net_init(SysBusDevice *dev)
 278 {
 279     VirtIODevice *vdev;
 280     SyborgVirtIOProxy *proxy = FROM_SYSBUS(SyborgVirtIOProxy, dev);
 281
 282     vdev = virtio_net_init(&dev->qdev, &proxy->nic, &proxy->net);
 283     return syborg_virtio_init(proxy, vdev);
 284 }
 285
 286 static SysBusDeviceInfo syborg_virtio_net_info = {
 287     .init = syborg_virtio_net_init,
 288     .qdev.name  = "syborg,virtio-net",
 289     .qdev.size  = sizeof(SyborgVirtIOProxy),
 290     .qdev.props = (Property[]) {
 291         DEFINE_NIC_PROPERTIES(SyborgVirtIOProxy, nic),
 292         DEFINE_VIRTIO_NET_FEATURES(SyborgVirtIOProxy, host_features),
 293         DEFINE_PROP_UINT32("x-txtimer", SyborgVirtIOProxy,
 294                            net.txtimer, TX_TIMER_INTERVAL),
 295         DEFINE_PROP_INT32("x-txburst", SyborgVirtIOProxy,
 296                           net.txburst, TX_BURST),
 297         DEFINE_PROP_STRING("tx", SyborgVirtIOProxy, net.tx),
 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)