2 * QEMU S390 virtio target
4 * Copyright (c) 2009 Alexander Graf <agraf@suse.de>
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
21 #include "block/block.h"
22 #include "sysemu/sysemu.h"
23 #include "hw/boards.h"
24 #include "monitor/monitor.h"
25 #include "hw/loader.h"
27 #include "hw/virtio.h"
28 #include "hw/virtio-rng.h"
29 #include "hw/virtio-serial.h"
30 #include "hw/virtio-net.h"
31 #include "hw/sysbus.h"
32 #include "sysemu/kvm.h"
34 #include "hw/s390x/s390-virtio-bus.h"
35 #include "hw/virtio-bus.h"
37 /* #define DEBUG_S390 */
40 #define dprintf(fmt, ...) \
41 do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
43 #define dprintf(fmt, ...) \
47 #define VIRTIO_EXT_CODE 0x2603
49 static const TypeInfo s390_virtio_bus_info
= {
50 .name
= TYPE_S390_VIRTIO_BUS
,
52 .instance_size
= sizeof(VirtIOS390Bus
),
55 static const VirtIOBindings virtio_s390_bindings
;
57 static ram_addr_t
s390_virtio_device_num_vq(VirtIOS390Device
*dev
);
59 /* length of VirtIO device pages */
60 const hwaddr virtio_size
= S390_DEVICE_PAGES
* TARGET_PAGE_SIZE
;
62 static void s390_virtio_bus_reset(void *opaque
)
64 VirtIOS390Bus
*bus
= opaque
;
65 bus
->next_ring
= bus
->dev_page
+ TARGET_PAGE_SIZE
;
68 void s390_virtio_reset_idx(VirtIOS390Device
*dev
)
74 num_vq
= s390_virtio_device_num_vq(dev
);
75 for (i
= 0; i
< num_vq
; i
++) {
76 idx_addr
= virtio_queue_get_avail_addr(dev
->vdev
, i
) +
77 VIRTIO_VRING_AVAIL_IDX_OFFS
;
78 stw_phys(idx_addr
, 0);
79 idx_addr
= virtio_queue_get_used_addr(dev
->vdev
, i
) +
80 VIRTIO_VRING_USED_IDX_OFFS
;
81 stw_phys(idx_addr
, 0);
85 VirtIOS390Bus
*s390_virtio_bus_init(ram_addr_t
*ram_size
)
91 /* Create bridge device */
92 dev
= qdev_create(NULL
, "s390-virtio-bridge");
93 qdev_init_nofail(dev
);
95 /* Create bus on bridge device */
97 _bus
= qbus_create(TYPE_S390_VIRTIO_BUS
, dev
, "s390-virtio");
98 bus
= DO_UPCAST(VirtIOS390Bus
, bus
, _bus
);
100 bus
->dev_page
= *ram_size
;
101 bus
->dev_offs
= bus
->dev_page
;
102 bus
->next_ring
= bus
->dev_page
+ TARGET_PAGE_SIZE
;
104 /* Enable hotplugging */
105 _bus
->allow_hotplug
= 1;
107 /* Allocate RAM for VirtIO device pages (descriptors, queues, rings) */
108 *ram_size
+= S390_DEVICE_PAGES
* TARGET_PAGE_SIZE
;
110 qemu_register_reset(s390_virtio_bus_reset
, bus
);
114 static void s390_virtio_irq(S390CPU
*cpu
, int config_change
, uint64_t token
)
117 kvm_s390_virtio_irq(cpu
, config_change
, token
);
119 cpu_inject_ext(cpu
, VIRTIO_EXT_CODE
, config_change
, token
);
123 static int s390_virtio_device_init(VirtIOS390Device
*dev
, VirtIODevice
*vdev
)
128 bus
= DO_UPCAST(VirtIOS390Bus
, bus
, dev
->qdev
.parent_bus
);
130 dev
->dev_offs
= bus
->dev_offs
;
131 dev
->feat_len
= sizeof(uint32_t); /* always keep 32 bits features */
133 dev_len
= VIRTIO_DEV_OFFS_CONFIG
;
134 dev_len
+= s390_virtio_device_num_vq(dev
) * VIRTIO_VQCONFIG_LEN
;
135 dev_len
+= dev
->feat_len
* 2;
136 dev_len
+= vdev
->config_len
;
138 bus
->dev_offs
+= dev_len
;
140 virtio_bind_device(vdev
, &virtio_s390_bindings
, DEVICE(dev
));
141 dev
->host_features
= vdev
->get_features(vdev
, dev
->host_features
);
142 s390_virtio_device_sync(dev
);
143 s390_virtio_reset_idx(dev
);
144 if (dev
->qdev
.hotplugged
) {
145 S390CPU
*cpu
= s390_cpu_addr2state(0);
146 s390_virtio_irq(cpu
, VIRTIO_PARAM_DEV_ADD
, dev
->dev_offs
);
152 static int s390_virtio_net_init(VirtIOS390Device
*dev
)
156 vdev
= virtio_net_init((DeviceState
*)dev
, &dev
->nic
, &dev
->net
);
161 return s390_virtio_device_init(dev
, vdev
);
164 static int s390_virtio_blk_init(VirtIOS390Device
*dev
)
168 vdev
= virtio_blk_init((DeviceState
*)dev
, &dev
->blk
);
173 return s390_virtio_device_init(dev
, vdev
);
176 static int s390_virtio_serial_init(VirtIOS390Device
*dev
)
182 bus
= DO_UPCAST(VirtIOS390Bus
, bus
, dev
->qdev
.parent_bus
);
184 vdev
= virtio_serial_init((DeviceState
*)dev
, &dev
->serial
);
189 r
= s390_virtio_device_init(dev
, vdev
);
197 static int s390_virtio_scsi_init(VirtIOS390Device
*dev
)
201 vdev
= virtio_scsi_init((DeviceState
*)dev
, &dev
->scsi
);
206 return s390_virtio_device_init(dev
, vdev
);
209 static int s390_virtio_rng_init(VirtIOS390Device
*dev
)
213 vdev
= virtio_rng_init((DeviceState
*)dev
, &dev
->rng
);
218 return s390_virtio_device_init(dev
, vdev
);
221 static uint64_t s390_virtio_device_vq_token(VirtIOS390Device
*dev
, int vq
)
223 ram_addr_t token_off
;
225 token_off
= (dev
->dev_offs
+ VIRTIO_DEV_OFFS_CONFIG
) +
226 (vq
* VIRTIO_VQCONFIG_LEN
) +
227 VIRTIO_VQCONFIG_OFFS_TOKEN
;
229 return ldq_be_phys(token_off
);
232 static ram_addr_t
s390_virtio_device_num_vq(VirtIOS390Device
*dev
)
234 VirtIODevice
*vdev
= dev
->vdev
;
237 for (num_vq
= 0; num_vq
< VIRTIO_PCI_QUEUE_MAX
; num_vq
++) {
238 if (!virtio_queue_get_num(vdev
, num_vq
)) {
246 static ram_addr_t
s390_virtio_next_ring(VirtIOS390Bus
*bus
)
248 ram_addr_t r
= bus
->next_ring
;
250 bus
->next_ring
+= VIRTIO_RING_LEN
;
254 void s390_virtio_device_sync(VirtIOS390Device
*dev
)
256 VirtIOS390Bus
*bus
= DO_UPCAST(VirtIOS390Bus
, bus
, dev
->qdev
.parent_bus
);
261 virtio_reset(dev
->vdev
);
264 stb_phys(dev
->dev_offs
+ VIRTIO_DEV_OFFS_TYPE
, dev
->vdev
->device_id
);
266 stb_phys(dev
->dev_offs
+ VIRTIO_DEV_OFFS_NUM_VQ
, s390_virtio_device_num_vq(dev
));
267 stb_phys(dev
->dev_offs
+ VIRTIO_DEV_OFFS_FEATURE_LEN
, dev
->feat_len
);
269 stb_phys(dev
->dev_offs
+ VIRTIO_DEV_OFFS_CONFIG_LEN
, dev
->vdev
->config_len
);
271 num_vq
= s390_virtio_device_num_vq(dev
);
272 stb_phys(dev
->dev_offs
+ VIRTIO_DEV_OFFS_NUM_VQ
, num_vq
);
274 /* Sync virtqueues */
275 for (i
= 0; i
< num_vq
; i
++) {
276 ram_addr_t vq
= (dev
->dev_offs
+ VIRTIO_DEV_OFFS_CONFIG
) +
277 (i
* VIRTIO_VQCONFIG_LEN
);
280 vring
= s390_virtio_next_ring(bus
);
281 virtio_queue_set_addr(dev
->vdev
, i
, vring
);
282 virtio_queue_set_vector(dev
->vdev
, i
, i
);
283 stq_be_phys(vq
+ VIRTIO_VQCONFIG_OFFS_ADDRESS
, vring
);
284 stw_be_phys(vq
+ VIRTIO_VQCONFIG_OFFS_NUM
, virtio_queue_get_num(dev
->vdev
, i
));
287 cur_offs
= dev
->dev_offs
;
288 cur_offs
+= VIRTIO_DEV_OFFS_CONFIG
;
289 cur_offs
+= num_vq
* VIRTIO_VQCONFIG_LEN
;
291 /* Sync feature bitmap */
292 stl_le_phys(cur_offs
, dev
->host_features
);
294 dev
->feat_offs
= cur_offs
+ dev
->feat_len
;
295 cur_offs
+= dev
->feat_len
* 2;
297 /* Sync config space */
298 if (dev
->vdev
->get_config
) {
299 dev
->vdev
->get_config(dev
->vdev
, dev
->vdev
->config
);
302 cpu_physical_memory_write(cur_offs
,
303 dev
->vdev
->config
, dev
->vdev
->config_len
);
304 cur_offs
+= dev
->vdev
->config_len
;
307 void s390_virtio_device_update_status(VirtIOS390Device
*dev
)
309 VirtIODevice
*vdev
= dev
->vdev
;
312 virtio_set_status(vdev
, ldub_phys(dev
->dev_offs
+ VIRTIO_DEV_OFFS_STATUS
));
314 /* Update guest supported feature bitmap */
316 features
= bswap32(ldl_be_phys(dev
->feat_offs
));
317 virtio_set_features(vdev
, features
);
320 VirtIOS390Device
*s390_virtio_bus_console(VirtIOS390Bus
*bus
)
325 /* Find a device by vring address */
326 VirtIOS390Device
*s390_virtio_bus_find_vring(VirtIOS390Bus
*bus
,
333 QTAILQ_FOREACH(kid
, &bus
->bus
.children
, sibling
) {
334 VirtIOS390Device
*dev
= (VirtIOS390Device
*)kid
->child
;
336 for(i
= 0; i
< VIRTIO_PCI_QUEUE_MAX
; i
++) {
337 if (!virtio_queue_get_addr(dev
->vdev
, i
))
339 if (virtio_queue_get_addr(dev
->vdev
, i
) == mem
) {
351 /* Find a device by device descriptor location */
352 VirtIOS390Device
*s390_virtio_bus_find_mem(VirtIOS390Bus
*bus
, ram_addr_t mem
)
356 QTAILQ_FOREACH(kid
, &bus
->bus
.children
, sibling
) {
357 VirtIOS390Device
*dev
= (VirtIOS390Device
*)kid
->child
;
358 if (dev
->dev_offs
== mem
) {
366 /* DeviceState to VirtIOS390Device. Note: used on datapath,
367 * be careful and test performance if you change this.
369 static inline VirtIOS390Device
*to_virtio_s390_device_fast(DeviceState
*d
)
371 return container_of(d
, VirtIOS390Device
, qdev
);
374 /* DeviceState to VirtIOS390Device. TODO: use QOM. */
375 static inline VirtIOS390Device
*to_virtio_s390_device(DeviceState
*d
)
377 return container_of(d
, VirtIOS390Device
, qdev
);
380 static void virtio_s390_notify(DeviceState
*d
, uint16_t vector
)
382 VirtIOS390Device
*dev
= to_virtio_s390_device_fast(d
);
383 uint64_t token
= s390_virtio_device_vq_token(dev
, vector
);
384 S390CPU
*cpu
= s390_cpu_addr2state(0);
386 s390_virtio_irq(cpu
, 0, token
);
389 static unsigned virtio_s390_get_features(DeviceState
*d
)
391 VirtIOS390Device
*dev
= to_virtio_s390_device(d
);
392 return dev
->host_features
;
395 /**************** S390 Virtio Bus Device Descriptions *******************/
397 static const VirtIOBindings virtio_s390_bindings
= {
398 .notify
= virtio_s390_notify
,
399 .get_features
= virtio_s390_get_features
,
402 static Property s390_virtio_net_properties
[] = {
403 DEFINE_NIC_PROPERTIES(VirtIOS390Device
, nic
),
404 DEFINE_PROP_UINT32("x-txtimer", VirtIOS390Device
,
405 net
.txtimer
, TX_TIMER_INTERVAL
),
406 DEFINE_PROP_INT32("x-txburst", VirtIOS390Device
,
407 net
.txburst
, TX_BURST
),
408 DEFINE_PROP_STRING("tx", VirtIOS390Device
, net
.tx
),
409 DEFINE_PROP_END_OF_LIST(),
412 static void s390_virtio_net_class_init(ObjectClass
*klass
, void *data
)
414 DeviceClass
*dc
= DEVICE_CLASS(klass
);
415 VirtIOS390DeviceClass
*k
= VIRTIO_S390_DEVICE_CLASS(klass
);
417 k
->init
= s390_virtio_net_init
;
418 dc
->props
= s390_virtio_net_properties
;
421 static const TypeInfo s390_virtio_net
= {
422 .name
= "virtio-net-s390",
423 .parent
= TYPE_VIRTIO_S390_DEVICE
,
424 .instance_size
= sizeof(VirtIOS390Device
),
425 .class_init
= s390_virtio_net_class_init
,
428 static Property s390_virtio_blk_properties
[] = {
429 DEFINE_BLOCK_PROPERTIES(VirtIOS390Device
, blk
.conf
),
430 DEFINE_BLOCK_CHS_PROPERTIES(VirtIOS390Device
, blk
.conf
),
431 DEFINE_PROP_STRING("serial", VirtIOS390Device
, blk
.serial
),
433 DEFINE_PROP_BIT("scsi", VirtIOS390Device
, blk
.scsi
, 0, true),
435 DEFINE_PROP_END_OF_LIST(),
438 static void s390_virtio_blk_class_init(ObjectClass
*klass
, void *data
)
440 DeviceClass
*dc
= DEVICE_CLASS(klass
);
441 VirtIOS390DeviceClass
*k
= VIRTIO_S390_DEVICE_CLASS(klass
);
443 k
->init
= s390_virtio_blk_init
;
444 dc
->props
= s390_virtio_blk_properties
;
447 static const TypeInfo s390_virtio_blk
= {
448 .name
= "virtio-blk-s390",
449 .parent
= TYPE_VIRTIO_S390_DEVICE
,
450 .instance_size
= sizeof(VirtIOS390Device
),
451 .class_init
= s390_virtio_blk_class_init
,
454 static Property s390_virtio_serial_properties
[] = {
455 DEFINE_PROP_UINT32("max_ports", VirtIOS390Device
,
456 serial
.max_virtserial_ports
, 31),
457 DEFINE_PROP_END_OF_LIST(),
460 static void s390_virtio_serial_class_init(ObjectClass
*klass
, void *data
)
462 DeviceClass
*dc
= DEVICE_CLASS(klass
);
463 VirtIOS390DeviceClass
*k
= VIRTIO_S390_DEVICE_CLASS(klass
);
465 k
->init
= s390_virtio_serial_init
;
466 dc
->props
= s390_virtio_serial_properties
;
469 static const TypeInfo s390_virtio_serial
= {
470 .name
= "virtio-serial-s390",
471 .parent
= TYPE_VIRTIO_S390_DEVICE
,
472 .instance_size
= sizeof(VirtIOS390Device
),
473 .class_init
= s390_virtio_serial_class_init
,
476 static void s390_virtio_rng_initfn(Object
*obj
)
478 VirtIOS390Device
*dev
= VIRTIO_S390_DEVICE(obj
);
480 object_property_add_link(obj
, "rng", TYPE_RNG_BACKEND
,
481 (Object
**)&dev
->rng
.rng
, NULL
);
484 static void s390_virtio_rng_class_init(ObjectClass
*klass
, void *data
)
486 VirtIOS390DeviceClass
*k
= VIRTIO_S390_DEVICE_CLASS(klass
);
488 k
->init
= s390_virtio_rng_init
;
491 static const TypeInfo s390_virtio_rng
= {
492 .name
= "virtio-rng-s390",
493 .parent
= TYPE_VIRTIO_S390_DEVICE
,
494 .instance_size
= sizeof(VirtIOS390Device
),
495 .instance_init
= s390_virtio_rng_initfn
,
496 .class_init
= s390_virtio_rng_class_init
,
499 static int s390_virtio_busdev_init(DeviceState
*dev
)
501 VirtIOS390Device
*_dev
= (VirtIOS390Device
*)dev
;
502 VirtIOS390DeviceClass
*_info
= VIRTIO_S390_DEVICE_GET_CLASS(dev
);
504 virtio_s390_bus_new(&_dev
->bus
, _dev
);
506 return _info
->init(_dev
);
509 static void s390_virtio_busdev_reset(DeviceState
*dev
)
511 VirtIOS390Device
*_dev
= (VirtIOS390Device
*)dev
;
513 virtio_reset(_dev
->vdev
);
516 static void virtio_s390_device_class_init(ObjectClass
*klass
, void *data
)
518 DeviceClass
*dc
= DEVICE_CLASS(klass
);
520 dc
->init
= s390_virtio_busdev_init
;
521 dc
->bus_type
= TYPE_S390_VIRTIO_BUS
;
522 dc
->unplug
= qdev_simple_unplug_cb
;
523 dc
->reset
= s390_virtio_busdev_reset
;
526 static const TypeInfo virtio_s390_device_info
= {
527 .name
= TYPE_VIRTIO_S390_DEVICE
,
528 .parent
= TYPE_DEVICE
,
529 .instance_size
= sizeof(VirtIOS390Device
),
530 .class_init
= virtio_s390_device_class_init
,
531 .class_size
= sizeof(VirtIOS390DeviceClass
),
535 static Property s390_virtio_scsi_properties
[] = {
536 DEFINE_VIRTIO_SCSI_PROPERTIES(VirtIOS390Device
, host_features
, scsi
),
537 DEFINE_PROP_END_OF_LIST(),
540 static void s390_virtio_scsi_class_init(ObjectClass
*klass
, void *data
)
542 DeviceClass
*dc
= DEVICE_CLASS(klass
);
543 VirtIOS390DeviceClass
*k
= VIRTIO_S390_DEVICE_CLASS(klass
);
545 k
->init
= s390_virtio_scsi_init
;
546 dc
->props
= s390_virtio_scsi_properties
;
549 static const TypeInfo s390_virtio_scsi
= {
550 .name
= "virtio-scsi-s390",
551 .parent
= TYPE_VIRTIO_S390_DEVICE
,
552 .instance_size
= sizeof(VirtIOS390Device
),
553 .class_init
= s390_virtio_scsi_class_init
,
556 /***************** S390 Virtio Bus Bridge Device *******************/
557 /* Only required to have the virtio bus as child in the system bus */
559 static int s390_virtio_bridge_init(SysBusDevice
*dev
)
565 static void s390_virtio_bridge_class_init(ObjectClass
*klass
, void *data
)
567 DeviceClass
*dc
= DEVICE_CLASS(klass
);
568 SysBusDeviceClass
*k
= SYS_BUS_DEVICE_CLASS(klass
);
570 k
->init
= s390_virtio_bridge_init
;
574 static const TypeInfo s390_virtio_bridge_info
= {
575 .name
= "s390-virtio-bridge",
576 .parent
= TYPE_SYS_BUS_DEVICE
,
577 .instance_size
= sizeof(SysBusDevice
),
578 .class_init
= s390_virtio_bridge_class_init
,
581 /* virtio-s390-bus */
583 void virtio_s390_bus_new(VirtioBusState
*bus
, VirtIOS390Device
*dev
)
585 DeviceState
*qdev
= DEVICE(dev
);
587 qbus_create_inplace((BusState
*)bus
, TYPE_VIRTIO_S390_BUS
, qdev
, NULL
);
589 qbus
->allow_hotplug
= 0;
592 static void virtio_s390_bus_class_init(ObjectClass
*klass
, void *data
)
594 VirtioBusClass
*k
= VIRTIO_BUS_CLASS(klass
);
595 BusClass
*bus_class
= BUS_CLASS(klass
);
596 bus_class
->max_dev
= 1;
597 k
->notify
= virtio_s390_notify
;
598 k
->get_features
= virtio_s390_get_features
;
601 static const TypeInfo virtio_s390_bus_info
= {
602 .name
= TYPE_VIRTIO_S390_BUS
,
603 .parent
= TYPE_VIRTIO_BUS
,
604 .instance_size
= sizeof(VirtioS390BusState
),
605 .class_init
= virtio_s390_bus_class_init
,
608 static void s390_virtio_register_types(void)
610 type_register_static(&virtio_s390_bus_info
);
611 type_register_static(&s390_virtio_bus_info
);
612 type_register_static(&virtio_s390_device_info
);
613 type_register_static(&s390_virtio_serial
);
614 type_register_static(&s390_virtio_blk
);
615 type_register_static(&s390_virtio_net
);
616 type_register_static(&s390_virtio_scsi
);
617 type_register_static(&s390_virtio_rng
);
618 type_register_static(&s390_virtio_bridge_info
);
621 type_init(s390_virtio_register_types
)