 3400c45504
			
		
	
	
		3400c45504
		
	
	
	
	
		
			
			Here the virtio-ccw-s390 is modified for the new API. The device virtio-ccw-s390 extends virtio-ccw-device as before. It creates and connects a virtio-ccw during the init. The properties are not modified. Signed-off-by: KONRAD Frederic <fred.konrad@greensocs.com> Reviewed-by: Peter Maydell <peter.maydell@linaro.org> Message-id: 1363624648-16906-9-git-send-email-fred.konrad@greensocs.com Signed-off-by: Anthony Liguori <aliguori@us.ibm.com>
		
			
				
	
	
		
			1023 lines
		
	
	
		
			30 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1023 lines
		
	
	
		
			30 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * virtio ccw target implementation
 | |
|  *
 | |
|  * Copyright 2012 IBM Corp.
 | |
|  * Author(s): Cornelia Huck <cornelia.huck@de.ibm.com>
 | |
|  *
 | |
|  * This work is licensed under the terms of the GNU GPL, version 2 or (at
 | |
|  * your option) any later version. See the COPYING file in the top-level
 | |
|  * directory.
 | |
|  */
 | |
| 
 | |
| #include "hw/hw.h"
 | |
| #include "block/block.h"
 | |
| #include "sysemu/blockdev.h"
 | |
| #include "sysemu/sysemu.h"
 | |
| #include "net/net.h"
 | |
| #include "monitor/monitor.h"
 | |
| #include "hw/virtio.h"
 | |
| #include "hw/virtio-serial.h"
 | |
| #include "hw/virtio-net.h"
 | |
| #include "hw/sysbus.h"
 | |
| #include "qemu/bitops.h"
 | |
| #include "hw/virtio-bus.h"
 | |
| 
 | |
| #include "ioinst.h"
 | |
| #include "css.h"
 | |
| #include "virtio-ccw.h"
 | |
| #include "trace.h"
 | |
| 
 | |
| static int virtual_css_bus_reset(BusState *qbus)
 | |
| {
 | |
|     /* This should actually be modelled via the generic css */
 | |
|     css_reset();
 | |
| 
 | |
|     /* we dont traverse ourself, return 0 */
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| 
 | |
| static void virtual_css_bus_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     BusClass *k = BUS_CLASS(klass);
 | |
| 
 | |
|     k->reset = virtual_css_bus_reset;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtual_css_bus_info = {
 | |
|     .name = TYPE_VIRTUAL_CSS_BUS,
 | |
|     .parent = TYPE_BUS,
 | |
|     .instance_size = sizeof(VirtualCssBus),
 | |
|     .class_init = virtual_css_bus_class_init,
 | |
| };
 | |
| 
 | |
| static const VirtIOBindings virtio_ccw_bindings;
 | |
| 
 | |
| VirtIODevice *virtio_ccw_get_vdev(SubchDev *sch)
 | |
| {
 | |
|     VirtIODevice *vdev = NULL;
 | |
| 
 | |
|     if (sch->driver_data) {
 | |
|         vdev = ((VirtioCcwDevice *)sch->driver_data)->vdev;
 | |
|     }
 | |
|     return vdev;
 | |
| }
 | |
| 
 | |
| VirtualCssBus *virtual_css_bus_init(void)
 | |
| {
 | |
|     VirtualCssBus *cbus;
 | |
|     BusState *bus;
 | |
|     DeviceState *dev;
 | |
| 
 | |
|     /* Create bridge device */
 | |
|     dev = qdev_create(NULL, "virtual-css-bridge");
 | |
|     qdev_init_nofail(dev);
 | |
| 
 | |
|     /* Create bus on bridge device */
 | |
|     bus = qbus_create(TYPE_VIRTUAL_CSS_BUS, dev, "virtual-css");
 | |
|     cbus = VIRTUAL_CSS_BUS(bus);
 | |
| 
 | |
|     /* Enable hotplugging */
 | |
|     bus->allow_hotplug = 1;
 | |
| 
 | |
|     return cbus;
 | |
| }
 | |
| 
 | |
| /* Communication blocks used by several channel commands. */
 | |
| typedef struct VqInfoBlock {
 | |
|     uint64_t queue;
 | |
|     uint32_t align;
 | |
|     uint16_t index;
 | |
|     uint16_t num;
 | |
| } QEMU_PACKED VqInfoBlock;
 | |
| 
 | |
| typedef struct VqConfigBlock {
 | |
|     uint16_t index;
 | |
|     uint16_t num_max;
 | |
| } QEMU_PACKED VqConfigBlock;
 | |
| 
 | |
| typedef struct VirtioFeatDesc {
 | |
|     uint32_t features;
 | |
|     uint8_t index;
 | |
| } QEMU_PACKED VirtioFeatDesc;
 | |
| 
 | |
| /* Specify where the virtqueues for the subchannel are in guest memory. */
 | |
| static int virtio_ccw_set_vqs(SubchDev *sch, uint64_t addr, uint32_t align,
 | |
|                               uint16_t index, uint16_t num)
 | |
| {
 | |
|     VirtioCcwDevice *dev = sch->driver_data;
 | |
| 
 | |
|     if (index > VIRTIO_PCI_QUEUE_MAX) {
 | |
|         return -EINVAL;
 | |
|     }
 | |
| 
 | |
|     /* Current code in virtio.c relies on 4K alignment. */
 | |
|     if (addr && (align != 4096)) {
 | |
|         return -EINVAL;
 | |
|     }
 | |
| 
 | |
|     if (!dev) {
 | |
|         return -EINVAL;
 | |
|     }
 | |
| 
 | |
|     virtio_queue_set_addr(dev->vdev, index, addr);
 | |
|     if (!addr) {
 | |
|         virtio_queue_set_vector(dev->vdev, index, 0);
 | |
|     } else {
 | |
|         /* Fail if we don't have a big enough queue. */
 | |
|         /* TODO: Add interface to handle vring.num changing */
 | |
|         if (virtio_queue_get_num(dev->vdev, index) > num) {
 | |
|             return -EINVAL;
 | |
|         }
 | |
|         virtio_queue_set_vector(dev->vdev, index, index);
 | |
|     }
 | |
|     /* tell notify handler in case of config change */
 | |
|     dev->vdev->config_vector = VIRTIO_PCI_QUEUE_MAX;
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_cb(SubchDev *sch, CCW1 ccw)
 | |
| {
 | |
|     int ret;
 | |
|     VqInfoBlock info;
 | |
|     uint8_t status;
 | |
|     VirtioFeatDesc features;
 | |
|     void *config;
 | |
|     hwaddr indicators;
 | |
|     VqConfigBlock vq_config;
 | |
|     VirtioCcwDevice *dev = sch->driver_data;
 | |
|     bool check_len;
 | |
|     int len;
 | |
|     hwaddr hw_len;
 | |
| 
 | |
|     if (!dev) {
 | |
|         return -EINVAL;
 | |
|     }
 | |
| 
 | |
|     trace_virtio_ccw_interpret_ccw(sch->cssid, sch->ssid, sch->schid,
 | |
|                                    ccw.cmd_code);
 | |
|     check_len = !((ccw.flags & CCW_FLAG_SLI) && !(ccw.flags & CCW_FLAG_DC));
 | |
| 
 | |
|     /* Look at the command. */
 | |
|     switch (ccw.cmd_code) {
 | |
|     case CCW_CMD_SET_VQ:
 | |
|         if (check_len) {
 | |
|             if (ccw.count != sizeof(info)) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         } else if (ccw.count < sizeof(info)) {
 | |
|             /* Can't execute command. */
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             info.queue = ldq_phys(ccw.cda);
 | |
|             info.align = ldl_phys(ccw.cda + sizeof(info.queue));
 | |
|             info.index = lduw_phys(ccw.cda + sizeof(info.queue)
 | |
|                                    + sizeof(info.align));
 | |
|             info.num = lduw_phys(ccw.cda + sizeof(info.queue)
 | |
|                                  + sizeof(info.align)
 | |
|                                  + sizeof(info.index));
 | |
|             ret = virtio_ccw_set_vqs(sch, info.queue, info.align, info.index,
 | |
|                                      info.num);
 | |
|             sch->curr_status.scsw.count = 0;
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_VDEV_RESET:
 | |
|         virtio_reset(dev->vdev);
 | |
|         ret = 0;
 | |
|         break;
 | |
|     case CCW_CMD_READ_FEAT:
 | |
|         if (check_len) {
 | |
|             if (ccw.count != sizeof(features)) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         } else if (ccw.count < sizeof(features)) {
 | |
|             /* Can't execute command. */
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             features.index = ldub_phys(ccw.cda + sizeof(features.features));
 | |
|             if (features.index < ARRAY_SIZE(dev->host_features)) {
 | |
|                 features.features = dev->host_features[features.index];
 | |
|             } else {
 | |
|                 /* Return zeroes if the guest supports more feature bits. */
 | |
|                 features.features = 0;
 | |
|             }
 | |
|             stl_le_phys(ccw.cda, features.features);
 | |
|             sch->curr_status.scsw.count = ccw.count - sizeof(features);
 | |
|             ret = 0;
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_WRITE_FEAT:
 | |
|         if (check_len) {
 | |
|             if (ccw.count != sizeof(features)) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         } else if (ccw.count < sizeof(features)) {
 | |
|             /* Can't execute command. */
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             features.index = ldub_phys(ccw.cda + sizeof(features.features));
 | |
|             features.features = ldl_le_phys(ccw.cda);
 | |
|             if (features.index < ARRAY_SIZE(dev->host_features)) {
 | |
|                 if (dev->vdev->set_features) {
 | |
|                     dev->vdev->set_features(dev->vdev, features.features);
 | |
|                 }
 | |
|                 dev->vdev->guest_features = features.features;
 | |
|             } else {
 | |
|                 /*
 | |
|                  * If the guest supports more feature bits, assert that it
 | |
|                  * passes us zeroes for those we don't support.
 | |
|                  */
 | |
|                 if (features.features) {
 | |
|                     fprintf(stderr, "Guest bug: features[%i]=%x (expected 0)\n",
 | |
|                             features.index, features.features);
 | |
|                     /* XXX: do a unit check here? */
 | |
|                 }
 | |
|             }
 | |
|             sch->curr_status.scsw.count = ccw.count - sizeof(features);
 | |
|             ret = 0;
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_READ_CONF:
 | |
|         if (check_len) {
 | |
|             if (ccw.count > dev->vdev->config_len) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         }
 | |
|         len = MIN(ccw.count, dev->vdev->config_len);
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             dev->vdev->get_config(dev->vdev, dev->vdev->config);
 | |
|             /* XXX config space endianness */
 | |
|             cpu_physical_memory_write(ccw.cda, dev->vdev->config, len);
 | |
|             sch->curr_status.scsw.count = ccw.count - len;
 | |
|             ret = 0;
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_WRITE_CONF:
 | |
|         if (check_len) {
 | |
|             if (ccw.count > dev->vdev->config_len) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         }
 | |
|         len = MIN(ccw.count, dev->vdev->config_len);
 | |
|         hw_len = len;
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             config = cpu_physical_memory_map(ccw.cda, &hw_len, 0);
 | |
|             if (!config) {
 | |
|                 ret = -EFAULT;
 | |
|             } else {
 | |
|                 len = hw_len;
 | |
|                 /* XXX config space endianness */
 | |
|                 memcpy(dev->vdev->config, config, len);
 | |
|                 cpu_physical_memory_unmap(config, hw_len, 0, hw_len);
 | |
|                 if (dev->vdev->set_config) {
 | |
|                     dev->vdev->set_config(dev->vdev, dev->vdev->config);
 | |
|                 }
 | |
|                 sch->curr_status.scsw.count = ccw.count - len;
 | |
|                 ret = 0;
 | |
|             }
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_WRITE_STATUS:
 | |
|         if (check_len) {
 | |
|             if (ccw.count != sizeof(status)) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         } else if (ccw.count < sizeof(status)) {
 | |
|             /* Can't execute command. */
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             status = ldub_phys(ccw.cda);
 | |
|             virtio_set_status(dev->vdev, status);
 | |
|             if (dev->vdev->status == 0) {
 | |
|                 virtio_reset(dev->vdev);
 | |
|             }
 | |
|             sch->curr_status.scsw.count = ccw.count - sizeof(status);
 | |
|             ret = 0;
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_SET_IND:
 | |
|         if (check_len) {
 | |
|             if (ccw.count != sizeof(indicators)) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         } else if (ccw.count < sizeof(indicators)) {
 | |
|             /* Can't execute command. */
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         indicators = ldq_phys(ccw.cda);
 | |
|         if (!indicators) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             dev->indicators = indicators;
 | |
|             sch->curr_status.scsw.count = ccw.count - sizeof(indicators);
 | |
|             ret = 0;
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_SET_CONF_IND:
 | |
|         if (check_len) {
 | |
|             if (ccw.count != sizeof(indicators)) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         } else if (ccw.count < sizeof(indicators)) {
 | |
|             /* Can't execute command. */
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         indicators = ldq_phys(ccw.cda);
 | |
|         if (!indicators) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             dev->indicators2 = indicators;
 | |
|             sch->curr_status.scsw.count = ccw.count - sizeof(indicators);
 | |
|             ret = 0;
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_READ_VQ_CONF:
 | |
|         if (check_len) {
 | |
|             if (ccw.count != sizeof(vq_config)) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         } else if (ccw.count < sizeof(vq_config)) {
 | |
|             /* Can't execute command. */
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             vq_config.index = lduw_phys(ccw.cda);
 | |
|             vq_config.num_max = virtio_queue_get_num(dev->vdev,
 | |
|                                                      vq_config.index);
 | |
|             stw_phys(ccw.cda + sizeof(vq_config.index), vq_config.num_max);
 | |
|             sch->curr_status.scsw.count = ccw.count - sizeof(vq_config);
 | |
|             ret = 0;
 | |
|         }
 | |
|         break;
 | |
|     default:
 | |
|         ret = -ENOSYS;
 | |
|         break;
 | |
|     }
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_device_init(VirtioCcwDevice *dev, VirtIODevice *vdev)
 | |
| {
 | |
|     unsigned int cssid = 0;
 | |
|     unsigned int ssid = 0;
 | |
|     unsigned int schid;
 | |
|     unsigned int devno;
 | |
|     bool have_devno = false;
 | |
|     bool found = false;
 | |
|     SubchDev *sch;
 | |
|     int ret;
 | |
|     int num;
 | |
|     DeviceState *parent = DEVICE(dev);
 | |
| 
 | |
|     sch = g_malloc0(sizeof(SubchDev));
 | |
| 
 | |
|     sch->driver_data = dev;
 | |
|     dev->sch = sch;
 | |
| 
 | |
|     dev->vdev = vdev;
 | |
|     dev->indicators = 0;
 | |
| 
 | |
|     /* Initialize subchannel structure. */
 | |
|     sch->channel_prog = 0x0;
 | |
|     sch->last_cmd_valid = false;
 | |
|     sch->orb = NULL;
 | |
|     /*
 | |
|      * Use a device number if provided. Otherwise, fall back to subchannel
 | |
|      * number.
 | |
|      */
 | |
|     if (dev->bus_id) {
 | |
|         num = sscanf(dev->bus_id, "%x.%x.%04x", &cssid, &ssid, &devno);
 | |
|         if (num == 3) {
 | |
|             if ((cssid > MAX_CSSID) || (ssid > MAX_SSID)) {
 | |
|                 ret = -EINVAL;
 | |
|                 error_report("Invalid cssid or ssid: cssid %x, ssid %x",
 | |
|                              cssid, ssid);
 | |
|                 goto out_err;
 | |
|             }
 | |
|             /* Enforce use of virtual cssid. */
 | |
|             if (cssid != VIRTUAL_CSSID) {
 | |
|                 ret = -EINVAL;
 | |
|                 error_report("cssid %x not valid for virtio devices", cssid);
 | |
|                 goto out_err;
 | |
|             }
 | |
|             if (css_devno_used(cssid, ssid, devno)) {
 | |
|                 ret = -EEXIST;
 | |
|                 error_report("Device %x.%x.%04x already exists", cssid, ssid,
 | |
|                              devno);
 | |
|                 goto out_err;
 | |
|             }
 | |
|             sch->cssid = cssid;
 | |
|             sch->ssid = ssid;
 | |
|             sch->devno = devno;
 | |
|             have_devno = true;
 | |
|         } else {
 | |
|             ret = -EINVAL;
 | |
|             error_report("Malformed devno parameter '%s'", dev->bus_id);
 | |
|             goto out_err;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /* Find the next free id. */
 | |
|     if (have_devno) {
 | |
|         for (schid = 0; schid <= MAX_SCHID; schid++) {
 | |
|             if (!css_find_subch(1, cssid, ssid, schid)) {
 | |
|                 sch->schid = schid;
 | |
|                 css_subch_assign(cssid, ssid, schid, devno, sch);
 | |
|                 found = true;
 | |
|                 break;
 | |
|             }
 | |
|         }
 | |
|         if (!found) {
 | |
|             ret = -ENODEV;
 | |
|             error_report("No free subchannel found for %x.%x.%04x", cssid, ssid,
 | |
|                          devno);
 | |
|             goto out_err;
 | |
|         }
 | |
|         trace_virtio_ccw_new_device(cssid, ssid, schid, devno,
 | |
|                                     "user-configured");
 | |
|     } else {
 | |
|         cssid = VIRTUAL_CSSID;
 | |
|         for (ssid = 0; ssid <= MAX_SSID; ssid++) {
 | |
|             for (schid = 0; schid <= MAX_SCHID; schid++) {
 | |
|                 if (!css_find_subch(1, cssid, ssid, schid)) {
 | |
|                     sch->cssid = cssid;
 | |
|                     sch->ssid = ssid;
 | |
|                     sch->schid = schid;
 | |
|                     devno = schid;
 | |
|                     /*
 | |
|                      * If the devno is already taken, look further in this
 | |
|                      * subchannel set.
 | |
|                      */
 | |
|                     while (css_devno_used(cssid, ssid, devno)) {
 | |
|                         if (devno == MAX_SCHID) {
 | |
|                             devno = 0;
 | |
|                         } else if (devno == schid - 1) {
 | |
|                             ret = -ENODEV;
 | |
|                             error_report("No free devno found");
 | |
|                             goto out_err;
 | |
|                         } else {
 | |
|                             devno++;
 | |
|                         }
 | |
|                     }
 | |
|                     sch->devno = devno;
 | |
|                     css_subch_assign(cssid, ssid, schid, devno, sch);
 | |
|                     found = true;
 | |
|                     break;
 | |
|                 }
 | |
|             }
 | |
|             if (found) {
 | |
|                 break;
 | |
|             }
 | |
|         }
 | |
|         if (!found) {
 | |
|             ret = -ENODEV;
 | |
|             error_report("Virtual channel subsystem is full!");
 | |
|             goto out_err;
 | |
|         }
 | |
|         trace_virtio_ccw_new_device(cssid, ssid, schid, devno,
 | |
|                                     "auto-configured");
 | |
|     }
 | |
| 
 | |
|     /* Build initial schib. */
 | |
|     css_sch_build_virtual_schib(sch, 0, VIRTIO_CCW_CHPID_TYPE);
 | |
| 
 | |
|     sch->ccw_cb = virtio_ccw_cb;
 | |
| 
 | |
|     /* Build senseid data. */
 | |
|     memset(&sch->id, 0, sizeof(SenseId));
 | |
|     sch->id.reserved = 0xff;
 | |
|     sch->id.cu_type = VIRTIO_CCW_CU_TYPE;
 | |
|     sch->id.cu_model = dev->vdev->device_id;
 | |
| 
 | |
|     virtio_bind_device(vdev, &virtio_ccw_bindings, DEVICE(dev));
 | |
|     /* Only the first 32 feature bits are used. */
 | |
|     dev->host_features[0] = vdev->get_features(vdev, dev->host_features[0]);
 | |
|     dev->host_features[0] |= 0x1 << VIRTIO_F_NOTIFY_ON_EMPTY;
 | |
|     dev->host_features[0] |= 0x1 << VIRTIO_F_BAD_FEATURE;
 | |
| 
 | |
|     css_generate_sch_crws(sch->cssid, sch->ssid, sch->schid,
 | |
|                           parent->hotplugged, 1);
 | |
|     return 0;
 | |
| 
 | |
| out_err:
 | |
|     dev->sch = NULL;
 | |
|     g_free(sch);
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_exit(VirtioCcwDevice *dev)
 | |
| {
 | |
|     SubchDev *sch = dev->sch;
 | |
| 
 | |
|     if (sch) {
 | |
|         css_subch_assign(sch->cssid, sch->ssid, sch->schid, sch->devno, NULL);
 | |
|         g_free(sch);
 | |
|     }
 | |
|     dev->indicators = 0;
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_net_init(VirtioCcwDevice *dev)
 | |
| {
 | |
|     VirtIODevice *vdev;
 | |
| 
 | |
|     vdev = virtio_net_init((DeviceState *)dev, &dev->nic, &dev->net,
 | |
|                            dev->host_features[0]);
 | |
|     if (!vdev) {
 | |
|         return -1;
 | |
|     }
 | |
| 
 | |
|     return virtio_ccw_device_init(dev, vdev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_net_exit(VirtioCcwDevice *dev)
 | |
| {
 | |
|     virtio_net_exit(dev->vdev);
 | |
|     return virtio_ccw_exit(dev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_blk_init(VirtioCcwDevice *ccw_dev)
 | |
| {
 | |
|     VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
|     virtio_blk_set_conf(vdev, &(dev->blk));
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     if (qdev_init(vdev) < 0) {
 | |
|         return -1;
 | |
|     }
 | |
| 
 | |
|     return virtio_ccw_device_init(ccw_dev, VIRTIO_DEVICE(vdev));
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_blk_instance_init(Object *obj)
 | |
| {
 | |
|     VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(obj);
 | |
|     object_initialize(OBJECT(&dev->vdev), TYPE_VIRTIO_BLK);
 | |
|     object_property_add_child(obj, "virtio-backend", OBJECT(&dev->vdev), NULL);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_serial_init(VirtioCcwDevice *dev)
 | |
| {
 | |
|     VirtIODevice *vdev;
 | |
| 
 | |
|     vdev = virtio_serial_init((DeviceState *)dev, &dev->serial);
 | |
|     if (!vdev) {
 | |
|         return -1;
 | |
|     }
 | |
| 
 | |
|     return virtio_ccw_device_init(dev, vdev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_serial_exit(VirtioCcwDevice *dev)
 | |
| {
 | |
|     virtio_serial_exit(dev->vdev);
 | |
|     return virtio_ccw_exit(dev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_balloon_init(VirtioCcwDevice *dev)
 | |
| {
 | |
|     VirtIODevice *vdev;
 | |
| 
 | |
|     vdev = virtio_balloon_init((DeviceState *)dev);
 | |
|     if (!vdev) {
 | |
|         return -1;
 | |
|     }
 | |
| 
 | |
|     return virtio_ccw_device_init(dev, vdev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_balloon_exit(VirtioCcwDevice *dev)
 | |
| {
 | |
|     virtio_balloon_exit(dev->vdev);
 | |
|     return virtio_ccw_exit(dev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_scsi_init(VirtioCcwDevice *dev)
 | |
| {
 | |
|     VirtIODevice *vdev;
 | |
| 
 | |
|     vdev = virtio_scsi_init((DeviceState *)dev, &dev->scsi);
 | |
|     if (!vdev) {
 | |
|         return -1;
 | |
|     }
 | |
| 
 | |
|     return virtio_ccw_device_init(dev, vdev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_scsi_exit(VirtioCcwDevice *dev)
 | |
| {
 | |
|     virtio_scsi_exit(dev->vdev);
 | |
|     return virtio_ccw_exit(dev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_rng_init(VirtioCcwDevice *dev)
 | |
| {
 | |
|     VirtIODevice *vdev;
 | |
| 
 | |
|     if (dev->rng.rng == NULL) {
 | |
|         dev->rng.default_backend = RNG_RANDOM(object_new(TYPE_RNG_RANDOM));
 | |
|         object_property_add_child(OBJECT(dev), "default-backend",
 | |
|                                   OBJECT(dev->rng.default_backend), NULL);
 | |
|         object_property_set_link(OBJECT(dev), OBJECT(dev->rng.default_backend),
 | |
|                                  "rng", NULL);
 | |
|     }
 | |
|     vdev = virtio_rng_init((DeviceState *)dev, &dev->rng);
 | |
|     if (!vdev) {
 | |
|         return -1;
 | |
|     }
 | |
|     return virtio_ccw_device_init(dev, vdev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_rng_exit(VirtioCcwDevice *dev)
 | |
| {
 | |
|     virtio_rng_exit(dev->vdev);
 | |
|     return virtio_ccw_exit(dev);
 | |
| }
 | |
| 
 | |
| /* DeviceState to VirtioCcwDevice. Note: used on datapath,
 | |
|  * be careful and test performance if you change this.
 | |
|  */
 | |
| static inline VirtioCcwDevice *to_virtio_ccw_dev_fast(DeviceState *d)
 | |
| {
 | |
|     return container_of(d, VirtioCcwDevice, parent_obj);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_notify(DeviceState *d, uint16_t vector)
 | |
| {
 | |
|     VirtioCcwDevice *dev = to_virtio_ccw_dev_fast(d);
 | |
|     SubchDev *sch = dev->sch;
 | |
|     uint64_t indicators;
 | |
| 
 | |
|     if (vector >= 128) {
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     if (vector < VIRTIO_PCI_QUEUE_MAX) {
 | |
|         indicators = ldq_phys(dev->indicators);
 | |
|         indicators |= 1ULL << vector;
 | |
|         stq_phys(dev->indicators, indicators);
 | |
|     } else {
 | |
|         vector = 0;
 | |
|         indicators = ldq_phys(dev->indicators2);
 | |
|         indicators |= 1ULL << vector;
 | |
|         stq_phys(dev->indicators2, indicators);
 | |
|     }
 | |
| 
 | |
|     css_conditional_io_interrupt(sch);
 | |
| 
 | |
| }
 | |
| 
 | |
| static unsigned virtio_ccw_get_features(DeviceState *d)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
| 
 | |
|     /* Only the first 32 feature bits are used. */
 | |
|     return dev->host_features[0];
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_reset(DeviceState *d)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
| 
 | |
|     virtio_reset(dev->vdev);
 | |
|     css_reset_sch(dev->sch);
 | |
| }
 | |
| 
 | |
| /**************** Virtio-ccw Bus Device Descriptions *******************/
 | |
| 
 | |
| static const VirtIOBindings virtio_ccw_bindings = {
 | |
|     .notify = virtio_ccw_notify,
 | |
|     .get_features = virtio_ccw_get_features,
 | |
| };
 | |
| 
 | |
| static Property virtio_ccw_net_properties[] = {
 | |
|     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 | |
|     DEFINE_VIRTIO_NET_FEATURES(VirtioCcwDevice, host_features[0]),
 | |
|     DEFINE_NIC_PROPERTIES(VirtioCcwDevice, nic),
 | |
|     DEFINE_PROP_UINT32("x-txtimer", VirtioCcwDevice,
 | |
|                        net.txtimer, TX_TIMER_INTERVAL),
 | |
|     DEFINE_PROP_INT32("x-txburst", VirtioCcwDevice,
 | |
|                       net.txburst, TX_BURST),
 | |
|     DEFINE_PROP_STRING("tx", VirtioCcwDevice, net.tx),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_net_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->init = virtio_ccw_net_init;
 | |
|     k->exit = virtio_ccw_net_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_net_properties;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_net = {
 | |
|     .name          = "virtio-net-ccw",
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtioCcwDevice),
 | |
|     .class_init    = virtio_ccw_net_class_init,
 | |
| };
 | |
| 
 | |
| static Property virtio_ccw_blk_properties[] = {
 | |
|     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 | |
|     DEFINE_BLOCK_PROPERTIES(VirtIOBlkCcw, blk.conf),
 | |
|     DEFINE_PROP_STRING("serial", VirtIOBlkCcw, blk.serial),
 | |
| #ifdef __linux__
 | |
|     DEFINE_PROP_BIT("scsi", VirtIOBlkCcw, blk.scsi, 0, true),
 | |
| #endif
 | |
|     DEFINE_VIRTIO_BLK_FEATURES(VirtioCcwDevice, host_features[0]),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_blk_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->init = virtio_ccw_blk_init;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_blk_properties;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_blk = {
 | |
|     .name          = TYPE_VIRTIO_BLK_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtIOBlkCcw),
 | |
|     .instance_init = virtio_ccw_blk_instance_init,
 | |
|     .class_init    = virtio_ccw_blk_class_init,
 | |
| };
 | |
| 
 | |
| static Property virtio_ccw_serial_properties[] = {
 | |
|     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 | |
|     DEFINE_PROP_UINT32("max_ports", VirtioCcwDevice,
 | |
|                        serial.max_virtserial_ports, 31),
 | |
|     DEFINE_VIRTIO_COMMON_FEATURES(VirtioCcwDevice, host_features[0]),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_serial_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->init = virtio_ccw_serial_init;
 | |
|     k->exit = virtio_ccw_serial_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_serial_properties;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_serial = {
 | |
|     .name          = "virtio-serial-ccw",
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtioCcwDevice),
 | |
|     .class_init    = virtio_ccw_serial_class_init,
 | |
| };
 | |
| 
 | |
| static Property virtio_ccw_balloon_properties[] = {
 | |
|     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 | |
|     DEFINE_VIRTIO_COMMON_FEATURES(VirtioCcwDevice, host_features[0]),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_balloon_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->init = virtio_ccw_balloon_init;
 | |
|     k->exit = virtio_ccw_balloon_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_balloon_properties;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_balloon = {
 | |
|     .name          = "virtio-balloon-ccw",
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtioCcwDevice),
 | |
|     .class_init    = virtio_ccw_balloon_class_init,
 | |
| };
 | |
| 
 | |
| static Property virtio_ccw_scsi_properties[] = {
 | |
|     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 | |
|     DEFINE_VIRTIO_SCSI_PROPERTIES(VirtioCcwDevice, host_features[0], scsi),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_scsi_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->init = virtio_ccw_scsi_init;
 | |
|     k->exit = virtio_ccw_scsi_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_scsi_properties;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_scsi = {
 | |
|     .name          = "virtio-scsi-ccw",
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtioCcwDevice),
 | |
|     .class_init    = virtio_ccw_scsi_class_init,
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_rng_initfn(Object *obj)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(obj);
 | |
| 
 | |
|     object_property_add_link(obj, "rng", TYPE_RNG_BACKEND,
 | |
|                              (Object **)&dev->rng.rng, NULL);
 | |
| }
 | |
| 
 | |
| static Property virtio_ccw_rng_properties[] = {
 | |
|     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 | |
|     DEFINE_VIRTIO_COMMON_FEATURES(VirtioCcwDevice, host_features[0]),
 | |
|     DEFINE_PROP_UINT64("max-bytes", VirtioCcwDevice, rng.max_bytes, INT64_MAX),
 | |
|     DEFINE_PROP_UINT32("period", VirtioCcwDevice, rng.period_ms, 1 << 16),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_rng_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->init = virtio_ccw_rng_init;
 | |
|     k->exit = virtio_ccw_rng_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_rng_properties;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_rng = {
 | |
|     .name          = "virtio-rng-ccw",
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtioCcwDevice),
 | |
|     .instance_init = virtio_ccw_rng_initfn,
 | |
|     .class_init    = virtio_ccw_rng_class_init,
 | |
| };
 | |
| 
 | |
| static int virtio_ccw_busdev_init(DeviceState *dev)
 | |
| {
 | |
|     VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev;
 | |
|     VirtIOCCWDeviceClass *_info = VIRTIO_CCW_DEVICE_GET_CLASS(dev);
 | |
| 
 | |
|     virtio_ccw_bus_new(&_dev->bus, _dev);
 | |
| 
 | |
|     return _info->init(_dev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_busdev_exit(DeviceState *dev)
 | |
| {
 | |
|     VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev;
 | |
|     VirtIOCCWDeviceClass *_info = VIRTIO_CCW_DEVICE_GET_CLASS(dev);
 | |
| 
 | |
|     return _info->exit(_dev);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_busdev_unplug(DeviceState *dev)
 | |
| {
 | |
|     VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev;
 | |
|     SubchDev *sch = _dev->sch;
 | |
| 
 | |
|     /*
 | |
|      * We should arrive here only for device_del, since we don't support
 | |
|      * direct hot(un)plug of channels, but only through virtio.
 | |
|      */
 | |
|     assert(sch != NULL);
 | |
|     /* Subchannel is now disabled and no longer valid. */
 | |
|     sch->curr_status.pmcw.flags &= ~(PMCW_FLAGS_MASK_ENA |
 | |
|                                      PMCW_FLAGS_MASK_DNV);
 | |
| 
 | |
|     css_generate_sch_crws(sch->cssid, sch->ssid, sch->schid, 1, 0);
 | |
| 
 | |
|     qdev_free(dev);
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_device_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
| 
 | |
|     dc->init = virtio_ccw_busdev_init;
 | |
|     dc->exit = virtio_ccw_busdev_exit;
 | |
|     dc->unplug = virtio_ccw_busdev_unplug;
 | |
|     dc->bus_type = TYPE_VIRTUAL_CSS_BUS;
 | |
| 
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_device_info = {
 | |
|     .name = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .parent = TYPE_DEVICE,
 | |
|     .instance_size = sizeof(VirtioCcwDevice),
 | |
|     .class_init = virtio_ccw_device_class_init,
 | |
|     .class_size = sizeof(VirtIOCCWDeviceClass),
 | |
|     .abstract = true,
 | |
| };
 | |
| 
 | |
| /***************** Virtual-css Bus Bridge Device ********************/
 | |
| /* Only required to have the virtio bus as child in the system bus */
 | |
| 
 | |
| static int virtual_css_bridge_init(SysBusDevice *dev)
 | |
| {
 | |
|     /* nothing */
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static void virtual_css_bridge_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->init = virtual_css_bridge_init;
 | |
|     dc->no_user = 1;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtual_css_bridge_info = {
 | |
|     .name          = "virtual-css-bridge",
 | |
|     .parent        = TYPE_SYS_BUS_DEVICE,
 | |
|     .instance_size = sizeof(SysBusDevice),
 | |
|     .class_init    = virtual_css_bridge_class_init,
 | |
| };
 | |
| 
 | |
| /* virtio-ccw-bus */
 | |
| 
 | |
| void virtio_ccw_bus_new(VirtioBusState *bus, VirtioCcwDevice *dev)
 | |
| {
 | |
|     DeviceState *qdev = DEVICE(dev);
 | |
|     BusState *qbus;
 | |
| 
 | |
|     qbus_create_inplace((BusState *)bus, TYPE_VIRTIO_CCW_BUS, qdev, NULL);
 | |
|     qbus = BUS(bus);
 | |
|     qbus->allow_hotplug = 1;
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_bus_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     VirtioBusClass *k = VIRTIO_BUS_CLASS(klass);
 | |
|     BusClass *bus_class = BUS_CLASS(klass);
 | |
| 
 | |
|     bus_class->max_dev = 1;
 | |
|     k->notify = virtio_ccw_notify;
 | |
|     k->get_features = virtio_ccw_get_features;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_bus_info = {
 | |
|     .name = TYPE_VIRTIO_CCW_BUS,
 | |
|     .parent = TYPE_VIRTIO_BUS,
 | |
|     .instance_size = sizeof(VirtioCcwBusState),
 | |
|     .class_init = virtio_ccw_bus_class_init,
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_register(void)
 | |
| {
 | |
|     type_register_static(&virtio_ccw_bus_info);
 | |
|     type_register_static(&virtual_css_bus_info);
 | |
|     type_register_static(&virtio_ccw_device_info);
 | |
|     type_register_static(&virtio_ccw_serial);
 | |
|     type_register_static(&virtio_ccw_blk);
 | |
|     type_register_static(&virtio_ccw_net);
 | |
|     type_register_static(&virtio_ccw_balloon);
 | |
|     type_register_static(&virtio_ccw_scsi);
 | |
|     type_register_static(&virtio_ccw_rng);
 | |
|     type_register_static(&virtual_css_bridge_info);
 | |
| }
 | |
| 
 | |
| type_init(virtio_ccw_register)
 |