xref: /openbmc/qemu/hw/vfio/ccw.c (revision 65d1a2bd)
1 /*
2  * vfio based subchannel assignment support
3  *
4  * Copyright 2017 IBM Corp.
5  * Copyright 2019 Red Hat, Inc.
6  *
7  * Author(s): Dong Jia Shi <bjsdjshi@linux.vnet.ibm.com>
8  *            Xiao Feng Ren <renxiaof@linux.vnet.ibm.com>
9  *            Pierre Morel <pmorel@linux.vnet.ibm.com>
10  *            Cornelia Huck <cohuck@redhat.com>
11  *
12  * This work is licensed under the terms of the GNU GPL, version 2 or (at
13  * your option) any later version. See the COPYING file in the top-level
14  * directory.
15  */
16 
17 #include "qemu/osdep.h"
18 #include <linux/vfio.h>
19 #include <linux/vfio_ccw.h>
20 #include <sys/ioctl.h>
21 
22 #include "qapi/error.h"
23 #include "hw/vfio/vfio.h"
24 #include "hw/vfio/vfio-common.h"
25 #include "hw/s390x/s390-ccw.h"
26 #include "hw/s390x/vfio-ccw.h"
27 #include "hw/qdev-properties.h"
28 #include "hw/s390x/ccw-device.h"
29 #include "exec/address-spaces.h"
30 #include "qemu/error-report.h"
31 #include "qemu/main-loop.h"
32 #include "qemu/module.h"
33 
34 struct VFIOCCWDevice {
35     S390CCWDevice cdev;
36     VFIODevice vdev;
37     uint64_t io_region_size;
38     uint64_t io_region_offset;
39     struct ccw_io_region *io_region;
40     uint64_t async_cmd_region_size;
41     uint64_t async_cmd_region_offset;
42     struct ccw_cmd_region *async_cmd_region;
43     uint64_t schib_region_size;
44     uint64_t schib_region_offset;
45     struct ccw_schib_region *schib_region;
46     uint64_t crw_region_size;
47     uint64_t crw_region_offset;
48     struct ccw_crw_region *crw_region;
49     EventNotifier io_notifier;
50     EventNotifier crw_notifier;
51     EventNotifier req_notifier;
52     bool force_orb_pfch;
53     bool warned_orb_pfch;
54 };
55 
56 static inline void warn_once_pfch(VFIOCCWDevice *vcdev, SubchDev *sch,
57                                   const char *msg)
58 {
59     warn_report_once_cond(&vcdev->warned_orb_pfch,
60                           "vfio-ccw (devno %x.%x.%04x): %s",
61                           sch->cssid, sch->ssid, sch->devno, msg);
62 }
63 
64 static void vfio_ccw_compute_needs_reset(VFIODevice *vdev)
65 {
66     vdev->needs_reset = false;
67 }
68 
69 /*
70  * We don't need vfio_hot_reset_multi and vfio_eoi operations for
71  * vfio_ccw device now.
72  */
73 struct VFIODeviceOps vfio_ccw_ops = {
74     .vfio_compute_needs_reset = vfio_ccw_compute_needs_reset,
75 };
76 
77 static IOInstEnding vfio_ccw_handle_request(SubchDev *sch)
78 {
79     S390CCWDevice *cdev = sch->driver_data;
80     VFIOCCWDevice *vcdev = DO_UPCAST(VFIOCCWDevice, cdev, cdev);
81     struct ccw_io_region *region = vcdev->io_region;
82     int ret;
83 
84     if (!(sch->orb.ctrl0 & ORB_CTRL0_MASK_PFCH) && vcdev->force_orb_pfch) {
85         sch->orb.ctrl0 |= ORB_CTRL0_MASK_PFCH;
86         warn_once_pfch(vcdev, sch, "PFCH flag forced");
87     }
88 
89     QEMU_BUILD_BUG_ON(sizeof(region->orb_area) != sizeof(ORB));
90     QEMU_BUILD_BUG_ON(sizeof(region->scsw_area) != sizeof(SCSW));
91     QEMU_BUILD_BUG_ON(sizeof(region->irb_area) != sizeof(IRB));
92 
93     memset(region, 0, sizeof(*region));
94 
95     memcpy(region->orb_area, &sch->orb, sizeof(ORB));
96     memcpy(region->scsw_area, &sch->curr_status.scsw, sizeof(SCSW));
97 
98 again:
99     ret = pwrite(vcdev->vdev.fd, region,
100                  vcdev->io_region_size, vcdev->io_region_offset);
101     if (ret != vcdev->io_region_size) {
102         if (errno == EAGAIN) {
103             goto again;
104         }
105         error_report("vfio-ccw: write I/O region failed with errno=%d", errno);
106         ret = errno ? -errno : -EFAULT;
107     } else {
108         ret = 0;
109     }
110     switch (ret) {
111     case 0:
112         return IOINST_CC_EXPECTED;
113     case -EBUSY:
114         return IOINST_CC_BUSY;
115     case -ENODEV:
116     case -EACCES:
117         return IOINST_CC_NOT_OPERATIONAL;
118     case -EFAULT:
119     default:
120         sch_gen_unit_exception(sch);
121         css_inject_io_interrupt(sch);
122         return IOINST_CC_EXPECTED;
123     }
124 }
125 
126 static IOInstEnding vfio_ccw_handle_store(SubchDev *sch)
127 {
128     S390CCWDevice *cdev = sch->driver_data;
129     VFIOCCWDevice *vcdev = DO_UPCAST(VFIOCCWDevice, cdev, cdev);
130     SCHIB *schib = &sch->curr_status;
131     struct ccw_schib_region *region = vcdev->schib_region;
132     SCHIB *s;
133     int ret;
134 
135     /* schib region not available so nothing else to do */
136     if (!region) {
137         return IOINST_CC_EXPECTED;
138     }
139 
140     memset(region, 0, sizeof(*region));
141     ret = pread(vcdev->vdev.fd, region, vcdev->schib_region_size,
142                 vcdev->schib_region_offset);
143 
144     if (ret == -1) {
145         /*
146          * Device is probably damaged, but store subchannel does not
147          * have a nonzero cc defined for this scenario.  Log an error,
148          * and presume things are otherwise fine.
149          */
150         error_report("vfio-ccw: store region read failed with errno=%d", errno);
151         return IOINST_CC_EXPECTED;
152     }
153 
154     /*
155      * Selectively copy path-related bits of the SCHIB,
156      * rather than copying the entire struct.
157      */
158     s = (SCHIB *)region->schib_area;
159     schib->pmcw.pnom = s->pmcw.pnom;
160     schib->pmcw.lpum = s->pmcw.lpum;
161     schib->pmcw.pam = s->pmcw.pam;
162     schib->pmcw.pom = s->pmcw.pom;
163 
164     if (s->scsw.flags & SCSW_FLAGS_MASK_PNO) {
165         schib->scsw.flags |= SCSW_FLAGS_MASK_PNO;
166     }
167 
168     return IOINST_CC_EXPECTED;
169 }
170 
171 static int vfio_ccw_handle_clear(SubchDev *sch)
172 {
173     S390CCWDevice *cdev = sch->driver_data;
174     VFIOCCWDevice *vcdev = DO_UPCAST(VFIOCCWDevice, cdev, cdev);
175     struct ccw_cmd_region *region = vcdev->async_cmd_region;
176     int ret;
177 
178     if (!vcdev->async_cmd_region) {
179         /* Async command region not available, fall back to emulation */
180         return -ENOSYS;
181     }
182 
183     memset(region, 0, sizeof(*region));
184     region->command = VFIO_CCW_ASYNC_CMD_CSCH;
185 
186 again:
187     ret = pwrite(vcdev->vdev.fd, region,
188                  vcdev->async_cmd_region_size, vcdev->async_cmd_region_offset);
189     if (ret != vcdev->async_cmd_region_size) {
190         if (errno == EAGAIN) {
191             goto again;
192         }
193         error_report("vfio-ccw: write cmd region failed with errno=%d", errno);
194         ret = errno ? -errno : -EFAULT;
195     } else {
196         ret = 0;
197     }
198     switch (ret) {
199     case 0:
200     case -ENODEV:
201     case -EACCES:
202         return 0;
203     case -EFAULT:
204     default:
205         sch_gen_unit_exception(sch);
206         css_inject_io_interrupt(sch);
207         return 0;
208     }
209 }
210 
211 static int vfio_ccw_handle_halt(SubchDev *sch)
212 {
213     S390CCWDevice *cdev = sch->driver_data;
214     VFIOCCWDevice *vcdev = DO_UPCAST(VFIOCCWDevice, cdev, cdev);
215     struct ccw_cmd_region *region = vcdev->async_cmd_region;
216     int ret;
217 
218     if (!vcdev->async_cmd_region) {
219         /* Async command region not available, fall back to emulation */
220         return -ENOSYS;
221     }
222 
223     memset(region, 0, sizeof(*region));
224     region->command = VFIO_CCW_ASYNC_CMD_HSCH;
225 
226 again:
227     ret = pwrite(vcdev->vdev.fd, region,
228                  vcdev->async_cmd_region_size, vcdev->async_cmd_region_offset);
229     if (ret != vcdev->async_cmd_region_size) {
230         if (errno == EAGAIN) {
231             goto again;
232         }
233         error_report("vfio-ccw: write cmd region failed with errno=%d", errno);
234         ret = errno ? -errno : -EFAULT;
235     } else {
236         ret = 0;
237     }
238     switch (ret) {
239     case 0:
240     case -EBUSY:
241     case -ENODEV:
242     case -EACCES:
243         return 0;
244     case -EFAULT:
245     default:
246         sch_gen_unit_exception(sch);
247         css_inject_io_interrupt(sch);
248         return 0;
249     }
250 }
251 
252 static void vfio_ccw_reset(DeviceState *dev)
253 {
254     CcwDevice *ccw_dev = DO_UPCAST(CcwDevice, parent_obj, dev);
255     S390CCWDevice *cdev = DO_UPCAST(S390CCWDevice, parent_obj, ccw_dev);
256     VFIOCCWDevice *vcdev = DO_UPCAST(VFIOCCWDevice, cdev, cdev);
257 
258     ioctl(vcdev->vdev.fd, VFIO_DEVICE_RESET);
259 }
260 
261 static void vfio_ccw_crw_read(VFIOCCWDevice *vcdev)
262 {
263     struct ccw_crw_region *region = vcdev->crw_region;
264     CRW crw;
265     int size;
266 
267     /* Keep reading CRWs as long as data is returned */
268     do {
269         memset(region, 0, sizeof(*region));
270         size = pread(vcdev->vdev.fd, region, vcdev->crw_region_size,
271                      vcdev->crw_region_offset);
272 
273         if (size == -1) {
274             error_report("vfio-ccw: Read crw region failed with errno=%d",
275                          errno);
276             break;
277         }
278 
279         if (region->crw == 0) {
280             /* No more CRWs to queue */
281             break;
282         }
283 
284         memcpy(&crw, &region->crw, sizeof(CRW));
285 
286         css_crw_add_to_queue(crw);
287     } while (1);
288 }
289 
290 static void vfio_ccw_req_notifier_handler(void *opaque)
291 {
292     VFIOCCWDevice *vcdev = opaque;
293     Error *err = NULL;
294 
295     if (!event_notifier_test_and_clear(&vcdev->req_notifier)) {
296         return;
297     }
298 
299     qdev_unplug(DEVICE(vcdev), &err);
300     if (err) {
301         warn_reportf_err(err, VFIO_MSG_PREFIX, vcdev->vdev.name);
302     }
303 }
304 
305 static void vfio_ccw_crw_notifier_handler(void *opaque)
306 {
307     VFIOCCWDevice *vcdev = opaque;
308 
309     while (event_notifier_test_and_clear(&vcdev->crw_notifier)) {
310         vfio_ccw_crw_read(vcdev);
311     }
312 }
313 
314 static void vfio_ccw_io_notifier_handler(void *opaque)
315 {
316     VFIOCCWDevice *vcdev = opaque;
317     struct ccw_io_region *region = vcdev->io_region;
318     S390CCWDevice *cdev = S390_CCW_DEVICE(vcdev);
319     CcwDevice *ccw_dev = CCW_DEVICE(cdev);
320     SubchDev *sch = ccw_dev->sch;
321     SCHIB *schib = &sch->curr_status;
322     SCSW s;
323     IRB irb;
324     ESW esw;
325     int size;
326 
327     if (!event_notifier_test_and_clear(&vcdev->io_notifier)) {
328         return;
329     }
330 
331     size = pread(vcdev->vdev.fd, region, vcdev->io_region_size,
332                  vcdev->io_region_offset);
333     if (size == -1) {
334         switch (errno) {
335         case ENODEV:
336             /* Generate a deferred cc 3 condition. */
337             schib->scsw.flags |= SCSW_FLAGS_MASK_CC;
338             schib->scsw.ctrl &= ~SCSW_CTRL_MASK_STCTL;
339             schib->scsw.ctrl |= (SCSW_STCTL_ALERT | SCSW_STCTL_STATUS_PEND);
340             goto read_err;
341         case EFAULT:
342             /* Memory problem, generate channel data check. */
343             schib->scsw.ctrl &= ~SCSW_ACTL_START_PEND;
344             schib->scsw.cstat = SCSW_CSTAT_DATA_CHECK;
345             schib->scsw.ctrl &= ~SCSW_CTRL_MASK_STCTL;
346             schib->scsw.ctrl |= SCSW_STCTL_PRIMARY | SCSW_STCTL_SECONDARY |
347                        SCSW_STCTL_ALERT | SCSW_STCTL_STATUS_PEND;
348             goto read_err;
349         default:
350             /* Error, generate channel program check. */
351             schib->scsw.ctrl &= ~SCSW_ACTL_START_PEND;
352             schib->scsw.cstat = SCSW_CSTAT_PROG_CHECK;
353             schib->scsw.ctrl &= ~SCSW_CTRL_MASK_STCTL;
354             schib->scsw.ctrl |= SCSW_STCTL_PRIMARY | SCSW_STCTL_SECONDARY |
355                        SCSW_STCTL_ALERT | SCSW_STCTL_STATUS_PEND;
356             goto read_err;
357         }
358     } else if (size != vcdev->io_region_size) {
359         /* Information transfer error, generate channel-control check. */
360         schib->scsw.ctrl &= ~SCSW_ACTL_START_PEND;
361         schib->scsw.cstat = SCSW_CSTAT_CHN_CTRL_CHK;
362         schib->scsw.ctrl &= ~SCSW_CTRL_MASK_STCTL;
363         schib->scsw.ctrl |= SCSW_STCTL_PRIMARY | SCSW_STCTL_SECONDARY |
364                    SCSW_STCTL_ALERT | SCSW_STCTL_STATUS_PEND;
365         goto read_err;
366     }
367 
368     memcpy(&irb, region->irb_area, sizeof(IRB));
369 
370     /* Update control block via irb. */
371     s = schib->scsw;
372     copy_scsw_to_guest(&s, &irb.scsw);
373     schib->scsw = s;
374 
375     copy_esw_to_guest(&esw, &irb.esw);
376     sch->esw = esw;
377 
378     /* If a uint check is pending, copy sense data. */
379     if ((schib->scsw.dstat & SCSW_DSTAT_UNIT_CHECK) &&
380         (schib->pmcw.chars & PMCW_CHARS_MASK_CSENSE)) {
381         memcpy(sch->sense_data, irb.ecw, sizeof(irb.ecw));
382     }
383 
384 read_err:
385     css_inject_io_interrupt(sch);
386 }
387 
388 static void vfio_ccw_register_irq_notifier(VFIOCCWDevice *vcdev,
389                                            unsigned int irq,
390                                            Error **errp)
391 {
392     VFIODevice *vdev = &vcdev->vdev;
393     struct vfio_irq_info *irq_info;
394     size_t argsz;
395     int fd;
396     EventNotifier *notifier;
397     IOHandler *fd_read;
398 
399     switch (irq) {
400     case VFIO_CCW_IO_IRQ_INDEX:
401         notifier = &vcdev->io_notifier;
402         fd_read = vfio_ccw_io_notifier_handler;
403         break;
404     case VFIO_CCW_CRW_IRQ_INDEX:
405         notifier = &vcdev->crw_notifier;
406         fd_read = vfio_ccw_crw_notifier_handler;
407         break;
408     case VFIO_CCW_REQ_IRQ_INDEX:
409         notifier = &vcdev->req_notifier;
410         fd_read = vfio_ccw_req_notifier_handler;
411         break;
412     default:
413         error_setg(errp, "vfio: Unsupported device irq(%d)", irq);
414         return;
415     }
416 
417     if (vdev->num_irqs < irq + 1) {
418         error_setg(errp, "vfio: IRQ %u not available (number of irqs %u)",
419                    irq, vdev->num_irqs);
420         return;
421     }
422 
423     argsz = sizeof(*irq_info);
424     irq_info = g_malloc0(argsz);
425     irq_info->index = irq;
426     irq_info->argsz = argsz;
427     if (ioctl(vdev->fd, VFIO_DEVICE_GET_IRQ_INFO,
428               irq_info) < 0 || irq_info->count < 1) {
429         error_setg_errno(errp, errno, "vfio: Error getting irq info");
430         goto out_free_info;
431     }
432 
433     if (event_notifier_init(notifier, 0)) {
434         error_setg_errno(errp, errno,
435                          "vfio: Unable to init event notifier for irq (%d)",
436                          irq);
437         goto out_free_info;
438     }
439 
440     fd = event_notifier_get_fd(notifier);
441     qemu_set_fd_handler(fd, fd_read, NULL, vcdev);
442 
443     if (vfio_set_irq_signaling(vdev, irq, 0,
444                                VFIO_IRQ_SET_ACTION_TRIGGER, fd, errp)) {
445         qemu_set_fd_handler(fd, NULL, NULL, vcdev);
446         event_notifier_cleanup(notifier);
447     }
448 
449 out_free_info:
450     g_free(irq_info);
451 }
452 
453 static void vfio_ccw_unregister_irq_notifier(VFIOCCWDevice *vcdev,
454                                              unsigned int irq)
455 {
456     Error *err = NULL;
457     EventNotifier *notifier;
458 
459     switch (irq) {
460     case VFIO_CCW_IO_IRQ_INDEX:
461         notifier = &vcdev->io_notifier;
462         break;
463     case VFIO_CCW_CRW_IRQ_INDEX:
464         notifier = &vcdev->crw_notifier;
465         break;
466     case VFIO_CCW_REQ_IRQ_INDEX:
467         notifier = &vcdev->req_notifier;
468         break;
469     default:
470         error_report("vfio: Unsupported device irq(%d)", irq);
471         return;
472     }
473 
474     if (vfio_set_irq_signaling(&vcdev->vdev, irq, 0,
475                                VFIO_IRQ_SET_ACTION_TRIGGER, -1, &err)) {
476         warn_reportf_err(err, VFIO_MSG_PREFIX, vcdev->vdev.name);
477     }
478 
479     qemu_set_fd_handler(event_notifier_get_fd(notifier),
480                         NULL, NULL, vcdev);
481     event_notifier_cleanup(notifier);
482 }
483 
484 static void vfio_ccw_get_region(VFIOCCWDevice *vcdev, Error **errp)
485 {
486     VFIODevice *vdev = &vcdev->vdev;
487     struct vfio_region_info *info;
488     int ret;
489 
490     /* Sanity check device */
491     if (!(vdev->flags & VFIO_DEVICE_FLAGS_CCW)) {
492         error_setg(errp, "vfio: Um, this isn't a vfio-ccw device");
493         return;
494     }
495 
496     /*
497      * We always expect at least the I/O region to be present. We also
498      * may have a variable number of regions governed by capabilities.
499      */
500     if (vdev->num_regions < VFIO_CCW_CONFIG_REGION_INDEX + 1) {
501         error_setg(errp, "vfio: too few regions (%u), expected at least %u",
502                    vdev->num_regions, VFIO_CCW_CONFIG_REGION_INDEX + 1);
503         return;
504     }
505 
506     ret = vfio_get_region_info(vdev, VFIO_CCW_CONFIG_REGION_INDEX, &info);
507     if (ret) {
508         error_setg_errno(errp, -ret, "vfio: Error getting config info");
509         return;
510     }
511 
512     vcdev->io_region_size = info->size;
513     if (sizeof(*vcdev->io_region) != vcdev->io_region_size) {
514         error_setg(errp, "vfio: Unexpected size of the I/O region");
515         goto out_err;
516     }
517 
518     vcdev->io_region_offset = info->offset;
519     vcdev->io_region = g_malloc0(info->size);
520     g_free(info);
521 
522     /* check for the optional async command region */
523     ret = vfio_get_dev_region_info(vdev, VFIO_REGION_TYPE_CCW,
524                                    VFIO_REGION_SUBTYPE_CCW_ASYNC_CMD, &info);
525     if (!ret) {
526         vcdev->async_cmd_region_size = info->size;
527         if (sizeof(*vcdev->async_cmd_region) != vcdev->async_cmd_region_size) {
528             error_setg(errp, "vfio: Unexpected size of the async cmd region");
529             goto out_err;
530         }
531         vcdev->async_cmd_region_offset = info->offset;
532         vcdev->async_cmd_region = g_malloc0(info->size);
533         g_free(info);
534     }
535 
536     ret = vfio_get_dev_region_info(vdev, VFIO_REGION_TYPE_CCW,
537                                    VFIO_REGION_SUBTYPE_CCW_SCHIB, &info);
538     if (!ret) {
539         vcdev->schib_region_size = info->size;
540         if (sizeof(*vcdev->schib_region) != vcdev->schib_region_size) {
541             error_setg(errp, "vfio: Unexpected size of the schib region");
542             goto out_err;
543         }
544         vcdev->schib_region_offset = info->offset;
545         vcdev->schib_region = g_malloc(info->size);
546         g_free(info);
547     }
548 
549     ret = vfio_get_dev_region_info(vdev, VFIO_REGION_TYPE_CCW,
550                                    VFIO_REGION_SUBTYPE_CCW_CRW, &info);
551 
552     if (!ret) {
553         vcdev->crw_region_size = info->size;
554         if (sizeof(*vcdev->crw_region) != vcdev->crw_region_size) {
555             error_setg(errp, "vfio: Unexpected size of the CRW region");
556             goto out_err;
557         }
558         vcdev->crw_region_offset = info->offset;
559         vcdev->crw_region = g_malloc(info->size);
560         g_free(info);
561     }
562 
563     return;
564 
565 out_err:
566     g_free(vcdev->crw_region);
567     g_free(vcdev->schib_region);
568     g_free(vcdev->async_cmd_region);
569     g_free(vcdev->io_region);
570     g_free(info);
571     return;
572 }
573 
574 static void vfio_ccw_put_region(VFIOCCWDevice *vcdev)
575 {
576     g_free(vcdev->crw_region);
577     g_free(vcdev->schib_region);
578     g_free(vcdev->async_cmd_region);
579     g_free(vcdev->io_region);
580 }
581 
582 static void vfio_ccw_put_device(VFIOCCWDevice *vcdev)
583 {
584     g_free(vcdev->vdev.name);
585     vfio_put_base_device(&vcdev->vdev);
586 }
587 
588 static void vfio_ccw_get_device(VFIOGroup *group, VFIOCCWDevice *vcdev,
589                                 Error **errp)
590 {
591     char *name = g_strdup_printf("%x.%x.%04x", vcdev->cdev.hostid.cssid,
592                                  vcdev->cdev.hostid.ssid,
593                                  vcdev->cdev.hostid.devid);
594     VFIODevice *vbasedev;
595 
596     QLIST_FOREACH(vbasedev, &group->device_list, next) {
597         if (strcmp(vbasedev->name, name) == 0) {
598             error_setg(errp, "vfio: subchannel %s has already been attached",
599                        name);
600             goto out_err;
601         }
602     }
603 
604     /*
605      * All vfio-ccw devices are believed to operate in a way compatible with
606      * discarding of memory in RAM blocks, ie. pages pinned in the host are
607      * in the current working set of the guest driver and therefore never
608      * overlap e.g., with pages available to the guest balloon driver.  This
609      * needs to be set before vfio_get_device() for vfio common to handle
610      * ram_block_discard_disable().
611      */
612     vcdev->vdev.ram_block_discard_allowed = true;
613 
614     if (vfio_get_device(group, vcdev->cdev.mdevid, &vcdev->vdev, errp)) {
615         goto out_err;
616     }
617 
618     vcdev->vdev.ops = &vfio_ccw_ops;
619     vcdev->vdev.type = VFIO_DEVICE_TYPE_CCW;
620     vcdev->vdev.name = name;
621     vcdev->vdev.dev = &vcdev->cdev.parent_obj.parent_obj;
622 
623     return;
624 
625 out_err:
626     g_free(name);
627 }
628 
629 static VFIOGroup *vfio_ccw_get_group(S390CCWDevice *cdev, Error **errp)
630 {
631     char *tmp, group_path[PATH_MAX];
632     ssize_t len;
633     int groupid;
634 
635     tmp = g_strdup_printf("/sys/bus/css/devices/%x.%x.%04x/%s/iommu_group",
636                           cdev->hostid.cssid, cdev->hostid.ssid,
637                           cdev->hostid.devid, cdev->mdevid);
638     len = readlink(tmp, group_path, sizeof(group_path));
639     g_free(tmp);
640 
641     if (len <= 0 || len >= sizeof(group_path)) {
642         error_setg(errp, "vfio: no iommu_group found");
643         return NULL;
644     }
645 
646     group_path[len] = 0;
647 
648     if (sscanf(basename(group_path), "%d", &groupid) != 1) {
649         error_setg(errp, "vfio: failed to read %s", group_path);
650         return NULL;
651     }
652 
653     return vfio_get_group(groupid, &address_space_memory, errp);
654 }
655 
656 static void vfio_ccw_realize(DeviceState *dev, Error **errp)
657 {
658     VFIOGroup *group;
659     CcwDevice *ccw_dev = DO_UPCAST(CcwDevice, parent_obj, dev);
660     S390CCWDevice *cdev = DO_UPCAST(S390CCWDevice, parent_obj, ccw_dev);
661     VFIOCCWDevice *vcdev = DO_UPCAST(VFIOCCWDevice, cdev, cdev);
662     S390CCWDeviceClass *cdc = S390_CCW_DEVICE_GET_CLASS(cdev);
663     Error *err = NULL;
664 
665     /* Call the class init function for subchannel. */
666     if (cdc->realize) {
667         cdc->realize(cdev, vcdev->vdev.sysfsdev, &err);
668         if (err) {
669             goto out_err_propagate;
670         }
671     }
672 
673     group = vfio_ccw_get_group(cdev, &err);
674     if (!group) {
675         goto out_group_err;
676     }
677 
678     vfio_ccw_get_device(group, vcdev, &err);
679     if (err) {
680         goto out_device_err;
681     }
682 
683     vfio_ccw_get_region(vcdev, &err);
684     if (err) {
685         goto out_region_err;
686     }
687 
688     vfio_ccw_register_irq_notifier(vcdev, VFIO_CCW_IO_IRQ_INDEX, &err);
689     if (err) {
690         goto out_io_notifier_err;
691     }
692 
693     if (vcdev->crw_region) {
694         vfio_ccw_register_irq_notifier(vcdev, VFIO_CCW_CRW_IRQ_INDEX, &err);
695         if (err) {
696             goto out_irq_notifier_err;
697         }
698     }
699 
700     vfio_ccw_register_irq_notifier(vcdev, VFIO_CCW_REQ_IRQ_INDEX, &err);
701     if (err) {
702         /*
703          * Report this error, but do not make it a failing condition.
704          * Lack of this IRQ in the host does not prevent normal operation.
705          */
706         error_report_err(err);
707     }
708 
709     return;
710 
711 out_irq_notifier_err:
712     vfio_ccw_unregister_irq_notifier(vcdev, VFIO_CCW_REQ_IRQ_INDEX);
713     vfio_ccw_unregister_irq_notifier(vcdev, VFIO_CCW_CRW_IRQ_INDEX);
714     vfio_ccw_unregister_irq_notifier(vcdev, VFIO_CCW_IO_IRQ_INDEX);
715 out_io_notifier_err:
716     vfio_ccw_put_region(vcdev);
717 out_region_err:
718     vfio_ccw_put_device(vcdev);
719 out_device_err:
720     vfio_put_group(group);
721 out_group_err:
722     if (cdc->unrealize) {
723         cdc->unrealize(cdev);
724     }
725 out_err_propagate:
726     error_propagate(errp, err);
727 }
728 
729 static void vfio_ccw_unrealize(DeviceState *dev)
730 {
731     CcwDevice *ccw_dev = DO_UPCAST(CcwDevice, parent_obj, dev);
732     S390CCWDevice *cdev = DO_UPCAST(S390CCWDevice, parent_obj, ccw_dev);
733     VFIOCCWDevice *vcdev = DO_UPCAST(VFIOCCWDevice, cdev, cdev);
734     S390CCWDeviceClass *cdc = S390_CCW_DEVICE_GET_CLASS(cdev);
735     VFIOGroup *group = vcdev->vdev.group;
736 
737     vfio_ccw_unregister_irq_notifier(vcdev, VFIO_CCW_REQ_IRQ_INDEX);
738     vfio_ccw_unregister_irq_notifier(vcdev, VFIO_CCW_CRW_IRQ_INDEX);
739     vfio_ccw_unregister_irq_notifier(vcdev, VFIO_CCW_IO_IRQ_INDEX);
740     vfio_ccw_put_region(vcdev);
741     vfio_ccw_put_device(vcdev);
742     vfio_put_group(group);
743 
744     if (cdc->unrealize) {
745         cdc->unrealize(cdev);
746     }
747 }
748 
749 static Property vfio_ccw_properties[] = {
750     DEFINE_PROP_STRING("sysfsdev", VFIOCCWDevice, vdev.sysfsdev),
751     DEFINE_PROP_BOOL("force-orb-pfch", VFIOCCWDevice, force_orb_pfch, false),
752     DEFINE_PROP_END_OF_LIST(),
753 };
754 
755 static const VMStateDescription vfio_ccw_vmstate = {
756     .name = "vfio-ccw",
757     .unmigratable = 1,
758 };
759 
760 static void vfio_ccw_class_init(ObjectClass *klass, void *data)
761 {
762     DeviceClass *dc = DEVICE_CLASS(klass);
763     S390CCWDeviceClass *cdc = S390_CCW_DEVICE_CLASS(klass);
764 
765     device_class_set_props(dc, vfio_ccw_properties);
766     dc->vmsd = &vfio_ccw_vmstate;
767     dc->desc = "VFIO-based subchannel assignment";
768     set_bit(DEVICE_CATEGORY_MISC, dc->categories);
769     dc->realize = vfio_ccw_realize;
770     dc->unrealize = vfio_ccw_unrealize;
771     dc->reset = vfio_ccw_reset;
772 
773     cdc->handle_request = vfio_ccw_handle_request;
774     cdc->handle_halt = vfio_ccw_handle_halt;
775     cdc->handle_clear = vfio_ccw_handle_clear;
776     cdc->handle_store = vfio_ccw_handle_store;
777 }
778 
779 static const TypeInfo vfio_ccw_info = {
780     .name = TYPE_VFIO_CCW,
781     .parent = TYPE_S390_CCW,
782     .instance_size = sizeof(VFIOCCWDevice),
783     .class_init = vfio_ccw_class_init,
784 };
785 
786 static void register_vfio_ccw_type(void)
787 {
788     type_register_static(&vfio_ccw_info);
789 }
790 
791 type_init(register_vfio_ccw_type)
792