hw/s390x/virtio-ccw.c

   1 /*
   2  * virtio ccw target implementation
   3  *
   4  * Copyright 2012 IBM Corp.
   5  * Author(s): Cornelia Huck <[email protected]>
   6  *
   7  * This work is licensed under the terms of the GNU GPL, version 2 or (at
   8  * your option) any later version. See the COPYING file in the top-level
   9  * directory.
  10  */
  11
  12 #include "hw/hw.h"
  13 #include "block/block.h"
  14 #include "sysemu/blockdev.h"
  15 #include "sysemu/sysemu.h"
  16 #include "net/net.h"
  17 #include "monitor/monitor.h"
  18 #include "hw/virtio/virtio.h"
  19 #include "hw/virtio/virtio-serial.h"
  20 #include "hw/virtio/virtio-net.h"
  21 #include "hw/sysbus.h"
  22 #include "qemu/bitops.h"
  23 #include "hw/virtio/virtio-bus.h"
  24
  25 #include "ioinst.h"
  26 #include "css.h"
  27 #include "virtio-ccw.h"
  28 #include "trace.h"
  29
  30 static int virtual_css_bus_reset(BusState *qbus)
  31 {
  32     /* This should actually be modelled via the generic css */
  33     css_reset();
  34
  35     /* we dont traverse ourself, return 0 */
  36     return 0;
  37 }
  38
  39
  40 static void virtual_css_bus_class_init(ObjectClass *klass, void *data)
  41 {
  42     BusClass *k = BUS_CLASS(klass);
  43
  44     k->reset = virtual_css_bus_reset;
  45 }
  46
  47 static const TypeInfo virtual_css_bus_info = {
  48     .name = TYPE_VIRTUAL_CSS_BUS,
  49     .parent = TYPE_BUS,
  50     .instance_size = sizeof(VirtualCssBus),
  51     .class_init = virtual_css_bus_class_init,
  52 };
  53
  54 static const VirtIOBindings virtio_ccw_bindings;
  55
  56 VirtIODevice *virtio_ccw_get_vdev(SubchDev *sch)
  57 {
  58     VirtIODevice *vdev = NULL;
  59
  60     if (sch->driver_data) {
  61         vdev = ((VirtioCcwDevice *)sch->driver_data)->vdev;
  62     }
  63     return vdev;
  64 }
  65
  66 VirtualCssBus *virtual_css_bus_init(void)
  67 {
  68     VirtualCssBus *cbus;
  69     BusState *bus;
  70     DeviceState *dev;
  71
  72     /* Create bridge device */
  73     dev = qdev_create(NULL, "virtual-css-bridge");
  74     qdev_init_nofail(dev);
  75
  76     /* Create bus on bridge device */
  77     bus = qbus_create(TYPE_VIRTUAL_CSS_BUS, dev, "virtual-css");
  78     cbus = VIRTUAL_CSS_BUS(bus);
  79
  80     /* Enable hotplugging */
  81     bus->allow_hotplug = 1;
  82
  83     return cbus;
  84 }
  85
  86 /* Communication blocks used by several channel commands. */
  87 typedef struct VqInfoBlock {
  88     uint64_t queue;
  89     uint32_t align;
  90     uint16_t index;
  91     uint16_t num;
  92 } QEMU_PACKED VqInfoBlock;
  93
  94 typedef struct VqConfigBlock {
  95     uint16_t index;
  96     uint16_t num_max;
  97 } QEMU_PACKED VqConfigBlock;
  98
  99 typedef struct VirtioFeatDesc {
 100     uint32_t features;
 101     uint8_t index;
 102 } QEMU_PACKED VirtioFeatDesc;
 103
 104 /* Specify where the virtqueues for the subchannel are in guest memory. */
 105 static int virtio_ccw_set_vqs(SubchDev *sch, uint64_t addr, uint32_t align,
 106                               uint16_t index, uint16_t num)
 107 {
 108     VirtioCcwDevice *dev = sch->driver_data;
 109
 110     if (index > VIRTIO_PCI_QUEUE_MAX) {
 111         return -EINVAL;
 112     }
 113
 114     /* Current code in virtio.c relies on 4K alignment. */
 115     if (addr && (align != 4096)) {
 116         return -EINVAL;
 117     }
 118
 119     if (!dev) {
 120         return -EINVAL;
 121     }
 122
 123     virtio_queue_set_addr(dev->vdev, index, addr);
 124     if (!addr) {
 125         virtio_queue_set_vector(dev->vdev, index, 0);
 126     } else {
 127         /* Fail if we don't have a big enough queue. */
 128         /* TODO: Add interface to handle vring.num changing */
 129         if (virtio_queue_get_num(dev->vdev, index) > num) {
 130             return -EINVAL;
 131         }
 132         virtio_queue_set_vector(dev->vdev, index, index);
 133     }
 134     /* tell notify handler in case of config change */
 135     dev->vdev->config_vector = VIRTIO_PCI_QUEUE_MAX;
 136     return 0;
 137 }
 138
 139 static int virtio_ccw_cb(SubchDev *sch, CCW1 ccw)
 140 {
 141     int ret;
 142     VqInfoBlock info;
 143     uint8_t status;
 144     VirtioFeatDesc features;
 145     void *config;
 146     hwaddr indicators;
 147     VqConfigBlock vq_config;
 148     VirtioCcwDevice *dev = sch->driver_data;
 149     bool check_len;
 150     int len;
 151     hwaddr hw_len;
 152
 153     if (!dev) {
 154         return -EINVAL;
 155     }
 156
 157     trace_virtio_ccw_interpret_ccw(sch->cssid, sch->ssid, sch->schid,
 158                                    ccw.cmd_code);
 159     check_len = !((ccw.flags & CCW_FLAG_SLI) && !(ccw.flags & CCW_FLAG_DC));
 160
 161     /* Look at the command. */
 162     switch (ccw.cmd_code) {
 163     case CCW_CMD_SET_VQ:
 164         if (check_len) {
 165             if (ccw.count != sizeof(info)) {
 166                 ret = -EINVAL;
 167                 break;
 168             }
 169         } else if (ccw.count < sizeof(info)) {
 170             /* Can't execute command. */
 171             ret = -EINVAL;
 172             break;
 173         }
 174         if (!ccw.cda) {
 175             ret = -EFAULT;
 176         } else {
 177             info.queue = ldq_phys(ccw.cda);
 178             info.align = ldl_phys(ccw.cda + sizeof(info.queue));
 179             info.index = lduw_phys(ccw.cda + sizeof(info.queue)
 180                                    + sizeof(info.align));
 181             info.num = lduw_phys(ccw.cda + sizeof(info.queue)
 182                                  + sizeof(info.align)
 183                                  + sizeof(info.index));
 184             ret = virtio_ccw_set_vqs(sch, info.queue, info.align, info.index,
 185                                      info.num);
 186             sch->curr_status.scsw.count = 0;
 187         }
 188         break;
 189     case CCW_CMD_VDEV_RESET:
 190         virtio_reset(dev->vdev);
 191         ret = 0;
 192         break;
 193     case CCW_CMD_READ_FEAT:
 194         if (check_len) {
 195             if (ccw.count != sizeof(features)) {
 196                 ret = -EINVAL;
 197                 break;
 198             }
 199         } else if (ccw.count < sizeof(features)) {
 200             /* Can't execute command. */
 201             ret = -EINVAL;
 202             break;
 203         }
 204         if (!ccw.cda) {
 205             ret = -EFAULT;
 206         } else {
 207             features.index = ldub_phys(ccw.cda + sizeof(features.features));
 208             if (features.index < ARRAY_SIZE(dev->host_features)) {
 209                 features.features = dev->host_features[features.index];
 210             } else {
 211                 /* Return zeroes if the guest supports more feature bits. */
 212                 features.features = 0;
 213             }
 214             stl_le_phys(ccw.cda, features.features);
 215             sch->curr_status.scsw.count = ccw.count - sizeof(features);
 216             ret = 0;
 217         }
 218         break;
 219     case CCW_CMD_WRITE_FEAT:
 220         if (check_len) {
 221             if (ccw.count != sizeof(features)) {
 222                 ret = -EINVAL;
 223                 break;
 224             }
 225         } else if (ccw.count < sizeof(features)) {
 226             /* Can't execute command. */
 227             ret = -EINVAL;
 228             break;
 229         }
 230         if (!ccw.cda) {
 231             ret = -EFAULT;
 232         } else {
 233             features.index = ldub_phys(ccw.cda + sizeof(features.features));
 234             features.features = ldl_le_phys(ccw.cda);
 235             if (features.index < ARRAY_SIZE(dev->host_features)) {
 236                 if (dev->vdev->set_features) {
 237                     dev->vdev->set_features(dev->vdev, features.features);
 238                 }
 239                 dev->vdev->guest_features = features.features;
 240             } else {
 241                 /*
 242                  * If the guest supports more feature bits, assert that it
 243                  * passes us zeroes for those we don't support.
 244                  */
 245                 if (features.features) {
 246                     fprintf(stderr, "Guest bug: features[%i]=%x (expected 0)\n",
 247                             features.index, features.features);
 248                     /* XXX: do a unit check here? */
 249                 }
 250             }
 251             sch->curr_status.scsw.count = ccw.count - sizeof(features);
 252             ret = 0;
 253         }
 254         break;
 255     case CCW_CMD_READ_CONF:
 256         if (check_len) {
 257             if (ccw.count > dev->vdev->config_len) {
 258                 ret = -EINVAL;
 259                 break;
 260             }
 261         }
 262         len = MIN(ccw.count, dev->vdev->config_len);
 263         if (!ccw.cda) {
 264             ret = -EFAULT;
 265         } else {
 266             dev->vdev->get_config(dev->vdev, dev->vdev->config);
 267             /* XXX config space endianness */
 268             cpu_physical_memory_write(ccw.cda, dev->vdev->config, len);
 269             sch->curr_status.scsw.count = ccw.count - len;
 270             ret = 0;
 271         }
 272         break;
 273     case CCW_CMD_WRITE_CONF:
 274         if (check_len) {
 275             if (ccw.count > dev->vdev->config_len) {
 276                 ret = -EINVAL;
 277                 break;
 278             }
 279         }
 280         len = MIN(ccw.count, dev->vdev->config_len);
 281         hw_len = len;
 282         if (!ccw.cda) {
 283             ret = -EFAULT;
 284         } else {
 285             config = cpu_physical_memory_map(ccw.cda, &hw_len, 0);
 286             if (!config) {
 287                 ret = -EFAULT;
 288             } else {
 289                 len = hw_len;
 290                 /* XXX config space endianness */
 291                 memcpy(dev->vdev->config, config, len);
 292                 cpu_physical_memory_unmap(config, hw_len, 0, hw_len);
 293                 if (dev->vdev->set_config) {
 294                     dev->vdev->set_config(dev->vdev, dev->vdev->config);
 295                 }
 296                 sch->curr_status.scsw.count = ccw.count - len;
 297                 ret = 0;
 298             }
 299         }
 300         break;
 301     case CCW_CMD_WRITE_STATUS:
 302         if (check_len) {
 303             if (ccw.count != sizeof(status)) {
 304                 ret = -EINVAL;
 305                 break;
 306             }
 307         } else if (ccw.count < sizeof(status)) {
 308             /* Can't execute command. */
 309             ret = -EINVAL;
 310             break;
 311         }
 312         if (!ccw.cda) {
 313             ret = -EFAULT;
 314         } else {
 315             status = ldub_phys(ccw.cda);
 316             virtio_set_status(dev->vdev, status);
 317             if (dev->vdev->status == 0) {
 318                 virtio_reset(dev->vdev);
 319             }
 320             sch->curr_status.scsw.count = ccw.count - sizeof(status);
 321             ret = 0;
 322         }
 323         break;
 324     case CCW_CMD_SET_IND:
 325         if (check_len) {
 326             if (ccw.count != sizeof(indicators)) {
 327                 ret = -EINVAL;
 328                 break;
 329             }
 330         } else if (ccw.count < sizeof(indicators)) {
 331             /* Can't execute command. */
 332             ret = -EINVAL;
 333             break;
 334         }
 335         indicators = ldq_phys(ccw.cda);
 336         if (!indicators) {
 337             ret = -EFAULT;
 338         } else {
 339             dev->indicators = indicators;
 340             sch->curr_status.scsw.count = ccw.count - sizeof(indicators);
 341             ret = 0;
 342         }
 343         break;
 344     case CCW_CMD_SET_CONF_IND:
 345         if (check_len) {
 346             if (ccw.count != sizeof(indicators)) {
 347                 ret = -EINVAL;
 348                 break;
 349             }
 350         } else if (ccw.count < sizeof(indicators)) {
 351             /* Can't execute command. */
 352             ret = -EINVAL;
 353             break;
 354         }
 355         indicators = ldq_phys(ccw.cda);
 356         if (!indicators) {
 357             ret = -EFAULT;
 358         } else {
 359             dev->indicators2 = indicators;
 360             sch->curr_status.scsw.count = ccw.count - sizeof(indicators);
 361             ret = 0;
 362         }
 363         break;
 364     case CCW_CMD_READ_VQ_CONF:
 365         if (check_len) {
 366             if (ccw.count != sizeof(vq_config)) {
 367                 ret = -EINVAL;
 368                 break;
 369             }
 370         } else if (ccw.count < sizeof(vq_config)) {
 371             /* Can't execute command. */
 372             ret = -EINVAL;
 373             break;
 374         }
 375         if (!ccw.cda) {
 376             ret = -EFAULT;
 377         } else {
 378             vq_config.index = lduw_phys(ccw.cda);
 379             vq_config.num_max = virtio_queue_get_num(dev->vdev,
 380                                                      vq_config.index);
 381             stw_phys(ccw.cda + sizeof(vq_config.index), vq_config.num_max);
 382             sch->curr_status.scsw.count = ccw.count - sizeof(vq_config);
 383             ret = 0;
 384         }
 385         break;
 386     default:
 387         ret = -ENOSYS;
 388         break;
 389     }
 390     return ret;
 391 }
 392
 393 static int virtio_ccw_device_init(VirtioCcwDevice *dev, VirtIODevice *vdev)
 394 {
 395     unsigned int cssid = 0;
 396     unsigned int ssid = 0;
 397     unsigned int schid;
 398     unsigned int devno;
 399     bool have_devno = false;
 400     bool found = false;
 401     SubchDev *sch;
 402     int ret;
 403     int num;
 404     DeviceState *parent = DEVICE(dev);
 405
 406     sch = g_malloc0(sizeof(SubchDev));
 407
 408     sch->driver_data = dev;
 409     dev->sch = sch;
 410
 411     dev->vdev = vdev;
 412     dev->indicators = 0;
 413
 414     /* Initialize subchannel structure. */
 415     sch->channel_prog = 0x0;
 416     sch->last_cmd_valid = false;
 417     sch->orb = NULL;
 418     /*
 419      * Use a device number if provided. Otherwise, fall back to subchannel
 420      * number.
 421      */
 422     if (dev->bus_id) {
 423         num = sscanf(dev->bus_id, "%x.%x.%04x", &cssid, &ssid, &devno);
 424         if (num == 3) {
 425             if ((cssid > MAX_CSSID) || (ssid > MAX_SSID)) {
 426                 ret = -EINVAL;
 427                 error_report("Invalid cssid or ssid: cssid %x, ssid %x",
 428                              cssid, ssid);
 429                 goto out_err;
 430             }
 431             /* Enforce use of virtual cssid. */
 432             if (cssid != VIRTUAL_CSSID) {
 433                 ret = -EINVAL;
 434                 error_report("cssid %x not valid for virtio devices", cssid);
 435                 goto out_err;
 436             }
 437             if (css_devno_used(cssid, ssid, devno)) {
 438                 ret = -EEXIST;
 439                 error_report("Device %x.%x.%04x already exists", cssid, ssid,
 440                              devno);
 441                 goto out_err;
 442             }
 443             sch->cssid = cssid;
 444             sch->ssid = ssid;
 445             sch->devno = devno;
 446             have_devno = true;
 447         } else {
 448             ret = -EINVAL;
 449             error_report("Malformed devno parameter '%s'", dev->bus_id);
 450             goto out_err;
 451         }
 452     }
 453
 454     /* Find the next free id. */
 455     if (have_devno) {
 456         for (schid = 0; schid <= MAX_SCHID; schid++) {
 457             if (!css_find_subch(1, cssid, ssid, schid)) {
 458                 sch->schid = schid;
 459                 css_subch_assign(cssid, ssid, schid, devno, sch);
 460                 found = true;
 461                 break;
 462             }
 463         }
 464         if (!found) {
 465             ret = -ENODEV;
 466             error_report("No free subchannel found for %x.%x.%04x", cssid, ssid,
 467                          devno);
 468             goto out_err;
 469         }
 470         trace_virtio_ccw_new_device(cssid, ssid, schid, devno,
 471                                     "user-configured");
 472     } else {
 473         cssid = VIRTUAL_CSSID;
 474         for (ssid = 0; ssid <= MAX_SSID; ssid++) {
 475             for (schid = 0; schid <= MAX_SCHID; schid++) {
 476                 if (!css_find_subch(1, cssid, ssid, schid)) {
 477                     sch->cssid = cssid;
 478                     sch->ssid = ssid;
 479                     sch->schid = schid;
 480                     devno = schid;
 481                     /*
 482                      * If the devno is already taken, look further in this
 483                      * subchannel set.
 484                      */
 485                     while (css_devno_used(cssid, ssid, devno)) {
 486                         if (devno == MAX_SCHID) {
 487                             devno = 0;
 488                         } else if (devno == schid - 1) {
 489                             ret = -ENODEV;
 490                             error_report("No free devno found");
 491                             goto out_err;
 492                         } else {
 493                             devno++;
 494                         }
 495                     }
 496                     sch->devno = devno;
 497                     css_subch_assign(cssid, ssid, schid, devno, sch);
 498                     found = true;
 499                     break;
 500                 }
 501             }
 502             if (found) {
 503                 break;
 504             }
 505         }
 506         if (!found) {
 507             ret = -ENODEV;
 508             error_report("Virtual channel subsystem is full!");
 509             goto out_err;
 510         }
 511         trace_virtio_ccw_new_device(cssid, ssid, schid, devno,
 512                                     "auto-configured");
 513     }
 514
 515     /* Build initial schib. */
 516     css_sch_build_virtual_schib(sch, 0, VIRTIO_CCW_CHPID_TYPE);
 517
 518     sch->ccw_cb = virtio_ccw_cb;
 519
 520     /* Build senseid data. */
 521     memset(&sch->id, 0, sizeof(SenseId));
 522     sch->id.reserved = 0xff;
 523     sch->id.cu_type = VIRTIO_CCW_CU_TYPE;
 524     sch->id.cu_model = dev->vdev->device_id;
 525
 526     virtio_bind_device(vdev, &virtio_ccw_bindings, DEVICE(dev));
 527     /* Only the first 32 feature bits are used. */
 528     dev->host_features[0] = vdev->get_features(vdev, dev->host_features[0]);
 529     dev->host_features[0] |= 0x1 << VIRTIO_F_NOTIFY_ON_EMPTY;
 530     dev->host_features[0] |= 0x1 << VIRTIO_F_BAD_FEATURE;
 531
 532     css_generate_sch_crws(sch->cssid, sch->ssid, sch->schid,
 533                           parent->hotplugged, 1);
 534     return 0;
 535
 536 out_err:
 537     dev->sch = NULL;
 538     g_free(sch);
 539     return ret;
 540 }
 541
 542 static int virtio_ccw_exit(VirtioCcwDevice *dev)
 543 {
 544     SubchDev *sch = dev->sch;
 545
 546     if (sch) {
 547         css_subch_assign(sch->cssid, sch->ssid, sch->schid, sch->devno, NULL);
 548         g_free(sch);
 549     }
 550     dev->indicators = 0;
 551     return 0;
 552 }
 553
 554 static int virtio_ccw_net_init(VirtioCcwDevice *dev)
 555 {
 556     VirtIODevice *vdev;
 557
 558     vdev = virtio_net_init((DeviceState *)dev, &dev->nic, &dev->net,
 559                            dev->host_features[0]);
 560     if (!vdev) {
 561         return -1;
 562     }
 563
 564     return virtio_ccw_device_init(dev, vdev);
 565 }
 566
 567 static int virtio_ccw_net_exit(VirtioCcwDevice *dev)
 568 {
 569     virtio_net_exit(dev->vdev);
 570     return virtio_ccw_exit(dev);
 571 }
 572
 573 static int virtio_ccw_blk_init(VirtioCcwDevice *ccw_dev)
 574 {
 575     VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(ccw_dev);
 576     DeviceState *vdev = DEVICE(&dev->vdev);
 577     virtio_blk_set_conf(vdev, &(dev->blk));
 578     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 579     if (qdev_init(vdev) < 0) {
 580         return -1;
 581     }
 582
 583     return virtio_ccw_device_init(ccw_dev, VIRTIO_DEVICE(vdev));
 584 }
 585
 586 static void virtio_ccw_blk_instance_init(Object *obj)
 587 {
 588     VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(obj);
 589     object_initialize(OBJECT(&dev->vdev), TYPE_VIRTIO_BLK);
 590     object_property_add_child(obj, "virtio-backend", OBJECT(&dev->vdev), NULL);
 591 }
 592
 593 static int virtio_ccw_serial_init(VirtioCcwDevice *dev)
 594 {
 595     VirtIODevice *vdev;
 596
 597     vdev = virtio_serial_init((DeviceState *)dev, &dev->serial);
 598     if (!vdev) {
 599         return -1;
 600     }
 601
 602     return virtio_ccw_device_init(dev, vdev);
 603 }
 604
 605 static int virtio_ccw_serial_exit(VirtioCcwDevice *dev)
 606 {
 607     virtio_serial_exit(dev->vdev);
 608     return virtio_ccw_exit(dev);
 609 }
 610
 611 static int virtio_ccw_balloon_init(VirtioCcwDevice *ccw_dev)
 612 {
 613     VirtIOBalloonCcw *dev = VIRTIO_BALLOON_CCW(ccw_dev);
 614     DeviceState *vdev = DEVICE(&dev->vdev);
 615
 616     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 617     if (qdev_init(vdev) < 0) {
 618         return -1;
 619     }
 620
 621     return virtio_ccw_device_init(ccw_dev, VIRTIO_DEVICE(vdev));
 622 }
 623
 624 static void virtio_ccw_balloon_instance_init(Object *obj)
 625 {
 626     VirtIOBalloonCcw *dev = VIRTIO_BALLOON_CCW(obj);
 627     object_initialize(OBJECT(&dev->vdev), TYPE_VIRTIO_BALLOON);
 628     object_property_add_child(obj, "virtio-backend", OBJECT(&dev->vdev), NULL);
 629 }
 630
 631 static int virtio_ccw_scsi_init(VirtioCcwDevice *ccw_dev)
 632 {
 633     VirtIOSCSICcw *dev = VIRTIO_SCSI_CCW(ccw_dev);
 634     DeviceState *vdev = DEVICE(&dev->vdev);
 635
 636     qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus));
 637     if (qdev_init(vdev) < 0) {
 638         return -1;
 639     }
 640
 641     return virtio_ccw_device_init(ccw_dev, VIRTIO_DEVICE(vdev));
 642 }
 643
 644 static void virtio_ccw_scsi_instance_init(Object *obj)
 645 {
 646     VirtIOSCSICcw *dev = VIRTIO_SCSI_CCW(obj);
 647     object_initialize(OBJECT(&dev->vdev), TYPE_VIRTIO_SCSI);
 648     object_property_add_child(obj, "virtio-backend", OBJECT(&dev->vdev), NULL);
 649 }
 650
 651 static int virtio_ccw_rng_init(VirtioCcwDevice *dev)
 652 {
 653     VirtIODevice *vdev;
 654
 655     if (dev->rng.rng == NULL) {
 656         dev->rng.default_backend = RNG_RANDOM(object_new(TYPE_RNG_RANDOM));
 657         object_property_add_child(OBJECT(dev), "default-backend",
 658                                   OBJECT(dev->rng.default_backend), NULL);
 659         object_property_set_link(OBJECT(dev), OBJECT(dev->rng.default_backend),
 660                                  "rng", NULL);
 661     }
 662     vdev = virtio_rng_init((DeviceState *)dev, &dev->rng);
 663     if (!vdev) {
 664         return -1;
 665     }
 666     return virtio_ccw_device_init(dev, vdev);
 667 }
 668
 669 static int virtio_ccw_rng_exit(VirtioCcwDevice *dev)
 670 {
 671     virtio_rng_exit(dev->vdev);
 672     return virtio_ccw_exit(dev);
 673 }
 674
 675 /* DeviceState to VirtioCcwDevice. Note: used on datapath,
 676  * be careful and test performance if you change this.
 677  */
 678 static inline VirtioCcwDevice *to_virtio_ccw_dev_fast(DeviceState *d)
 679 {
 680     return container_of(d, VirtioCcwDevice, parent_obj);
 681 }
 682
 683 static void virtio_ccw_notify(DeviceState *d, uint16_t vector)
 684 {
 685     VirtioCcwDevice *dev = to_virtio_ccw_dev_fast(d);
 686     SubchDev *sch = dev->sch;
 687     uint64_t indicators;
 688
 689     if (vector >= 128) {
 690         return;
 691     }
 692
 693     if (vector < VIRTIO_PCI_QUEUE_MAX) {
 694         indicators = ldq_phys(dev->indicators);
 695         indicators |= 1ULL << vector;
 696         stq_phys(dev->indicators, indicators);
 697     } else {
 698         vector = 0;
 699         indicators = ldq_phys(dev->indicators2);
 700         indicators |= 1ULL << vector;
 701         stq_phys(dev->indicators2, indicators);
 702     }
 703
 704     css_conditional_io_interrupt(sch);
 705
 706 }
 707
 708 static unsigned virtio_ccw_get_features(DeviceState *d)
 709 {
 710     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 711
 712     /* Only the first 32 feature bits are used. */
 713     return dev->host_features[0];
 714 }
 715
 716 static void virtio_ccw_reset(DeviceState *d)
 717 {
 718     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d);
 719
 720     virtio_reset(dev->vdev);
 721     css_reset_sch(dev->sch);
 722 }
 723
 724 /**************** Virtio-ccw Bus Device Descriptions *******************/
 725
 726 static const VirtIOBindings virtio_ccw_bindings = {
 727     .notify = virtio_ccw_notify,
 728     .get_features = virtio_ccw_get_features,
 729 };
 730
 731 static Property virtio_ccw_net_properties[] = {
 732     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 733     DEFINE_VIRTIO_NET_FEATURES(VirtioCcwDevice, host_features[0]),
 734     DEFINE_NIC_PROPERTIES(VirtioCcwDevice, nic),
 735     DEFINE_PROP_UINT32("x-txtimer", VirtioCcwDevice,
 736                        net.txtimer, TX_TIMER_INTERVAL),
 737     DEFINE_PROP_INT32("x-txburst", VirtioCcwDevice,
 738                       net.txburst, TX_BURST),
 739     DEFINE_PROP_STRING("tx", VirtioCcwDevice, net.tx),
 740     DEFINE_PROP_END_OF_LIST(),
 741 };
 742
 743 static void virtio_ccw_net_class_init(ObjectClass *klass, void *data)
 744 {
 745     DeviceClass *dc = DEVICE_CLASS(klass);
 746     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 747
 748     k->init = virtio_ccw_net_init;
 749     k->exit = virtio_ccw_net_exit;
 750     dc->reset = virtio_ccw_reset;
 751     dc->props = virtio_ccw_net_properties;
 752 }
 753
 754 static const TypeInfo virtio_ccw_net = {
 755     .name          = "virtio-net-ccw",
 756     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 757     .instance_size = sizeof(VirtioCcwDevice),
 758     .class_init    = virtio_ccw_net_class_init,
 759 };
 760
 761 static Property virtio_ccw_blk_properties[] = {
 762     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 763     DEFINE_VIRTIO_BLK_FEATURES(VirtioCcwDevice, host_features[0]),
 764     DEFINE_VIRTIO_BLK_PROPERTIES(VirtIOBlkCcw, blk),
 765     DEFINE_PROP_END_OF_LIST(),
 766 };
 767
 768 static void virtio_ccw_blk_class_init(ObjectClass *klass, void *data)
 769 {
 770     DeviceClass *dc = DEVICE_CLASS(klass);
 771     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 772
 773     k->init = virtio_ccw_blk_init;
 774     k->exit = virtio_ccw_exit;
 775     dc->reset = virtio_ccw_reset;
 776     dc->props = virtio_ccw_blk_properties;
 777 }
 778
 779 static const TypeInfo virtio_ccw_blk = {
 780     .name          = TYPE_VIRTIO_BLK_CCW,
 781     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 782     .instance_size = sizeof(VirtIOBlkCcw),
 783     .instance_init = virtio_ccw_blk_instance_init,
 784     .class_init    = virtio_ccw_blk_class_init,
 785 };
 786
 787 static Property virtio_ccw_serial_properties[] = {
 788     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 789     DEFINE_VIRTIO_SERIAL_PROPERTIES(VirtioCcwDevice, serial),
 790     DEFINE_VIRTIO_COMMON_FEATURES(VirtioCcwDevice, host_features[0]),
 791     DEFINE_PROP_END_OF_LIST(),
 792 };
 793
 794 static void virtio_ccw_serial_class_init(ObjectClass *klass, void *data)
 795 {
 796     DeviceClass *dc = DEVICE_CLASS(klass);
 797     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 798
 799     k->init = virtio_ccw_serial_init;
 800     k->exit = virtio_ccw_serial_exit;
 801     dc->reset = virtio_ccw_reset;
 802     dc->props = virtio_ccw_serial_properties;
 803 }
 804
 805 static const TypeInfo virtio_ccw_serial = {
 806     .name          = "virtio-serial-ccw",
 807     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 808     .instance_size = sizeof(VirtioCcwDevice),
 809     .class_init    = virtio_ccw_serial_class_init,
 810 };
 811
 812 static Property virtio_ccw_balloon_properties[] = {
 813     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 814     DEFINE_VIRTIO_COMMON_FEATURES(VirtioCcwDevice, host_features[0]),
 815     DEFINE_PROP_END_OF_LIST(),
 816 };
 817
 818 static void virtio_ccw_balloon_class_init(ObjectClass *klass, void *data)
 819 {
 820     DeviceClass *dc = DEVICE_CLASS(klass);
 821     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 822
 823     k->init = virtio_ccw_balloon_init;
 824     k->exit = virtio_ccw_exit;
 825     dc->reset = virtio_ccw_reset;
 826     dc->props = virtio_ccw_balloon_properties;
 827 }
 828
 829 static const TypeInfo virtio_ccw_balloon = {
 830     .name          = TYPE_VIRTIO_BALLOON_CCW,
 831     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 832     .instance_size = sizeof(VirtIOBalloonCcw),
 833     .instance_init = virtio_ccw_balloon_instance_init,
 834     .class_init    = virtio_ccw_balloon_class_init,
 835 };
 836
 837 static Property virtio_ccw_scsi_properties[] = {
 838     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 839     DEFINE_VIRTIO_SCSI_PROPERTIES(VirtIOSCSICcw, vdev.conf),
 840     DEFINE_VIRTIO_SCSI_FEATURES(VirtioCcwDevice, host_features[0]),
 841     DEFINE_PROP_END_OF_LIST(),
 842 };
 843
 844 static void virtio_ccw_scsi_class_init(ObjectClass *klass, void *data)
 845 {
 846     DeviceClass *dc = DEVICE_CLASS(klass);
 847     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 848
 849     k->init = virtio_ccw_scsi_init;
 850     k->exit = virtio_ccw_exit;
 851     dc->reset = virtio_ccw_reset;
 852     dc->props = virtio_ccw_scsi_properties;
 853 }
 854
 855 static const TypeInfo virtio_ccw_scsi = {
 856     .name          = TYPE_VIRTIO_SCSI_CCW,
 857     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 858     .instance_size = sizeof(VirtIOSCSICcw),
 859     .instance_init = virtio_ccw_scsi_instance_init,
 860     .class_init    = virtio_ccw_scsi_class_init,
 861 };
 862
 863 static void virtio_ccw_rng_initfn(Object *obj)
 864 {
 865     VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(obj);
 866
 867     object_property_add_link(obj, "rng", TYPE_RNG_BACKEND,
 868                              (Object **)&dev->rng.rng, NULL);
 869 }
 870
 871 static Property virtio_ccw_rng_properties[] = {
 872     DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id),
 873     DEFINE_VIRTIO_COMMON_FEATURES(VirtioCcwDevice, host_features[0]),
 874     DEFINE_PROP_UINT64("max-bytes", VirtioCcwDevice, rng.max_bytes, INT64_MAX),
 875     DEFINE_PROP_UINT32("period", VirtioCcwDevice, rng.period_ms, 1 << 16),
 876     DEFINE_PROP_END_OF_LIST(),
 877 };
 878
 879 static void virtio_ccw_rng_class_init(ObjectClass *klass, void *data)
 880 {
 881     DeviceClass *dc = DEVICE_CLASS(klass);
 882     VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass);
 883
 884     k->init = virtio_ccw_rng_init;
 885     k->exit = virtio_ccw_rng_exit;
 886     dc->reset = virtio_ccw_reset;
 887     dc->props = virtio_ccw_rng_properties;
 888 }
 889
 890 static const TypeInfo virtio_ccw_rng = {
 891     .name          = "virtio-rng-ccw",
 892     .parent        = TYPE_VIRTIO_CCW_DEVICE,
 893     .instance_size = sizeof(VirtioCcwDevice),
 894     .instance_init = virtio_ccw_rng_initfn,
 895     .class_init    = virtio_ccw_rng_class_init,
 896 };
 897
 898 static int virtio_ccw_busdev_init(DeviceState *dev)
 899 {
 900     VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev;
 901     VirtIOCCWDeviceClass *_info = VIRTIO_CCW_DEVICE_GET_CLASS(dev);
 902
 903     virtio_ccw_bus_new(&_dev->bus, _dev);
 904
 905     return _info->init(_dev);
 906 }
 907
 908 static int virtio_ccw_busdev_exit(DeviceState *dev)
 909 {
 910     VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev;
 911     VirtIOCCWDeviceClass *_info = VIRTIO_CCW_DEVICE_GET_CLASS(dev);
 912
 913     return _info->exit(_dev);
 914 }
 915
 916 static int virtio_ccw_busdev_unplug(DeviceState *dev)
 917 {
 918     VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev;
 919     SubchDev *sch = _dev->sch;
 920
 921     /*
 922      * We should arrive here only for device_del, since we don't support
 923      * direct hot(un)plug of channels, but only through virtio.
 924      */
 925     assert(sch != NULL);
 926     /* Subchannel is now disabled and no longer valid. */
 927     sch->curr_status.pmcw.flags &= ~(PMCW_FLAGS_MASK_ENA |
 928                                      PMCW_FLAGS_MASK_DNV);
 929
 930     css_generate_sch_crws(sch->cssid, sch->ssid, sch->schid, 1, 0);
 931
 932     qdev_free(dev);
 933     return 0;
 934 }
 935
 936 static void virtio_ccw_device_class_init(ObjectClass *klass, void *data)
 937 {
 938     DeviceClass *dc = DEVICE_CLASS(klass);
 939
 940     dc->init = virtio_ccw_busdev_init;
 941     dc->exit = virtio_ccw_busdev_exit;
 942     dc->unplug = virtio_ccw_busdev_unplug;
 943     dc->bus_type = TYPE_VIRTUAL_CSS_BUS;
 944
 945 }
 946
 947 static const TypeInfo virtio_ccw_device_info = {
 948     .name = TYPE_VIRTIO_CCW_DEVICE,
 949     .parent = TYPE_DEVICE,
 950     .instance_size = sizeof(VirtioCcwDevice),
 951     .class_init = virtio_ccw_device_class_init,
 952     .class_size = sizeof(VirtIOCCWDeviceClass),
 953     .abstract = true,
 954 };
 955
 956 /***************** Virtual-css Bus Bridge Device ********************/
 957 /* Only required to have the virtio bus as child in the system bus */
 958
 959 static int virtual_css_bridge_init(SysBusDevice *dev)
 960 {
 961     /* nothing */
 962     return 0;
 963 }
 964
 965 static void virtual_css_bridge_class_init(ObjectClass *klass, void *data)
 966 {
 967     DeviceClass *dc = DEVICE_CLASS(klass);
 968     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
 969
 970     k->init = virtual_css_bridge_init;
 971     dc->no_user = 1;
 972 }
 973
 974 static const TypeInfo virtual_css_bridge_info = {
 975     .name          = "virtual-css-bridge",
 976     .parent        = TYPE_SYS_BUS_DEVICE,
 977     .instance_size = sizeof(SysBusDevice),
 978     .class_init    = virtual_css_bridge_class_init,
 979 };
 980
 981 /* virtio-ccw-bus */
 982
 983 void virtio_ccw_bus_new(VirtioBusState *bus, VirtioCcwDevice *dev)
 984 {
 985     DeviceState *qdev = DEVICE(dev);
 986     BusState *qbus;
 987
 988     qbus_create_inplace((BusState *)bus, TYPE_VIRTIO_CCW_BUS, qdev, NULL);
 989     qbus = BUS(bus);
 990     qbus->allow_hotplug = 1;
 991 }
 992
 993 static void virtio_ccw_bus_class_init(ObjectClass *klass, void *data)
 994 {
 995     VirtioBusClass *k = VIRTIO_BUS_CLASS(klass);
 996     BusClass *bus_class = BUS_CLASS(klass);
 997
 998     bus_class->max_dev = 1;
 999     k->notify = virtio_ccw_notify;
1000     k->get_features = virtio_ccw_get_features;
1001 }
1002
1003 static const TypeInfo virtio_ccw_bus_info = {
1004     .name = TYPE_VIRTIO_CCW_BUS,
1005     .parent = TYPE_VIRTIO_BUS,
1006     .instance_size = sizeof(VirtioCcwBusState),
1007     .class_init = virtio_ccw_bus_class_init,
1008 };
1009
1010 static void virtio_ccw_register(void)
1011 {
1012     type_register_static(&virtio_ccw_bus_info);
1013     type_register_static(&virtual_css_bus_info);
1014     type_register_static(&virtio_ccw_device_info);
1015     type_register_static(&virtio_ccw_serial);
1016     type_register_static(&virtio_ccw_blk);
1017     type_register_static(&virtio_ccw_net);
1018     type_register_static(&virtio_ccw_balloon);
1019     type_register_static(&virtio_ccw_scsi);
1020     type_register_static(&virtio_ccw_rng);
1021     type_register_static(&virtual_css_bridge_info);
1022 }
1023
1024 type_init(virtio_ccw_register)