1 /* 2 * virtio ccw target implementation 3 * 4 * Copyright 2012,2015 IBM Corp. 5 * Author(s): Cornelia Huck <cornelia.huck@de.ibm.com> 6 * Pierre Morel <pmorel@linux.vnet.ibm.com> 7 * 8 * This work is licensed under the terms of the GNU GPL, version 2 or (at 9 * your option) any later version. See the COPYING file in the top-level 10 * directory. 11 */ 12 13 #include "hw/hw.h" 14 #include "sysemu/block-backend.h" 15 #include "sysemu/blockdev.h" 16 #include "sysemu/sysemu.h" 17 #include "net/net.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 "qemu/error-report.h" 24 #include "hw/virtio/virtio-bus.h" 25 #include "hw/s390x/adapter.h" 26 #include "hw/s390x/s390_flic.h" 27 28 #include "ioinst.h" 29 #include "css.h" 30 #include "virtio-ccw.h" 31 #include "trace.h" 32 33 static QTAILQ_HEAD(, IndAddr) indicator_addresses = 34 QTAILQ_HEAD_INITIALIZER(indicator_addresses); 35 36 static IndAddr *get_indicator(hwaddr ind_addr, int len) 37 { 38 IndAddr *indicator; 39 40 QTAILQ_FOREACH(indicator, &indicator_addresses, sibling) { 41 if (indicator->addr == ind_addr) { 42 indicator->refcnt++; 43 return indicator; 44 } 45 } 46 indicator = g_new0(IndAddr, 1); 47 indicator->addr = ind_addr; 48 indicator->len = len; 49 indicator->refcnt = 1; 50 QTAILQ_INSERT_TAIL(&indicator_addresses, indicator, sibling); 51 return indicator; 52 } 53 54 static int s390_io_adapter_map(AdapterInfo *adapter, uint64_t map_addr, 55 bool do_map) 56 { 57 S390FLICState *fs = s390_get_flic(); 58 S390FLICStateClass *fsc = S390_FLIC_COMMON_GET_CLASS(fs); 59 60 return fsc->io_adapter_map(fs, adapter->adapter_id, map_addr, do_map); 61 } 62 63 static void release_indicator(AdapterInfo *adapter, IndAddr *indicator) 64 { 65 assert(indicator->refcnt > 0); 66 indicator->refcnt--; 67 if (indicator->refcnt > 0) { 68 return; 69 } 70 QTAILQ_REMOVE(&indicator_addresses, indicator, sibling); 71 if (indicator->map) { 72 s390_io_adapter_map(adapter, indicator->map, false); 73 } 74 g_free(indicator); 75 } 76 77 static int map_indicator(AdapterInfo *adapter, IndAddr *indicator) 78 { 79 int ret; 80 81 if (indicator->map) { 82 return 0; /* already mapped is not an error */ 83 } 84 indicator->map = indicator->addr; 85 ret = s390_io_adapter_map(adapter, indicator->map, true); 86 if ((ret != 0) && (ret != -ENOSYS)) { 87 goto out_err; 88 } 89 return 0; 90 91 out_err: 92 indicator->map = 0; 93 return ret; 94 } 95 96 static void virtio_ccw_bus_new(VirtioBusState *bus, size_t bus_size, 97 VirtioCcwDevice *dev); 98 99 static void virtual_css_bus_reset(BusState *qbus) 100 { 101 /* This should actually be modelled via the generic css */ 102 css_reset(); 103 } 104 105 106 static void virtual_css_bus_class_init(ObjectClass *klass, void *data) 107 { 108 BusClass *k = BUS_CLASS(klass); 109 110 k->reset = virtual_css_bus_reset; 111 } 112 113 static const TypeInfo virtual_css_bus_info = { 114 .name = TYPE_VIRTUAL_CSS_BUS, 115 .parent = TYPE_BUS, 116 .instance_size = sizeof(VirtualCssBus), 117 .class_init = virtual_css_bus_class_init, 118 }; 119 120 VirtIODevice *virtio_ccw_get_vdev(SubchDev *sch) 121 { 122 VirtIODevice *vdev = NULL; 123 VirtioCcwDevice *dev = sch->driver_data; 124 125 if (dev) { 126 vdev = virtio_bus_get_device(&dev->bus); 127 } 128 return vdev; 129 } 130 131 static int virtio_ccw_set_guest2host_notifier(VirtioCcwDevice *dev, int n, 132 bool assign, bool set_handler) 133 { 134 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 135 VirtQueue *vq = virtio_get_queue(vdev, n); 136 EventNotifier *notifier = virtio_queue_get_host_notifier(vq); 137 int r = 0; 138 SubchDev *sch = dev->sch; 139 uint32_t sch_id = (css_build_subchannel_id(sch) << 16) | sch->schid; 140 141 if (assign) { 142 r = event_notifier_init(notifier, 1); 143 if (r < 0) { 144 error_report("%s: unable to init event notifier: %d", __func__, r); 145 return r; 146 } 147 virtio_queue_set_host_notifier_fd_handler(vq, true, set_handler); 148 r = s390_assign_subch_ioeventfd(notifier, sch_id, n, assign); 149 if (r < 0) { 150 error_report("%s: unable to assign ioeventfd: %d", __func__, r); 151 virtio_queue_set_host_notifier_fd_handler(vq, false, false); 152 event_notifier_cleanup(notifier); 153 return r; 154 } 155 } else { 156 virtio_queue_set_host_notifier_fd_handler(vq, false, false); 157 s390_assign_subch_ioeventfd(notifier, sch_id, n, assign); 158 event_notifier_cleanup(notifier); 159 } 160 return r; 161 } 162 163 static void virtio_ccw_start_ioeventfd(VirtioCcwDevice *dev) 164 { 165 VirtIODevice *vdev; 166 int n, r; 167 168 if (!(dev->flags & VIRTIO_CCW_FLAG_USE_IOEVENTFD) || 169 dev->ioeventfd_disabled || 170 dev->ioeventfd_started) { 171 return; 172 } 173 vdev = virtio_bus_get_device(&dev->bus); 174 for (n = 0; n < VIRTIO_CCW_QUEUE_MAX; n++) { 175 if (!virtio_queue_get_num(vdev, n)) { 176 continue; 177 } 178 r = virtio_ccw_set_guest2host_notifier(dev, n, true, true); 179 if (r < 0) { 180 goto assign_error; 181 } 182 } 183 dev->ioeventfd_started = true; 184 return; 185 186 assign_error: 187 while (--n >= 0) { 188 if (!virtio_queue_get_num(vdev, n)) { 189 continue; 190 } 191 r = virtio_ccw_set_guest2host_notifier(dev, n, false, false); 192 assert(r >= 0); 193 } 194 dev->ioeventfd_started = false; 195 /* Disable ioeventfd for this device. */ 196 dev->flags &= ~VIRTIO_CCW_FLAG_USE_IOEVENTFD; 197 error_report("%s: failed. Fallback to userspace (slower).", __func__); 198 } 199 200 static void virtio_ccw_stop_ioeventfd(VirtioCcwDevice *dev) 201 { 202 VirtIODevice *vdev; 203 int n, r; 204 205 if (!dev->ioeventfd_started) { 206 return; 207 } 208 vdev = virtio_bus_get_device(&dev->bus); 209 for (n = 0; n < VIRTIO_CCW_QUEUE_MAX; n++) { 210 if (!virtio_queue_get_num(vdev, n)) { 211 continue; 212 } 213 r = virtio_ccw_set_guest2host_notifier(dev, n, false, false); 214 assert(r >= 0); 215 } 216 dev->ioeventfd_started = false; 217 } 218 219 VirtualCssBus *virtual_css_bus_init(void) 220 { 221 VirtualCssBus *cbus; 222 BusState *bus; 223 DeviceState *dev; 224 225 /* Create bridge device */ 226 dev = qdev_create(NULL, "virtual-css-bridge"); 227 qdev_init_nofail(dev); 228 229 /* Create bus on bridge device */ 230 bus = qbus_create(TYPE_VIRTUAL_CSS_BUS, dev, "virtual-css"); 231 cbus = VIRTUAL_CSS_BUS(bus); 232 233 /* Enable hotplugging */ 234 qbus_set_hotplug_handler(bus, dev, &error_abort); 235 236 return cbus; 237 } 238 239 /* Communication blocks used by several channel commands. */ 240 typedef struct VqInfoBlock { 241 uint64_t queue; 242 uint32_t align; 243 uint16_t index; 244 uint16_t num; 245 } QEMU_PACKED VqInfoBlock; 246 247 typedef struct VqConfigBlock { 248 uint16_t index; 249 uint16_t num_max; 250 } QEMU_PACKED VqConfigBlock; 251 252 typedef struct VirtioFeatDesc { 253 uint32_t features; 254 uint8_t index; 255 } QEMU_PACKED VirtioFeatDesc; 256 257 typedef struct VirtioThinintInfo { 258 hwaddr summary_indicator; 259 hwaddr device_indicator; 260 uint64_t ind_bit; 261 uint8_t isc; 262 } QEMU_PACKED VirtioThinintInfo; 263 264 /* Specify where the virtqueues for the subchannel are in guest memory. */ 265 static int virtio_ccw_set_vqs(SubchDev *sch, uint64_t addr, uint32_t align, 266 uint16_t index, uint16_t num) 267 { 268 VirtIODevice *vdev = virtio_ccw_get_vdev(sch); 269 270 if (index >= VIRTIO_CCW_QUEUE_MAX) { 271 return -EINVAL; 272 } 273 274 /* Current code in virtio.c relies on 4K alignment. */ 275 if (addr && (align != 4096)) { 276 return -EINVAL; 277 } 278 279 if (!vdev) { 280 return -EINVAL; 281 } 282 283 virtio_queue_set_addr(vdev, index, addr); 284 if (!addr) { 285 virtio_queue_set_vector(vdev, index, VIRTIO_NO_VECTOR); 286 } else { 287 /* Fail if we don't have a big enough queue. */ 288 /* TODO: Add interface to handle vring.num changing */ 289 if (virtio_queue_get_num(vdev, index) > num) { 290 return -EINVAL; 291 } 292 virtio_queue_set_vector(vdev, index, index); 293 } 294 /* tell notify handler in case of config change */ 295 vdev->config_vector = VIRTIO_CCW_QUEUE_MAX; 296 return 0; 297 } 298 299 static int virtio_ccw_cb(SubchDev *sch, CCW1 ccw) 300 { 301 int ret; 302 VqInfoBlock info; 303 uint8_t status; 304 VirtioFeatDesc features; 305 void *config; 306 hwaddr indicators; 307 VqConfigBlock vq_config; 308 VirtioCcwDevice *dev = sch->driver_data; 309 VirtIODevice *vdev = virtio_ccw_get_vdev(sch); 310 bool check_len; 311 int len; 312 hwaddr hw_len; 313 VirtioThinintInfo *thinint; 314 315 if (!dev) { 316 return -EINVAL; 317 } 318 319 trace_virtio_ccw_interpret_ccw(sch->cssid, sch->ssid, sch->schid, 320 ccw.cmd_code); 321 check_len = !((ccw.flags & CCW_FLAG_SLI) && !(ccw.flags & CCW_FLAG_DC)); 322 323 /* Look at the command. */ 324 switch (ccw.cmd_code) { 325 case CCW_CMD_SET_VQ: 326 if (check_len) { 327 if (ccw.count != sizeof(info)) { 328 ret = -EINVAL; 329 break; 330 } 331 } else if (ccw.count < sizeof(info)) { 332 /* Can't execute command. */ 333 ret = -EINVAL; 334 break; 335 } 336 if (!ccw.cda) { 337 ret = -EFAULT; 338 } else { 339 info.queue = address_space_ldq(&address_space_memory, ccw.cda, 340 MEMTXATTRS_UNSPECIFIED, NULL); 341 info.align = address_space_ldl(&address_space_memory, 342 ccw.cda + sizeof(info.queue), 343 MEMTXATTRS_UNSPECIFIED, 344 NULL); 345 info.index = address_space_lduw(&address_space_memory, 346 ccw.cda + sizeof(info.queue) 347 + sizeof(info.align), 348 MEMTXATTRS_UNSPECIFIED, 349 NULL); 350 info.num = address_space_lduw(&address_space_memory, 351 ccw.cda + sizeof(info.queue) 352 + sizeof(info.align) 353 + sizeof(info.index), 354 MEMTXATTRS_UNSPECIFIED, 355 NULL); 356 ret = virtio_ccw_set_vqs(sch, info.queue, info.align, info.index, 357 info.num); 358 sch->curr_status.scsw.count = 0; 359 } 360 break; 361 case CCW_CMD_VDEV_RESET: 362 virtio_ccw_stop_ioeventfd(dev); 363 virtio_reset(vdev); 364 ret = 0; 365 break; 366 case CCW_CMD_READ_FEAT: 367 if (check_len) { 368 if (ccw.count != sizeof(features)) { 369 ret = -EINVAL; 370 break; 371 } 372 } else if (ccw.count < sizeof(features)) { 373 /* Can't execute command. */ 374 ret = -EINVAL; 375 break; 376 } 377 if (!ccw.cda) { 378 ret = -EFAULT; 379 } else { 380 features.index = address_space_ldub(&address_space_memory, 381 ccw.cda 382 + sizeof(features.features), 383 MEMTXATTRS_UNSPECIFIED, 384 NULL); 385 if (features.index == 0) { 386 features.features = vdev->host_features; 387 } else { 388 /* Return zeroes if the guest supports more feature bits. */ 389 features.features = 0; 390 } 391 address_space_stl_le(&address_space_memory, ccw.cda, 392 features.features, MEMTXATTRS_UNSPECIFIED, 393 NULL); 394 sch->curr_status.scsw.count = ccw.count - sizeof(features); 395 ret = 0; 396 } 397 break; 398 case CCW_CMD_WRITE_FEAT: 399 if (check_len) { 400 if (ccw.count != sizeof(features)) { 401 ret = -EINVAL; 402 break; 403 } 404 } else if (ccw.count < sizeof(features)) { 405 /* Can't execute command. */ 406 ret = -EINVAL; 407 break; 408 } 409 if (!ccw.cda) { 410 ret = -EFAULT; 411 } else { 412 features.index = address_space_ldub(&address_space_memory, 413 ccw.cda 414 + sizeof(features.features), 415 MEMTXATTRS_UNSPECIFIED, 416 NULL); 417 features.features = address_space_ldl_le(&address_space_memory, 418 ccw.cda, 419 MEMTXATTRS_UNSPECIFIED, 420 NULL); 421 if (features.index == 0) { 422 virtio_set_features(vdev, features.features); 423 } else { 424 /* 425 * If the guest supports more feature bits, assert that it 426 * passes us zeroes for those we don't support. 427 */ 428 if (features.features) { 429 fprintf(stderr, "Guest bug: features[%i]=%x (expected 0)\n", 430 features.index, features.features); 431 /* XXX: do a unit check here? */ 432 } 433 } 434 sch->curr_status.scsw.count = ccw.count - sizeof(features); 435 ret = 0; 436 } 437 break; 438 case CCW_CMD_READ_CONF: 439 if (check_len) { 440 if (ccw.count > vdev->config_len) { 441 ret = -EINVAL; 442 break; 443 } 444 } 445 len = MIN(ccw.count, vdev->config_len); 446 if (!ccw.cda) { 447 ret = -EFAULT; 448 } else { 449 virtio_bus_get_vdev_config(&dev->bus, vdev->config); 450 /* XXX config space endianness */ 451 cpu_physical_memory_write(ccw.cda, vdev->config, len); 452 sch->curr_status.scsw.count = ccw.count - len; 453 ret = 0; 454 } 455 break; 456 case CCW_CMD_WRITE_CONF: 457 if (check_len) { 458 if (ccw.count > vdev->config_len) { 459 ret = -EINVAL; 460 break; 461 } 462 } 463 len = MIN(ccw.count, vdev->config_len); 464 hw_len = len; 465 if (!ccw.cda) { 466 ret = -EFAULT; 467 } else { 468 config = cpu_physical_memory_map(ccw.cda, &hw_len, 0); 469 if (!config) { 470 ret = -EFAULT; 471 } else { 472 len = hw_len; 473 /* XXX config space endianness */ 474 memcpy(vdev->config, config, len); 475 cpu_physical_memory_unmap(config, hw_len, 0, hw_len); 476 virtio_bus_set_vdev_config(&dev->bus, vdev->config); 477 sch->curr_status.scsw.count = ccw.count - len; 478 ret = 0; 479 } 480 } 481 break; 482 case CCW_CMD_WRITE_STATUS: 483 if (check_len) { 484 if (ccw.count != sizeof(status)) { 485 ret = -EINVAL; 486 break; 487 } 488 } else if (ccw.count < sizeof(status)) { 489 /* Can't execute command. */ 490 ret = -EINVAL; 491 break; 492 } 493 if (!ccw.cda) { 494 ret = -EFAULT; 495 } else { 496 status = address_space_ldub(&address_space_memory, ccw.cda, 497 MEMTXATTRS_UNSPECIFIED, NULL); 498 if (!(status & VIRTIO_CONFIG_S_DRIVER_OK)) { 499 virtio_ccw_stop_ioeventfd(dev); 500 } 501 if (virtio_set_status(vdev, status) == 0) { 502 if (vdev->status == 0) { 503 virtio_reset(vdev); 504 } 505 if (status & VIRTIO_CONFIG_S_DRIVER_OK) { 506 virtio_ccw_start_ioeventfd(dev); 507 } 508 sch->curr_status.scsw.count = ccw.count - sizeof(status); 509 ret = 0; 510 } else { 511 /* Trigger a command reject. */ 512 ret = -ENOSYS; 513 } 514 } 515 break; 516 case CCW_CMD_SET_IND: 517 if (check_len) { 518 if (ccw.count != sizeof(indicators)) { 519 ret = -EINVAL; 520 break; 521 } 522 } else if (ccw.count < sizeof(indicators)) { 523 /* Can't execute command. */ 524 ret = -EINVAL; 525 break; 526 } 527 if (sch->thinint_active) { 528 /* Trigger a command reject. */ 529 ret = -ENOSYS; 530 break; 531 } 532 if (!ccw.cda) { 533 ret = -EFAULT; 534 } else { 535 indicators = address_space_ldq_be(&address_space_memory, ccw.cda, 536 MEMTXATTRS_UNSPECIFIED, NULL); 537 dev->indicators = get_indicator(indicators, sizeof(uint64_t)); 538 sch->curr_status.scsw.count = ccw.count - sizeof(indicators); 539 ret = 0; 540 } 541 break; 542 case CCW_CMD_SET_CONF_IND: 543 if (check_len) { 544 if (ccw.count != sizeof(indicators)) { 545 ret = -EINVAL; 546 break; 547 } 548 } else if (ccw.count < sizeof(indicators)) { 549 /* Can't execute command. */ 550 ret = -EINVAL; 551 break; 552 } 553 if (!ccw.cda) { 554 ret = -EFAULT; 555 } else { 556 indicators = address_space_ldq_be(&address_space_memory, ccw.cda, 557 MEMTXATTRS_UNSPECIFIED, NULL); 558 dev->indicators2 = get_indicator(indicators, sizeof(uint64_t)); 559 sch->curr_status.scsw.count = ccw.count - sizeof(indicators); 560 ret = 0; 561 } 562 break; 563 case CCW_CMD_READ_VQ_CONF: 564 if (check_len) { 565 if (ccw.count != sizeof(vq_config)) { 566 ret = -EINVAL; 567 break; 568 } 569 } else if (ccw.count < sizeof(vq_config)) { 570 /* Can't execute command. */ 571 ret = -EINVAL; 572 break; 573 } 574 if (!ccw.cda) { 575 ret = -EFAULT; 576 } else { 577 vq_config.index = address_space_lduw_be(&address_space_memory, 578 ccw.cda, 579 MEMTXATTRS_UNSPECIFIED, 580 NULL); 581 if (vq_config.index >= VIRTIO_CCW_QUEUE_MAX) { 582 ret = -EINVAL; 583 break; 584 } 585 vq_config.num_max = virtio_queue_get_num(vdev, 586 vq_config.index); 587 address_space_stw_be(&address_space_memory, 588 ccw.cda + sizeof(vq_config.index), 589 vq_config.num_max, 590 MEMTXATTRS_UNSPECIFIED, 591 NULL); 592 sch->curr_status.scsw.count = ccw.count - sizeof(vq_config); 593 ret = 0; 594 } 595 break; 596 case CCW_CMD_SET_IND_ADAPTER: 597 if (check_len) { 598 if (ccw.count != sizeof(*thinint)) { 599 ret = -EINVAL; 600 break; 601 } 602 } else if (ccw.count < sizeof(*thinint)) { 603 /* Can't execute command. */ 604 ret = -EINVAL; 605 break; 606 } 607 len = sizeof(*thinint); 608 hw_len = len; 609 if (!ccw.cda) { 610 ret = -EFAULT; 611 } else if (dev->indicators && !sch->thinint_active) { 612 /* Trigger a command reject. */ 613 ret = -ENOSYS; 614 } else { 615 thinint = cpu_physical_memory_map(ccw.cda, &hw_len, 0); 616 if (!thinint) { 617 ret = -EFAULT; 618 } else { 619 uint64_t ind_bit = ldq_be_p(&thinint->ind_bit); 620 621 len = hw_len; 622 dev->summary_indicator = 623 get_indicator(ldq_be_p(&thinint->summary_indicator), 624 sizeof(uint8_t)); 625 dev->indicators = 626 get_indicator(ldq_be_p(&thinint->device_indicator), 627 ind_bit / 8 + 1); 628 dev->thinint_isc = thinint->isc; 629 dev->routes.adapter.ind_offset = ind_bit; 630 dev->routes.adapter.summary_offset = 7; 631 cpu_physical_memory_unmap(thinint, hw_len, 0, hw_len); 632 ret = css_register_io_adapter(CSS_IO_ADAPTER_VIRTIO, 633 dev->thinint_isc, true, false, 634 &dev->routes.adapter.adapter_id); 635 assert(ret == 0); 636 sch->thinint_active = ((dev->indicators != NULL) && 637 (dev->summary_indicator != NULL)); 638 sch->curr_status.scsw.count = ccw.count - len; 639 ret = 0; 640 } 641 } 642 break; 643 default: 644 ret = -ENOSYS; 645 break; 646 } 647 return ret; 648 } 649 650 static void virtio_ccw_device_realize(VirtioCcwDevice *dev, Error **errp) 651 { 652 unsigned int cssid = 0; 653 unsigned int ssid = 0; 654 unsigned int schid; 655 unsigned int devno; 656 bool have_devno = false; 657 bool found = false; 658 SubchDev *sch; 659 int num; 660 Error *err = NULL; 661 VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_GET_CLASS(dev); 662 663 sch = g_malloc0(sizeof(SubchDev)); 664 665 sch->driver_data = dev; 666 dev->sch = sch; 667 668 dev->indicators = NULL; 669 670 /* Initialize subchannel structure. */ 671 sch->channel_prog = 0x0; 672 sch->last_cmd_valid = false; 673 sch->thinint_active = false; 674 /* 675 * Use a device number if provided. Otherwise, fall back to subchannel 676 * number. 677 */ 678 if (dev->bus_id) { 679 num = sscanf(dev->bus_id, "%x.%x.%04x", &cssid, &ssid, &devno); 680 if (num == 3) { 681 if ((cssid > MAX_CSSID) || (ssid > MAX_SSID)) { 682 error_setg(errp, "Invalid cssid or ssid: cssid %x, ssid %x", 683 cssid, ssid); 684 goto out_err; 685 } 686 /* Enforce use of virtual cssid. */ 687 if (cssid != VIRTUAL_CSSID) { 688 error_setg(errp, "cssid %x not valid for virtio devices", 689 cssid); 690 goto out_err; 691 } 692 if (css_devno_used(cssid, ssid, devno)) { 693 error_setg(errp, "Device %x.%x.%04x already exists", 694 cssid, ssid, devno); 695 goto out_err; 696 } 697 sch->cssid = cssid; 698 sch->ssid = ssid; 699 sch->devno = devno; 700 have_devno = true; 701 } else { 702 error_setg(errp, "Malformed devno parameter '%s'", dev->bus_id); 703 goto out_err; 704 } 705 } 706 707 /* Find the next free id. */ 708 if (have_devno) { 709 for (schid = 0; schid <= MAX_SCHID; schid++) { 710 if (!css_find_subch(1, cssid, ssid, schid)) { 711 sch->schid = schid; 712 css_subch_assign(cssid, ssid, schid, devno, sch); 713 found = true; 714 break; 715 } 716 } 717 if (!found) { 718 error_setg(errp, "No free subchannel found for %x.%x.%04x", 719 cssid, ssid, devno); 720 goto out_err; 721 } 722 trace_virtio_ccw_new_device(cssid, ssid, schid, devno, 723 "user-configured"); 724 } else { 725 cssid = VIRTUAL_CSSID; 726 for (ssid = 0; ssid <= MAX_SSID; ssid++) { 727 for (schid = 0; schid <= MAX_SCHID; schid++) { 728 if (!css_find_subch(1, cssid, ssid, schid)) { 729 sch->cssid = cssid; 730 sch->ssid = ssid; 731 sch->schid = schid; 732 devno = schid; 733 /* 734 * If the devno is already taken, look further in this 735 * subchannel set. 736 */ 737 while (css_devno_used(cssid, ssid, devno)) { 738 if (devno == MAX_SCHID) { 739 devno = 0; 740 } else if (devno == schid - 1) { 741 error_setg(errp, "No free devno found"); 742 goto out_err; 743 } else { 744 devno++; 745 } 746 } 747 sch->devno = devno; 748 css_subch_assign(cssid, ssid, schid, devno, sch); 749 found = true; 750 break; 751 } 752 } 753 if (found) { 754 break; 755 } 756 } 757 if (!found) { 758 error_setg(errp, "Virtual channel subsystem is full!"); 759 goto out_err; 760 } 761 trace_virtio_ccw_new_device(cssid, ssid, schid, devno, 762 "auto-configured"); 763 } 764 765 /* Build initial schib. */ 766 css_sch_build_virtual_schib(sch, 0, VIRTIO_CCW_CHPID_TYPE); 767 768 sch->ccw_cb = virtio_ccw_cb; 769 770 /* Build senseid data. */ 771 memset(&sch->id, 0, sizeof(SenseId)); 772 sch->id.reserved = 0xff; 773 sch->id.cu_type = VIRTIO_CCW_CU_TYPE; 774 775 if (k->realize) { 776 k->realize(dev, &err); 777 } 778 if (err) { 779 error_propagate(errp, err); 780 css_subch_assign(cssid, ssid, schid, devno, NULL); 781 goto out_err; 782 } 783 784 return; 785 786 out_err: 787 dev->sch = NULL; 788 g_free(sch); 789 } 790 791 static int virtio_ccw_exit(VirtioCcwDevice *dev) 792 { 793 SubchDev *sch = dev->sch; 794 795 if (sch) { 796 css_subch_assign(sch->cssid, sch->ssid, sch->schid, sch->devno, NULL); 797 g_free(sch); 798 } 799 if (dev->indicators) { 800 release_indicator(&dev->routes.adapter, dev->indicators); 801 dev->indicators = NULL; 802 } 803 return 0; 804 } 805 806 static void virtio_ccw_net_realize(VirtioCcwDevice *ccw_dev, Error **errp) 807 { 808 DeviceState *qdev = DEVICE(ccw_dev); 809 VirtIONetCcw *dev = VIRTIO_NET_CCW(ccw_dev); 810 DeviceState *vdev = DEVICE(&dev->vdev); 811 Error *err = NULL; 812 813 virtio_net_set_netclient_name(&dev->vdev, qdev->id, 814 object_get_typename(OBJECT(qdev))); 815 qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); 816 object_property_set_bool(OBJECT(vdev), true, "realized", &err); 817 if (err) { 818 error_propagate(errp, err); 819 } 820 } 821 822 static void virtio_ccw_net_instance_init(Object *obj) 823 { 824 VirtIONetCcw *dev = VIRTIO_NET_CCW(obj); 825 826 virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), 827 TYPE_VIRTIO_NET); 828 object_property_add_alias(obj, "bootindex", OBJECT(&dev->vdev), 829 "bootindex", &error_abort); 830 } 831 832 static void virtio_ccw_blk_realize(VirtioCcwDevice *ccw_dev, Error **errp) 833 { 834 VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(ccw_dev); 835 DeviceState *vdev = DEVICE(&dev->vdev); 836 Error *err = NULL; 837 838 qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); 839 object_property_set_bool(OBJECT(vdev), true, "realized", &err); 840 if (err) { 841 error_propagate(errp, err); 842 } 843 } 844 845 static void virtio_ccw_blk_instance_init(Object *obj) 846 { 847 VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(obj); 848 849 virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), 850 TYPE_VIRTIO_BLK); 851 object_property_add_alias(obj, "iothread", OBJECT(&dev->vdev),"iothread", 852 &error_abort); 853 object_property_add_alias(obj, "bootindex", OBJECT(&dev->vdev), 854 "bootindex", &error_abort); 855 } 856 857 static void virtio_ccw_serial_realize(VirtioCcwDevice *ccw_dev, Error **errp) 858 { 859 VirtioSerialCcw *dev = VIRTIO_SERIAL_CCW(ccw_dev); 860 DeviceState *vdev = DEVICE(&dev->vdev); 861 DeviceState *proxy = DEVICE(ccw_dev); 862 Error *err = NULL; 863 char *bus_name; 864 865 /* 866 * For command line compatibility, this sets the virtio-serial-device bus 867 * name as before. 868 */ 869 if (proxy->id) { 870 bus_name = g_strdup_printf("%s.0", proxy->id); 871 virtio_device_set_child_bus_name(VIRTIO_DEVICE(vdev), bus_name); 872 g_free(bus_name); 873 } 874 875 qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); 876 object_property_set_bool(OBJECT(vdev), true, "realized", &err); 877 if (err) { 878 error_propagate(errp, err); 879 } 880 } 881 882 883 static void virtio_ccw_serial_instance_init(Object *obj) 884 { 885 VirtioSerialCcw *dev = VIRTIO_SERIAL_CCW(obj); 886 887 virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), 888 TYPE_VIRTIO_SERIAL); 889 } 890 891 static void virtio_ccw_balloon_realize(VirtioCcwDevice *ccw_dev, Error **errp) 892 { 893 VirtIOBalloonCcw *dev = VIRTIO_BALLOON_CCW(ccw_dev); 894 DeviceState *vdev = DEVICE(&dev->vdev); 895 Error *err = NULL; 896 897 qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); 898 object_property_set_bool(OBJECT(vdev), true, "realized", &err); 899 if (err) { 900 error_propagate(errp, err); 901 } 902 } 903 904 static void virtio_ccw_balloon_instance_init(Object *obj) 905 { 906 VirtIOBalloonCcw *dev = VIRTIO_BALLOON_CCW(obj); 907 908 virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), 909 TYPE_VIRTIO_BALLOON); 910 object_property_add_alias(obj, "guest-stats", OBJECT(&dev->vdev), 911 "guest-stats", &error_abort); 912 object_property_add_alias(obj, "guest-stats-polling-interval", 913 OBJECT(&dev->vdev), 914 "guest-stats-polling-interval", &error_abort); 915 } 916 917 static void virtio_ccw_scsi_realize(VirtioCcwDevice *ccw_dev, Error **errp) 918 { 919 VirtIOSCSICcw *dev = VIRTIO_SCSI_CCW(ccw_dev); 920 DeviceState *vdev = DEVICE(&dev->vdev); 921 DeviceState *qdev = DEVICE(ccw_dev); 922 Error *err = NULL; 923 char *bus_name; 924 925 /* 926 * For command line compatibility, this sets the virtio-scsi-device bus 927 * name as before. 928 */ 929 if (qdev->id) { 930 bus_name = g_strdup_printf("%s.0", qdev->id); 931 virtio_device_set_child_bus_name(VIRTIO_DEVICE(vdev), bus_name); 932 g_free(bus_name); 933 } 934 935 qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); 936 object_property_set_bool(OBJECT(vdev), true, "realized", &err); 937 if (err) { 938 error_propagate(errp, err); 939 } 940 } 941 942 static void virtio_ccw_scsi_instance_init(Object *obj) 943 { 944 VirtIOSCSICcw *dev = VIRTIO_SCSI_CCW(obj); 945 946 virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), 947 TYPE_VIRTIO_SCSI); 948 object_property_add_alias(obj, "iothread", OBJECT(&dev->vdev), "iothread", 949 &error_abort); 950 } 951 952 #ifdef CONFIG_VHOST_SCSI 953 static void vhost_ccw_scsi_realize(VirtioCcwDevice *ccw_dev, Error **errp) 954 { 955 VHostSCSICcw *dev = VHOST_SCSI_CCW(ccw_dev); 956 DeviceState *vdev = DEVICE(&dev->vdev); 957 Error *err = NULL; 958 959 qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); 960 object_property_set_bool(OBJECT(vdev), true, "realized", &err); 961 if (err) { 962 error_propagate(errp, err); 963 } 964 } 965 966 static void vhost_ccw_scsi_instance_init(Object *obj) 967 { 968 VHostSCSICcw *dev = VHOST_SCSI_CCW(obj); 969 970 virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), 971 TYPE_VHOST_SCSI); 972 } 973 #endif 974 975 static void virtio_ccw_rng_realize(VirtioCcwDevice *ccw_dev, Error **errp) 976 { 977 VirtIORNGCcw *dev = VIRTIO_RNG_CCW(ccw_dev); 978 DeviceState *vdev = DEVICE(&dev->vdev); 979 Error *err = NULL; 980 981 qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); 982 object_property_set_bool(OBJECT(vdev), true, "realized", &err); 983 if (err) { 984 error_propagate(errp, err); 985 return; 986 } 987 988 object_property_set_link(OBJECT(dev), 989 OBJECT(dev->vdev.conf.rng), "rng", 990 NULL); 991 } 992 993 /* DeviceState to VirtioCcwDevice. Note: used on datapath, 994 * be careful and test performance if you change this. 995 */ 996 static inline VirtioCcwDevice *to_virtio_ccw_dev_fast(DeviceState *d) 997 { 998 return container_of(d, VirtioCcwDevice, parent_obj); 999 } 1000 1001 static uint8_t virtio_set_ind_atomic(SubchDev *sch, uint64_t ind_loc, 1002 uint8_t to_be_set) 1003 { 1004 uint8_t ind_old, ind_new; 1005 hwaddr len = 1; 1006 uint8_t *ind_addr; 1007 1008 ind_addr = cpu_physical_memory_map(ind_loc, &len, 1); 1009 if (!ind_addr) { 1010 error_report("%s(%x.%x.%04x): unable to access indicator", 1011 __func__, sch->cssid, sch->ssid, sch->schid); 1012 return -1; 1013 } 1014 do { 1015 ind_old = *ind_addr; 1016 ind_new = ind_old | to_be_set; 1017 } while (atomic_cmpxchg(ind_addr, ind_old, ind_new) != ind_old); 1018 cpu_physical_memory_unmap(ind_addr, len, 1, len); 1019 1020 return ind_old; 1021 } 1022 1023 static void virtio_ccw_notify(DeviceState *d, uint16_t vector) 1024 { 1025 VirtioCcwDevice *dev = to_virtio_ccw_dev_fast(d); 1026 SubchDev *sch = dev->sch; 1027 uint64_t indicators; 1028 1029 if (vector >= 128) { 1030 return; 1031 } 1032 1033 if (vector < VIRTIO_CCW_QUEUE_MAX) { 1034 if (!dev->indicators) { 1035 return; 1036 } 1037 if (sch->thinint_active) { 1038 /* 1039 * In the adapter interrupt case, indicators points to a 1040 * memory area that may be (way) larger than 64 bit and 1041 * ind_bit indicates the start of the indicators in a big 1042 * endian notation. 1043 */ 1044 uint64_t ind_bit = dev->routes.adapter.ind_offset; 1045 1046 virtio_set_ind_atomic(sch, dev->indicators->addr + 1047 (ind_bit + vector) / 8, 1048 0x80 >> ((ind_bit + vector) % 8)); 1049 if (!virtio_set_ind_atomic(sch, dev->summary_indicator->addr, 1050 0x01)) { 1051 css_adapter_interrupt(dev->thinint_isc); 1052 } 1053 } else { 1054 indicators = address_space_ldq(&address_space_memory, 1055 dev->indicators->addr, 1056 MEMTXATTRS_UNSPECIFIED, 1057 NULL); 1058 indicators |= 1ULL << vector; 1059 address_space_stq(&address_space_memory, dev->indicators->addr, 1060 indicators, MEMTXATTRS_UNSPECIFIED, NULL); 1061 css_conditional_io_interrupt(sch); 1062 } 1063 } else { 1064 if (!dev->indicators2) { 1065 return; 1066 } 1067 vector = 0; 1068 indicators = address_space_ldq(&address_space_memory, 1069 dev->indicators2->addr, 1070 MEMTXATTRS_UNSPECIFIED, 1071 NULL); 1072 indicators |= 1ULL << vector; 1073 address_space_stq(&address_space_memory, dev->indicators2->addr, 1074 indicators, MEMTXATTRS_UNSPECIFIED, NULL); 1075 css_conditional_io_interrupt(sch); 1076 } 1077 } 1078 1079 static void virtio_ccw_reset(DeviceState *d) 1080 { 1081 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1082 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 1083 1084 virtio_ccw_stop_ioeventfd(dev); 1085 virtio_reset(vdev); 1086 css_reset_sch(dev->sch); 1087 if (dev->indicators) { 1088 release_indicator(&dev->routes.adapter, dev->indicators); 1089 dev->indicators = NULL; 1090 } 1091 if (dev->indicators2) { 1092 release_indicator(&dev->routes.adapter, dev->indicators2); 1093 dev->indicators2 = NULL; 1094 } 1095 if (dev->summary_indicator) { 1096 release_indicator(&dev->routes.adapter, dev->summary_indicator); 1097 dev->summary_indicator = NULL; 1098 } 1099 } 1100 1101 static void virtio_ccw_vmstate_change(DeviceState *d, bool running) 1102 { 1103 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1104 1105 if (running) { 1106 virtio_ccw_start_ioeventfd(dev); 1107 } else { 1108 virtio_ccw_stop_ioeventfd(dev); 1109 } 1110 } 1111 1112 static bool virtio_ccw_query_guest_notifiers(DeviceState *d) 1113 { 1114 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1115 1116 return !!(dev->sch->curr_status.pmcw.flags & PMCW_FLAGS_MASK_ENA); 1117 } 1118 1119 static int virtio_ccw_set_host_notifier(DeviceState *d, int n, bool assign) 1120 { 1121 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1122 1123 /* Stop using the generic ioeventfd, we are doing eventfd handling 1124 * ourselves below */ 1125 dev->ioeventfd_disabled = assign; 1126 if (assign) { 1127 virtio_ccw_stop_ioeventfd(dev); 1128 } 1129 return virtio_ccw_set_guest2host_notifier(dev, n, assign, false); 1130 } 1131 1132 static int virtio_ccw_get_mappings(VirtioCcwDevice *dev) 1133 { 1134 int r; 1135 1136 if (!dev->sch->thinint_active) { 1137 return -EINVAL; 1138 } 1139 1140 r = map_indicator(&dev->routes.adapter, dev->summary_indicator); 1141 if (r) { 1142 return r; 1143 } 1144 r = map_indicator(&dev->routes.adapter, dev->indicators); 1145 if (r) { 1146 return r; 1147 } 1148 dev->routes.adapter.summary_addr = dev->summary_indicator->map; 1149 dev->routes.adapter.ind_addr = dev->indicators->map; 1150 1151 return 0; 1152 } 1153 1154 static int virtio_ccw_setup_irqroutes(VirtioCcwDevice *dev, int nvqs) 1155 { 1156 int i; 1157 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 1158 int ret; 1159 S390FLICState *fs = s390_get_flic(); 1160 S390FLICStateClass *fsc = S390_FLIC_COMMON_GET_CLASS(fs); 1161 1162 ret = virtio_ccw_get_mappings(dev); 1163 if (ret) { 1164 return ret; 1165 } 1166 for (i = 0; i < nvqs; i++) { 1167 if (!virtio_queue_get_num(vdev, i)) { 1168 break; 1169 } 1170 } 1171 dev->routes.num_routes = i; 1172 return fsc->add_adapter_routes(fs, &dev->routes); 1173 } 1174 1175 static void virtio_ccw_release_irqroutes(VirtioCcwDevice *dev, int nvqs) 1176 { 1177 S390FLICState *fs = s390_get_flic(); 1178 S390FLICStateClass *fsc = S390_FLIC_COMMON_GET_CLASS(fs); 1179 1180 fsc->release_adapter_routes(fs, &dev->routes); 1181 } 1182 1183 static int virtio_ccw_add_irqfd(VirtioCcwDevice *dev, int n) 1184 { 1185 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 1186 VirtQueue *vq = virtio_get_queue(vdev, n); 1187 EventNotifier *notifier = virtio_queue_get_guest_notifier(vq); 1188 1189 return kvm_irqchip_add_irqfd_notifier(kvm_state, notifier, NULL, 1190 dev->routes.gsi[n]); 1191 } 1192 1193 static void virtio_ccw_remove_irqfd(VirtioCcwDevice *dev, int n) 1194 { 1195 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 1196 VirtQueue *vq = virtio_get_queue(vdev, n); 1197 EventNotifier *notifier = virtio_queue_get_guest_notifier(vq); 1198 int ret; 1199 1200 ret = kvm_irqchip_remove_irqfd_notifier(kvm_state, notifier, 1201 dev->routes.gsi[n]); 1202 assert(ret == 0); 1203 } 1204 1205 static int virtio_ccw_set_guest_notifier(VirtioCcwDevice *dev, int n, 1206 bool assign, bool with_irqfd) 1207 { 1208 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 1209 VirtQueue *vq = virtio_get_queue(vdev, n); 1210 EventNotifier *notifier = virtio_queue_get_guest_notifier(vq); 1211 VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); 1212 1213 if (assign) { 1214 int r = event_notifier_init(notifier, 0); 1215 1216 if (r < 0) { 1217 return r; 1218 } 1219 virtio_queue_set_guest_notifier_fd_handler(vq, true, with_irqfd); 1220 if (with_irqfd) { 1221 r = virtio_ccw_add_irqfd(dev, n); 1222 if (r) { 1223 virtio_queue_set_guest_notifier_fd_handler(vq, false, 1224 with_irqfd); 1225 return r; 1226 } 1227 } 1228 /* 1229 * We do not support individual masking for channel devices, so we 1230 * need to manually trigger any guest masking callbacks here. 1231 */ 1232 if (k->guest_notifier_mask) { 1233 k->guest_notifier_mask(vdev, n, false); 1234 } 1235 /* get lost events and re-inject */ 1236 if (k->guest_notifier_pending && 1237 k->guest_notifier_pending(vdev, n)) { 1238 event_notifier_set(notifier); 1239 } 1240 } else { 1241 if (k->guest_notifier_mask) { 1242 k->guest_notifier_mask(vdev, n, true); 1243 } 1244 if (with_irqfd) { 1245 virtio_ccw_remove_irqfd(dev, n); 1246 } 1247 virtio_queue_set_guest_notifier_fd_handler(vq, false, with_irqfd); 1248 event_notifier_cleanup(notifier); 1249 } 1250 return 0; 1251 } 1252 1253 static int virtio_ccw_set_guest_notifiers(DeviceState *d, int nvqs, 1254 bool assigned) 1255 { 1256 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1257 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 1258 bool with_irqfd = dev->sch->thinint_active && kvm_irqfds_enabled(); 1259 int r, n; 1260 1261 if (with_irqfd && assigned) { 1262 /* irq routes need to be set up before assigning irqfds */ 1263 r = virtio_ccw_setup_irqroutes(dev, nvqs); 1264 if (r < 0) { 1265 goto irqroute_error; 1266 } 1267 } 1268 for (n = 0; n < nvqs; n++) { 1269 if (!virtio_queue_get_num(vdev, n)) { 1270 break; 1271 } 1272 r = virtio_ccw_set_guest_notifier(dev, n, assigned, with_irqfd); 1273 if (r < 0) { 1274 goto assign_error; 1275 } 1276 } 1277 if (with_irqfd && !assigned) { 1278 /* release irq routes after irqfds have been released */ 1279 virtio_ccw_release_irqroutes(dev, nvqs); 1280 } 1281 return 0; 1282 1283 assign_error: 1284 while (--n >= 0) { 1285 virtio_ccw_set_guest_notifier(dev, n, !assigned, false); 1286 } 1287 irqroute_error: 1288 if (with_irqfd && assigned) { 1289 virtio_ccw_release_irqroutes(dev, nvqs); 1290 } 1291 return r; 1292 } 1293 1294 static void virtio_ccw_save_queue(DeviceState *d, int n, QEMUFile *f) 1295 { 1296 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1297 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 1298 1299 qemu_put_be16(f, virtio_queue_vector(vdev, n)); 1300 } 1301 1302 static int virtio_ccw_load_queue(DeviceState *d, int n, QEMUFile *f) 1303 { 1304 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1305 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 1306 uint16_t vector; 1307 1308 qemu_get_be16s(f, &vector); 1309 virtio_queue_set_vector(vdev, n , vector); 1310 1311 return 0; 1312 } 1313 1314 static void virtio_ccw_save_config(DeviceState *d, QEMUFile *f) 1315 { 1316 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1317 SubchDev *s = dev->sch; 1318 VirtIODevice *vdev = virtio_ccw_get_vdev(s); 1319 1320 subch_device_save(s, f); 1321 if (dev->indicators != NULL) { 1322 qemu_put_be32(f, dev->indicators->len); 1323 qemu_put_be64(f, dev->indicators->addr); 1324 } else { 1325 qemu_put_be32(f, 0); 1326 qemu_put_be64(f, 0UL); 1327 } 1328 if (dev->indicators2 != NULL) { 1329 qemu_put_be32(f, dev->indicators2->len); 1330 qemu_put_be64(f, dev->indicators2->addr); 1331 } else { 1332 qemu_put_be32(f, 0); 1333 qemu_put_be64(f, 0UL); 1334 } 1335 if (dev->summary_indicator != NULL) { 1336 qemu_put_be32(f, dev->summary_indicator->len); 1337 qemu_put_be64(f, dev->summary_indicator->addr); 1338 } else { 1339 qemu_put_be32(f, 0); 1340 qemu_put_be64(f, 0UL); 1341 } 1342 qemu_put_be16(f, vdev->config_vector); 1343 qemu_put_be64(f, dev->routes.adapter.ind_offset); 1344 qemu_put_byte(f, dev->thinint_isc); 1345 } 1346 1347 static int virtio_ccw_load_config(DeviceState *d, QEMUFile *f) 1348 { 1349 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1350 SubchDev *s = dev->sch; 1351 VirtIODevice *vdev = virtio_ccw_get_vdev(s); 1352 int len; 1353 1354 s->driver_data = dev; 1355 subch_device_load(s, f); 1356 len = qemu_get_be32(f); 1357 if (len != 0) { 1358 dev->indicators = get_indicator(qemu_get_be64(f), len); 1359 } else { 1360 qemu_get_be64(f); 1361 dev->indicators = NULL; 1362 } 1363 len = qemu_get_be32(f); 1364 if (len != 0) { 1365 dev->indicators2 = get_indicator(qemu_get_be64(f), len); 1366 } else { 1367 qemu_get_be64(f); 1368 dev->indicators2 = NULL; 1369 } 1370 len = qemu_get_be32(f); 1371 if (len != 0) { 1372 dev->summary_indicator = get_indicator(qemu_get_be64(f), len); 1373 } else { 1374 qemu_get_be64(f); 1375 dev->summary_indicator = NULL; 1376 } 1377 qemu_get_be16s(f, &vdev->config_vector); 1378 dev->routes.adapter.ind_offset = qemu_get_be64(f); 1379 dev->thinint_isc = qemu_get_byte(f); 1380 if (s->thinint_active) { 1381 return css_register_io_adapter(CSS_IO_ADAPTER_VIRTIO, 1382 dev->thinint_isc, true, false, 1383 &dev->routes.adapter.adapter_id); 1384 } 1385 1386 return 0; 1387 } 1388 1389 /* This is called by virtio-bus just after the device is plugged. */ 1390 static void virtio_ccw_device_plugged(DeviceState *d, Error **errp) 1391 { 1392 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1393 VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); 1394 SubchDev *sch = dev->sch; 1395 int n = virtio_get_num_queues(vdev); 1396 1397 if (virtio_get_num_queues(vdev) > VIRTIO_CCW_QUEUE_MAX) { 1398 error_setg(errp, "The nubmer of virtqueues %d " 1399 "exceeds ccw limit %d", n, 1400 VIRTIO_CCW_QUEUE_MAX); 1401 return; 1402 } 1403 1404 if (!kvm_eventfds_enabled()) { 1405 dev->flags &= ~VIRTIO_CCW_FLAG_USE_IOEVENTFD; 1406 } 1407 1408 sch->id.cu_model = virtio_bus_get_vdev_id(&dev->bus); 1409 1410 css_generate_sch_crws(sch->cssid, sch->ssid, sch->schid, 1411 d->hotplugged, 1); 1412 } 1413 1414 static void virtio_ccw_device_unplugged(DeviceState *d) 1415 { 1416 VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); 1417 1418 virtio_ccw_stop_ioeventfd(dev); 1419 } 1420 /**************** Virtio-ccw Bus Device Descriptions *******************/ 1421 1422 static Property virtio_ccw_net_properties[] = { 1423 DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), 1424 DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, 1425 VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), 1426 DEFINE_PROP_END_OF_LIST(), 1427 }; 1428 1429 static void virtio_ccw_net_class_init(ObjectClass *klass, void *data) 1430 { 1431 DeviceClass *dc = DEVICE_CLASS(klass); 1432 VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass); 1433 1434 k->realize = virtio_ccw_net_realize; 1435 k->exit = virtio_ccw_exit; 1436 dc->reset = virtio_ccw_reset; 1437 dc->props = virtio_ccw_net_properties; 1438 set_bit(DEVICE_CATEGORY_NETWORK, dc->categories); 1439 } 1440 1441 static const TypeInfo virtio_ccw_net = { 1442 .name = TYPE_VIRTIO_NET_CCW, 1443 .parent = TYPE_VIRTIO_CCW_DEVICE, 1444 .instance_size = sizeof(VirtIONetCcw), 1445 .instance_init = virtio_ccw_net_instance_init, 1446 .class_init = virtio_ccw_net_class_init, 1447 }; 1448 1449 static Property virtio_ccw_blk_properties[] = { 1450 DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), 1451 DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, 1452 VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), 1453 DEFINE_PROP_END_OF_LIST(), 1454 }; 1455 1456 static void virtio_ccw_blk_class_init(ObjectClass *klass, void *data) 1457 { 1458 DeviceClass *dc = DEVICE_CLASS(klass); 1459 VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass); 1460 1461 k->realize = virtio_ccw_blk_realize; 1462 k->exit = virtio_ccw_exit; 1463 dc->reset = virtio_ccw_reset; 1464 dc->props = virtio_ccw_blk_properties; 1465 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1466 } 1467 1468 static const TypeInfo virtio_ccw_blk = { 1469 .name = TYPE_VIRTIO_BLK_CCW, 1470 .parent = TYPE_VIRTIO_CCW_DEVICE, 1471 .instance_size = sizeof(VirtIOBlkCcw), 1472 .instance_init = virtio_ccw_blk_instance_init, 1473 .class_init = virtio_ccw_blk_class_init, 1474 }; 1475 1476 static Property virtio_ccw_serial_properties[] = { 1477 DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), 1478 DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, 1479 VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), 1480 DEFINE_PROP_END_OF_LIST(), 1481 }; 1482 1483 static void virtio_ccw_serial_class_init(ObjectClass *klass, void *data) 1484 { 1485 DeviceClass *dc = DEVICE_CLASS(klass); 1486 VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass); 1487 1488 k->realize = virtio_ccw_serial_realize; 1489 k->exit = virtio_ccw_exit; 1490 dc->reset = virtio_ccw_reset; 1491 dc->props = virtio_ccw_serial_properties; 1492 set_bit(DEVICE_CATEGORY_INPUT, dc->categories); 1493 } 1494 1495 static const TypeInfo virtio_ccw_serial = { 1496 .name = TYPE_VIRTIO_SERIAL_CCW, 1497 .parent = TYPE_VIRTIO_CCW_DEVICE, 1498 .instance_size = sizeof(VirtioSerialCcw), 1499 .instance_init = virtio_ccw_serial_instance_init, 1500 .class_init = virtio_ccw_serial_class_init, 1501 }; 1502 1503 static Property virtio_ccw_balloon_properties[] = { 1504 DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), 1505 DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, 1506 VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), 1507 DEFINE_PROP_END_OF_LIST(), 1508 }; 1509 1510 static void virtio_ccw_balloon_class_init(ObjectClass *klass, void *data) 1511 { 1512 DeviceClass *dc = DEVICE_CLASS(klass); 1513 VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass); 1514 1515 k->realize = virtio_ccw_balloon_realize; 1516 k->exit = virtio_ccw_exit; 1517 dc->reset = virtio_ccw_reset; 1518 dc->props = virtio_ccw_balloon_properties; 1519 set_bit(DEVICE_CATEGORY_MISC, dc->categories); 1520 } 1521 1522 static const TypeInfo virtio_ccw_balloon = { 1523 .name = TYPE_VIRTIO_BALLOON_CCW, 1524 .parent = TYPE_VIRTIO_CCW_DEVICE, 1525 .instance_size = sizeof(VirtIOBalloonCcw), 1526 .instance_init = virtio_ccw_balloon_instance_init, 1527 .class_init = virtio_ccw_balloon_class_init, 1528 }; 1529 1530 static Property virtio_ccw_scsi_properties[] = { 1531 DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), 1532 DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, 1533 VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), 1534 DEFINE_PROP_END_OF_LIST(), 1535 }; 1536 1537 static void virtio_ccw_scsi_class_init(ObjectClass *klass, void *data) 1538 { 1539 DeviceClass *dc = DEVICE_CLASS(klass); 1540 VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass); 1541 1542 k->realize = virtio_ccw_scsi_realize; 1543 k->exit = virtio_ccw_exit; 1544 dc->reset = virtio_ccw_reset; 1545 dc->props = virtio_ccw_scsi_properties; 1546 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1547 } 1548 1549 static const TypeInfo virtio_ccw_scsi = { 1550 .name = TYPE_VIRTIO_SCSI_CCW, 1551 .parent = TYPE_VIRTIO_CCW_DEVICE, 1552 .instance_size = sizeof(VirtIOSCSICcw), 1553 .instance_init = virtio_ccw_scsi_instance_init, 1554 .class_init = virtio_ccw_scsi_class_init, 1555 }; 1556 1557 #ifdef CONFIG_VHOST_SCSI 1558 static Property vhost_ccw_scsi_properties[] = { 1559 DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), 1560 DEFINE_PROP_END_OF_LIST(), 1561 }; 1562 1563 static void vhost_ccw_scsi_class_init(ObjectClass *klass, void *data) 1564 { 1565 DeviceClass *dc = DEVICE_CLASS(klass); 1566 VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass); 1567 1568 k->realize = vhost_ccw_scsi_realize; 1569 k->exit = virtio_ccw_exit; 1570 dc->reset = virtio_ccw_reset; 1571 dc->props = vhost_ccw_scsi_properties; 1572 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1573 } 1574 1575 static const TypeInfo vhost_ccw_scsi = { 1576 .name = TYPE_VHOST_SCSI_CCW, 1577 .parent = TYPE_VIRTIO_CCW_DEVICE, 1578 .instance_size = sizeof(VHostSCSICcw), 1579 .instance_init = vhost_ccw_scsi_instance_init, 1580 .class_init = vhost_ccw_scsi_class_init, 1581 }; 1582 #endif 1583 1584 static void virtio_ccw_rng_instance_init(Object *obj) 1585 { 1586 VirtIORNGCcw *dev = VIRTIO_RNG_CCW(obj); 1587 1588 virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), 1589 TYPE_VIRTIO_RNG); 1590 object_property_add_alias(obj, "rng", OBJECT(&dev->vdev), 1591 "rng", &error_abort); 1592 } 1593 1594 static Property virtio_ccw_rng_properties[] = { 1595 DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), 1596 DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, 1597 VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), 1598 DEFINE_PROP_END_OF_LIST(), 1599 }; 1600 1601 static void virtio_ccw_rng_class_init(ObjectClass *klass, void *data) 1602 { 1603 DeviceClass *dc = DEVICE_CLASS(klass); 1604 VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass); 1605 1606 k->realize = virtio_ccw_rng_realize; 1607 k->exit = virtio_ccw_exit; 1608 dc->reset = virtio_ccw_reset; 1609 dc->props = virtio_ccw_rng_properties; 1610 set_bit(DEVICE_CATEGORY_MISC, dc->categories); 1611 } 1612 1613 static const TypeInfo virtio_ccw_rng = { 1614 .name = TYPE_VIRTIO_RNG_CCW, 1615 .parent = TYPE_VIRTIO_CCW_DEVICE, 1616 .instance_size = sizeof(VirtIORNGCcw), 1617 .instance_init = virtio_ccw_rng_instance_init, 1618 .class_init = virtio_ccw_rng_class_init, 1619 }; 1620 1621 static void virtio_ccw_busdev_realize(DeviceState *dev, Error **errp) 1622 { 1623 VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev; 1624 1625 virtio_ccw_bus_new(&_dev->bus, sizeof(_dev->bus), _dev); 1626 virtio_ccw_device_realize(_dev, errp); 1627 } 1628 1629 static int virtio_ccw_busdev_exit(DeviceState *dev) 1630 { 1631 VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev; 1632 VirtIOCCWDeviceClass *_info = VIRTIO_CCW_DEVICE_GET_CLASS(dev); 1633 1634 return _info->exit(_dev); 1635 } 1636 1637 static void virtio_ccw_busdev_unplug(HotplugHandler *hotplug_dev, 1638 DeviceState *dev, Error **errp) 1639 { 1640 VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev; 1641 SubchDev *sch = _dev->sch; 1642 1643 virtio_ccw_stop_ioeventfd(_dev); 1644 1645 /* 1646 * We should arrive here only for device_del, since we don't support 1647 * direct hot(un)plug of channels, but only through virtio. 1648 */ 1649 assert(sch != NULL); 1650 /* Subchannel is now disabled and no longer valid. */ 1651 sch->curr_status.pmcw.flags &= ~(PMCW_FLAGS_MASK_ENA | 1652 PMCW_FLAGS_MASK_DNV); 1653 1654 css_generate_sch_crws(sch->cssid, sch->ssid, sch->schid, 1, 0); 1655 1656 object_unparent(OBJECT(dev)); 1657 } 1658 1659 static void virtio_ccw_device_class_init(ObjectClass *klass, void *data) 1660 { 1661 DeviceClass *dc = DEVICE_CLASS(klass); 1662 1663 dc->realize = virtio_ccw_busdev_realize; 1664 dc->exit = virtio_ccw_busdev_exit; 1665 dc->bus_type = TYPE_VIRTUAL_CSS_BUS; 1666 } 1667 1668 static const TypeInfo virtio_ccw_device_info = { 1669 .name = TYPE_VIRTIO_CCW_DEVICE, 1670 .parent = TYPE_DEVICE, 1671 .instance_size = sizeof(VirtioCcwDevice), 1672 .class_init = virtio_ccw_device_class_init, 1673 .class_size = sizeof(VirtIOCCWDeviceClass), 1674 .abstract = true, 1675 }; 1676 1677 /***************** Virtual-css Bus Bridge Device ********************/ 1678 /* Only required to have the virtio bus as child in the system bus */ 1679 1680 static int virtual_css_bridge_init(SysBusDevice *dev) 1681 { 1682 /* nothing */ 1683 return 0; 1684 } 1685 1686 static void virtual_css_bridge_class_init(ObjectClass *klass, void *data) 1687 { 1688 SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); 1689 HotplugHandlerClass *hc = HOTPLUG_HANDLER_CLASS(klass); 1690 DeviceClass *dc = DEVICE_CLASS(klass); 1691 1692 k->init = virtual_css_bridge_init; 1693 hc->unplug = virtio_ccw_busdev_unplug; 1694 set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories); 1695 } 1696 1697 static const TypeInfo virtual_css_bridge_info = { 1698 .name = "virtual-css-bridge", 1699 .parent = TYPE_SYS_BUS_DEVICE, 1700 .instance_size = sizeof(SysBusDevice), 1701 .class_init = virtual_css_bridge_class_init, 1702 .interfaces = (InterfaceInfo[]) { 1703 { TYPE_HOTPLUG_HANDLER }, 1704 { } 1705 } 1706 }; 1707 1708 /* virtio-ccw-bus */ 1709 1710 static void virtio_ccw_bus_new(VirtioBusState *bus, size_t bus_size, 1711 VirtioCcwDevice *dev) 1712 { 1713 DeviceState *qdev = DEVICE(dev); 1714 char virtio_bus_name[] = "virtio-bus"; 1715 1716 qbus_create_inplace(bus, bus_size, TYPE_VIRTIO_CCW_BUS, 1717 qdev, virtio_bus_name); 1718 } 1719 1720 static void virtio_ccw_bus_class_init(ObjectClass *klass, void *data) 1721 { 1722 VirtioBusClass *k = VIRTIO_BUS_CLASS(klass); 1723 BusClass *bus_class = BUS_CLASS(klass); 1724 1725 bus_class->max_dev = 1; 1726 k->notify = virtio_ccw_notify; 1727 k->vmstate_change = virtio_ccw_vmstate_change; 1728 k->query_guest_notifiers = virtio_ccw_query_guest_notifiers; 1729 k->set_host_notifier = virtio_ccw_set_host_notifier; 1730 k->set_guest_notifiers = virtio_ccw_set_guest_notifiers; 1731 k->save_queue = virtio_ccw_save_queue; 1732 k->load_queue = virtio_ccw_load_queue; 1733 k->save_config = virtio_ccw_save_config; 1734 k->load_config = virtio_ccw_load_config; 1735 k->device_plugged = virtio_ccw_device_plugged; 1736 k->device_unplugged = virtio_ccw_device_unplugged; 1737 } 1738 1739 static const TypeInfo virtio_ccw_bus_info = { 1740 .name = TYPE_VIRTIO_CCW_BUS, 1741 .parent = TYPE_VIRTIO_BUS, 1742 .instance_size = sizeof(VirtioCcwBusState), 1743 .class_init = virtio_ccw_bus_class_init, 1744 }; 1745 1746 #ifdef CONFIG_VIRTFS 1747 static Property virtio_ccw_9p_properties[] = { 1748 DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), 1749 DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, 1750 VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), 1751 DEFINE_PROP_END_OF_LIST(), 1752 }; 1753 1754 static void virtio_ccw_9p_realize(VirtioCcwDevice *ccw_dev, Error **errp) 1755 { 1756 V9fsCCWState *dev = VIRTIO_9P_CCW(ccw_dev); 1757 DeviceState *vdev = DEVICE(&dev->vdev); 1758 Error *err = NULL; 1759 1760 qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); 1761 object_property_set_bool(OBJECT(vdev), true, "realized", &err); 1762 if (err) { 1763 error_propagate(errp, err); 1764 } 1765 } 1766 1767 static void virtio_ccw_9p_class_init(ObjectClass *klass, void *data) 1768 { 1769 DeviceClass *dc = DEVICE_CLASS(klass); 1770 VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_CLASS(klass); 1771 1772 k->exit = virtio_ccw_exit; 1773 k->realize = virtio_ccw_9p_realize; 1774 dc->reset = virtio_ccw_reset; 1775 dc->props = virtio_ccw_9p_properties; 1776 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 1777 } 1778 1779 static void virtio_ccw_9p_instance_init(Object *obj) 1780 { 1781 V9fsCCWState *dev = VIRTIO_9P_CCW(obj); 1782 1783 virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), 1784 TYPE_VIRTIO_9P); 1785 } 1786 1787 static const TypeInfo virtio_ccw_9p_info = { 1788 .name = TYPE_VIRTIO_9P_CCW, 1789 .parent = TYPE_VIRTIO_CCW_DEVICE, 1790 .instance_size = sizeof(V9fsCCWState), 1791 .instance_init = virtio_ccw_9p_instance_init, 1792 .class_init = virtio_ccw_9p_class_init, 1793 }; 1794 #endif 1795 1796 static void virtio_ccw_register(void) 1797 { 1798 type_register_static(&virtio_ccw_bus_info); 1799 type_register_static(&virtual_css_bus_info); 1800 type_register_static(&virtio_ccw_device_info); 1801 type_register_static(&virtio_ccw_serial); 1802 type_register_static(&virtio_ccw_blk); 1803 type_register_static(&virtio_ccw_net); 1804 type_register_static(&virtio_ccw_balloon); 1805 type_register_static(&virtio_ccw_scsi); 1806 #ifdef CONFIG_VHOST_SCSI 1807 type_register_static(&vhost_ccw_scsi); 1808 #endif 1809 type_register_static(&virtio_ccw_rng); 1810 type_register_static(&virtual_css_bridge_info); 1811 #ifdef CONFIG_VIRTFS 1812 type_register_static(&virtio_ccw_9p_info); 1813 #endif 1814 } 1815 1816 type_init(virtio_ccw_register) 1817