]>
Commit | Line | Data |
---|---|---|
a5cf2bb4 CH |
1 | /* |
2 | * virtio ccw target implementation | |
3 | * | |
de6a9218 | 4 | * Copyright 2012,2015 IBM Corp. |
a5cf2bb4 | 5 | * Author(s): Cornelia Huck <cornelia.huck@de.ibm.com> |
de6a9218 | 6 | * Pierre Morel <pmorel@linux.vnet.ibm.com> |
a5cf2bb4 CH |
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" | |
4be74634 | 14 | #include "sysemu/block-backend.h" |
a5cf2bb4 CH |
15 | #include "sysemu/blockdev.h" |
16 | #include "sysemu/sysemu.h" | |
17 | #include "net/net.h" | |
0d09e41a PB |
18 | #include "hw/virtio/virtio.h" |
19 | #include "hw/virtio/virtio-serial.h" | |
20 | #include "hw/virtio/virtio-net.h" | |
a5cf2bb4 CH |
21 | #include "hw/sysbus.h" |
22 | #include "qemu/bitops.h" | |
d49b6836 | 23 | #include "qemu/error-report.h" |
0d09e41a | 24 | #include "hw/virtio/virtio-bus.h" |
d426d9fb CH |
25 | #include "hw/s390x/adapter.h" |
26 | #include "hw/s390x/s390_flic.h" | |
a5cf2bb4 CH |
27 | |
28 | #include "ioinst.h" | |
29 | #include "css.h" | |
30 | #include "virtio-ccw.h" | |
31 | #include "trace.h" | |
32 | ||
7bca3892 CH |
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 | ||
d426d9fb CH |
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) | |
7bca3892 CH |
64 | { |
65 | assert(indicator->refcnt > 0); | |
66 | indicator->refcnt--; | |
67 | if (indicator->refcnt > 0) { | |
68 | return; | |
69 | } | |
70 | QTAILQ_REMOVE(&indicator_addresses, indicator, sibling); | |
d426d9fb CH |
71 | if (indicator->map) { |
72 | s390_io_adapter_map(adapter, indicator->map, false); | |
73 | } | |
7bca3892 CH |
74 | g_free(indicator); |
75 | } | |
76 | ||
d426d9fb CH |
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 | ||
1bf4d7aa AF |
96 | static void virtio_ccw_bus_new(VirtioBusState *bus, size_t bus_size, |
97 | VirtioCcwDevice *dev); | |
d51fcfac | 98 | |
dcc20931 | 99 | static void virtual_css_bus_reset(BusState *qbus) |
a5cf2bb4 CH |
100 | { |
101 | /* This should actually be modelled via the generic css */ | |
102 | css_reset(); | |
a5cf2bb4 CH |
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 | ||
a5cf2bb4 CH |
120 | VirtIODevice *virtio_ccw_get_vdev(SubchDev *sch) |
121 | { | |
122 | VirtIODevice *vdev = NULL; | |
f24a6840 | 123 | VirtioCcwDevice *dev = sch->driver_data; |
a5cf2bb4 | 124 | |
f24a6840 PB |
125 | if (dev) { |
126 | vdev = virtio_bus_get_device(&dev->bus); | |
a5cf2bb4 CH |
127 | } |
128 | return vdev; | |
129 | } | |
130 | ||
b4436a0b CH |
131 | static int virtio_ccw_set_guest2host_notifier(VirtioCcwDevice *dev, int n, |
132 | bool assign, bool set_handler) | |
133 | { | |
f24a6840 PB |
134 | VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); |
135 | VirtQueue *vq = virtio_get_queue(vdev, n); | |
b4436a0b CH |
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); | |
cc3ac9c4 | 148 | r = s390_assign_subch_ioeventfd(notifier, sch_id, n, assign); |
b4436a0b CH |
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); | |
cc3ac9c4 | 157 | s390_assign_subch_ioeventfd(notifier, sch_id, n, assign); |
b4436a0b CH |
158 | event_notifier_cleanup(notifier); |
159 | } | |
160 | return r; | |
161 | } | |
162 | ||
163 | static void virtio_ccw_start_ioeventfd(VirtioCcwDevice *dev) | |
164 | { | |
f24a6840 | 165 | VirtIODevice *vdev; |
b4436a0b CH |
166 | int n, r; |
167 | ||
168 | if (!(dev->flags & VIRTIO_CCW_FLAG_USE_IOEVENTFD) || | |
320ce850 | 169 | dev->ioeventfd_disabled || |
b4436a0b CH |
170 | dev->ioeventfd_started) { |
171 | return; | |
172 | } | |
f24a6840 | 173 | vdev = virtio_bus_get_device(&dev->bus); |
8dfbaa6a | 174 | for (n = 0; n < VIRTIO_CCW_QUEUE_MAX; n++) { |
f24a6840 | 175 | if (!virtio_queue_get_num(vdev, n)) { |
b4436a0b CH |
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) { | |
f24a6840 | 188 | if (!virtio_queue_get_num(vdev, n)) { |
b4436a0b CH |
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 | { | |
f24a6840 | 202 | VirtIODevice *vdev; |
b4436a0b CH |
203 | int n, r; |
204 | ||
205 | if (!dev->ioeventfd_started) { | |
206 | return; | |
207 | } | |
f24a6840 | 208 | vdev = virtio_bus_get_device(&dev->bus); |
8dfbaa6a | 209 | for (n = 0; n < VIRTIO_CCW_QUEUE_MAX; n++) { |
f24a6840 | 210 | if (!virtio_queue_get_num(vdev, n)) { |
b4436a0b CH |
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 | ||
a5cf2bb4 CH |
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 */ | |
277bc95e | 234 | qbus_set_hotplug_handler(bus, dev, &error_abort); |
a5cf2bb4 CH |
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 | ||
7e749462 CH |
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 | ||
a5cf2bb4 CH |
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 | { | |
f24a6840 | 268 | VirtIODevice *vdev = virtio_ccw_get_vdev(sch); |
a5cf2bb4 | 269 | |
8dfbaa6a | 270 | if (index >= VIRTIO_CCW_QUEUE_MAX) { |
a5cf2bb4 CH |
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 | ||
f24a6840 | 279 | if (!vdev) { |
a5cf2bb4 CH |
280 | return -EINVAL; |
281 | } | |
282 | ||
f24a6840 | 283 | virtio_queue_set_addr(vdev, index, addr); |
a5cf2bb4 | 284 | if (!addr) { |
955cc8c9 | 285 | virtio_queue_set_vector(vdev, index, VIRTIO_NO_VECTOR); |
a5cf2bb4 CH |
286 | } else { |
287 | /* Fail if we don't have a big enough queue. */ | |
288 | /* TODO: Add interface to handle vring.num changing */ | |
f24a6840 | 289 | if (virtio_queue_get_num(vdev, index) > num) { |
a5cf2bb4 CH |
290 | return -EINVAL; |
291 | } | |
f24a6840 | 292 | virtio_queue_set_vector(vdev, index, index); |
a5cf2bb4 CH |
293 | } |
294 | /* tell notify handler in case of config change */ | |
8dfbaa6a | 295 | vdev->config_vector = VIRTIO_CCW_QUEUE_MAX; |
a5cf2bb4 CH |
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; | |
f24a6840 | 309 | VirtIODevice *vdev = virtio_ccw_get_vdev(sch); |
a5cf2bb4 CH |
310 | bool check_len; |
311 | int len; | |
312 | hwaddr hw_len; | |
7e749462 | 313 | VirtioThinintInfo *thinint; |
a5cf2bb4 CH |
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 { | |
42874d3a PM |
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); | |
a5cf2bb4 CH |
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: | |
b4436a0b | 362 | virtio_ccw_stop_ioeventfd(dev); |
f24a6840 | 363 | virtio_reset(vdev); |
a5cf2bb4 CH |
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 { | |
42874d3a PM |
380 | features.index = address_space_ldub(&address_space_memory, |
381 | ccw.cda | |
382 | + sizeof(features.features), | |
383 | MEMTXATTRS_UNSPECIFIED, | |
384 | NULL); | |
6b8f1020 CH |
385 | if (features.index == 0) { |
386 | features.features = vdev->host_features; | |
a5cf2bb4 CH |
387 | } else { |
388 | /* Return zeroes if the guest supports more feature bits. */ | |
389 | features.features = 0; | |
390 | } | |
42874d3a PM |
391 | address_space_stl_le(&address_space_memory, ccw.cda, |
392 | features.features, MEMTXATTRS_UNSPECIFIED, | |
393 | NULL); | |
a5cf2bb4 CH |
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 { | |
42874d3a PM |
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); | |
6b8f1020 | 421 | if (features.index == 0) { |
a590fd5b | 422 | virtio_set_features(vdev, features.features); |
a5cf2bb4 CH |
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) { | |
f24a6840 | 440 | if (ccw.count > vdev->config_len) { |
a5cf2bb4 CH |
441 | ret = -EINVAL; |
442 | break; | |
443 | } | |
444 | } | |
f24a6840 | 445 | len = MIN(ccw.count, vdev->config_len); |
a5cf2bb4 CH |
446 | if (!ccw.cda) { |
447 | ret = -EFAULT; | |
448 | } else { | |
f24a6840 | 449 | virtio_bus_get_vdev_config(&dev->bus, vdev->config); |
a5cf2bb4 | 450 | /* XXX config space endianness */ |
f24a6840 | 451 | cpu_physical_memory_write(ccw.cda, vdev->config, len); |
a5cf2bb4 CH |
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) { | |
f24a6840 | 458 | if (ccw.count > vdev->config_len) { |
a5cf2bb4 CH |
459 | ret = -EINVAL; |
460 | break; | |
461 | } | |
462 | } | |
f24a6840 | 463 | len = MIN(ccw.count, vdev->config_len); |
a5cf2bb4 CH |
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 */ | |
f24a6840 | 474 | memcpy(vdev->config, config, len); |
a5cf2bb4 | 475 | cpu_physical_memory_unmap(config, hw_len, 0, hw_len); |
f24a6840 | 476 | virtio_bus_set_vdev_config(&dev->bus, vdev->config); |
a5cf2bb4 CH |
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 { | |
42874d3a PM |
496 | status = address_space_ldub(&address_space_memory, ccw.cda, |
497 | MEMTXATTRS_UNSPECIFIED, NULL); | |
b4436a0b CH |
498 | if (!(status & VIRTIO_CONFIG_S_DRIVER_OK)) { |
499 | virtio_ccw_stop_ioeventfd(dev); | |
500 | } | |
0b352fd6 CH |
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; | |
b4436a0b | 513 | } |
a5cf2bb4 CH |
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 | } | |
7e749462 CH |
527 | if (sch->thinint_active) { |
528 | /* Trigger a command reject. */ | |
529 | ret = -ENOSYS; | |
530 | break; | |
531 | } | |
d1db1fa8 | 532 | if (!ccw.cda) { |
a5cf2bb4 CH |
533 | ret = -EFAULT; |
534 | } else { | |
42874d3a PM |
535 | indicators = address_space_ldq_be(&address_space_memory, ccw.cda, |
536 | MEMTXATTRS_UNSPECIFIED, NULL); | |
7bca3892 | 537 | dev->indicators = get_indicator(indicators, sizeof(uint64_t)); |
a5cf2bb4 CH |
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 | } | |
d1db1fa8 | 553 | if (!ccw.cda) { |
a5cf2bb4 CH |
554 | ret = -EFAULT; |
555 | } else { | |
42874d3a PM |
556 | indicators = address_space_ldq_be(&address_space_memory, ccw.cda, |
557 | MEMTXATTRS_UNSPECIFIED, NULL); | |
7bca3892 | 558 | dev->indicators2 = get_indicator(indicators, sizeof(uint64_t)); |
a5cf2bb4 CH |
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 { | |
42874d3a PM |
577 | vq_config.index = address_space_lduw_be(&address_space_memory, |
578 | ccw.cda, | |
579 | MEMTXATTRS_UNSPECIFIED, | |
580 | NULL); | |
8dfbaa6a | 581 | if (vq_config.index >= VIRTIO_CCW_QUEUE_MAX) { |
d03a3630 CH |
582 | ret = -EINVAL; |
583 | break; | |
584 | } | |
f24a6840 | 585 | vq_config.num_max = virtio_queue_get_num(vdev, |
a5cf2bb4 | 586 | vq_config.index); |
42874d3a PM |
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); | |
a5cf2bb4 CH |
592 | sch->curr_status.scsw.count = ccw.count - sizeof(vq_config); |
593 | ret = 0; | |
594 | } | |
595 | break; | |
7e749462 CH |
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 { | |
7d45285f CH |
619 | uint64_t ind_bit = ldq_be_p(&thinint->ind_bit); |
620 | ||
7e749462 | 621 | len = hw_len; |
7bca3892 | 622 | dev->summary_indicator = |
7d45285f CH |
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); | |
7e749462 | 628 | dev->thinint_isc = thinint->isc; |
7d45285f | 629 | dev->routes.adapter.ind_offset = ind_bit; |
d426d9fb | 630 | dev->routes.adapter.summary_offset = 7; |
7e749462 | 631 | cpu_physical_memory_unmap(thinint, hw_len, 0, hw_len); |
03cf077a CH |
632 | ret = css_register_io_adapter(CSS_IO_ADAPTER_VIRTIO, |
633 | dev->thinint_isc, true, false, | |
d426d9fb | 634 | &dev->routes.adapter.adapter_id); |
03cf077a | 635 | assert(ret == 0); |
7bca3892 CH |
636 | sch->thinint_active = ((dev->indicators != NULL) && |
637 | (dev->summary_indicator != NULL)); | |
7e749462 CH |
638 | sch->curr_status.scsw.count = ccw.count - len; |
639 | ret = 0; | |
640 | } | |
641 | } | |
642 | break; | |
a5cf2bb4 | 643 | default: |
8d034a6f | 644 | ret = -ENOSYS; |
a5cf2bb4 CH |
645 | break; |
646 | } | |
647 | return ret; | |
648 | } | |
649 | ||
1fa75523 | 650 | static void virtio_ccw_device_realize(VirtioCcwDevice *dev, Error **errp) |
a5cf2bb4 CH |
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; | |
a5cf2bb4 | 659 | int num; |
1fa75523 CH |
660 | Error *err = NULL; |
661 | VirtIOCCWDeviceClass *k = VIRTIO_CCW_DEVICE_GET_CLASS(dev); | |
a5cf2bb4 CH |
662 | |
663 | sch = g_malloc0(sizeof(SubchDev)); | |
664 | ||
665 | sch->driver_data = dev; | |
666 | dev->sch = sch; | |
667 | ||
7bca3892 | 668 | dev->indicators = NULL; |
a5cf2bb4 CH |
669 | |
670 | /* Initialize subchannel structure. */ | |
671 | sch->channel_prog = 0x0; | |
672 | sch->last_cmd_valid = false; | |
7e749462 | 673 | sch->thinint_active = false; |
a5cf2bb4 CH |
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)) { | |
5e5ced38 MA |
682 | error_setg(errp, "Invalid cssid or ssid: cssid %x, ssid %x", |
683 | cssid, ssid); | |
a5cf2bb4 CH |
684 | goto out_err; |
685 | } | |
686 | /* Enforce use of virtual cssid. */ | |
687 | if (cssid != VIRTUAL_CSSID) { | |
5e5ced38 MA |
688 | error_setg(errp, "cssid %x not valid for virtio devices", |
689 | cssid); | |
a5cf2bb4 CH |
690 | goto out_err; |
691 | } | |
692 | if (css_devno_used(cssid, ssid, devno)) { | |
5e5ced38 MA |
693 | error_setg(errp, "Device %x.%x.%04x already exists", |
694 | cssid, ssid, devno); | |
a5cf2bb4 CH |
695 | goto out_err; |
696 | } | |
697 | sch->cssid = cssid; | |
698 | sch->ssid = ssid; | |
699 | sch->devno = devno; | |
700 | have_devno = true; | |
701 | } else { | |
5e5ced38 | 702 | error_setg(errp, "Malformed devno parameter '%s'", dev->bus_id); |
a5cf2bb4 CH |
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) { | |
5e5ced38 MA |
718 | error_setg(errp, "No free subchannel found for %x.%x.%04x", |
719 | cssid, ssid, devno); | |
a5cf2bb4 CH |
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) { | |
5e5ced38 | 741 | error_setg(errp, "No free devno found"); |
a5cf2bb4 CH |
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) { | |
5e5ced38 | 758 | error_setg(errp, "Virtual channel subsystem is full!"); |
a5cf2bb4 CH |
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; | |
1fa75523 CH |
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 | ||
5e5ced38 | 784 | return; |
a5cf2bb4 CH |
785 | |
786 | out_err: | |
787 | dev->sch = NULL; | |
788 | g_free(sch); | |
a5cf2bb4 CH |
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 | } | |
7bca3892 | 799 | if (dev->indicators) { |
d426d9fb | 800 | release_indicator(&dev->routes.adapter, dev->indicators); |
7bca3892 CH |
801 | dev->indicators = NULL; |
802 | } | |
a5cf2bb4 CH |
803 | return 0; |
804 | } | |
805 | ||
5e5ced38 | 806 | static void virtio_ccw_net_realize(VirtioCcwDevice *ccw_dev, Error **errp) |
a5cf2bb4 | 807 | { |
800ced8c | 808 | DeviceState *qdev = DEVICE(ccw_dev); |
89334c8b FK |
809 | VirtIONetCcw *dev = VIRTIO_NET_CCW(ccw_dev); |
810 | DeviceState *vdev = DEVICE(&dev->vdev); | |
5e5ced38 | 811 | Error *err = NULL; |
a5cf2bb4 | 812 | |
800ced8c FK |
813 | virtio_net_set_netclient_name(&dev->vdev, qdev->id, |
814 | object_get_typename(OBJECT(qdev))); | |
89334c8b | 815 | qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); |
5e5ced38 MA |
816 | object_property_set_bool(OBJECT(vdev), true, "realized", &err); |
817 | if (err) { | |
818 | error_propagate(errp, err); | |
a5cf2bb4 | 819 | } |
a5cf2bb4 CH |
820 | } |
821 | ||
89334c8b | 822 | static void virtio_ccw_net_instance_init(Object *obj) |
a5cf2bb4 | 823 | { |
89334c8b | 824 | VirtIONetCcw *dev = VIRTIO_NET_CCW(obj); |
c8075caf GA |
825 | |
826 | virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), | |
827 | TYPE_VIRTIO_NET); | |
0cf63c3e GA |
828 | object_property_add_alias(obj, "bootindex", OBJECT(&dev->vdev), |
829 | "bootindex", &error_abort); | |
a5cf2bb4 CH |
830 | } |
831 | ||
5e5ced38 | 832 | static void virtio_ccw_blk_realize(VirtioCcwDevice *ccw_dev, Error **errp) |
a5cf2bb4 | 833 | { |
3400c455 FK |
834 | VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(ccw_dev); |
835 | DeviceState *vdev = DEVICE(&dev->vdev); | |
5e5ced38 MA |
836 | Error *err = NULL; |
837 | ||
3400c455 | 838 | qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); |
5e5ced38 MA |
839 | object_property_set_bool(OBJECT(vdev), true, "realized", &err); |
840 | if (err) { | |
841 | error_propagate(errp, err); | |
a5cf2bb4 | 842 | } |
a5cf2bb4 CH |
843 | } |
844 | ||
3400c455 | 845 | static void virtio_ccw_blk_instance_init(Object *obj) |
a5cf2bb4 | 846 | { |
3400c455 | 847 | VirtIOBlkCcw *dev = VIRTIO_BLK_CCW(obj); |
c8075caf GA |
848 | |
849 | virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), | |
850 | TYPE_VIRTIO_BLK); | |
467b3f33 SH |
851 | object_property_add_alias(obj, "iothread", OBJECT(&dev->vdev),"iothread", |
852 | &error_abort); | |
aeb98ddc GA |
853 | object_property_add_alias(obj, "bootindex", OBJECT(&dev->vdev), |
854 | "bootindex", &error_abort); | |
a5cf2bb4 CH |
855 | } |
856 | ||
5e5ced38 | 857 | static void virtio_ccw_serial_realize(VirtioCcwDevice *ccw_dev, Error **errp) |
a5cf2bb4 | 858 | { |
6acf69cd FK |
859 | VirtioSerialCcw *dev = VIRTIO_SERIAL_CCW(ccw_dev); |
860 | DeviceState *vdev = DEVICE(&dev->vdev); | |
80270a19 | 861 | DeviceState *proxy = DEVICE(ccw_dev); |
5e5ced38 | 862 | Error *err = NULL; |
80270a19 FK |
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 | } | |
a5cf2bb4 | 874 | |
6acf69cd | 875 | qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); |
5e5ced38 MA |
876 | object_property_set_bool(OBJECT(vdev), true, "realized", &err); |
877 | if (err) { | |
878 | error_propagate(errp, err); | |
a5cf2bb4 | 879 | } |
a5cf2bb4 CH |
880 | } |
881 | ||
6acf69cd FK |
882 | |
883 | static void virtio_ccw_serial_instance_init(Object *obj) | |
a5cf2bb4 | 884 | { |
6acf69cd | 885 | VirtioSerialCcw *dev = VIRTIO_SERIAL_CCW(obj); |
c8075caf GA |
886 | |
887 | virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), | |
888 | TYPE_VIRTIO_SERIAL); | |
a5cf2bb4 CH |
889 | } |
890 | ||
5e5ced38 | 891 | static void virtio_ccw_balloon_realize(VirtioCcwDevice *ccw_dev, Error **errp) |
a5cf2bb4 | 892 | { |
30bff6a0 FK |
893 | VirtIOBalloonCcw *dev = VIRTIO_BALLOON_CCW(ccw_dev); |
894 | DeviceState *vdev = DEVICE(&dev->vdev); | |
5e5ced38 | 895 | Error *err = NULL; |
a5cf2bb4 | 896 | |
30bff6a0 | 897 | qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); |
5e5ced38 MA |
898 | object_property_set_bool(OBJECT(vdev), true, "realized", &err); |
899 | if (err) { | |
900 | error_propagate(errp, err); | |
a5cf2bb4 | 901 | } |
a5cf2bb4 CH |
902 | } |
903 | ||
30bff6a0 | 904 | static void virtio_ccw_balloon_instance_init(Object *obj) |
a5cf2bb4 | 905 | { |
30bff6a0 | 906 | VirtIOBalloonCcw *dev = VIRTIO_BALLOON_CCW(obj); |
ecfa60e3 | 907 | |
a6027b0f DL |
908 | virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), |
909 | TYPE_VIRTIO_BALLOON); | |
ecfa60e3 SZ |
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); | |
a5cf2bb4 CH |
915 | } |
916 | ||
5e5ced38 | 917 | static void virtio_ccw_scsi_realize(VirtioCcwDevice *ccw_dev, Error **errp) |
a5cf2bb4 | 918 | { |
c908ea10 FK |
919 | VirtIOSCSICcw *dev = VIRTIO_SCSI_CCW(ccw_dev); |
920 | DeviceState *vdev = DEVICE(&dev->vdev); | |
6f32a6b4 | 921 | DeviceState *qdev = DEVICE(ccw_dev); |
5e5ced38 | 922 | Error *err = NULL; |
6f32a6b4 FK |
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 | } | |
a5cf2bb4 | 934 | |
c908ea10 | 935 | qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); |
5e5ced38 MA |
936 | object_property_set_bool(OBJECT(vdev), true, "realized", &err); |
937 | if (err) { | |
938 | error_propagate(errp, err); | |
a5cf2bb4 | 939 | } |
a5cf2bb4 CH |
940 | } |
941 | ||
c908ea10 | 942 | static void virtio_ccw_scsi_instance_init(Object *obj) |
a5cf2bb4 | 943 | { |
c908ea10 | 944 | VirtIOSCSICcw *dev = VIRTIO_SCSI_CCW(obj); |
c8075caf GA |
945 | |
946 | virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), | |
947 | TYPE_VIRTIO_SCSI); | |
19d339f1 FZ |
948 | object_property_add_alias(obj, "iothread", OBJECT(&dev->vdev), "iothread", |
949 | &error_abort); | |
a5cf2bb4 CH |
950 | } |
951 | ||
ccf6916c | 952 | #ifdef CONFIG_VHOST_SCSI |
5e5ced38 | 953 | static void vhost_ccw_scsi_realize(VirtioCcwDevice *ccw_dev, Error **errp) |
ccf6916c PB |
954 | { |
955 | VHostSCSICcw *dev = VHOST_SCSI_CCW(ccw_dev); | |
956 | DeviceState *vdev = DEVICE(&dev->vdev); | |
5e5ced38 | 957 | Error *err = NULL; |
ccf6916c PB |
958 | |
959 | qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); | |
5e5ced38 MA |
960 | object_property_set_bool(OBJECT(vdev), true, "realized", &err); |
961 | if (err) { | |
962 | error_propagate(errp, err); | |
ccf6916c | 963 | } |
ccf6916c PB |
964 | } |
965 | ||
966 | static void vhost_ccw_scsi_instance_init(Object *obj) | |
967 | { | |
968 | VHostSCSICcw *dev = VHOST_SCSI_CCW(obj); | |
c8075caf GA |
969 | |
970 | virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), | |
971 | TYPE_VHOST_SCSI); | |
ccf6916c PB |
972 | } |
973 | #endif | |
974 | ||
5e5ced38 | 975 | static void virtio_ccw_rng_realize(VirtioCcwDevice *ccw_dev, Error **errp) |
2362ecc5 | 976 | { |
2db26d4c FK |
977 | VirtIORNGCcw *dev = VIRTIO_RNG_CCW(ccw_dev); |
978 | DeviceState *vdev = DEVICE(&dev->vdev); | |
5e5ced38 | 979 | Error *err = NULL; |
2362ecc5 | 980 | |
2db26d4c | 981 | qdev_set_parent_bus(vdev, BUS(&ccw_dev->bus)); |
5e5ced38 MA |
982 | object_property_set_bool(OBJECT(vdev), true, "realized", &err); |
983 | if (err) { | |
984 | error_propagate(errp, err); | |
985 | return; | |
2362ecc5 | 986 | } |
2362ecc5 | 987 | |
2db26d4c | 988 | object_property_set_link(OBJECT(dev), |
5b456438 | 989 | OBJECT(dev->vdev.conf.rng), "rng", |
2db26d4c | 990 | NULL); |
2362ecc5 CH |
991 | } |
992 | ||
a5cf2bb4 CH |
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 | ||
7e749462 CH |
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 | ||
a5cf2bb4 CH |
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 | ||
8dfbaa6a | 1033 | if (vector < VIRTIO_CCW_QUEUE_MAX) { |
7c486976 CH |
1034 | if (!dev->indicators) { |
1035 | return; | |
1036 | } | |
7e749462 CH |
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 | */ | |
d426d9fb CH |
1044 | uint64_t ind_bit = dev->routes.adapter.ind_offset; |
1045 | ||
7bca3892 | 1046 | virtio_set_ind_atomic(sch, dev->indicators->addr + |
d426d9fb CH |
1047 | (ind_bit + vector) / 8, |
1048 | 0x80 >> ((ind_bit + vector) % 8)); | |
7bca3892 | 1049 | if (!virtio_set_ind_atomic(sch, dev->summary_indicator->addr, |
7e749462 CH |
1050 | 0x01)) { |
1051 | css_adapter_interrupt(dev->thinint_isc); | |
1052 | } | |
1053 | } else { | |
42874d3a PM |
1054 | indicators = address_space_ldq(&address_space_memory, |
1055 | dev->indicators->addr, | |
1056 | MEMTXATTRS_UNSPECIFIED, | |
1057 | NULL); | |
7e749462 | 1058 | indicators |= 1ULL << vector; |
42874d3a PM |
1059 | address_space_stq(&address_space_memory, dev->indicators->addr, |
1060 | indicators, MEMTXATTRS_UNSPECIFIED, NULL); | |
7e749462 CH |
1061 | css_conditional_io_interrupt(sch); |
1062 | } | |
a5cf2bb4 | 1063 | } else { |
7c486976 CH |
1064 | if (!dev->indicators2) { |
1065 | return; | |
1066 | } | |
a5cf2bb4 | 1067 | vector = 0; |
42874d3a PM |
1068 | indicators = address_space_ldq(&address_space_memory, |
1069 | dev->indicators2->addr, | |
1070 | MEMTXATTRS_UNSPECIFIED, | |
1071 | NULL); | |
19380b1b | 1072 | indicators |= 1ULL << vector; |
42874d3a PM |
1073 | address_space_stq(&address_space_memory, dev->indicators2->addr, |
1074 | indicators, MEMTXATTRS_UNSPECIFIED, NULL); | |
7e749462 | 1075 | css_conditional_io_interrupt(sch); |
a5cf2bb4 | 1076 | } |
a5cf2bb4 CH |
1077 | } |
1078 | ||
a5cf2bb4 CH |
1079 | static void virtio_ccw_reset(DeviceState *d) |
1080 | { | |
1081 | VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); | |
f24a6840 | 1082 | VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); |
a5cf2bb4 | 1083 | |
b4436a0b | 1084 | virtio_ccw_stop_ioeventfd(dev); |
f24a6840 | 1085 | virtio_reset(vdev); |
a5cf2bb4 | 1086 | css_reset_sch(dev->sch); |
7bca3892 | 1087 | if (dev->indicators) { |
d426d9fb | 1088 | release_indicator(&dev->routes.adapter, dev->indicators); |
7bca3892 CH |
1089 | dev->indicators = NULL; |
1090 | } | |
1091 | if (dev->indicators2) { | |
d426d9fb | 1092 | release_indicator(&dev->routes.adapter, dev->indicators2); |
7bca3892 CH |
1093 | dev->indicators2 = NULL; |
1094 | } | |
1095 | if (dev->summary_indicator) { | |
d426d9fb | 1096 | release_indicator(&dev->routes.adapter, dev->summary_indicator); |
7bca3892 CH |
1097 | dev->summary_indicator = NULL; |
1098 | } | |
a5cf2bb4 CH |
1099 | } |
1100 | ||
b4436a0b CH |
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 | ||
320ce850 CH |
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 | ||
d426d9fb CH |
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 | ||
320ce850 CH |
1205 | static int virtio_ccw_set_guest_notifier(VirtioCcwDevice *dev, int n, |
1206 | bool assign, bool with_irqfd) | |
1207 | { | |
f24a6840 PB |
1208 | VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); |
1209 | VirtQueue *vq = virtio_get_queue(vdev, n); | |
320ce850 | 1210 | EventNotifier *notifier = virtio_queue_get_guest_notifier(vq); |
f24a6840 | 1211 | VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
320ce850 CH |
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); | |
d426d9fb CH |
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. | |
320ce850 CH |
1231 | */ |
1232 | if (k->guest_notifier_mask) { | |
f24a6840 | 1233 | k->guest_notifier_mask(vdev, n, false); |
320ce850 CH |
1234 | } |
1235 | /* get lost events and re-inject */ | |
1236 | if (k->guest_notifier_pending && | |
f24a6840 | 1237 | k->guest_notifier_pending(vdev, n)) { |
320ce850 CH |
1238 | event_notifier_set(notifier); |
1239 | } | |
1240 | } else { | |
1241 | if (k->guest_notifier_mask) { | |
f24a6840 | 1242 | k->guest_notifier_mask(vdev, n, true); |
320ce850 | 1243 | } |
d426d9fb CH |
1244 | if (with_irqfd) { |
1245 | virtio_ccw_remove_irqfd(dev, n); | |
1246 | } | |
320ce850 CH |
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); | |
f24a6840 | 1257 | VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); |
d426d9fb | 1258 | bool with_irqfd = dev->sch->thinint_active && kvm_irqfds_enabled(); |
320ce850 CH |
1259 | int r, n; |
1260 | ||
d426d9fb CH |
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 | } | |
320ce850 CH |
1268 | for (n = 0; n < nvqs; n++) { |
1269 | if (!virtio_queue_get_num(vdev, n)) { | |
1270 | break; | |
1271 | } | |
d426d9fb | 1272 | r = virtio_ccw_set_guest_notifier(dev, n, assigned, with_irqfd); |
320ce850 CH |
1273 | if (r < 0) { |
1274 | goto assign_error; | |
1275 | } | |
1276 | } | |
d426d9fb CH |
1277 | if (with_irqfd && !assigned) { |
1278 | /* release irq routes after irqfds have been released */ | |
1279 | virtio_ccw_release_irqroutes(dev, nvqs); | |
1280 | } | |
320ce850 CH |
1281 | return 0; |
1282 | ||
1283 | assign_error: | |
1284 | while (--n >= 0) { | |
1285 | virtio_ccw_set_guest_notifier(dev, n, !assigned, false); | |
1286 | } | |
d426d9fb CH |
1287 | irqroute_error: |
1288 | if (with_irqfd && assigned) { | |
1289 | virtio_ccw_release_irqroutes(dev, nvqs); | |
1290 | } | |
320ce850 CH |
1291 | return r; |
1292 | } | |
1293 | ||
bcb2b582 JF |
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; | |
2a72ea5f | 1318 | VirtIODevice *vdev = virtio_ccw_get_vdev(s); |
bcb2b582 JF |
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 | } | |
2a72ea5f | 1342 | qemu_put_be16(f, vdev->config_vector); |
bcb2b582 JF |
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; | |
2a72ea5f | 1351 | VirtIODevice *vdev = virtio_ccw_get_vdev(s); |
bcb2b582 JF |
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 | } | |
2a72ea5f | 1377 | qemu_get_be16s(f, &vdev->config_vector); |
bcb2b582 JF |
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 | ||
fb846a09 | 1389 | /* This is called by virtio-bus just after the device is plugged. */ |
e8398045 | 1390 | static void virtio_ccw_device_plugged(DeviceState *d, Error **errp) |
fb846a09 CH |
1391 | { |
1392 | VirtioCcwDevice *dev = VIRTIO_CCW_DEVICE(d); | |
10ceaa1e | 1393 | VirtIODevice *vdev = virtio_bus_get_device(&dev->bus); |
fb846a09 | 1394 | SubchDev *sch = dev->sch; |
10ceaa1e JW |
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 | } | |
fb846a09 | 1403 | |
a499973f AJ |
1404 | if (!kvm_eventfds_enabled()) { |
1405 | dev->flags &= ~VIRTIO_CCW_FLAG_USE_IOEVENTFD; | |
1406 | } | |
1407 | ||
fb846a09 CH |
1408 | sch->id.cu_model = virtio_bus_get_vdev_id(&dev->bus); |
1409 | ||
fb846a09 CH |
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 | } | |
a5cf2bb4 CH |
1420 | /**************** Virtio-ccw Bus Device Descriptions *******************/ |
1421 | ||
a5cf2bb4 CH |
1422 | static Property virtio_ccw_net_properties[] = { |
1423 | DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), | |
b4436a0b CH |
1424 | DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, |
1425 | VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), | |
a5cf2bb4 CH |
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 | ||
5e5ced38 | 1434 | k->realize = virtio_ccw_net_realize; |
89334c8b | 1435 | k->exit = virtio_ccw_exit; |
a5cf2bb4 CH |
1436 | dc->reset = virtio_ccw_reset; |
1437 | dc->props = virtio_ccw_net_properties; | |
cd20d616 | 1438 | set_bit(DEVICE_CATEGORY_NETWORK, dc->categories); |
a5cf2bb4 CH |
1439 | } |
1440 | ||
1441 | static const TypeInfo virtio_ccw_net = { | |
89334c8b | 1442 | .name = TYPE_VIRTIO_NET_CCW, |
a5cf2bb4 | 1443 | .parent = TYPE_VIRTIO_CCW_DEVICE, |
89334c8b FK |
1444 | .instance_size = sizeof(VirtIONetCcw), |
1445 | .instance_init = virtio_ccw_net_instance_init, | |
a5cf2bb4 CH |
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), | |
b4436a0b CH |
1451 | DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, |
1452 | VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), | |
a5cf2bb4 CH |
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 | ||
5e5ced38 | 1461 | k->realize = virtio_ccw_blk_realize; |
3400c455 | 1462 | k->exit = virtio_ccw_exit; |
a5cf2bb4 CH |
1463 | dc->reset = virtio_ccw_reset; |
1464 | dc->props = virtio_ccw_blk_properties; | |
cd20d616 | 1465 | set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); |
a5cf2bb4 CH |
1466 | } |
1467 | ||
1468 | static const TypeInfo virtio_ccw_blk = { | |
3400c455 | 1469 | .name = TYPE_VIRTIO_BLK_CCW, |
a5cf2bb4 | 1470 | .parent = TYPE_VIRTIO_CCW_DEVICE, |
3400c455 FK |
1471 | .instance_size = sizeof(VirtIOBlkCcw), |
1472 | .instance_init = virtio_ccw_blk_instance_init, | |
a5cf2bb4 CH |
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), | |
b4436a0b CH |
1478 | DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, |
1479 | VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), | |
a5cf2bb4 CH |
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 | ||
5e5ced38 | 1488 | k->realize = virtio_ccw_serial_realize; |
6acf69cd | 1489 | k->exit = virtio_ccw_exit; |
a5cf2bb4 CH |
1490 | dc->reset = virtio_ccw_reset; |
1491 | dc->props = virtio_ccw_serial_properties; | |
cd20d616 | 1492 | set_bit(DEVICE_CATEGORY_INPUT, dc->categories); |
a5cf2bb4 CH |
1493 | } |
1494 | ||
1495 | static const TypeInfo virtio_ccw_serial = { | |
6acf69cd | 1496 | .name = TYPE_VIRTIO_SERIAL_CCW, |
a5cf2bb4 | 1497 | .parent = TYPE_VIRTIO_CCW_DEVICE, |
6acf69cd FK |
1498 | .instance_size = sizeof(VirtioSerialCcw), |
1499 | .instance_init = virtio_ccw_serial_instance_init, | |
a5cf2bb4 CH |
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), | |
b4436a0b CH |
1505 | DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, |
1506 | VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), | |
a5cf2bb4 CH |
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 | ||
5e5ced38 | 1515 | k->realize = virtio_ccw_balloon_realize; |
30bff6a0 | 1516 | k->exit = virtio_ccw_exit; |
a5cf2bb4 CH |
1517 | dc->reset = virtio_ccw_reset; |
1518 | dc->props = virtio_ccw_balloon_properties; | |
cd20d616 | 1519 | set_bit(DEVICE_CATEGORY_MISC, dc->categories); |
a5cf2bb4 CH |
1520 | } |
1521 | ||
1522 | static const TypeInfo virtio_ccw_balloon = { | |
30bff6a0 | 1523 | .name = TYPE_VIRTIO_BALLOON_CCW, |
a5cf2bb4 | 1524 | .parent = TYPE_VIRTIO_CCW_DEVICE, |
30bff6a0 FK |
1525 | .instance_size = sizeof(VirtIOBalloonCcw), |
1526 | .instance_init = virtio_ccw_balloon_instance_init, | |
a5cf2bb4 CH |
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), | |
b4436a0b CH |
1532 | DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, |
1533 | VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), | |
a5cf2bb4 CH |
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 | ||
5e5ced38 | 1542 | k->realize = virtio_ccw_scsi_realize; |
c908ea10 | 1543 | k->exit = virtio_ccw_exit; |
a5cf2bb4 CH |
1544 | dc->reset = virtio_ccw_reset; |
1545 | dc->props = virtio_ccw_scsi_properties; | |
cd20d616 | 1546 | set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); |
a5cf2bb4 CH |
1547 | } |
1548 | ||
1549 | static const TypeInfo virtio_ccw_scsi = { | |
c908ea10 | 1550 | .name = TYPE_VIRTIO_SCSI_CCW, |
a5cf2bb4 | 1551 | .parent = TYPE_VIRTIO_CCW_DEVICE, |
c908ea10 FK |
1552 | .instance_size = sizeof(VirtIOSCSICcw), |
1553 | .instance_init = virtio_ccw_scsi_instance_init, | |
a5cf2bb4 CH |
1554 | .class_init = virtio_ccw_scsi_class_init, |
1555 | }; | |
1556 | ||
ccf6916c PB |
1557 | #ifdef CONFIG_VHOST_SCSI |
1558 | static Property vhost_ccw_scsi_properties[] = { | |
1559 | DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), | |
ccf6916c PB |
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 | ||
5e5ced38 | 1568 | k->realize = vhost_ccw_scsi_realize; |
ccf6916c PB |
1569 | k->exit = virtio_ccw_exit; |
1570 | dc->reset = virtio_ccw_reset; | |
1571 | dc->props = vhost_ccw_scsi_properties; | |
cd20d616 | 1572 | set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); |
ccf6916c PB |
1573 | } |
1574 | ||
1575 | static const TypeInfo vhost_ccw_scsi = { | |
1576 | .name = TYPE_VHOST_SCSI_CCW, | |
1577 | .parent = TYPE_VIRTIO_CCW_DEVICE, | |
4b7757ba | 1578 | .instance_size = sizeof(VHostSCSICcw), |
ccf6916c PB |
1579 | .instance_init = vhost_ccw_scsi_instance_init, |
1580 | .class_init = vhost_ccw_scsi_class_init, | |
1581 | }; | |
1582 | #endif | |
1583 | ||
2db26d4c | 1584 | static void virtio_ccw_rng_instance_init(Object *obj) |
2362ecc5 | 1585 | { |
2db26d4c | 1586 | VirtIORNGCcw *dev = VIRTIO_RNG_CCW(obj); |
c8075caf GA |
1587 | |
1588 | virtio_instance_init_common(obj, &dev->vdev, sizeof(dev->vdev), | |
1589 | TYPE_VIRTIO_RNG); | |
cbd5ac69 PB |
1590 | object_property_add_alias(obj, "rng", OBJECT(&dev->vdev), |
1591 | "rng", &error_abort); | |
2362ecc5 CH |
1592 | } |
1593 | ||
1594 | static Property virtio_ccw_rng_properties[] = { | |
1595 | DEFINE_PROP_STRING("devno", VirtioCcwDevice, bus_id), | |
b4436a0b CH |
1596 | DEFINE_PROP_BIT("ioeventfd", VirtioCcwDevice, flags, |
1597 | VIRTIO_CCW_FLAG_USE_IOEVENTFD_BIT, true), | |
2362ecc5 CH |
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 | ||
5e5ced38 | 1606 | k->realize = virtio_ccw_rng_realize; |
2db26d4c | 1607 | k->exit = virtio_ccw_exit; |
2362ecc5 CH |
1608 | dc->reset = virtio_ccw_reset; |
1609 | dc->props = virtio_ccw_rng_properties; | |
cd20d616 | 1610 | set_bit(DEVICE_CATEGORY_MISC, dc->categories); |
2362ecc5 CH |
1611 | } |
1612 | ||
1613 | static const TypeInfo virtio_ccw_rng = { | |
2db26d4c | 1614 | .name = TYPE_VIRTIO_RNG_CCW, |
2362ecc5 | 1615 | .parent = TYPE_VIRTIO_CCW_DEVICE, |
2db26d4c FK |
1616 | .instance_size = sizeof(VirtIORNGCcw), |
1617 | .instance_init = virtio_ccw_rng_instance_init, | |
2362ecc5 CH |
1618 | .class_init = virtio_ccw_rng_class_init, |
1619 | }; | |
1620 | ||
5e5ced38 | 1621 | static void virtio_ccw_busdev_realize(DeviceState *dev, Error **errp) |
a5cf2bb4 CH |
1622 | { |
1623 | VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev; | |
a5cf2bb4 | 1624 | |
1bf4d7aa | 1625 | virtio_ccw_bus_new(&_dev->bus, sizeof(_dev->bus), _dev); |
1fa75523 | 1626 | virtio_ccw_device_realize(_dev, errp); |
a5cf2bb4 CH |
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 | ||
277bc95e IM |
1637 | static void virtio_ccw_busdev_unplug(HotplugHandler *hotplug_dev, |
1638 | DeviceState *dev, Error **errp) | |
a5cf2bb4 CH |
1639 | { |
1640 | VirtioCcwDevice *_dev = (VirtioCcwDevice *)dev; | |
1641 | SubchDev *sch = _dev->sch; | |
1642 | ||
0b81c1ef PB |
1643 | virtio_ccw_stop_ioeventfd(_dev); |
1644 | ||
a5cf2bb4 CH |
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 | ||
02a5c4c9 | 1656 | object_unparent(OBJECT(dev)); |
a5cf2bb4 CH |
1657 | } |
1658 | ||
1659 | static void virtio_ccw_device_class_init(ObjectClass *klass, void *data) | |
1660 | { | |
1661 | DeviceClass *dc = DEVICE_CLASS(klass); | |
1662 | ||
5e5ced38 | 1663 | dc->realize = virtio_ccw_busdev_realize; |
a5cf2bb4 | 1664 | dc->exit = virtio_ccw_busdev_exit; |
a5cf2bb4 | 1665 | dc->bus_type = TYPE_VIRTUAL_CSS_BUS; |
a5cf2bb4 CH |
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 | { | |
a5cf2bb4 | 1688 | SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); |
277bc95e | 1689 | HotplugHandlerClass *hc = HOTPLUG_HANDLER_CLASS(klass); |
cd20d616 | 1690 | DeviceClass *dc = DEVICE_CLASS(klass); |
a5cf2bb4 CH |
1691 | |
1692 | k->init = virtual_css_bridge_init; | |
277bc95e | 1693 | hc->unplug = virtio_ccw_busdev_unplug; |
cd20d616 | 1694 | set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories); |
a5cf2bb4 CH |
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, | |
277bc95e IM |
1702 | .interfaces = (InterfaceInfo[]) { |
1703 | { TYPE_HOTPLUG_HANDLER }, | |
1704 | { } | |
1705 | } | |
a5cf2bb4 CH |
1706 | }; |
1707 | ||
1708 | /* virtio-ccw-bus */ | |
1709 | ||
1bf4d7aa AF |
1710 | static void virtio_ccw_bus_new(VirtioBusState *bus, size_t bus_size, |
1711 | VirtioCcwDevice *dev) | |
a5cf2bb4 CH |
1712 | { |
1713 | DeviceState *qdev = DEVICE(dev); | |
f4dd69aa | 1714 | char virtio_bus_name[] = "virtio-bus"; |
a5cf2bb4 | 1715 | |
fb17dfe0 AF |
1716 | qbus_create_inplace(bus, bus_size, TYPE_VIRTIO_CCW_BUS, |
1717 | qdev, virtio_bus_name); | |
a5cf2bb4 CH |
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; | |
b4436a0b | 1727 | k->vmstate_change = virtio_ccw_vmstate_change; |
320ce850 CH |
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; | |
bcb2b582 JF |
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; | |
fb846a09 CH |
1735 | k->device_plugged = virtio_ccw_device_plugged; |
1736 | k->device_unplugged = virtio_ccw_device_unplugged; | |
a5cf2bb4 CH |
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 | ||
de6a9218 PM |
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 | ||
a5cf2bb4 CH |
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); | |
b702d2ae | 1806 | #ifdef CONFIG_VHOST_SCSI |
ccf6916c | 1807 | type_register_static(&vhost_ccw_scsi); |
b702d2ae | 1808 | #endif |
2362ecc5 | 1809 | type_register_static(&virtio_ccw_rng); |
a5cf2bb4 | 1810 | type_register_static(&virtual_css_bridge_info); |
de6a9218 PM |
1811 | #ifdef CONFIG_VIRTFS |
1812 | type_register_static(&virtio_ccw_9p_info); | |
1813 | #endif | |
a5cf2bb4 CH |
1814 | } |
1815 | ||
1816 | type_init(virtio_ccw_register) |