1821 lines
		
	
	
		
			59 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			1821 lines
		
	
	
		
			59 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * virtio ccw target implementation
 | |
|  *
 | |
|  * Copyright 2012,2015 IBM Corp.
 | |
|  * Author(s): Cornelia Huck <cornelia.huck@de.ibm.com>
 | |
|  *            Pierre Morel <pmorel@linux.vnet.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 "qemu/osdep.h"
 | |
| #include "qapi/error.h"
 | |
| #include "hw/hw.h"
 | |
| #include "sysemu/block-backend.h"
 | |
| #include "sysemu/blockdev.h"
 | |
| #include "sysemu/sysemu.h"
 | |
| #include "sysemu/kvm.h"
 | |
| #include "net/net.h"
 | |
| #include "hw/virtio/virtio.h"
 | |
| #include "hw/virtio/virtio-serial.h"
 | |
| #include "hw/virtio/virtio-net.h"
 | |
| #include "hw/sysbus.h"
 | |
| #include "qemu/bitops.h"
 | |
| #include "qemu/error-report.h"
 | |
| #include "hw/virtio/virtio-access.h"
 | |
| #include "hw/virtio/virtio-bus.h"
 | |
| #include "hw/s390x/adapter.h"
 | |
| #include "hw/s390x/s390_flic.h"
 | |
| 
 | |
| #include "hw/s390x/ioinst.h"
 | |
| #include "hw/s390x/css.h"
 | |
| #include "virtio-ccw.h"
 | |
| #include "trace.h"
 | |
| #include "hw/s390x/css-bridge.h"
 | |
| #include "hw/s390x/s390-virtio-ccw.h"
 | |
| 
 | |
| #define NR_CLASSIC_INDICATOR_BITS 64
 | |
| 
 | |
| static int virtio_ccw_dev_post_load(void *opaque, int version_id)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(opaque);
 | |
|     CcwDevice *ccw_dev = CCW_DEVICE(dev);
 | |
|     CCWDeviceClass *ck = CCW_DEVICE_GET_CLASS(ccw_dev);
 | |
| 
 | |
|     ccw_dev->sch->driver_data = dev;
 | |
|     if (ccw_dev->sch->thinint_active) {
 | |
|         dev->routes.adapter.adapter_id = css_get_adapter_id(
 | |
|                                          CSS_IO_ADAPTER_VIRTIO,
 | |
|                                          dev->thinint_isc);
 | |
|     }
 | |
|     /* Re-fill subch_id after loading the subchannel states.*/
 | |
|     if (ck->refill_ids) {
 | |
|         ck->refill_ids(ccw_dev);
 | |
|     }
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| typedef struct VirtioCcwDeviceTmp {
 | |
|     VirtioCcwDevice *parent;
 | |
|     uint16_t config_vector;
 | |
| } VirtioCcwDeviceTmp;
 | |
| 
 | |
| static void virtio_ccw_dev_tmp_pre_save(void *opaque)
 | |
| {
 | |
|     VirtioCcwDeviceTmp *tmp = opaque;
 | |
|     VirtioCcwDevice *dev = tmp->parent;
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
| 
 | |
|     tmp->config_vector = vdev->config_vector;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_dev_tmp_post_load(void *opaque, int version_id)
 | |
| {
 | |
|     VirtioCcwDeviceTmp *tmp = opaque;
 | |
|     VirtioCcwDevice *dev = tmp->parent;
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
| 
 | |
|     vdev->config_vector = tmp->config_vector;
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| const VMStateDescription vmstate_virtio_ccw_dev_tmp = {
 | |
|     .name = "s390_virtio_ccw_dev_tmp",
 | |
|     .pre_save = virtio_ccw_dev_tmp_pre_save,
 | |
|     .post_load = virtio_ccw_dev_tmp_post_load,
 | |
|     .fields = (VMStateField[]) {
 | |
|         VMSTATE_UINT16(config_vector, VirtioCcwDeviceTmp),
 | |
|         VMSTATE_END_OF_LIST()
 | |
|     }
 | |
| };
 | |
| 
 | |
| const VMStateDescription vmstate_virtio_ccw_dev = {
 | |
|     .name = "s390_virtio_ccw_dev",
 | |
|     .version_id = 1,
 | |
|     .minimum_version_id = 1,
 | |
|     .post_load = virtio_ccw_dev_post_load,
 | |
|     .fields = (VMStateField[]) {
 | |
|         VMSTATE_CCW_DEVICE(parent_obj, VirtioCcwDevice),
 | |
|         VMSTATE_PTR_TO_IND_ADDR(indicators, VirtioCcwDevice),
 | |
|         VMSTATE_PTR_TO_IND_ADDR(indicators2, VirtioCcwDevice),
 | |
|         VMSTATE_PTR_TO_IND_ADDR(summary_indicator, VirtioCcwDevice),
 | |
|         /*
 | |
|          * Ugly hack because VirtIODevice does not migrate itself.
 | |
|          * This also makes legacy via vmstate_save_state possible.
 | |
|          */
 | |
|         VMSTATE_WITH_TMP(VirtioCcwDevice, VirtioCcwDeviceTmp,
 | |
|                          vmstate_virtio_ccw_dev_tmp),
 | |
|         VMSTATE_STRUCT(routes, VirtioCcwDevice, 1, vmstate_adapter_routes,
 | |
|                        AdapterRoutes),
 | |
|         VMSTATE_UINT8(thinint_isc, VirtioCcwDevice),
 | |
|         VMSTATE_INT32(revision, VirtioCcwDevice),
 | |
|         VMSTATE_END_OF_LIST()
 | |
|     }
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_bus_new(VirtioBusState *bus, size_t bus_size,
 | |
|                                VirtioCcwDevice *dev);
 | |
| 
 | |
| VirtIODevice *virtio_ccw_get_vdev(SubchDev *sch)
 | |
| {
 | |
|     VirtIODevice *vdev = NULL;
 | |
|     VirtioCcwDevice *dev = sch->driver_data;
 | |
| 
 | |
|     if (dev) {
 | |
|         vdev = virtio_bus_get_device(&dev->bus);
 | |
|     }
 | |
|     return vdev;
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_start_ioeventfd(VirtioCcwDevice *dev)
 | |
| {
 | |
|     virtio_bus_start_ioeventfd(&dev->bus);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_stop_ioeventfd(VirtioCcwDevice *dev)
 | |
| {
 | |
|     virtio_bus_stop_ioeventfd(&dev->bus);
 | |
| }
 | |
| 
 | |
| static bool virtio_ccw_ioeventfd_enabled(DeviceState *d)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
| 
 | |
|     return (dev->flags & VIRTIO_CCW_FLAG_USE_IOEVENTFD) != 0;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_ioeventfd_assign(DeviceState *d, EventNotifier *notifier,
 | |
|                                        int n, bool assign)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
|     CcwDevice *ccw_dev = CCW_DEVICE(dev);
 | |
|     SubchDev *sch = ccw_dev->sch;
 | |
|     uint32_t sch_id = (css_build_subchannel_id(sch) << 16) | sch->schid;
 | |
| 
 | |
|     return s390_assign_subch_ioeventfd(notifier, sch_id, n, assign);
 | |
| }
 | |
| 
 | |
| /* Communication blocks used by several channel commands. */
 | |
| typedef struct VqInfoBlockLegacy {
 | |
|     uint64_t queue;
 | |
|     uint32_t align;
 | |
|     uint16_t index;
 | |
|     uint16_t num;
 | |
| } QEMU_PACKED VqInfoBlockLegacy;
 | |
| 
 | |
| typedef struct VqInfoBlock {
 | |
|     uint64_t desc;
 | |
|     uint32_t res0;
 | |
|     uint16_t index;
 | |
|     uint16_t num;
 | |
|     uint64_t avail;
 | |
|     uint64_t used;
 | |
| } 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;
 | |
| 
 | |
| typedef struct VirtioThinintInfo {
 | |
|     hwaddr summary_indicator;
 | |
|     hwaddr device_indicator;
 | |
|     uint64_t ind_bit;
 | |
|     uint8_t isc;
 | |
| } QEMU_PACKED VirtioThinintInfo;
 | |
| 
 | |
| typedef struct VirtioRevInfo {
 | |
|     uint16_t revision;
 | |
|     uint16_t length;
 | |
|     uint8_t data[0];
 | |
| } QEMU_PACKED VirtioRevInfo;
 | |
| 
 | |
| /* Specify where the virtqueues for the subchannel are in guest memory. */
 | |
| static int virtio_ccw_set_vqs(SubchDev *sch, VqInfoBlock *info,
 | |
|                               VqInfoBlockLegacy *linfo)
 | |
| {
 | |
|     VirtIODevice *vdev = virtio_ccw_get_vdev(sch);
 | |
|     uint16_t index = info ? info->index : linfo->index;
 | |
|     uint16_t num = info ? info->num : linfo->num;
 | |
|     uint64_t desc = info ? info->desc : linfo->queue;
 | |
| 
 | |
|     if (index >= VIRTIO_QUEUE_MAX) {
 | |
|         return -EINVAL;
 | |
|     }
 | |
| 
 | |
|     /* Current code in virtio.c relies on 4K alignment. */
 | |
|     if (linfo && desc && (linfo->align != 4096)) {
 | |
|         return -EINVAL;
 | |
|     }
 | |
| 
 | |
|     if (!vdev) {
 | |
|         return -EINVAL;
 | |
|     }
 | |
| 
 | |
|     if (info) {
 | |
|         virtio_queue_set_rings(vdev, index, desc, info->avail, info->used);
 | |
|     } else {
 | |
|         virtio_queue_set_addr(vdev, index, desc);
 | |
|     }
 | |
|     if (!desc) {
 | |
|         virtio_queue_set_vector(vdev, index, VIRTIO_NO_VECTOR);
 | |
|     } else {
 | |
|         if (info) {
 | |
|             /* virtio-1 allows changing the ring size. */
 | |
|             if (virtio_queue_get_max_num(vdev, index) < num) {
 | |
|                 /* Fail if we exceed the maximum number. */
 | |
|                 return -EINVAL;
 | |
|             }
 | |
|             virtio_queue_set_num(vdev, index, num);
 | |
|         } else if (virtio_queue_get_num(vdev, index) > num) {
 | |
|             /* Fail if we don't have a big enough queue. */
 | |
|             return -EINVAL;
 | |
|         }
 | |
|         /* We ignore possible increased num for legacy for compatibility. */
 | |
|         virtio_queue_set_vector(vdev, index, index);
 | |
|     }
 | |
|     /* tell notify handler in case of config change */
 | |
|     vdev->config_vector = VIRTIO_QUEUE_MAX;
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_reset_virtio(VirtioCcwDevice *dev, VirtIODevice *vdev)
 | |
| {
 | |
|     CcwDevice *ccw_dev = CCW_DEVICE(dev);
 | |
| 
 | |
|     virtio_ccw_stop_ioeventfd(dev);
 | |
|     virtio_reset(vdev);
 | |
|     if (dev->indicators) {
 | |
|         release_indicator(&dev->routes.adapter, dev->indicators);
 | |
|         dev->indicators = NULL;
 | |
|     }
 | |
|     if (dev->indicators2) {
 | |
|         release_indicator(&dev->routes.adapter, dev->indicators2);
 | |
|         dev->indicators2 = NULL;
 | |
|     }
 | |
|     if (dev->summary_indicator) {
 | |
|         release_indicator(&dev->routes.adapter, dev->summary_indicator);
 | |
|         dev->summary_indicator = NULL;
 | |
|     }
 | |
|     ccw_dev->sch->thinint_active = false;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_handle_set_vq(SubchDev *sch, CCW1 ccw, bool check_len,
 | |
|                                     bool is_legacy)
 | |
| {
 | |
|     int ret;
 | |
|     VqInfoBlock info;
 | |
|     VqInfoBlockLegacy linfo;
 | |
|     size_t info_len = is_legacy ? sizeof(linfo) : sizeof(info);
 | |
| 
 | |
|     if (check_len) {
 | |
|         if (ccw.count != info_len) {
 | |
|             return -EINVAL;
 | |
|         }
 | |
|     } else if (ccw.count < info_len) {
 | |
|         /* Can't execute command. */
 | |
|         return -EINVAL;
 | |
|     }
 | |
|     if (!ccw.cda) {
 | |
|         return -EFAULT;
 | |
|     }
 | |
|     if (is_legacy) {
 | |
|         linfo.queue = address_space_ldq_be(&address_space_memory, ccw.cda,
 | |
|                                            MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|         linfo.align = address_space_ldl_be(&address_space_memory,
 | |
|                                            ccw.cda + sizeof(linfo.queue),
 | |
|                                            MEMTXATTRS_UNSPECIFIED,
 | |
|                                            NULL);
 | |
|         linfo.index = address_space_lduw_be(&address_space_memory,
 | |
|                                             ccw.cda + sizeof(linfo.queue)
 | |
|                                             + sizeof(linfo.align),
 | |
|                                             MEMTXATTRS_UNSPECIFIED,
 | |
|                                             NULL);
 | |
|         linfo.num = address_space_lduw_be(&address_space_memory,
 | |
|                                           ccw.cda + sizeof(linfo.queue)
 | |
|                                           + sizeof(linfo.align)
 | |
|                                           + sizeof(linfo.index),
 | |
|                                           MEMTXATTRS_UNSPECIFIED,
 | |
|                                           NULL);
 | |
|         ret = virtio_ccw_set_vqs(sch, NULL, &linfo);
 | |
|     } else {
 | |
|         info.desc = address_space_ldq_be(&address_space_memory, ccw.cda,
 | |
|                                            MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|         info.index = address_space_lduw_be(&address_space_memory,
 | |
|                                            ccw.cda + sizeof(info.desc)
 | |
|                                            + sizeof(info.res0),
 | |
|                                            MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|         info.num = address_space_lduw_be(&address_space_memory,
 | |
|                                          ccw.cda + sizeof(info.desc)
 | |
|                                          + sizeof(info.res0)
 | |
|                                          + sizeof(info.index),
 | |
|                                          MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|         info.avail = address_space_ldq_be(&address_space_memory,
 | |
|                                           ccw.cda + sizeof(info.desc)
 | |
|                                           + sizeof(info.res0)
 | |
|                                           + sizeof(info.index)
 | |
|                                           + sizeof(info.num),
 | |
|                                           MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|         info.used = address_space_ldq_be(&address_space_memory,
 | |
|                                          ccw.cda + sizeof(info.desc)
 | |
|                                          + sizeof(info.res0)
 | |
|                                          + sizeof(info.index)
 | |
|                                          + sizeof(info.num)
 | |
|                                          + sizeof(info.avail),
 | |
|                                          MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|         ret = virtio_ccw_set_vqs(sch, &info, NULL);
 | |
|     }
 | |
|     sch->curr_status.scsw.count = 0;
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_cb(SubchDev *sch, CCW1 ccw)
 | |
| {
 | |
|     int ret;
 | |
|     VirtioRevInfo revinfo;
 | |
|     uint8_t status;
 | |
|     VirtioFeatDesc features;
 | |
|     void *config;
 | |
|     hwaddr indicators;
 | |
|     VqConfigBlock vq_config;
 | |
|     VirtioCcwDevice *dev = sch->driver_data;
 | |
|     VirtIODevice *vdev = virtio_ccw_get_vdev(sch);
 | |
|     bool check_len;
 | |
|     int len;
 | |
|     hwaddr hw_len;
 | |
|     VirtioThinintInfo *thinint;
 | |
| 
 | |
|     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));
 | |
| 
 | |
|     if (dev->force_revision_1 && dev->revision < 0 &&
 | |
|         ccw.cmd_code != CCW_CMD_SET_VIRTIO_REV) {
 | |
|         /*
 | |
|          * virtio-1 drivers must start with negotiating to a revision >= 1,
 | |
|          * so post a command reject for all other commands
 | |
|          */
 | |
|         return -ENOSYS;
 | |
|     }
 | |
| 
 | |
|     /* Look at the command. */
 | |
|     switch (ccw.cmd_code) {
 | |
|     case CCW_CMD_SET_VQ:
 | |
|         ret = virtio_ccw_handle_set_vq(sch, ccw, check_len, dev->revision < 1);
 | |
|         break;
 | |
|     case CCW_CMD_VDEV_RESET:
 | |
|         virtio_ccw_reset_virtio(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 {
 | |
|             VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
 | |
| 
 | |
|             features.index = address_space_ldub(&address_space_memory,
 | |
|                                                 ccw.cda
 | |
|                                                 + sizeof(features.features),
 | |
|                                                 MEMTXATTRS_UNSPECIFIED,
 | |
|                                                 NULL);
 | |
|             if (features.index == 0) {
 | |
|                 if (dev->revision >= 1) {
 | |
|                     /* Don't offer legacy features for modern devices. */
 | |
|                     features.features = (uint32_t)
 | |
|                         (vdev->host_features & ~vdc->legacy_features);
 | |
|                 } else {
 | |
|                     features.features = (uint32_t)vdev->host_features;
 | |
|                 }
 | |
|             } else if ((features.index == 1) && (dev->revision >= 1)) {
 | |
|                 /*
 | |
|                  * Only offer feature bits beyond 31 if the guest has
 | |
|                  * negotiated at least revision 1.
 | |
|                  */
 | |
|                 features.features = (uint32_t)(vdev->host_features >> 32);
 | |
|             } else {
 | |
|                 /* Return zeroes if the guest supports more feature bits. */
 | |
|                 features.features = 0;
 | |
|             }
 | |
|             address_space_stl_le(&address_space_memory, ccw.cda,
 | |
|                                  features.features, MEMTXATTRS_UNSPECIFIED,
 | |
|                                  NULL);
 | |
|             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 = address_space_ldub(&address_space_memory,
 | |
|                                                 ccw.cda
 | |
|                                                 + sizeof(features.features),
 | |
|                                                 MEMTXATTRS_UNSPECIFIED,
 | |
|                                                 NULL);
 | |
|             features.features = address_space_ldl_le(&address_space_memory,
 | |
|                                                      ccw.cda,
 | |
|                                                      MEMTXATTRS_UNSPECIFIED,
 | |
|                                                      NULL);
 | |
|             if (features.index == 0) {
 | |
|                 virtio_set_features(vdev,
 | |
|                                     (vdev->guest_features & 0xffffffff00000000ULL) |
 | |
|                                     features.features);
 | |
|             } else if ((features.index == 1) && (dev->revision >= 1)) {
 | |
|                 /*
 | |
|                  * If the guest did not negotiate at least revision 1,
 | |
|                  * we did not offer it any feature bits beyond 31. Such a
 | |
|                  * guest passing us any bit here is therefore buggy.
 | |
|                  */
 | |
|                 virtio_set_features(vdev,
 | |
|                                     (vdev->guest_features & 0x00000000ffffffffULL) |
 | |
|                                     ((uint64_t)features.features << 32));
 | |
|             } 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 > vdev->config_len) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         }
 | |
|         len = MIN(ccw.count, vdev->config_len);
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             virtio_bus_get_vdev_config(&dev->bus, vdev->config);
 | |
|             /* XXX config space endianness */
 | |
|             cpu_physical_memory_write(ccw.cda, 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 > vdev->config_len) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         }
 | |
|         len = MIN(ccw.count, 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(vdev->config, config, len);
 | |
|                 cpu_physical_memory_unmap(config, hw_len, 0, hw_len);
 | |
|                 virtio_bus_set_vdev_config(&dev->bus, vdev->config);
 | |
|                 sch->curr_status.scsw.count = ccw.count - len;
 | |
|                 ret = 0;
 | |
|             }
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_READ_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 {
 | |
|             address_space_stb(&address_space_memory, ccw.cda, vdev->status,
 | |
|                                         MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|             sch->curr_status.scsw.count = ccw.count - sizeof(vdev->status);;
 | |
|             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 = address_space_ldub(&address_space_memory, ccw.cda,
 | |
|                                         MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|             if (!(status & VIRTIO_CONFIG_S_DRIVER_OK)) {
 | |
|                 virtio_ccw_stop_ioeventfd(dev);
 | |
|             }
 | |
|             if (virtio_set_status(vdev, status) == 0) {
 | |
|                 if (vdev->status == 0) {
 | |
|                     virtio_ccw_reset_virtio(dev, vdev);
 | |
|                 }
 | |
|                 if (status & VIRTIO_CONFIG_S_DRIVER_OK) {
 | |
|                     virtio_ccw_start_ioeventfd(dev);
 | |
|                 }
 | |
|                 sch->curr_status.scsw.count = ccw.count - sizeof(status);
 | |
|                 ret = 0;
 | |
|             } else {
 | |
|                 /* Trigger a command reject. */
 | |
|                 ret = -ENOSYS;
 | |
|             }
 | |
|         }
 | |
|         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;
 | |
|         }
 | |
|         if (sch->thinint_active) {
 | |
|             /* Trigger a command reject. */
 | |
|             ret = -ENOSYS;
 | |
|             break;
 | |
|         }
 | |
|         if (virtio_get_num_queues(vdev) > NR_CLASSIC_INDICATOR_BITS) {
 | |
|             /* More queues than indicator bits --> trigger a reject */
 | |
|             ret = -ENOSYS;
 | |
|             break;
 | |
|         }
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             indicators = address_space_ldq_be(&address_space_memory, ccw.cda,
 | |
|                                               MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|             dev->indicators = get_indicator(indicators, sizeof(uint64_t));
 | |
|             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;
 | |
|         }
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else {
 | |
|             indicators = address_space_ldq_be(&address_space_memory, ccw.cda,
 | |
|                                               MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|             dev->indicators2 = get_indicator(indicators, sizeof(uint64_t));
 | |
|             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 = address_space_lduw_be(&address_space_memory,
 | |
|                                                     ccw.cda,
 | |
|                                                     MEMTXATTRS_UNSPECIFIED,
 | |
|                                                     NULL);
 | |
|             if (vq_config.index >= VIRTIO_QUEUE_MAX) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|             vq_config.num_max = virtio_queue_get_num(vdev,
 | |
|                                                      vq_config.index);
 | |
|             address_space_stw_be(&address_space_memory,
 | |
|                                  ccw.cda + sizeof(vq_config.index),
 | |
|                                  vq_config.num_max,
 | |
|                                  MEMTXATTRS_UNSPECIFIED,
 | |
|                                  NULL);
 | |
|             sch->curr_status.scsw.count = ccw.count - sizeof(vq_config);
 | |
|             ret = 0;
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_SET_IND_ADAPTER:
 | |
|         if (check_len) {
 | |
|             if (ccw.count != sizeof(*thinint)) {
 | |
|                 ret = -EINVAL;
 | |
|                 break;
 | |
|             }
 | |
|         } else if (ccw.count < sizeof(*thinint)) {
 | |
|             /* Can't execute command. */
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         len = sizeof(*thinint);
 | |
|         hw_len = len;
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|         } else if (dev->indicators && !sch->thinint_active) {
 | |
|             /* Trigger a command reject. */
 | |
|             ret = -ENOSYS;
 | |
|         } else {
 | |
|             thinint = cpu_physical_memory_map(ccw.cda, &hw_len, 0);
 | |
|             if (!thinint) {
 | |
|                 ret = -EFAULT;
 | |
|             } else {
 | |
|                 uint64_t ind_bit = ldq_be_p(&thinint->ind_bit);
 | |
| 
 | |
|                 len = hw_len;
 | |
|                 dev->summary_indicator =
 | |
|                     get_indicator(ldq_be_p(&thinint->summary_indicator),
 | |
|                                   sizeof(uint8_t));
 | |
|                 dev->indicators =
 | |
|                     get_indicator(ldq_be_p(&thinint->device_indicator),
 | |
|                                   ind_bit / 8 + 1);
 | |
|                 dev->thinint_isc = thinint->isc;
 | |
|                 dev->routes.adapter.ind_offset = ind_bit;
 | |
|                 dev->routes.adapter.summary_offset = 7;
 | |
|                 cpu_physical_memory_unmap(thinint, hw_len, 0, hw_len);
 | |
|                 dev->routes.adapter.adapter_id = css_get_adapter_id(
 | |
|                                                  CSS_IO_ADAPTER_VIRTIO,
 | |
|                                                  dev->thinint_isc);
 | |
|                 sch->thinint_active = ((dev->indicators != NULL) &&
 | |
|                                        (dev->summary_indicator != NULL));
 | |
|                 sch->curr_status.scsw.count = ccw.count - len;
 | |
|                 ret = 0;
 | |
|             }
 | |
|         }
 | |
|         break;
 | |
|     case CCW_CMD_SET_VIRTIO_REV:
 | |
|         len = sizeof(revinfo);
 | |
|         if (ccw.count < len) {
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         if (!ccw.cda) {
 | |
|             ret = -EFAULT;
 | |
|             break;
 | |
|         }
 | |
|         revinfo.revision =
 | |
|             address_space_lduw_be(&address_space_memory, ccw.cda,
 | |
|                                   MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|         revinfo.length =
 | |
|             address_space_lduw_be(&address_space_memory,
 | |
|                                   ccw.cda + sizeof(revinfo.revision),
 | |
|                                   MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|         if (ccw.count < len + revinfo.length ||
 | |
|             (check_len && ccw.count > len + revinfo.length)) {
 | |
|             ret = -EINVAL;
 | |
|             break;
 | |
|         }
 | |
|         /*
 | |
|          * Once we start to support revisions with additional data, we'll
 | |
|          * need to fetch it here. Nothing to do for now, though.
 | |
|          */
 | |
|         if (dev->revision >= 0 ||
 | |
|             revinfo.revision > virtio_ccw_rev_max(dev) ||
 | |
|             (dev->force_revision_1 && !revinfo.revision)) {
 | |
|             ret = -ENOSYS;
 | |
|             break;
 | |
|         }
 | |
|         ret = 0;
 | |
|         dev->revision = revinfo.revision;
 | |
|         break;
 | |
|     default:
 | |
|         ret = -ENOSYS;
 | |
|         break;
 | |
|     }
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static void virtio_sch_disable_cb(SubchDev *sch)
 | |
| {
 | |
|     VirtioCcwDevice *dev = sch->driver_data;
 | |
| 
 | |
|     dev->revision = -1;
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_device_realize(VirtioCcwDevice *dev, Error **errp)
 | |
| {
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_GET_CLASS(dev);
 | |
|     CcwDevice *ccw_dev = CCW_DEVICE(dev);
 | |
|     CCWDeviceClass *ck = CCW_DEVICE_GET_CLASS(ccw_dev);
 | |
|     DeviceState *parent = DEVICE(ccw_dev);
 | |
|     BusState *qbus = qdev_get_parent_bus(parent);
 | |
|     VirtualCssBus *cbus = VIRTUAL_CSS_BUS(qbus);
 | |
|     SubchDev *sch;
 | |
|     Error *err = NULL;
 | |
| 
 | |
|     sch = css_create_sch(ccw_dev->devno, true, cbus->squash_mcss, errp);
 | |
|     if (!sch) {
 | |
|         return;
 | |
|     }
 | |
|     if (!virtio_ccw_rev_max(dev) && dev->force_revision_1) {
 | |
|         error_setg(&err, "Invalid value of property max_rev "
 | |
|                    "(is %d expected >= 1)", virtio_ccw_rev_max(dev));
 | |
|         goto out_err;
 | |
|     }
 | |
| 
 | |
|     sch->driver_data = dev;
 | |
|     sch->ccw_cb = virtio_ccw_cb;
 | |
|     sch->disable_cb = virtio_sch_disable_cb;
 | |
|     sch->id.reserved = 0xff;
 | |
|     sch->id.cu_type = VIRTIO_CCW_CU_TYPE;
 | |
|     sch->do_subchannel_work = do_subchannel_work_virtual;
 | |
|     ccw_dev->sch = sch;
 | |
|     dev->indicators = NULL;
 | |
|     dev->revision = -1;
 | |
|     css_sch_build_virtual_schib(sch, 0, VIRTIO_CCW_CHPID_TYPE);
 | |
| 
 | |
|     trace_virtio_ccw_new_device(
 | |
|         sch->cssid, sch->ssid, sch->schid, sch->devno,
 | |
|         ccw_dev->devno.valid ? "user-configured" : "auto-configured");
 | |
| 
 | |
|     if (kvm_enabled() && !kvm_eventfds_enabled()) {
 | |
|         dev->flags &= ~VIRTIO_CCW_FLAG_USE_IOEVENTFD;
 | |
|     }
 | |
| 
 | |
|     if (k->realize) {
 | |
|         k->realize(dev, &err);
 | |
|         if (err) {
 | |
|             goto out_err;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     ck->realize(ccw_dev, &err);
 | |
|     if (err) {
 | |
|         goto out_err;
 | |
|     }
 | |
| 
 | |
|     return;
 | |
| 
 | |
| out_err:
 | |
|     error_propagate(errp, err);
 | |
|     css_subch_assign(sch->cssid, sch->ssid, sch->schid, sch->devno, NULL);
 | |
|     ccw_dev->sch = NULL;
 | |
|     g_free(sch);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_exit(VirtioCcwDevice *dev)
 | |
| {
 | |
|     CcwDevice *ccw_dev = CCW_DEVICE(dev);
 | |
|     SubchDev *sch = ccw_dev->sch;
 | |
| 
 | |
|     if (sch) {
 | |
|         css_subch_assign(sch->cssid, sch->ssid, sch->schid, sch->devno, NULL);
 | |
|         g_free(sch);
 | |
|     }
 | |
|     if (dev->indicators) {
 | |
|         release_indicator(&dev->routes.adapter, dev->indicators);
 | |
|         dev->indicators = NULL;
 | |
|     }
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_net_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     DeviceState *qdev = DEVICE(ccw_dev);
 | |
|     VirtIONetCcw *dev = VIRTIO_NET_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
| 
 | |
|     virtio_net_set_netclient_name(&dev->vdev, qdev->id,
 | |
|                                   object_get_typename(OBJECT(qdev)));
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", errp);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_net_instance_init(Object *obj)
 | |
| {
 | |
|     VirtIONetCcw *dev = VIRTIO_NET_CCW(obj);
 | |
| 
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VIRTIO_NET);
 | |
|     object_property_add_alias(obj, "bootindex", OBJECT(&dev->vdev),
 | |
|                               "bootindex", &error_abort);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_blk_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
| 
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", errp);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_blk_instance_init(Object *obj)
 | |
| {
 | |
|     VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(obj);
 | |
| 
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VIRTIO_BLK);
 | |
|     object_property_add_alias(obj, "bootindex", OBJECT(&dev->vdev),
 | |
|                               "bootindex", &error_abort);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_serial_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     VirtioSerialCcw *dev = VIRTIO_SERIAL_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
|     DeviceState *proxy = DEVICE(ccw_dev);
 | |
|     char *bus_name;
 | |
| 
 | |
|     /*
 | |
|      * For command line compatibility, this sets the virtio-serial-device bus
 | |
|      * name as before.
 | |
|      */
 | |
|     if (proxy->id) {
 | |
|         bus_name = g_strdup_printf("%s.0", proxy->id);
 | |
|         virtio_device_set_child_bus_name(VIRTIO_DEVICE(vdev), bus_name);
 | |
|         g_free(bus_name);
 | |
|     }
 | |
| 
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", errp);
 | |
| }
 | |
| 
 | |
| 
 | |
| static void virtio_ccw_serial_instance_init(Object *obj)
 | |
| {
 | |
|     VirtioSerialCcw *dev = VIRTIO_SERIAL_CCW(obj);
 | |
| 
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VIRTIO_SERIAL);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_balloon_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     VirtIOBalloonCcw *dev = VIRTIO_BALLOON_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
| 
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", errp);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_balloon_instance_init(Object *obj)
 | |
| {
 | |
|     VirtIOBalloonCcw *dev = VIRTIO_BALLOON_CCW(obj);
 | |
| 
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VIRTIO_BALLOON);
 | |
|     object_property_add_alias(obj, "guest-stats", OBJECT(&dev->vdev),
 | |
|                               "guest-stats", &error_abort);
 | |
|     object_property_add_alias(obj, "guest-stats-polling-interval",
 | |
|                               OBJECT(&dev->vdev),
 | |
|                               "guest-stats-polling-interval", &error_abort);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_scsi_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     VirtIOSCSICcw *dev = VIRTIO_SCSI_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
|     DeviceState *qdev = DEVICE(ccw_dev);
 | |
|     char *bus_name;
 | |
| 
 | |
|     /*
 | |
|      * For command line compatibility, this sets the virtio-scsi-device bus
 | |
|      * name as before.
 | |
|      */
 | |
|     if (qdev->id) {
 | |
|         bus_name = g_strdup_printf("%s.0", qdev->id);
 | |
|         virtio_device_set_child_bus_name(VIRTIO_DEVICE(vdev), bus_name);
 | |
|         g_free(bus_name);
 | |
|     }
 | |
| 
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", errp);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_scsi_instance_init(Object *obj)
 | |
| {
 | |
|     VirtIOSCSICcw *dev = VIRTIO_SCSI_CCW(obj);
 | |
| 
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VIRTIO_SCSI);
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_VHOST_SCSI
 | |
| static void vhost_ccw_scsi_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     VHostSCSICcw *dev = VHOST_SCSI_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
| 
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", errp);
 | |
| }
 | |
| 
 | |
| static void vhost_ccw_scsi_instance_init(Object *obj)
 | |
| {
 | |
|     VHostSCSICcw *dev = VHOST_SCSI_CCW(obj);
 | |
| 
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VHOST_SCSI);
 | |
| }
 | |
| #endif
 | |
| 
 | |
| static void virtio_ccw_rng_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     VirtIORNGCcw *dev = VIRTIO_RNG_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
|     Error *err = NULL;
 | |
| 
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", &err);
 | |
|     if (err) {
 | |
|         error_propagate(errp, err);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     object_property_set_link(OBJECT(dev),
 | |
|                              OBJECT(dev->vdev.conf.rng), "rng",
 | |
|                              NULL);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_crypto_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     VirtIOCryptoCcw *dev = VIRTIO_CRYPTO_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
|     Error *err = NULL;
 | |
| 
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", &err);
 | |
|     if (err) {
 | |
|         error_propagate(errp, err);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     object_property_set_link(OBJECT(vdev),
 | |
|                              OBJECT(dev->vdev.conf.cryptodev), "cryptodev",
 | |
|                              NULL);
 | |
| }
 | |
| 
 | |
| /* 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)
 | |
| {
 | |
|     CcwDevice *ccw_dev = to_ccw_dev_fast(d);
 | |
| 
 | |
|     return container_of(ccw_dev, VirtioCcwDevice, parent_obj);
 | |
| }
 | |
| 
 | |
| static uint8_t virtio_set_ind_atomic(SubchDev *sch, uint64_t ind_loc,
 | |
|                                      uint8_t to_be_set)
 | |
| {
 | |
|     uint8_t ind_old, ind_new;
 | |
|     hwaddr len = 1;
 | |
|     uint8_t *ind_addr;
 | |
| 
 | |
|     ind_addr = cpu_physical_memory_map(ind_loc, &len, 1);
 | |
|     if (!ind_addr) {
 | |
|         error_report("%s(%x.%x.%04x): unable to access indicator",
 | |
|                      __func__, sch->cssid, sch->ssid, sch->schid);
 | |
|         return -1;
 | |
|     }
 | |
|     do {
 | |
|         ind_old = *ind_addr;
 | |
|         ind_new = ind_old | to_be_set;
 | |
|     } while (atomic_cmpxchg(ind_addr, ind_old, ind_new) != ind_old);
 | |
|     trace_virtio_ccw_set_ind(ind_loc, ind_old, ind_new);
 | |
|     cpu_physical_memory_unmap(ind_addr, len, 1, len);
 | |
| 
 | |
|     return ind_old;
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_notify(DeviceState *d, uint16_t vector)
 | |
| {
 | |
|     VirtioCcwDevice *dev = to_virtio_ccw_dev_fast(d);
 | |
|     CcwDevice *ccw_dev = to_ccw_dev_fast(d);
 | |
|     SubchDev *sch = ccw_dev->sch;
 | |
|     uint64_t indicators;
 | |
| 
 | |
|     /* queue indicators + secondary indicators */
 | |
|     if (vector >= VIRTIO_QUEUE_MAX + 64) {
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     if (vector < VIRTIO_QUEUE_MAX) {
 | |
|         if (!dev->indicators) {
 | |
|             return;
 | |
|         }
 | |
|         if (sch->thinint_active) {
 | |
|             /*
 | |
|              * In the adapter interrupt case, indicators points to a
 | |
|              * memory area that may be (way) larger than 64 bit and
 | |
|              * ind_bit indicates the start of the indicators in a big
 | |
|              * endian notation.
 | |
|              */
 | |
|             uint64_t ind_bit = dev->routes.adapter.ind_offset;
 | |
| 
 | |
|             virtio_set_ind_atomic(sch, dev->indicators->addr +
 | |
|                                   (ind_bit + vector) / 8,
 | |
|                                   0x80 >> ((ind_bit + vector) % 8));
 | |
|             if (!virtio_set_ind_atomic(sch, dev->summary_indicator->addr,
 | |
|                                        0x01)) {
 | |
|                 css_adapter_interrupt(CSS_IO_ADAPTER_VIRTIO, dev->thinint_isc);
 | |
|             }
 | |
|         } else {
 | |
|             indicators = address_space_ldq(&address_space_memory,
 | |
|                                            dev->indicators->addr,
 | |
|                                            MEMTXATTRS_UNSPECIFIED,
 | |
|                                            NULL);
 | |
|             indicators |= 1ULL << vector;
 | |
|             address_space_stq(&address_space_memory, dev->indicators->addr,
 | |
|                               indicators, MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|             css_conditional_io_interrupt(sch);
 | |
|         }
 | |
|     } else {
 | |
|         if (!dev->indicators2) {
 | |
|             return;
 | |
|         }
 | |
|         vector = 0;
 | |
|         indicators = address_space_ldq(&address_space_memory,
 | |
|                                        dev->indicators2->addr,
 | |
|                                        MEMTXATTRS_UNSPECIFIED,
 | |
|                                        NULL);
 | |
|         indicators |= 1ULL << vector;
 | |
|         address_space_stq(&address_space_memory, dev->indicators2->addr,
 | |
|                           indicators, MEMTXATTRS_UNSPECIFIED, NULL);
 | |
|         css_conditional_io_interrupt(sch);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_reset(DeviceState *d)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
|     CcwDevice *ccw_dev = CCW_DEVICE(d);
 | |
| 
 | |
|     virtio_ccw_reset_virtio(dev, vdev);
 | |
|     css_reset_sch(ccw_dev->sch);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_vmstate_change(DeviceState *d, bool running)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
| 
 | |
|     if (running) {
 | |
|         virtio_ccw_start_ioeventfd(dev);
 | |
|     } else {
 | |
|         virtio_ccw_stop_ioeventfd(dev);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static bool virtio_ccw_query_guest_notifiers(DeviceState *d)
 | |
| {
 | |
|     CcwDevice *dev = CCW_DEVICE(d);
 | |
| 
 | |
|     return !!(dev->sch->curr_status.pmcw.flags & PMCW_FLAGS_MASK_ENA);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_get_mappings(VirtioCcwDevice *dev)
 | |
| {
 | |
|     int r;
 | |
|     CcwDevice *ccw_dev = CCW_DEVICE(dev);
 | |
| 
 | |
|     if (!ccw_dev->sch->thinint_active) {
 | |
|         return -EINVAL;
 | |
|     }
 | |
| 
 | |
|     r = map_indicator(&dev->routes.adapter, dev->summary_indicator);
 | |
|     if (r) {
 | |
|         return r;
 | |
|     }
 | |
|     r = map_indicator(&dev->routes.adapter, dev->indicators);
 | |
|     if (r) {
 | |
|         return r;
 | |
|     }
 | |
|     dev->routes.adapter.summary_addr = dev->summary_indicator->map;
 | |
|     dev->routes.adapter.ind_addr = dev->indicators->map;
 | |
| 
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_setup_irqroutes(VirtioCcwDevice *dev, int nvqs)
 | |
| {
 | |
|     int i;
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
|     int ret;
 | |
|     S390FLICState *fs = s390_get_flic();
 | |
|     S390FLICStateClass *fsc = S390_FLIC_COMMON_GET_CLASS(fs);
 | |
| 
 | |
|     ret = virtio_ccw_get_mappings(dev);
 | |
|     if (ret) {
 | |
|         return ret;
 | |
|     }
 | |
|     for (i = 0; i < nvqs; i++) {
 | |
|         if (!virtio_queue_get_num(vdev, i)) {
 | |
|             break;
 | |
|         }
 | |
|     }
 | |
|     dev->routes.num_routes = i;
 | |
|     return fsc->add_adapter_routes(fs, &dev->routes);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_release_irqroutes(VirtioCcwDevice *dev, int nvqs)
 | |
| {
 | |
|     S390FLICState *fs = s390_get_flic();
 | |
|     S390FLICStateClass *fsc = S390_FLIC_COMMON_GET_CLASS(fs);
 | |
| 
 | |
|     fsc->release_adapter_routes(fs, &dev->routes);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_add_irqfd(VirtioCcwDevice *dev, int n)
 | |
| {
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
|     VirtQueue *vq = virtio_get_queue(vdev, n);
 | |
|     EventNotifier *notifier = virtio_queue_get_guest_notifier(vq);
 | |
| 
 | |
|     return kvm_irqchip_add_irqfd_notifier_gsi(kvm_state, notifier, NULL,
 | |
|                                               dev->routes.gsi[n]);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_remove_irqfd(VirtioCcwDevice *dev, int n)
 | |
| {
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
|     VirtQueue *vq = virtio_get_queue(vdev, n);
 | |
|     EventNotifier *notifier = virtio_queue_get_guest_notifier(vq);
 | |
|     int ret;
 | |
| 
 | |
|     ret = kvm_irqchip_remove_irqfd_notifier_gsi(kvm_state, notifier,
 | |
|                                                 dev->routes.gsi[n]);
 | |
|     assert(ret == 0);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_set_guest_notifier(VirtioCcwDevice *dev, int n,
 | |
|                                          bool assign, bool with_irqfd)
 | |
| {
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
|     VirtQueue *vq = virtio_get_queue(vdev, n);
 | |
|     EventNotifier *notifier = virtio_queue_get_guest_notifier(vq);
 | |
|     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
 | |
| 
 | |
|     if (assign) {
 | |
|         int r = event_notifier_init(notifier, 0);
 | |
| 
 | |
|         if (r < 0) {
 | |
|             return r;
 | |
|         }
 | |
|         virtio_queue_set_guest_notifier_fd_handler(vq, true, with_irqfd);
 | |
|         if (with_irqfd) {
 | |
|             r = virtio_ccw_add_irqfd(dev, n);
 | |
|             if (r) {
 | |
|                 virtio_queue_set_guest_notifier_fd_handler(vq, false,
 | |
|                                                            with_irqfd);
 | |
|                 return r;
 | |
|             }
 | |
|         }
 | |
|         /*
 | |
|          * We do not support individual masking for channel devices, so we
 | |
|          * need to manually trigger any guest masking callbacks here.
 | |
|          */
 | |
|         if (k->guest_notifier_mask && vdev->use_guest_notifier_mask) {
 | |
|             k->guest_notifier_mask(vdev, n, false);
 | |
|         }
 | |
|         /* get lost events and re-inject */
 | |
|         if (k->guest_notifier_pending &&
 | |
|             k->guest_notifier_pending(vdev, n)) {
 | |
|             event_notifier_set(notifier);
 | |
|         }
 | |
|     } else {
 | |
|         if (k->guest_notifier_mask && vdev->use_guest_notifier_mask) {
 | |
|             k->guest_notifier_mask(vdev, n, true);
 | |
|         }
 | |
|         if (with_irqfd) {
 | |
|             virtio_ccw_remove_irqfd(dev, n);
 | |
|         }
 | |
|         virtio_queue_set_guest_notifier_fd_handler(vq, false, with_irqfd);
 | |
|         event_notifier_cleanup(notifier);
 | |
|     }
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_set_guest_notifiers(DeviceState *d, int nvqs,
 | |
|                                           bool assigned)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
|     CcwDevice *ccw_dev = CCW_DEVICE(d);
 | |
|     bool with_irqfd = ccw_dev->sch->thinint_active && kvm_irqfds_enabled();
 | |
|     int r, n;
 | |
| 
 | |
|     if (with_irqfd && assigned) {
 | |
|         /* irq routes need to be set up before assigning irqfds */
 | |
|         r = virtio_ccw_setup_irqroutes(dev, nvqs);
 | |
|         if (r < 0) {
 | |
|             goto irqroute_error;
 | |
|         }
 | |
|     }
 | |
|     for (n = 0; n < nvqs; n++) {
 | |
|         if (!virtio_queue_get_num(vdev, n)) {
 | |
|             break;
 | |
|         }
 | |
|         r = virtio_ccw_set_guest_notifier(dev, n, assigned, with_irqfd);
 | |
|         if (r < 0) {
 | |
|             goto assign_error;
 | |
|         }
 | |
|     }
 | |
|     if (with_irqfd && !assigned) {
 | |
|         /* release irq routes after irqfds have been released */
 | |
|         virtio_ccw_release_irqroutes(dev, nvqs);
 | |
|     }
 | |
|     return 0;
 | |
| 
 | |
| assign_error:
 | |
|     while (--n >= 0) {
 | |
|         virtio_ccw_set_guest_notifier(dev, n, !assigned, false);
 | |
|     }
 | |
| irqroute_error:
 | |
|     if (with_irqfd && assigned) {
 | |
|         virtio_ccw_release_irqroutes(dev, nvqs);
 | |
|     }
 | |
|     return r;
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_save_queue(DeviceState *d, int n, QEMUFile *f)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
| 
 | |
|     qemu_put_be16(f, virtio_queue_vector(vdev, n));
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_load_queue(DeviceState *d, int n, QEMUFile *f)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
|     uint16_t vector;
 | |
| 
 | |
|     qemu_get_be16s(f, &vector);
 | |
|     virtio_queue_set_vector(vdev, n , vector);
 | |
| 
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_save_config(DeviceState *d, QEMUFile *f)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
|     vmstate_save_state(f, &vmstate_virtio_ccw_dev, dev, NULL);
 | |
| }
 | |
| 
 | |
| static int virtio_ccw_load_config(DeviceState *d, QEMUFile *f)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
|     return vmstate_load_state(f, &vmstate_virtio_ccw_dev, dev, 1);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_pre_plugged(DeviceState *d, Error **errp)
 | |
| {
 | |
|    VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
|    VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
| 
 | |
|     if (dev->max_rev >= 1) {
 | |
|         virtio_add_feature(&vdev->host_features, VIRTIO_F_VERSION_1);
 | |
|     }
 | |
| }
 | |
| 
 | |
| /* This is called by virtio-bus just after the device is plugged. */
 | |
| static void virtio_ccw_device_plugged(DeviceState *d, Error **errp)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
|     VirtIODevice *vdev = virtio_bus_get_device(&dev->bus);
 | |
|     CcwDevice *ccw_dev = CCW_DEVICE(d);
 | |
|     SubchDev *sch = ccw_dev->sch;
 | |
|     int n = virtio_get_num_queues(vdev);
 | |
|     S390FLICState *flic = s390_get_flic();
 | |
| 
 | |
|     if (!virtio_has_feature(vdev->host_features, VIRTIO_F_VERSION_1)) {
 | |
|         dev->max_rev = 0;
 | |
|     }
 | |
| 
 | |
|     if (virtio_get_num_queues(vdev) > VIRTIO_QUEUE_MAX) {
 | |
|         error_setg(errp, "The number of virtqueues %d "
 | |
|                    "exceeds virtio limit %d", n,
 | |
|                    VIRTIO_QUEUE_MAX);
 | |
|         return;
 | |
|     }
 | |
|     if (virtio_get_num_queues(vdev) > flic->adapter_routes_max_batch) {
 | |
|         error_setg(errp, "The number of virtqueues %d "
 | |
|                    "exceeds flic adapter route limit %d", n,
 | |
|                    flic->adapter_routes_max_batch);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     sch->id.cu_model = virtio_bus_get_vdev_id(&dev->bus);
 | |
| 
 | |
| 
 | |
|     css_generate_sch_crws(sch->cssid, sch->ssid, sch->schid,
 | |
|                           d->hotplugged, 1);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_device_unplugged(DeviceState *d)
 | |
| {
 | |
|     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 | |
| 
 | |
|     virtio_ccw_stop_ioeventfd(dev);
 | |
| }
 | |
| /**************** Virtio-ccw Bus Device Descriptions *******************/
 | |
| 
 | |
| static Property virtio_ccw_net_properties[] = {
 | |
|     DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags,
 | |
|                     VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true),
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     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->realize = virtio_ccw_net_realize;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_net_properties;
 | |
|     set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_net = {
 | |
|     .name          = TYPE_VIRTIO_NET_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtIONetCcw),
 | |
|     .instance_init = virtio_ccw_net_instance_init,
 | |
|     .class_init    = virtio_ccw_net_class_init,
 | |
| };
 | |
| 
 | |
| static Property virtio_ccw_blk_properties[] = {
 | |
|     DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags,
 | |
|                     VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true),
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     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->realize = virtio_ccw_blk_realize;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_blk_properties;
 | |
|     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
 | |
| }
 | |
| 
 | |
| 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_BIT("ioeventfd", VirtioCcwDevice, flags,
 | |
|                     VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true),
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     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->realize = virtio_ccw_serial_realize;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_serial_properties;
 | |
|     set_bit(DEVICE_CATEGORY_INPUT, dc->categories);
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_serial = {
 | |
|     .name          = TYPE_VIRTIO_SERIAL_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtioSerialCcw),
 | |
|     .instance_init = virtio_ccw_serial_instance_init,
 | |
|     .class_init    = virtio_ccw_serial_class_init,
 | |
| };
 | |
| 
 | |
| static Property virtio_ccw_balloon_properties[] = {
 | |
|     DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags,
 | |
|                     VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true),
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     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->realize = virtio_ccw_balloon_realize;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_balloon_properties;
 | |
|     set_bit(DEVICE_CATEGORY_MISC, dc->categories);
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_balloon = {
 | |
|     .name          = TYPE_VIRTIO_BALLOON_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtIOBalloonCcw),
 | |
|     .instance_init = virtio_ccw_balloon_instance_init,
 | |
|     .class_init    = virtio_ccw_balloon_class_init,
 | |
| };
 | |
| 
 | |
| static Property virtio_ccw_scsi_properties[] = {
 | |
|     DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags,
 | |
|                     VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true),
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     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->realize = virtio_ccw_scsi_realize;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_scsi_properties;
 | |
|     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_scsi = {
 | |
|     .name          = TYPE_VIRTIO_SCSI_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtIOSCSICcw),
 | |
|     .instance_init = virtio_ccw_scsi_instance_init,
 | |
|     .class_init    = virtio_ccw_scsi_class_init,
 | |
| };
 | |
| 
 | |
| #ifdef CONFIG_VHOST_SCSI
 | |
| static Property vhost_ccw_scsi_properties[] = {
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void vhost_ccw_scsi_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->realize = vhost_ccw_scsi_realize;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = vhost_ccw_scsi_properties;
 | |
|     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
 | |
| }
 | |
| 
 | |
| static const TypeInfo vhost_ccw_scsi = {
 | |
|     .name          = TYPE_VHOST_SCSI_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VHostSCSICcw),
 | |
|     .instance_init = vhost_ccw_scsi_instance_init,
 | |
|     .class_init    = vhost_ccw_scsi_class_init,
 | |
| };
 | |
| #endif
 | |
| 
 | |
| static void virtio_ccw_rng_instance_init(Object *obj)
 | |
| {
 | |
|     VirtIORNGCcw *dev = VIRTIO_RNG_CCW(obj);
 | |
| 
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VIRTIO_RNG);
 | |
| }
 | |
| 
 | |
| static Property virtio_ccw_rng_properties[] = {
 | |
|     DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags,
 | |
|                     VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true),
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     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->realize = virtio_ccw_rng_realize;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_rng_properties;
 | |
|     set_bit(DEVICE_CATEGORY_MISC, dc->categories);
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_rng = {
 | |
|     .name          = TYPE_VIRTIO_RNG_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtIORNGCcw),
 | |
|     .instance_init = virtio_ccw_rng_instance_init,
 | |
|     .class_init    = virtio_ccw_rng_class_init,
 | |
| };
 | |
| 
 | |
| static Property virtio_ccw_crypto_properties[] = {
 | |
|     DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags,
 | |
|                     VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true),
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_crypto_instance_init(Object *obj)
 | |
| {
 | |
|     VirtIOCryptoCcw *dev = VIRTIO_CRYPTO_CCW(obj);
 | |
|     VirtioCcwDevice *ccw_dev = VIRTIO_CCW_DEVICE(obj);
 | |
| 
 | |
|     ccw_dev->force_revision_1 = true;
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VIRTIO_CRYPTO);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_crypto_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->realize = virtio_ccw_crypto_realize;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_crypto_properties;
 | |
|     set_bit(DEVICE_CATEGORY_MISC, dc->categories);
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_crypto = {
 | |
|     .name          = TYPE_VIRTIO_CRYPTO_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtIOCryptoCcw),
 | |
|     .instance_init = virtio_ccw_crypto_instance_init,
 | |
|     .class_init    = virtio_ccw_crypto_class_init,
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_busdev_realize(DeviceState *dev, Error **errp)
 | |
| {
 | |
|     VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev;
 | |
| 
 | |
|     virtio_ccw_bus_new(&_dev->bus, sizeof(_dev->bus), _dev);
 | |
|     virtio_ccw_device_realize(_dev, errp);
 | |
| }
 | |
| 
 | |
| 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 void virtio_ccw_busdev_unplug(HotplugHandler *hotplug_dev,
 | |
|                                      DeviceState *dev, Error **errp)
 | |
| {
 | |
|     VirtioCcwDevice *_dev = to_virtio_ccw_dev_fast(dev);
 | |
| 
 | |
|     virtio_ccw_stop_ioeventfd(_dev);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_device_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     CCWDeviceClass *k = CCW_DEVICE_CLASS(dc);
 | |
| 
 | |
|     k->unplug = virtio_ccw_busdev_unplug;
 | |
|     dc->realize = virtio_ccw_busdev_realize;
 | |
|     dc->exit = virtio_ccw_busdev_exit;
 | |
|     dc->bus_type = TYPE_VIRTUAL_CSS_BUS;
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_device_info = {
 | |
|     .name = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .parent = TYPE_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VirtioCcwDevice),
 | |
|     .class_init = virtio_ccw_device_class_init,
 | |
|     .class_size = sizeof(VirtIOCCWDeviceClass),
 | |
|     .abstract = true,
 | |
| };
 | |
| 
 | |
| /* virtio-ccw-bus */
 | |
| 
 | |
| static void virtio_ccw_bus_new(VirtioBusState *bus, size_t bus_size,
 | |
|                                VirtioCcwDevice *dev)
 | |
| {
 | |
|     DeviceState *qdev = DEVICE(dev);
 | |
|     char virtio_bus_name[] = "virtio-bus";
 | |
| 
 | |
|     qbus_create_inplace(bus, bus_size, TYPE_VIRTIO_CCW_BUS,
 | |
|                         qdev, virtio_bus_name);
 | |
| }
 | |
| 
 | |
| 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->vmstate_change = virtio_ccw_vmstate_change;
 | |
|     k->query_guest_notifiers = virtio_ccw_query_guest_notifiers;
 | |
|     k->set_guest_notifiers = virtio_ccw_set_guest_notifiers;
 | |
|     k->save_queue = virtio_ccw_save_queue;
 | |
|     k->load_queue = virtio_ccw_load_queue;
 | |
|     k->save_config = virtio_ccw_save_config;
 | |
|     k->load_config = virtio_ccw_load_config;
 | |
|     k->pre_plugged = virtio_ccw_pre_plugged;
 | |
|     k->device_plugged = virtio_ccw_device_plugged;
 | |
|     k->device_unplugged = virtio_ccw_device_unplugged;
 | |
|     k->ioeventfd_enabled = virtio_ccw_ioeventfd_enabled;
 | |
|     k->ioeventfd_assign = virtio_ccw_ioeventfd_assign;
 | |
| }
 | |
| 
 | |
| 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,
 | |
| };
 | |
| 
 | |
| #ifdef CONFIG_VIRTFS
 | |
| static Property virtio_ccw_9p_properties[] = {
 | |
|     DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags,
 | |
|             VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true),
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void virtio_ccw_9p_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     V9fsCCWState *dev = VIRTIO_9P_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
| 
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", errp);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_9p_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     k->realize = virtio_ccw_9p_realize;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
|     dc->props = virtio_ccw_9p_properties;
 | |
|     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
 | |
| }
 | |
| 
 | |
| static void virtio_ccw_9p_instance_init(Object *obj)
 | |
| {
 | |
|     V9fsCCWState *dev = VIRTIO_9P_CCW(obj);
 | |
| 
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VIRTIO_9P);
 | |
| }
 | |
| 
 | |
| static const TypeInfo virtio_ccw_9p_info = {
 | |
|     .name          = TYPE_VIRTIO_9P_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(V9fsCCWState),
 | |
|     .instance_init = virtio_ccw_9p_instance_init,
 | |
|     .class_init    = virtio_ccw_9p_class_init,
 | |
| };
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_VHOST_VSOCK
 | |
| 
 | |
| static Property vhost_vsock_ccw_properties[] = {
 | |
|     DEFINE_PROP_UINT32("max_revision", VirtioCcwDevice, max_rev,
 | |
|                        VIRTIO_CCW_MAX_REV),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void vhost_vsock_ccw_realize(VirtioCcwDevice *ccw_dev, Error **errp)
 | |
| {
 | |
|     VHostVSockCCWState *dev = VHOST_VSOCK_CCW(ccw_dev);
 | |
|     DeviceState *vdev = DEVICE(&dev->vdev);
 | |
|     Error *err = NULL;
 | |
| 
 | |
|     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 | |
|     object_property_set_bool(OBJECT(vdev), true, "realized", &err);
 | |
|     error_propagate(errp, err);
 | |
| }
 | |
| 
 | |
| static void vhost_vsock_ccw_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 | |
| 
 | |
|     k->realize = vhost_vsock_ccw_realize;
 | |
|     k->exit = virtio_ccw_exit;
 | |
|     set_bit(DEVICE_CATEGORY_MISC, dc->categories);
 | |
|     dc->props = vhost_vsock_ccw_properties;
 | |
|     dc->reset = virtio_ccw_reset;
 | |
| }
 | |
| 
 | |
| static void vhost_vsock_ccw_instance_init(Object *obj)
 | |
| {
 | |
|     VHostVSockCCWState *dev = VHOST_VSOCK_CCW(obj);
 | |
| 
 | |
|     virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev),
 | |
|                                 TYPE_VHOST_VSOCK);
 | |
| }
 | |
| 
 | |
| static const TypeInfo vhost_vsock_ccw_info = {
 | |
|     .name          = TYPE_VHOST_VSOCK_CCW,
 | |
|     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 | |
|     .instance_size = sizeof(VHostVSockCCWState),
 | |
|     .instance_init = vhost_vsock_ccw_instance_init,
 | |
|     .class_init    = vhost_vsock_ccw_class_init,
 | |
| };
 | |
| #endif
 | |
| 
 | |
| static void virtio_ccw_register(void)
 | |
| {
 | |
|     type_register_static(&virtio_ccw_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);
 | |
| #ifdef CONFIG_VHOST_SCSI
 | |
|     type_register_static(&vhost_ccw_scsi);
 | |
| #endif
 | |
|     type_register_static(&virtio_ccw_rng);
 | |
| #ifdef CONFIG_VIRTFS
 | |
|     type_register_static(&virtio_ccw_9p_info);
 | |
| #endif
 | |
| #ifdef CONFIG_VHOST_VSOCK
 | |
|     type_register_static(&vhost_vsock_ccw_info);
 | |
| #endif
 | |
|     type_register_static(&virtio_ccw_crypto);
 | |
| }
 | |
| 
 | |
| type_init(virtio_ccw_register)
 |