[qemu.git] / hw / s390-virtio-bus.c

/*
 * QEMU S390 virtio target
 *
 * Copyright (c) 2009 Alexander Graf <[email protected]>
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
 */

#include "hw.h"
#include "block/block.h"
#include "sysemu/sysemu.h"
#include "boards.h"
#include "monitor/monitor.h"
#include "loader.h"
#include "elf.h"
#include "hw/virtio.h"
#include "hw/virtio-rng.h"
#include "hw/virtio-serial.h"
#include "hw/virtio-net.h"
#include "hw/sysbus.h"
#include "sysemu/kvm.h"

#include "hw/s390-virtio-bus.h"

/* #define DEBUG_S390 */

#ifdef DEBUG_S390
#define dprintf(fmt, ...) \
    do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
#else
#define dprintf(fmt, ...) \
    do { } while (0)
#endif

#define VIRTIO_EXT_CODE   0x2603

static const TypeInfo s390_virtio_bus_info = {
    .name = TYPE_S390_VIRTIO_BUS,
    .parent = TYPE_BUS,
    .instance_size = sizeof(VirtIOS390Bus),
};

static const VirtIOBindings virtio_s390_bindings;

static ram_addr_t s390_virtio_device_num_vq(VirtIOS390Device *dev);

/* length of VirtIO device pages */
const hwaddr virtio_size = S390_DEVICE_PAGES * TARGET_PAGE_SIZE;

static void s390_virtio_bus_reset(void *opaque)
{
    VirtIOS390Bus *bus = opaque;
    bus->next_ring = bus->dev_page + TARGET_PAGE_SIZE;
}

void s390_virtio_reset_idx(VirtIOS390Device *dev)
{
    int i;
    hwaddr idx_addr;
    uint8_t num_vq;

    num_vq = s390_virtio_device_num_vq(dev);
    for (i = 0; i < num_vq; i++) {
        idx_addr = virtio_queue_get_avail_addr(dev->vdev, i) +
            VIRTIO_VRING_AVAIL_IDX_OFFS;
        stw_phys(idx_addr, 0);
        idx_addr = virtio_queue_get_used_addr(dev->vdev, i) +
            VIRTIO_VRING_USED_IDX_OFFS;
        stw_phys(idx_addr, 0);
    }
}

VirtIOS390Bus *s390_virtio_bus_init(ram_addr_t *ram_size)
{
    VirtIOS390Bus *bus;
    BusState *_bus;
    DeviceState *dev;

    /* Create bridge device */
    dev = qdev_create(NULL, "s390-virtio-bridge");
    qdev_init_nofail(dev);

    /* Create bus on bridge device */

    _bus = qbus_create(TYPE_S390_VIRTIO_BUS, dev, "s390-virtio");
    bus = DO_UPCAST(VirtIOS390Bus, bus, _bus);

    bus->dev_page = *ram_size;
    bus->dev_offs = bus->dev_page;
    bus->next_ring = bus->dev_page + TARGET_PAGE_SIZE;

    /* Enable hotplugging */
    _bus->allow_hotplug = 1;

    /* Allocate RAM for VirtIO device pages (descriptors, queues, rings) */
    *ram_size += S390_DEVICE_PAGES * TARGET_PAGE_SIZE;

    qemu_register_reset(s390_virtio_bus_reset, bus);
    return bus;
}

static void s390_virtio_irq(S390CPU *cpu, int config_change, uint64_t token)
{
    CPUS390XState *env = &cpu->env;

    if (kvm_enabled()) {
        kvm_s390_virtio_irq(cpu, config_change, token);
    } else {
        cpu_inject_ext(env, VIRTIO_EXT_CODE, config_change, token);
    }
}

static int s390_virtio_device_init(VirtIOS390Device *dev, VirtIODevice *vdev)
{
    VirtIOS390Bus *bus;
    int dev_len;

    bus = DO_UPCAST(VirtIOS390Bus, bus, dev->qdev.parent_bus);
    dev->vdev = vdev;
    dev->dev_offs = bus->dev_offs;
    dev->feat_len = sizeof(uint32_t); /* always keep 32 bits features */

    dev_len = VIRTIO_DEV_OFFS_CONFIG;
    dev_len += s390_virtio_device_num_vq(dev) * VIRTIO_VQCONFIG_LEN;
    dev_len += dev->feat_len * 2;
    dev_len += vdev->config_len;

    bus->dev_offs += dev_len;

    virtio_bind_device(vdev, &virtio_s390_bindings, DEVICE(dev));
    dev->host_features = vdev->get_features(vdev, dev->host_features);
    s390_virtio_device_sync(dev);
    s390_virtio_reset_idx(dev);
    if (dev->qdev.hotplugged) {
        S390CPU *cpu = s390_cpu_addr2state(0);
        s390_virtio_irq(cpu, VIRTIO_PARAM_DEV_ADD, dev->dev_offs);
    }

    return 0;
}

static int s390_virtio_net_init(VirtIOS390Device *dev)
{
    VirtIODevice *vdev;

    vdev = virtio_net_init((DeviceState *)dev, &dev->nic, &dev->net);
    if (!vdev) {
        return -1;
    }

    return s390_virtio_device_init(dev, vdev);
}

static int s390_virtio_blk_init(VirtIOS390Device *dev)
{
    VirtIODevice *vdev;

    vdev = virtio_blk_init((DeviceState *)dev, &dev->blk);
    if (!vdev) {
        return -1;
    }

    return s390_virtio_device_init(dev, vdev);
}

static int s390_virtio_serial_init(VirtIOS390Device *dev)
{
    VirtIOS390Bus *bus;
    VirtIODevice *vdev;
    int r;

    bus = DO_UPCAST(VirtIOS390Bus, bus, dev->qdev.parent_bus);

    vdev = virtio_serial_init((DeviceState *)dev, &dev->serial);
    if (!vdev) {
        return -1;
    }

    r = s390_virtio_device_init(dev, vdev);
    if (!r) {
        bus->console = dev;
    }

    return r;
}

static int s390_virtio_scsi_init(VirtIOS390Device *dev)
{
    VirtIODevice *vdev;

    vdev = virtio_scsi_init((DeviceState *)dev, &dev->scsi);
    if (!vdev) {
        return -1;
    }

    return s390_virtio_device_init(dev, vdev);
}

static int s390_virtio_rng_init(VirtIOS390Device *dev)
{
    VirtIODevice *vdev;

    vdev = virtio_rng_init((DeviceState *)dev, &dev->rng);
    if (!vdev) {
        return -1;
    }

    return s390_virtio_device_init(dev, vdev);
}

static uint64_t s390_virtio_device_vq_token(VirtIOS390Device *dev, int vq)
{
    ram_addr_t token_off;

    token_off = (dev->dev_offs + VIRTIO_DEV_OFFS_CONFIG) +
                (vq * VIRTIO_VQCONFIG_LEN) +
                VIRTIO_VQCONFIG_OFFS_TOKEN;

    return ldq_be_phys(token_off);
}

static ram_addr_t s390_virtio_device_num_vq(VirtIOS390Device *dev)
{
    VirtIODevice *vdev = dev->vdev;
    int num_vq;

    for (num_vq = 0; num_vq < VIRTIO_PCI_QUEUE_MAX; num_vq++) {
        if (!virtio_queue_get_num(vdev, num_vq)) {
            break;
        }
    }

    return num_vq;
}

static ram_addr_t s390_virtio_next_ring(VirtIOS390Bus *bus)
{
    ram_addr_t r = bus->next_ring;

    bus->next_ring += VIRTIO_RING_LEN;
    return r;
}

void s390_virtio_device_sync(VirtIOS390Device *dev)
{
    VirtIOS390Bus *bus = DO_UPCAST(VirtIOS390Bus, bus, dev->qdev.parent_bus);
    ram_addr_t cur_offs;
    uint8_t num_vq;
    int i;

    virtio_reset(dev->vdev);

    /* Sync dev space */
    stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_TYPE, dev->vdev->device_id);

    stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_NUM_VQ, s390_virtio_device_num_vq(dev));
    stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_FEATURE_LEN, dev->feat_len);

    stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_CONFIG_LEN, dev->vdev->config_len);

    num_vq = s390_virtio_device_num_vq(dev);
    stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_NUM_VQ, num_vq);

    /* Sync virtqueues */
    for (i = 0; i < num_vq; i++) {
        ram_addr_t vq = (dev->dev_offs + VIRTIO_DEV_OFFS_CONFIG) +
                        (i * VIRTIO_VQCONFIG_LEN);
        ram_addr_t vring;

        vring = s390_virtio_next_ring(bus);
        virtio_queue_set_addr(dev->vdev, i, vring);
        virtio_queue_set_vector(dev->vdev, i, i);
        stq_be_phys(vq + VIRTIO_VQCONFIG_OFFS_ADDRESS, vring);
        stw_be_phys(vq + VIRTIO_VQCONFIG_OFFS_NUM, virtio_queue_get_num(dev->vdev, i));
    }

    cur_offs = dev->dev_offs;
    cur_offs += VIRTIO_DEV_OFFS_CONFIG;
    cur_offs += num_vq * VIRTIO_VQCONFIG_LEN;

    /* Sync feature bitmap */
    stl_le_phys(cur_offs, dev->host_features);

    dev->feat_offs = cur_offs + dev->feat_len;
    cur_offs += dev->feat_len * 2;

    /* Sync config space */
    if (dev->vdev->get_config) {
        dev->vdev->get_config(dev->vdev, dev->vdev->config);
    }

    cpu_physical_memory_write(cur_offs,
                              dev->vdev->config, dev->vdev->config_len);
    cur_offs += dev->vdev->config_len;
}

void s390_virtio_device_update_status(VirtIOS390Device *dev)
{
    VirtIODevice *vdev = dev->vdev;
    uint32_t features;

    virtio_set_status(vdev, ldub_phys(dev->dev_offs + VIRTIO_DEV_OFFS_STATUS));

    /* Update guest supported feature bitmap */

    features = bswap32(ldl_be_phys(dev->feat_offs));
    virtio_set_features(vdev, features);
}

VirtIOS390Device *s390_virtio_bus_console(VirtIOS390Bus *bus)
{
    return bus->console;
}

/* Find a device by vring address */
VirtIOS390Device *s390_virtio_bus_find_vring(VirtIOS390Bus *bus,
                                             ram_addr_t mem,
                                             int *vq_num)
{
    BusChild *kid;
    int i;

    QTAILQ_FOREACH(kid, &bus->bus.children, sibling) {
        VirtIOS390Device *dev = (VirtIOS390Device *)kid->child;

        for(i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
            if (!virtio_queue_get_addr(dev->vdev, i))
                break;
            if (virtio_queue_get_addr(dev->vdev, i) == mem) {
                if (vq_num) {
                    *vq_num = i;
                }
                return dev;
            }
        }
    }

    return NULL;
}

/* Find a device by device descriptor location */
VirtIOS390Device *s390_virtio_bus_find_mem(VirtIOS390Bus *bus, ram_addr_t mem)
{
    BusChild *kid;

    QTAILQ_FOREACH(kid, &bus->bus.children, sibling) {
        VirtIOS390Device *dev = (VirtIOS390Device *)kid->child;
        if (dev->dev_offs == mem) {
            return dev;
        }
    }

    return NULL;
}

/* DeviceState to VirtIOS390Device. Note: used on datapath,
 * be careful and test performance if you change this.
 */
static inline VirtIOS390Device *to_virtio_s390_device_fast(DeviceState *d)
{
    return container_of(d, VirtIOS390Device, qdev);
}

/* DeviceState to VirtIOS390Device. TODO: use QOM. */
static inline VirtIOS390Device *to_virtio_s390_device(DeviceState *d)
{
    return container_of(d, VirtIOS390Device, qdev);
}

static void virtio_s390_notify(DeviceState *d, uint16_t vector)
{
    VirtIOS390Device *dev = to_virtio_s390_device_fast(d);
    uint64_t token = s390_virtio_device_vq_token(dev, vector);
    S390CPU *cpu = s390_cpu_addr2state(0);

    s390_virtio_irq(cpu, 0, token);
}

static unsigned virtio_s390_get_features(DeviceState *d)
{
    VirtIOS390Device *dev = to_virtio_s390_device(d);
    return dev->host_features;
}

/**************** S390 Virtio Bus Device Descriptions *******************/

static const VirtIOBindings virtio_s390_bindings = {
    .notify = virtio_s390_notify,
    .get_features = virtio_s390_get_features,
};

static Property s390_virtio_net_properties[] = {
    DEFINE_NIC_PROPERTIES(VirtIOS390Device, nic),
    DEFINE_PROP_UINT32("x-txtimer", VirtIOS390Device,
                       net.txtimer, TX_TIMER_INTERVAL),
    DEFINE_PROP_INT32("x-txburst", VirtIOS390Device,
                      net.txburst, TX_BURST),
    DEFINE_PROP_STRING("tx", VirtIOS390Device, net.tx),
    DEFINE_PROP_END_OF_LIST(),
};

static void s390_virtio_net_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);

    k->init = s390_virtio_net_init;
    dc->props = s390_virtio_net_properties;
}

static TypeInfo s390_virtio_net = {
    .name          = "virtio-net-s390",
    .parent        = TYPE_VIRTIO_S390_DEVICE,
    .instance_size = sizeof(VirtIOS390Device),
    .class_init    = s390_virtio_net_class_init,
};

static Property s390_virtio_blk_properties[] = {
    DEFINE_BLOCK_PROPERTIES(VirtIOS390Device, blk.conf),
    DEFINE_BLOCK_CHS_PROPERTIES(VirtIOS390Device, blk.conf),
    DEFINE_PROP_STRING("serial", VirtIOS390Device, blk.serial),
#ifdef __linux__
    DEFINE_PROP_BIT("scsi", VirtIOS390Device, blk.scsi, 0, true),
#endif
    DEFINE_PROP_END_OF_LIST(),
};

static void s390_virtio_blk_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);

    k->init = s390_virtio_blk_init;
    dc->props = s390_virtio_blk_properties;
}

static TypeInfo s390_virtio_blk = {
    .name          = "virtio-blk-s390",
    .parent        = TYPE_VIRTIO_S390_DEVICE,
    .instance_size = sizeof(VirtIOS390Device),
    .class_init    = s390_virtio_blk_class_init,
};

static Property s390_virtio_serial_properties[] = {
    DEFINE_PROP_UINT32("max_ports", VirtIOS390Device,
                       serial.max_virtserial_ports, 31),
    DEFINE_PROP_END_OF_LIST(),
};

static void s390_virtio_serial_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);

    k->init = s390_virtio_serial_init;
    dc->props = s390_virtio_serial_properties;
}

static TypeInfo s390_virtio_serial = {
    .name          = "virtio-serial-s390",
    .parent        = TYPE_VIRTIO_S390_DEVICE,
    .instance_size = sizeof(VirtIOS390Device),
    .class_init    = s390_virtio_serial_class_init,
};

static void s390_virtio_rng_initfn(Object *obj)
{
    VirtIOS390Device *dev = VIRTIO_S390_DEVICE(obj);

    object_property_add_link(obj, "rng", TYPE_RNG_BACKEND,
                             (Object **)&dev->rng.rng, NULL);
}

static void s390_virtio_rng_class_init(ObjectClass *klass, void *data)
{
    VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);

    k->init = s390_virtio_rng_init;
}

static TypeInfo s390_virtio_rng = {
    .name          = "virtio-rng-s390",
    .parent        = TYPE_VIRTIO_S390_DEVICE,
    .instance_size = sizeof(VirtIOS390Device),
    .instance_init = s390_virtio_rng_initfn,
    .class_init    = s390_virtio_rng_class_init,
};

static int s390_virtio_busdev_init(DeviceState *dev)
{
    VirtIOS390Device *_dev = (VirtIOS390Device *)dev;
    VirtIOS390DeviceClass *_info = VIRTIO_S390_DEVICE_GET_CLASS(dev);

    return _info->init(_dev);
}

static void virtio_s390_device_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);

    dc->init = s390_virtio_busdev_init;
    dc->bus_type = TYPE_S390_VIRTIO_BUS;
    dc->unplug = qdev_simple_unplug_cb;
}

static TypeInfo virtio_s390_device_info = {
    .name = TYPE_VIRTIO_S390_DEVICE,
    .parent = TYPE_DEVICE,
    .instance_size = sizeof(VirtIOS390Device),
    .class_init = virtio_s390_device_class_init,
    .class_size = sizeof(VirtIOS390DeviceClass),
    .abstract = true,
};

static Property s390_virtio_scsi_properties[] = {
    DEFINE_VIRTIO_SCSI_PROPERTIES(VirtIOS390Device, host_features, scsi),
    DEFINE_PROP_END_OF_LIST(),
};

static void s390_virtio_scsi_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);

    k->init = s390_virtio_scsi_init;
    dc->props = s390_virtio_scsi_properties;
}

static TypeInfo s390_virtio_scsi = {
    .name          = "virtio-scsi-s390",
    .parent        = TYPE_VIRTIO_S390_DEVICE,
    .instance_size = sizeof(VirtIOS390Device),
    .class_init    = s390_virtio_scsi_class_init,
};

/***************** S390 Virtio Bus Bridge Device *******************/
/* Only required to have the virtio bus as child in the system bus */

static int s390_virtio_bridge_init(SysBusDevice *dev)
{
    /* nothing */
    return 0;
}

static void s390_virtio_bridge_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);

    k->init = s390_virtio_bridge_init;
    dc->no_user = 1;
}

static TypeInfo s390_virtio_bridge_info = {
    .name          = "s390-virtio-bridge",
    .parent        = TYPE_SYS_BUS_DEVICE,
    .instance_size = sizeof(SysBusDevice),
    .class_init    = s390_virtio_bridge_class_init,
};

static void s390_virtio_register_types(void)
{
    type_register_static(&s390_virtio_bus_info);
    type_register_static(&virtio_s390_device_info);
    type_register_static(&s390_virtio_serial);
    type_register_static(&s390_virtio_blk);
    type_register_static(&s390_virtio_net);
    type_register_static(&s390_virtio_scsi);
    type_register_static(&s390_virtio_rng);
    type_register_static(&s390_virtio_bridge_info);
}

type_init(s390_virtio_register_types)
Commit	Line	Data
f3304eea AG	1	/*
	2	* QEMU S390 virtio target
	3	*
	4	* Copyright (c) 2009 Alexander Graf <[email protected]>
	5	*
	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.
	10	*
	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.
	15	*
	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/>.
	18	*/
	19
	20	#include "hw.h"
737e150e	21	#include "block/block.h"
9c17d615	22	#include "sysemu/sysemu.h"
f3304eea	23	#include "boards.h"
83c9089e	24	#include "monitor/monitor.h"
f3304eea AG	25	#include "loader.h"
	26	#include "elf.h"
	27	#include "hw/virtio.h"
16c915ba	28	#include "hw/virtio-rng.h"
98b19252	29	#include "hw/virtio-serial.h"
f0c07c7c	30	#include "hw/virtio-net.h"
f3304eea	31	#include "hw/sysbus.h"
9c17d615	32	#include "sysemu/kvm.h"
f3304eea AG	33
	34	#include "hw/s390-virtio-bus.h"
	35
	36	/* #define DEBUG_S390 */
	37
	38	#ifdef DEBUG_S390
	39	#define dprintf(fmt, ...) \
	40	do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
	41	#else
	42	#define dprintf(fmt, ...) \
	43	do { } while (0)
	44	#endif
	45
8103b4d1 AG	46	#define VIRTIO_EXT_CODE 0x2603
8103b4d1 AG	47
0d936928 AL	48	static const TypeInfo s390_virtio_bus_info = {
	49	.name = TYPE_S390_VIRTIO_BUS,
	50	.parent = TYPE_BUS,
	51	.instance_size = sizeof(VirtIOS390Bus),
f3304eea AG	52	};
f3304eea AG	53
f3304eea AG	54	static const VirtIOBindings virtio_s390_bindings;
	55
	56	static ram_addr_t s390_virtio_device_num_vq(VirtIOS390Device *dev);
f3304eea	57
d1ff903c	58	/* length of VirtIO device pages */
a8170e5e	59	const hwaddr virtio_size = S390_DEVICE_PAGES * TARGET_PAGE_SIZE;
d1ff903c	60
eb3caa44 JF	61	static void s390_virtio_bus_reset(void *opaque)
	62	{
	63	VirtIOS390Bus *bus = opaque;
	64	bus->next_ring = bus->dev_page + TARGET_PAGE_SIZE;
	65	}
	66
4170aea1 JF	67	void s390_virtio_reset_idx(VirtIOS390Device *dev)
	68	{
	69	int i;
a8170e5e	70	hwaddr idx_addr;
4170aea1 JF	71	uint8_t num_vq;
	72
	73	num_vq = s390_virtio_device_num_vq(dev);
	74	for (i = 0; i < num_vq; i++) {
	75	idx_addr = virtio_queue_get_avail_addr(dev->vdev, i) +
	76	VIRTIO_VRING_AVAIL_IDX_OFFS;
	77	stw_phys(idx_addr, 0);
	78	idx_addr = virtio_queue_get_used_addr(dev->vdev, i) +
	79	VIRTIO_VRING_USED_IDX_OFFS;
	80	stw_phys(idx_addr, 0);
	81	}
	82	}
	83
f3304eea AG	84	VirtIOS390Bus s390_virtio_bus_init(ram_addr_t ram_size)
	85	{
	86	VirtIOS390Bus *bus;
	87	BusState *_bus;
	88	DeviceState *dev;
	89
	90	/* Create bridge device */
	91	dev = qdev_create(NULL, "s390-virtio-bridge");
	92	qdev_init_nofail(dev);
	93
	94	/* Create bus on bridge device */
	95
0d936928	96	_bus = qbus_create(TYPE_S390_VIRTIO_BUS, dev, "s390-virtio");
f3304eea AG	97	bus = DO_UPCAST(VirtIOS390Bus, bus, _bus);
	98
	99	bus->dev_page = *ram_size;
	100	bus->dev_offs = bus->dev_page;
	101	bus->next_ring = bus->dev_page + TARGET_PAGE_SIZE;
	102
7fa41e53 AG	103	/* Enable hotplugging */
	104	_bus->allow_hotplug = 1;
	105
f3304eea AG	106	/* Allocate RAM for VirtIO device pages (descriptors, queues, rings) */
	107	ram_size += S390_DEVICE_PAGES TARGET_PAGE_SIZE;
	108
eb3caa44	109	qemu_register_reset(s390_virtio_bus_reset, bus);
f3304eea AG	110	return bus;
	111	}
	112
1bc22652	113	static void s390_virtio_irq(S390CPU *cpu, int config_change, uint64_t token)
7fa41e53	114	{
1bc22652 AF	115	CPUS390XState *env = &cpu->env;
1bc22652 AF	116
7fa41e53	117	if (kvm_enabled()) {
1bc22652	118	kvm_s390_virtio_irq(cpu, config_change, token);
7fa41e53 AG	119	} else {
	120	cpu_inject_ext(env, VIRTIO_EXT_CODE, config_change, token);
	121	}
	122	}
	123
f3304eea AG	124	static int s390_virtio_device_init(VirtIOS390Device dev, VirtIODevice vdev)
	125	{
	126	VirtIOS390Bus *bus;
	127	int dev_len;
	128
	129	bus = DO_UPCAST(VirtIOS390Bus, bus, dev->qdev.parent_bus);
	130	dev->vdev = vdev;
	131	dev->dev_offs = bus->dev_offs;
	132	dev->feat_len = sizeof(uint32_t); /* always keep 32 bits features */
	133
	134	dev_len = VIRTIO_DEV_OFFS_CONFIG;
	135	dev_len += s390_virtio_device_num_vq(dev) * VIRTIO_VQCONFIG_LEN;
	136	dev_len += dev->feat_len * 2;
	137	dev_len += vdev->config_len;
	138
	139	bus->dev_offs += dev_len;
	140
d2a0ccc6	141	virtio_bind_device(vdev, &virtio_s390_bindings, DEVICE(dev));
8172539d	142	dev->host_features = vdev->get_features(vdev, dev->host_features);
f3304eea	143	s390_virtio_device_sync(dev);
4170aea1	144	s390_virtio_reset_idx(dev);
7fa41e53	145	if (dev->qdev.hotplugged) {
45fa769b	146	S390CPU *cpu = s390_cpu_addr2state(0);
1bc22652	147	s390_virtio_irq(cpu, VIRTIO_PARAM_DEV_ADD, dev->dev_offs);
7fa41e53 AG	148	}
7fa41e53 AG	149
f3304eea AG	150	return 0;
	151	}
	152
	153	static int s390_virtio_net_init(VirtIOS390Device *dev)
	154	{
	155	VirtIODevice *vdev;
	156
f0c07c7c	157	vdev = virtio_net_init((DeviceState *)dev, &dev->nic, &dev->net);
f3304eea AG	158	if (!vdev) {
	159	return -1;
	160	}
	161
	162	return s390_virtio_device_init(dev, vdev);
	163	}
	164
	165	static int s390_virtio_blk_init(VirtIOS390Device *dev)
	166	{
	167	VirtIODevice *vdev;
	168
12c5674b	169	vdev = virtio_blk_init((DeviceState *)dev, &dev->blk);
f3304eea AG	170	if (!vdev) {
	171	return -1;
	172	}
	173
	174	return s390_virtio_device_init(dev, vdev);
	175	}
	176
98b19252	177	static int s390_virtio_serial_init(VirtIOS390Device *dev)
f3304eea AG	178	{
	179	VirtIOS390Bus *bus;
	180	VirtIODevice *vdev;
	181	int r;
	182
	183	bus = DO_UPCAST(VirtIOS390Bus, bus, dev->qdev.parent_bus);
	184
6be9b414	185	vdev = virtio_serial_init((DeviceState *)dev, &dev->serial);
f3304eea AG	186	if (!vdev) {
	187	return -1;
	188	}
	189
	190	r = s390_virtio_device_init(dev, vdev);
	191	if (!r) {
	192	bus->console = dev;
	193	}
	194
	195	return r;
	196	}
	197
973abc7f SH	198	static int s390_virtio_scsi_init(VirtIOS390Device *dev)
	199	{
	200	VirtIODevice *vdev;
	201
	202	vdev = virtio_scsi_init((DeviceState *)dev, &dev->scsi);
	203	if (!vdev) {
	204	return -1;
	205	}
	206
	207	return s390_virtio_device_init(dev, vdev);
	208	}
	209
16c915ba AS	210	static int s390_virtio_rng_init(VirtIOS390Device *dev)
	211	{
	212	VirtIODevice *vdev;
	213
	214	vdev = virtio_rng_init((DeviceState *)dev, &dev->rng);
	215	if (!vdev) {
	216	return -1;
	217	}
	218
	219	return s390_virtio_device_init(dev, vdev);
	220	}
	221
f3304eea AG	222	static uint64_t s390_virtio_device_vq_token(VirtIOS390Device *dev, int vq)
	223	{
	224	ram_addr_t token_off;
	225
	226	token_off = (dev->dev_offs + VIRTIO_DEV_OFFS_CONFIG) +
	227	(vq * VIRTIO_VQCONFIG_LEN) +
	228	VIRTIO_VQCONFIG_OFFS_TOKEN;
	229
04bc74ed	230	return ldq_be_phys(token_off);
f3304eea AG	231	}
	232
	233	static ram_addr_t s390_virtio_device_num_vq(VirtIOS390Device *dev)
	234	{
	235	VirtIODevice *vdev = dev->vdev;
	236	int num_vq;
	237
	238	for (num_vq = 0; num_vq < VIRTIO_PCI_QUEUE_MAX; num_vq++) {
	239	if (!virtio_queue_get_num(vdev, num_vq)) {
	240	break;
	241	}
	242	}
	243
	244	return num_vq;
	245	}
	246
	247	static ram_addr_t s390_virtio_next_ring(VirtIOS390Bus *bus)
	248	{
	249	ram_addr_t r = bus->next_ring;
	250
	251	bus->next_ring += VIRTIO_RING_LEN;
	252	return r;
	253	}
	254
baf0b55a	255	void s390_virtio_device_sync(VirtIOS390Device *dev)
f3304eea AG	256	{
	257	VirtIOS390Bus *bus = DO_UPCAST(VirtIOS390Bus, bus, dev->qdev.parent_bus);
	258	ram_addr_t cur_offs;
	259	uint8_t num_vq;
	260	int i;
	261
	262	virtio_reset(dev->vdev);
	263
	264	/* Sync dev space */
	265	stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_TYPE, dev->vdev->device_id);
	266
	267	stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_NUM_VQ, s390_virtio_device_num_vq(dev));
	268	stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_FEATURE_LEN, dev->feat_len);
	269
	270	stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_CONFIG_LEN, dev->vdev->config_len);
	271
	272	num_vq = s390_virtio_device_num_vq(dev);
	273	stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_NUM_VQ, num_vq);
	274
	275	/* Sync virtqueues */
	276	for (i = 0; i < num_vq; i++) {
	277	ram_addr_t vq = (dev->dev_offs + VIRTIO_DEV_OFFS_CONFIG) +
	278	(i * VIRTIO_VQCONFIG_LEN);
	279	ram_addr_t vring;
	280
	281	vring = s390_virtio_next_ring(bus);
	282	virtio_queue_set_addr(dev->vdev, i, vring);
	283	virtio_queue_set_vector(dev->vdev, i, i);
04bc74ed AG	284	stq_be_phys(vq + VIRTIO_VQCONFIG_OFFS_ADDRESS, vring);
04bc74ed AG	285	stw_be_phys(vq + VIRTIO_VQCONFIG_OFFS_NUM, virtio_queue_get_num(dev->vdev, i));
f3304eea AG	286	}
	287
	288	cur_offs = dev->dev_offs;
	289	cur_offs += VIRTIO_DEV_OFFS_CONFIG;
	290	cur_offs += num_vq * VIRTIO_VQCONFIG_LEN;
	291
	292	/* Sync feature bitmap */
04bc74ed	293	stl_le_phys(cur_offs, dev->host_features);
f3304eea AG	294
	295	dev->feat_offs = cur_offs + dev->feat_len;
	296	cur_offs += dev->feat_len * 2;
	297
	298	/* Sync config space */
	299	if (dev->vdev->get_config) {
	300	dev->vdev->get_config(dev->vdev, dev->vdev->config);
	301	}
	302
54f7b4a3 SW	303	cpu_physical_memory_write(cur_offs,
54f7b4a3 SW	304	dev->vdev->config, dev->vdev->config_len);
f3304eea AG	305	cur_offs += dev->vdev->config_len;
	306	}
	307
	308	void s390_virtio_device_update_status(VirtIOS390Device *dev)
	309	{
	310	VirtIODevice *vdev = dev->vdev;
	311	uint32_t features;
	312
3e607cb5	313	virtio_set_status(vdev, ldub_phys(dev->dev_offs + VIRTIO_DEV_OFFS_STATUS));
f3304eea AG	314
	315	/* Update guest supported feature bitmap */
	316
04bc74ed	317	features = bswap32(ldl_be_phys(dev->feat_offs));
ad0c9332	318	virtio_set_features(vdev, features);
f3304eea AG	319	}
	320
	321	VirtIOS390Device s390_virtio_bus_console(VirtIOS390Bus bus)
	322	{
	323	return bus->console;
	324	}
	325
	326	/* Find a device by vring address */
	327	VirtIOS390Device s390_virtio_bus_find_vring(VirtIOS390Bus bus,
	328	ram_addr_t mem,
	329	int *vq_num)
	330	{
0866aca1	331	BusChild *kid;
f3304eea AG	332	int i;
f3304eea AG	333
0866aca1 AL	334	QTAILQ_FOREACH(kid, &bus->bus.children, sibling) {
	335	VirtIOS390Device dev = (VirtIOS390Device )kid->child;
	336
f3304eea	337	for(i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
0866aca1	338	if (!virtio_queue_get_addr(dev->vdev, i))
f3304eea	339	break;
0866aca1	340	if (virtio_queue_get_addr(dev->vdev, i) == mem) {
f3304eea AG	341	if (vq_num) {
	342	*vq_num = i;
	343	}
0866aca1	344	return dev;
f3304eea AG	345	}
	346	}
	347	}
	348
	349	return NULL;
	350	}
	351
	352	/* Find a device by device descriptor location */
	353	VirtIOS390Device s390_virtio_bus_find_mem(VirtIOS390Bus bus, ram_addr_t mem)
	354	{
0866aca1	355	BusChild *kid;
f3304eea	356
0866aca1 AL	357	QTAILQ_FOREACH(kid, &bus->bus.children, sibling) {
	358	VirtIOS390Device dev = (VirtIOS390Device )kid->child;
	359	if (dev->dev_offs == mem) {
	360	return dev;
f3304eea AG	361	}
	362	}
	363
	364	return NULL;
	365	}
	366
d2a0ccc6 MT	367	/* DeviceState to VirtIOS390Device. Note: used on datapath,
	368	* be careful and test performance if you change this.
	369	*/
	370	static inline VirtIOS390Device to_virtio_s390_device_fast(DeviceState d)
	371	{
	372	return container_of(d, VirtIOS390Device, qdev);
	373	}
	374
	375	/* DeviceState to VirtIOS390Device. TODO: use QOM. */
	376	static inline VirtIOS390Device to_virtio_s390_device(DeviceState d)
	377	{
	378	return container_of(d, VirtIOS390Device, qdev);
	379	}
	380
	381	static void virtio_s390_notify(DeviceState *d, uint16_t vector)
f3304eea	382	{
d2a0ccc6	383	VirtIOS390Device *dev = to_virtio_s390_device_fast(d);
f3304eea	384	uint64_t token = s390_virtio_device_vq_token(dev, vector);
45fa769b	385	S390CPU *cpu = s390_cpu_addr2state(0);
f3304eea	386
1bc22652	387	s390_virtio_irq(cpu, 0, token);
f3304eea AG	388	}
f3304eea AG	389
d2a0ccc6	390	static unsigned virtio_s390_get_features(DeviceState *d)
8172539d	391	{
d2a0ccc6	392	VirtIOS390Device *dev = to_virtio_s390_device(d);
8172539d MT	393	return dev->host_features;
	394	}
	395
f3304eea AG	396	/************** S390 Virtio Bus Device Descriptions *****************/
	397
	398	static const VirtIOBindings virtio_s390_bindings = {
	399	.notify = virtio_s390_notify,
8172539d	400	.get_features = virtio_s390_get_features,
f3304eea AG	401	};
f3304eea AG	402
39bffca2 AL	403	static Property s390_virtio_net_properties[] = {
	404	DEFINE_NIC_PROPERTIES(VirtIOS390Device, nic),
	405	DEFINE_PROP_UINT32("x-txtimer", VirtIOS390Device,
	406	net.txtimer, TX_TIMER_INTERVAL),
	407	DEFINE_PROP_INT32("x-txburst", VirtIOS390Device,
	408	net.txburst, TX_BURST),
	409	DEFINE_PROP_STRING("tx", VirtIOS390Device, net.tx),
	410	DEFINE_PROP_END_OF_LIST(),
	411	};
	412
19b6914a AL	413	static void s390_virtio_net_class_init(ObjectClass klass, void data)
19b6914a AL	414	{
39bffca2 AL	415	DeviceClass *dc = DEVICE_CLASS(klass);
39bffca2 AL	416	VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);
19b6914a	417
39bffca2 AL	418	k->init = s390_virtio_net_init;
39bffca2 AL	419	dc->props = s390_virtio_net_properties;
19b6914a AL	420	}
19b6914a AL	421
39bffca2 AL	422	static TypeInfo s390_virtio_net = {
	423	.name = "virtio-net-s390",
	424	.parent = TYPE_VIRTIO_S390_DEVICE,
	425	.instance_size = sizeof(VirtIOS390Device),
	426	.class_init = s390_virtio_net_class_init,
	427	};
	428
	429	static Property s390_virtio_blk_properties[] = {
12c5674b	430	DEFINE_BLOCK_PROPERTIES(VirtIOS390Device, blk.conf),
e63e7fde	431	DEFINE_BLOCK_CHS_PROPERTIES(VirtIOS390Device, blk.conf),
12c5674b	432	DEFINE_PROP_STRING("serial", VirtIOS390Device, blk.serial),
a6c5c84a PB	433	#ifdef __linux__
	434	DEFINE_PROP_BIT("scsi", VirtIOS390Device, blk.scsi, 0, true),
	435	#endif
39bffca2	436	DEFINE_PROP_END_OF_LIST(),
f3304eea AG	437	};
f3304eea AG	438
19b6914a AL	439	static void s390_virtio_blk_class_init(ObjectClass klass, void data)
19b6914a AL	440	{
39bffca2 AL	441	DeviceClass *dc = DEVICE_CLASS(klass);
39bffca2 AL	442	VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);
19b6914a	443
39bffca2 AL	444	k->init = s390_virtio_blk_init;
39bffca2 AL	445	dc->props = s390_virtio_blk_properties;
19b6914a AL	446	}
19b6914a AL	447
39bffca2 AL	448	static TypeInfo s390_virtio_blk = {
	449	.name = "virtio-blk-s390",
	450	.parent = TYPE_VIRTIO_S390_DEVICE,
	451	.instance_size = sizeof(VirtIOS390Device),
	452	.class_init = s390_virtio_blk_class_init,
	453	};
	454
	455	static Property s390_virtio_serial_properties[] = {
	456	DEFINE_PROP_UINT32("max_ports", VirtIOS390Device,
	457	serial.max_virtserial_ports, 31),
	458	DEFINE_PROP_END_OF_LIST(),
f3304eea AG	459	};
f3304eea AG	460
19b6914a AL	461	static void s390_virtio_serial_class_init(ObjectClass klass, void data)
19b6914a AL	462	{
39bffca2 AL	463	DeviceClass *dc = DEVICE_CLASS(klass);
39bffca2 AL	464	VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);
19b6914a	465
39bffca2 AL	466	k->init = s390_virtio_serial_init;
39bffca2 AL	467	dc->props = s390_virtio_serial_properties;
19b6914a AL	468	}
19b6914a AL	469
39bffca2 AL	470	static TypeInfo s390_virtio_serial = {
	471	.name = "virtio-serial-s390",
	472	.parent = TYPE_VIRTIO_S390_DEVICE,
	473	.instance_size = sizeof(VirtIOS390Device),
	474	.class_init = s390_virtio_serial_class_init,
f3304eea AG	475	};
f3304eea AG	476
16c915ba AS	477	static void s390_virtio_rng_initfn(Object *obj)
	478	{
	479	VirtIOS390Device *dev = VIRTIO_S390_DEVICE(obj);
	480
	481	object_property_add_link(obj, "rng", TYPE_RNG_BACKEND,
	482	(Object **)&dev->rng.rng, NULL);
	483	}
	484
	485	static void s390_virtio_rng_class_init(ObjectClass klass, void data)
	486	{
	487	VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);
	488
	489	k->init = s390_virtio_rng_init;
	490	}
	491
	492	static TypeInfo s390_virtio_rng = {
	493	.name = "virtio-rng-s390",
	494	.parent = TYPE_VIRTIO_S390_DEVICE,
	495	.instance_size = sizeof(VirtIOS390Device),
	496	.instance_init = s390_virtio_rng_initfn,
	497	.class_init = s390_virtio_rng_class_init,
	498	};
	499
d307af79	500	static int s390_virtio_busdev_init(DeviceState *dev)
f3304eea	501	{
f3304eea	502	VirtIOS390Device _dev = (VirtIOS390Device )dev;
19b6914a	503	VirtIOS390DeviceClass *_info = VIRTIO_S390_DEVICE_GET_CLASS(dev);
f3304eea AG	504
	505	return _info->init(_dev);
	506	}
	507
39bffca2	508	static void virtio_s390_device_class_init(ObjectClass klass, void data)
f3304eea	509	{
39bffca2	510	DeviceClass *dc = DEVICE_CLASS(klass);
f3304eea	511
39bffca2	512	dc->init = s390_virtio_busdev_init;
0d936928	513	dc->bus_type = TYPE_S390_VIRTIO_BUS;
39bffca2	514	dc->unplug = qdev_simple_unplug_cb;
f3304eea AG	515	}
f3304eea AG	516
19b6914a AL	517	static TypeInfo virtio_s390_device_info = {
	518	.name = TYPE_VIRTIO_S390_DEVICE,
	519	.parent = TYPE_DEVICE,
	520	.instance_size = sizeof(VirtIOS390Device),
39bffca2	521	.class_init = virtio_s390_device_class_init,
e87f7fc6	522	.class_size = sizeof(VirtIOS390DeviceClass),
19b6914a AL	523	.abstract = true,
	524	};
	525
973abc7f SH	526	static Property s390_virtio_scsi_properties[] = {
	527	DEFINE_VIRTIO_SCSI_PROPERTIES(VirtIOS390Device, host_features, scsi),
	528	DEFINE_PROP_END_OF_LIST(),
	529	};
	530
	531	static void s390_virtio_scsi_class_init(ObjectClass klass, void data)
	532	{
	533	DeviceClass *dc = DEVICE_CLASS(klass);
	534	VirtIOS390DeviceClass *k = VIRTIO_S390_DEVICE_CLASS(klass);
	535
	536	k->init = s390_virtio_scsi_init;
	537	dc->props = s390_virtio_scsi_properties;
	538	}
	539
	540	static TypeInfo s390_virtio_scsi = {
	541	.name = "virtio-scsi-s390",
	542	.parent = TYPE_VIRTIO_S390_DEVICE,
	543	.instance_size = sizeof(VirtIOS390Device),
	544	.class_init = s390_virtio_scsi_class_init,
	545	};
f3304eea AG	546
	547	/*************** S390 Virtio Bus Bridge Device *****************/
	548	/* Only required to have the virtio bus as child in the system bus */
	549
	550	static int s390_virtio_bridge_init(SysBusDevice *dev)
	551	{
	552	/* nothing */
	553	return 0;
	554	}
	555
999e12bb AL	556	static void s390_virtio_bridge_class_init(ObjectClass klass, void data)
999e12bb AL	557	{
39bffca2	558	DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb AL	559	SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
	560
	561	k->init = s390_virtio_bridge_init;
39bffca2	562	dc->no_user = 1;
999e12bb AL	563	}
999e12bb AL	564
39bffca2 AL	565	static TypeInfo s390_virtio_bridge_info = {
	566	.name = "s390-virtio-bridge",
	567	.parent = TYPE_SYS_BUS_DEVICE,
	568	.instance_size = sizeof(SysBusDevice),
	569	.class_init = s390_virtio_bridge_class_init,
f3304eea AG	570	};
f3304eea AG	571
83f7d43a	572	static void s390_virtio_register_types(void)
f3304eea	573	{
0d936928	574	type_register_static(&s390_virtio_bus_info);
83f7d43a AF	575	type_register_static(&virtio_s390_device_info);
	576	type_register_static(&s390_virtio_serial);
	577	type_register_static(&s390_virtio_blk);
	578	type_register_static(&s390_virtio_net);
973abc7f	579	type_register_static(&s390_virtio_scsi);
16c915ba	580	type_register_static(&s390_virtio_rng);
39bffca2	581	type_register_static(&s390_virtio_bridge_info);
f3304eea AG	582	}
f3304eea AG	583
83f7d43a	584	type_init(s390_virtio_register_types)