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