[mirror_qemu.git] / hw / s390x / event-facility.c

/*
 * SCLP
 *    Event Facility
 *       handles SCLP event types
 *          - Signal Quiesce - system power down
 *          - ASCII Console Data - VT220 read and write
 *
 * Copyright IBM, Corp. 2012
 *
 * Authors:
 *  Heinz Graalfs <graalfs@de.ibm.com>
 *
 * This work is licensed under the terms of the GNU GPL, version 2 or (at your
 * option) any later version.  See the COPYING file in the top-level directory.
 *
 */

#include "monitor/monitor.h"
#include "sysemu/sysemu.h"

#include "hw/s390x/sclp.h"
#include "hw/s390x/event-facility.h"

typedef struct SCLPEventsBus {
    BusState qbus;
} SCLPEventsBus;

struct SCLPEventFacility {
    SCLPEventsBus sbus;
    DeviceState *qdev;
    /* guest' receive mask */
    unsigned int receive_mask;
};

SCLPEvent cpu_hotplug;

/* return true if any child has event pending set */
static bool event_pending(SCLPEventFacility *ef)
{
    BusChild *kid;
    SCLPEvent *event;
    SCLPEventClass *event_class;

    QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
        DeviceState *qdev = kid->child;
        event = DO_UPCAST(SCLPEvent, qdev, qdev);
        event_class = SCLP_EVENT_GET_CLASS(event);
        if (event->event_pending &&
            event_class->get_send_mask() & ef->receive_mask) {
            return true;
        }
    }
    return false;
}

static unsigned int get_host_send_mask(SCLPEventFacility *ef)
{
    unsigned int mask;
    BusChild *kid;
    SCLPEventClass *child;

    mask = 0;

    QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
        DeviceState *qdev = kid->child;
        child = SCLP_EVENT_GET_CLASS((SCLPEvent *) qdev);
        mask |= child->get_send_mask();
    }
    return mask;
}

static unsigned int get_host_receive_mask(SCLPEventFacility *ef)
{
    unsigned int mask;
    BusChild *kid;
    SCLPEventClass *child;

    mask = 0;

    QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
        DeviceState *qdev = kid->child;
        child = SCLP_EVENT_GET_CLASS((SCLPEvent *) qdev);
        mask |= child->get_receive_mask();
    }
    return mask;
}

static uint16_t write_event_length_check(SCCB *sccb)
{
    int slen;
    unsigned elen = 0;
    EventBufferHeader *event;
    WriteEventData *wed = (WriteEventData *) sccb;

    event = (EventBufferHeader *) &wed->ebh;
    for (slen = sccb_data_len(sccb); slen > 0; slen -= elen) {
        elen = be16_to_cpu(event->length);
        if (elen < sizeof(*event) || elen > slen) {
            return SCLP_RC_EVENT_BUFFER_SYNTAX_ERROR;
        }
        event = (void *) event + elen;
    }
    if (slen) {
        return SCLP_RC_INCONSISTENT_LENGTHS;
    }
    return SCLP_RC_NORMAL_COMPLETION;
}

static uint16_t handle_write_event_buf(SCLPEventFacility *ef,
                                       EventBufferHeader *event_buf, SCCB *sccb)
{
    uint16_t rc;
    BusChild *kid;
    SCLPEvent *event;
    SCLPEventClass *ec;

    rc = SCLP_RC_INVALID_FUNCTION;

    QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
        DeviceState *qdev = kid->child;
        event = (SCLPEvent *) qdev;
        ec = SCLP_EVENT_GET_CLASS(event);

        if (ec->write_event_data &&
            ec->can_handle_event(event_buf->type)) {
            rc = ec->write_event_data(event, event_buf);
            break;
        }
    }
    return rc;
}

static uint16_t handle_sccb_write_events(SCLPEventFacility *ef, SCCB *sccb)
{
    uint16_t rc;
    int slen;
    unsigned elen = 0;
    EventBufferHeader *event_buf;
    WriteEventData *wed = (WriteEventData *) sccb;

    event_buf = &wed->ebh;
    rc = SCLP_RC_NORMAL_COMPLETION;

    /* loop over all contained event buffers */
    for (slen = sccb_data_len(sccb); slen > 0; slen -= elen) {
        elen = be16_to_cpu(event_buf->length);

        /* in case of a previous error mark all trailing buffers
         * as not accepted */
        if (rc != SCLP_RC_NORMAL_COMPLETION) {
            event_buf->flags &= ~(SCLP_EVENT_BUFFER_ACCEPTED);
        } else {
            rc = handle_write_event_buf(ef, event_buf, sccb);
        }
        event_buf = (void *) event_buf + elen;
    }
    return rc;
}

static void write_event_data(SCLPEventFacility *ef, SCCB *sccb)
{
    if (sccb->h.function_code != SCLP_FC_NORMAL_WRITE) {
        sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_FUNCTION);
        goto out;
    }
    if (be16_to_cpu(sccb->h.length) < 8) {
        sccb->h.response_code = cpu_to_be16(SCLP_RC_INSUFFICIENT_SCCB_LENGTH);
        goto out;
    }
    /* first do a sanity check of the write events */
    sccb->h.response_code = cpu_to_be16(write_event_length_check(sccb));

    /* if no early error, then execute */
    if (sccb->h.response_code == be16_to_cpu(SCLP_RC_NORMAL_COMPLETION)) {
        sccb->h.response_code =
                cpu_to_be16(handle_sccb_write_events(ef, sccb));
    }

out:
    return;
}

static uint16_t handle_sccb_read_events(SCLPEventFacility *ef, SCCB *sccb,
                                        unsigned int mask)
{
    uint16_t rc;
    int slen;
    unsigned elen;
    BusChild *kid;
    SCLPEvent *event;
    SCLPEventClass *ec;
    EventBufferHeader *event_buf;
    ReadEventData *red = (ReadEventData *) sccb;

    event_buf = &red->ebh;
    event_buf->length = 0;
    slen = sizeof(sccb->data);

    rc = SCLP_RC_NO_EVENT_BUFFERS_STORED;

    QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
        DeviceState *qdev = kid->child;
        event = (SCLPEvent *) qdev;
        ec = SCLP_EVENT_GET_CLASS(event);

        if (mask & ec->get_send_mask()) {
            if (ec->read_event_data(event, event_buf, &slen)) {
                elen = be16_to_cpu(event_buf->length);
                event_buf = (EventBufferHeader *) ((char *)event_buf + elen);
                rc = SCLP_RC_NORMAL_COMPLETION;
            }
        }
    }

    if (sccb->h.control_mask[2] & SCLP_VARIABLE_LENGTH_RESPONSE) {
        /* architecture suggests to reset variable-length-response bit */
        sccb->h.control_mask[2] &= ~SCLP_VARIABLE_LENGTH_RESPONSE;
        /* with a new length value */
        sccb->h.length = cpu_to_be16(SCCB_SIZE - slen);
    }
    return rc;
}

static void read_event_data(SCLPEventFacility *ef, SCCB *sccb)
{
    unsigned int sclp_active_selection_mask;
    unsigned int sclp_cp_receive_mask;

    ReadEventData *red = (ReadEventData *) sccb;

    if (be16_to_cpu(sccb->h.length) != SCCB_SIZE) {
        sccb->h.response_code = cpu_to_be16(SCLP_RC_INSUFFICIENT_SCCB_LENGTH);
        goto out;
    }

    sclp_cp_receive_mask = ef->receive_mask;

    /* get active selection mask */
    switch (sccb->h.function_code) {
    case SCLP_UNCONDITIONAL_READ:
        sclp_active_selection_mask = sclp_cp_receive_mask;
        break;
    case SCLP_SELECTIVE_READ:
        if (!(sclp_cp_receive_mask & be32_to_cpu(red->mask))) {
            sccb->h.response_code =
                    cpu_to_be16(SCLP_RC_INVALID_SELECTION_MASK);
            goto out;
        }
        sclp_active_selection_mask = be32_to_cpu(red->mask);
        break;
    default:
        sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_FUNCTION);
        goto out;
    }
    sccb->h.response_code = cpu_to_be16(
            handle_sccb_read_events(ef, sccb, sclp_active_selection_mask));

out:
    return;
}

static void write_event_mask(SCLPEventFacility *ef, SCCB *sccb)
{
    WriteEventMask *we_mask = (WriteEventMask *) sccb;

    /* Attention: We assume that Linux uses 4-byte masks, what it actually
       does. Architecture allows for masks of variable size, though */
    if (be16_to_cpu(we_mask->mask_length) != 4) {
        sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_MASK_LENGTH);
        goto out;
    }

    /* keep track of the guest's capability masks */
    ef->receive_mask = be32_to_cpu(we_mask->cp_receive_mask);

    /* return the SCLP's capability masks to the guest */
    we_mask->send_mask = cpu_to_be32(get_host_send_mask(ef));
    we_mask->receive_mask = cpu_to_be32(get_host_receive_mask(ef));

    sccb->h.response_code = cpu_to_be16(SCLP_RC_NORMAL_COMPLETION);

out:
    return;
}

/* qemu object creation and initialization functions */

#define TYPE_SCLP_EVENTS_BUS "s390-sclp-events-bus"

static void sclp_events_bus_class_init(ObjectClass *klass, void *data)
{
}

static const TypeInfo sclp_events_bus_info = {
    .name = TYPE_SCLP_EVENTS_BUS,
    .parent = TYPE_BUS,
    .class_init = sclp_events_bus_class_init,
};

static void command_handler(SCLPEventFacility *ef, SCCB *sccb, uint64_t code)
{
    switch (code & SCLP_CMD_CODE_MASK) {
    case SCLP_CMD_READ_EVENT_DATA:
        read_event_data(ef, sccb);
        break;
    case SCLP_CMD_WRITE_EVENT_DATA:
        write_event_data(ef, sccb);
        break;
    case SCLP_CMD_WRITE_EVENT_MASK:
        write_event_mask(ef, sccb);
        break;
    default:
        sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_SCLP_COMMAND);
        break;
    }
}

static int init_event_facility(S390SCLPDevice *sdev)
{
    SCLPEventFacility *event_facility;
    DeviceState *quiesce;

    event_facility = g_malloc0(sizeof(SCLPEventFacility));
    sdev->ef = event_facility;
    sdev->sclp_command_handler = command_handler;
    sdev->event_pending = event_pending;

    /* Spawn a new sclp-events facility */
    qbus_create_inplace(&event_facility->sbus, sizeof(event_facility->sbus),
                        TYPE_SCLP_EVENTS_BUS, DEVICE(sdev), NULL);
    event_facility->sbus.qbus.allow_hotplug = 0;
    event_facility->qdev = (DeviceState *) sdev;

    quiesce = qdev_create(&event_facility->sbus.qbus, "sclpquiesce");
    if (!quiesce) {
        return -1;
    }
    qdev_init_nofail(quiesce);

    object_initialize(&cpu_hotplug, sizeof(cpu_hotplug), TYPE_SCLP_CPU_HOTPLUG);
    qdev_set_parent_bus(DEVICE(&cpu_hotplug), BUS(&event_facility->sbus));
    object_property_set_bool(OBJECT(&cpu_hotplug), true, "realized", NULL);

    return 0;
}

static void reset_event_facility(DeviceState *dev)
{
    S390SCLPDevice *sdev = SCLP_S390_DEVICE(dev);

    sdev->ef->receive_mask = 0;
}

static void init_event_facility_class(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    S390SCLPDeviceClass *k = SCLP_S390_DEVICE_CLASS(klass);

    dc->reset = reset_event_facility;
    k->init = init_event_facility;
}

static const TypeInfo sclp_event_facility_info = {
    .name          = "s390-sclp-event-facility",
    .parent        = TYPE_DEVICE_S390_SCLP,
    .instance_size = sizeof(S390SCLPDevice),
    .class_init    = init_event_facility_class,
};

static int event_qdev_init(DeviceState *qdev)
{
    SCLPEvent *event = DO_UPCAST(SCLPEvent, qdev, qdev);
    SCLPEventClass *child = SCLP_EVENT_GET_CLASS(event);

    return child->init(event);
}

static int event_qdev_exit(DeviceState *qdev)
{
    SCLPEvent *event = DO_UPCAST(SCLPEvent, qdev, qdev);
    SCLPEventClass *child = SCLP_EVENT_GET_CLASS(event);
    if (child->exit) {
        child->exit(event);
    }
    return 0;
}

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

    dc->bus_type = TYPE_SCLP_EVENTS_BUS;
    dc->unplug = qdev_simple_unplug_cb;
    dc->init = event_qdev_init;
    dc->exit = event_qdev_exit;
}

static const TypeInfo sclp_event_type_info = {
    .name = TYPE_SCLP_EVENT,
    .parent = TYPE_DEVICE,
    .instance_size = sizeof(SCLPEvent),
    .class_init = event_class_init,
    .class_size = sizeof(SCLPEventClass),
    .abstract = true,
};

static void register_types(void)
{
    type_register_static(&sclp_events_bus_info);
    type_register_static(&sclp_event_facility_info);
    type_register_static(&sclp_event_type_info);
}

type_init(register_types)
Commit	Line	Data
559a17a1 HG	1	/*
	2	* SCLP
	3	* Event Facility
	4	* handles SCLP event types
	5	* - Signal Quiesce - system power down
	6	* - ASCII Console Data - VT220 read and write
	7	*
	8	* Copyright IBM, Corp. 2012
	9	*
	10	* Authors:
	11	* Heinz Graalfs <graalfs@de.ibm.com>
	12	*
	13	* This work is licensed under the terms of the GNU GPL, version 2 or (at your
	14	* option) any later version. See the COPYING file in the top-level directory.
	15	*
	16	*/
	17
83c9089e	18	#include "monitor/monitor.h"
9c17d615	19	#include "sysemu/sysemu.h"
559a17a1	20
83c9f4ca PB	21	#include "hw/s390x/sclp.h"
83c9f4ca PB	22	#include "hw/s390x/event-facility.h"
559a17a1	23
65e526c2	24	typedef struct SCLPEventsBus {
559a17a1	25	BusState qbus;
65e526c2	26	} SCLPEventsBus;
559a17a1 HG	27
559a17a1 HG	28	struct SCLPEventFacility {
65e526c2	29	SCLPEventsBus sbus;
559a17a1 HG	30	DeviceState *qdev;
	31	/* guest' receive mask */
	32	unsigned int receive_mask;
	33	};
	34
49204458 JH	35	SCLPEvent cpu_hotplug;
49204458 JH	36
559a17a1 HG	37	/* return true if any child has event pending set */
	38	static bool event_pending(SCLPEventFacility *ef)
	39	{
	40	BusChild *kid;
	41	SCLPEvent *event;
	42	SCLPEventClass *event_class;
	43
	44	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	45	DeviceState *qdev = kid->child;
	46	event = DO_UPCAST(SCLPEvent, qdev, qdev);
	47	event_class = SCLP_EVENT_GET_CLASS(event);
	48	if (event->event_pending &&
	49	event_class->get_send_mask() & ef->receive_mask) {
	50	return true;
	51	}
	52	}
	53	return false;
	54	}
	55
	56	static unsigned int get_host_send_mask(SCLPEventFacility *ef)
	57	{
	58	unsigned int mask;
	59	BusChild *kid;
	60	SCLPEventClass *child;
	61
	62	mask = 0;
	63
	64	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	65	DeviceState *qdev = kid->child;
	66	child = SCLP_EVENT_GET_CLASS((SCLPEvent *) qdev);
	67	mask \|= child->get_send_mask();
	68	}
	69	return mask;
	70	}
	71
	72	static unsigned int get_host_receive_mask(SCLPEventFacility *ef)
	73	{
	74	unsigned int mask;
	75	BusChild *kid;
	76	SCLPEventClass *child;
	77
	78	mask = 0;
	79
	80	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	81	DeviceState *qdev = kid->child;
	82	child = SCLP_EVENT_GET_CLASS((SCLPEvent *) qdev);
	83	mask \|= child->get_receive_mask();
	84	}
	85	return mask;
	86	}
	87
	88	static uint16_t write_event_length_check(SCCB *sccb)
	89	{
	90	int slen;
	91	unsigned elen = 0;
	92	EventBufferHeader *event;
	93	WriteEventData wed = (WriteEventData ) sccb;
	94
	95	event = (EventBufferHeader *) &wed->ebh;
	96	for (slen = sccb_data_len(sccb); slen > 0; slen -= elen) {
	97	elen = be16_to_cpu(event->length);
	98	if (elen < sizeof(*event) \|\| elen > slen) {
	99	return SCLP_RC_EVENT_BUFFER_SYNTAX_ERROR;
	100	}
101	event = (void *) event + elen;
102	}
103	if (slen) {
104	return SCLP_RC_INCONSISTENT_LENGTHS;
105	}
106	return SCLP_RC_NORMAL_COMPLETION;
107	}
108
109	static uint16_t handle_write_event_buf(SCLPEventFacility *ef,
110	EventBufferHeader event_buf, SCCB sccb)
111	{
112	uint16_t rc;
113	BusChild *kid;
114	SCLPEvent *event;
115	SCLPEventClass *ec;
116
773de5c7 CH	117	rc = SCLP_RC_INVALID_FUNCTION;
773de5c7 CH	118
559a17a1 HG	119	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	120	DeviceState *qdev = kid->child;
	121	event = (SCLPEvent *) qdev;
	122	ec = SCLP_EVENT_GET_CLASS(event);
	123
559a17a1	124	if (ec->write_event_data &&
c3d9f24a	125	ec->can_handle_event(event_buf->type)) {
559a17a1 HG	126	rc = ec->write_event_data(event, event_buf);
	127	break;
	128	}
	129	}
	130	return rc;
	131	}
	132
	133	static uint16_t handle_sccb_write_events(SCLPEventFacility ef, SCCB sccb)
	134	{
	135	uint16_t rc;
	136	int slen;
	137	unsigned elen = 0;
	138	EventBufferHeader *event_buf;
	139	WriteEventData wed = (WriteEventData ) sccb;
	140
	141	event_buf = &wed->ebh;
	142	rc = SCLP_RC_NORMAL_COMPLETION;
	143
	144	/* loop over all contained event buffers */
	145	for (slen = sccb_data_len(sccb); slen > 0; slen -= elen) {
	146	elen = be16_to_cpu(event_buf->length);
	147
	148	/* in case of a previous error mark all trailing buffers
	149	* as not accepted */
	150	if (rc != SCLP_RC_NORMAL_COMPLETION) {
	151	event_buf->flags &= ~(SCLP_EVENT_BUFFER_ACCEPTED);
	152	} else {
	153	rc = handle_write_event_buf(ef, event_buf, sccb);
	154	}
	155	event_buf = (void *) event_buf + elen;
	156	}
	157	return rc;
	158	}
	159
	160	static void write_event_data(SCLPEventFacility ef, SCCB sccb)
	161	{
	162	if (sccb->h.function_code != SCLP_FC_NORMAL_WRITE) {
	163	sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_FUNCTION);
	164	goto out;
	165	}
	166	if (be16_to_cpu(sccb->h.length) < 8) {
	167	sccb->h.response_code = cpu_to_be16(SCLP_RC_INSUFFICIENT_SCCB_LENGTH);
	168	goto out;
	169	}
	170	/* first do a sanity check of the write events */
	171	sccb->h.response_code = cpu_to_be16(write_event_length_check(sccb));
	172
	173	/* if no early error, then execute */
	174	if (sccb->h.response_code == be16_to_cpu(SCLP_RC_NORMAL_COMPLETION)) {
	175	sccb->h.response_code =
	176	cpu_to_be16(handle_sccb_write_events(ef, sccb));
	177	}
	178
	179	out:
	180	return;
	181	}
	182
	183	static uint16_t handle_sccb_read_events(SCLPEventFacility ef, SCCB sccb,
	184	unsigned int mask)
	185	{
	186	uint16_t rc;
	187	int slen;
a0c8699b	188	unsigned elen;
559a17a1 HG	189	BusChild *kid;
	190	SCLPEvent *event;
	191	SCLPEventClass *ec;
	192	EventBufferHeader *event_buf;
	193	ReadEventData red = (ReadEventData ) sccb;
	194
	195	event_buf = &red->ebh;
	196	event_buf->length = 0;
	197	slen = sizeof(sccb->data);
	198
	199	rc = SCLP_RC_NO_EVENT_BUFFERS_STORED;
	200
	201	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	202	DeviceState *qdev = kid->child;
	203	event = (SCLPEvent *) qdev;
	204	ec = SCLP_EVENT_GET_CLASS(event);
	205
	206	if (mask & ec->get_send_mask()) {
	207	if (ec->read_event_data(event, event_buf, &slen)) {
a0c8699b RH	208	elen = be16_to_cpu(event_buf->length);
a0c8699b RH	209	event_buf = (EventBufferHeader ) ((char )event_buf + elen);
559a17a1 HG	210	rc = SCLP_RC_NORMAL_COMPLETION;
	211	}
	212	}
559a17a1 HG	213	}
	214
	215	if (sccb->h.control_mask[2] & SCLP_VARIABLE_LENGTH_RESPONSE) {
	216	/* architecture suggests to reset variable-length-response bit */
	217	sccb->h.control_mask[2] &= ~SCLP_VARIABLE_LENGTH_RESPONSE;
	218	/* with a new length value */
	219	sccb->h.length = cpu_to_be16(SCCB_SIZE - slen);
	220	}
	221	return rc;
	222	}
	223
	224	static void read_event_data(SCLPEventFacility ef, SCCB sccb)
	225	{
	226	unsigned int sclp_active_selection_mask;
	227	unsigned int sclp_cp_receive_mask;
	228
	229	ReadEventData red = (ReadEventData ) sccb;
	230
	231	if (be16_to_cpu(sccb->h.length) != SCCB_SIZE) {
	232	sccb->h.response_code = cpu_to_be16(SCLP_RC_INSUFFICIENT_SCCB_LENGTH);
	233	goto out;
	234	}
	235
	236	sclp_cp_receive_mask = ef->receive_mask;
	237
	238	/* get active selection mask */
	239	switch (sccb->h.function_code) {
	240	case SCLP_UNCONDITIONAL_READ:
	241	sclp_active_selection_mask = sclp_cp_receive_mask;
	242	break;
	243	case SCLP_SELECTIVE_READ:
	244	if (!(sclp_cp_receive_mask & be32_to_cpu(red->mask))) {
	245	sccb->h.response_code =
	246	cpu_to_be16(SCLP_RC_INVALID_SELECTION_MASK);
	247	goto out;
	248	}
	249	sclp_active_selection_mask = be32_to_cpu(red->mask);
	250	break;
	251	default:
	252	sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_FUNCTION);
	253	goto out;
	254	}
	255	sccb->h.response_code = cpu_to_be16(
	256	handle_sccb_read_events(ef, sccb, sclp_active_selection_mask));
	257
	258	out:
	259	return;
	260	}
	261
	262	static void write_event_mask(SCLPEventFacility ef, SCCB sccb)
	263	{
	264	WriteEventMask we_mask = (WriteEventMask ) sccb;
	265
	266	/* Attention: We assume that Linux uses 4-byte masks, what it actually
	267	does. Architecture allows for masks of variable size, though */
	268	if (be16_to_cpu(we_mask->mask_length) != 4) {
	269	sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_MASK_LENGTH);
	270	goto out;
	271	}
	272
	273	/* keep track of the guest's capability masks */
	274	ef->receive_mask = be32_to_cpu(we_mask->cp_receive_mask);
	275
	276	/* return the SCLP's capability masks to the guest */
277	we_mask->send_mask = cpu_to_be32(get_host_send_mask(ef));
278	we_mask->receive_mask = cpu_to_be32(get_host_receive_mask(ef));
279
280	sccb->h.response_code = cpu_to_be16(SCLP_RC_NORMAL_COMPLETION);
281
282	out:
283	return;
284	}
285
286	/* qemu object creation and initialization functions */
287
288	#define TYPE_SCLP_EVENTS_BUS "s390-sclp-events-bus"
289
290	static void sclp_events_bus_class_init(ObjectClass klass, void data)
291	{
292	}
293
65e526c2	294	static const TypeInfo sclp_events_bus_info = {
559a17a1 HG	295	.name = TYPE_SCLP_EVENTS_BUS,
	296	.parent = TYPE_BUS,
	297	.class_init = sclp_events_bus_class_init,
	298	};
	299
	300	static void command_handler(SCLPEventFacility ef, SCCB sccb, uint64_t code)
	301	{
9da45bb2	302	switch (code & SCLP_CMD_CODE_MASK) {
559a17a1 HG	303	case SCLP_CMD_READ_EVENT_DATA:
	304	read_event_data(ef, sccb);
	305	break;
	306	case SCLP_CMD_WRITE_EVENT_DATA:
	307	write_event_data(ef, sccb);
	308	break;
	309	case SCLP_CMD_WRITE_EVENT_MASK:
	310	write_event_mask(ef, sccb);
	311	break;
	312	default:
	313	sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_SCLP_COMMAND);
	314	break;
	315	}
	316	}
	317
	318	static int init_event_facility(S390SCLPDevice *sdev)
	319	{
	320	SCLPEventFacility *event_facility;
ab9074b5	321	DeviceState *quiesce;
559a17a1 HG	322
	323	event_facility = g_malloc0(sizeof(SCLPEventFacility));
	324	sdev->ef = event_facility;
	325	sdev->sclp_command_handler = command_handler;
	326	sdev->event_pending = event_pending;
	327
	328	/* Spawn a new sclp-events facility */
fb17dfe0 AF	329	qbus_create_inplace(&event_facility->sbus, sizeof(event_facility->sbus),
fb17dfe0 AF	330	TYPE_SCLP_EVENTS_BUS, DEVICE(sdev), NULL);
559a17a1 HG	331	event_facility->sbus.qbus.allow_hotplug = 0;
	332	event_facility->qdev = (DeviceState *) sdev;
	333
ab9074b5 HG	334	quiesce = qdev_create(&event_facility->sbus.qbus, "sclpquiesce");
	335	if (!quiesce) {
	336	return -1;
	337	}
	338	qdev_init_nofail(quiesce);
	339
49204458 JH	340	object_initialize(&cpu_hotplug, sizeof(cpu_hotplug), TYPE_SCLP_CPU_HOTPLUG);
	341	qdev_set_parent_bus(DEVICE(&cpu_hotplug), BUS(&event_facility->sbus));
	342	object_property_set_bool(OBJECT(&cpu_hotplug), true, "realized", NULL);
	343
559a17a1 HG	344	return 0;
	345	}
	346
3af6de32 HG	347	static void reset_event_facility(DeviceState *dev)
	348	{
	349	S390SCLPDevice *sdev = SCLP_S390_DEVICE(dev);
	350
	351	sdev->ef->receive_mask = 0;
	352	}
	353
559a17a1 HG	354	static void init_event_facility_class(ObjectClass klass, void data)
559a17a1 HG	355	{
3af6de32	356	DeviceClass *dc = DEVICE_CLASS(klass);
559a17a1 HG	357	S390SCLPDeviceClass *k = SCLP_S390_DEVICE_CLASS(klass);
559a17a1 HG	358
3af6de32	359	dc->reset = reset_event_facility;
559a17a1 HG	360	k->init = init_event_facility;
	361	}
	362
65e526c2	363	static const TypeInfo sclp_event_facility_info = {
559a17a1 HG	364	.name = "s390-sclp-event-facility",
	365	.parent = TYPE_DEVICE_S390_SCLP,
	366	.instance_size = sizeof(S390SCLPDevice),
	367	.class_init = init_event_facility_class,
	368	};
	369
	370	static int event_qdev_init(DeviceState *qdev)
	371	{
	372	SCLPEvent *event = DO_UPCAST(SCLPEvent, qdev, qdev);
	373	SCLPEventClass *child = SCLP_EVENT_GET_CLASS(event);
	374
	375	return child->init(event);
	376	}
	377
	378	static int event_qdev_exit(DeviceState *qdev)
	379	{
	380	SCLPEvent *event = DO_UPCAST(SCLPEvent, qdev, qdev);
	381	SCLPEventClass *child = SCLP_EVENT_GET_CLASS(event);
	382	if (child->exit) {
	383	child->exit(event);
	384	}
	385	return 0;
	386	}
	387
	388	static void event_class_init(ObjectClass klass, void data)
	389	{
	390	DeviceClass *dc = DEVICE_CLASS(klass);
	391
	392	dc->bus_type = TYPE_SCLP_EVENTS_BUS;
	393	dc->unplug = qdev_simple_unplug_cb;
	394	dc->init = event_qdev_init;
	395	dc->exit = event_qdev_exit;
	396	}
	397
65e526c2	398	static const TypeInfo sclp_event_type_info = {
559a17a1 HG	399	.name = TYPE_SCLP_EVENT,
	400	.parent = TYPE_DEVICE,
	401	.instance_size = sizeof(SCLPEvent),
	402	.class_init = event_class_init,
	403	.class_size = sizeof(SCLPEventClass),
	404	.abstract = true,
	405	};
	406
	407	static void register_types(void)
	408	{
65e526c2 HG	409	type_register_static(&sclp_events_bus_info);
	410	type_register_static(&sclp_event_facility_info);
	411	type_register_static(&sclp_event_type_info);
559a17a1 HG	412	}
	413
	414	type_init(register_types)