[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 <[email protected]>
 *
 * 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 "sysemu/sysemu.h"

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

typedef struct SCLPEventsBus {
    BusState qbus;
} SCLPEventsBus;

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

static 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:
        sclp_active_selection_mask = be32_to_cpu(red->mask);
        if (!sclp_cp_receive_mask ||
            (sclp_active_selection_mask & ~sclp_cp_receive_mask)) {
            sccb->h.response_code =
                    cpu_to_be16(SCLP_RC_INVALID_SELECTION_MASK);
            goto out;
        }
        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 const VMStateDescription vmstate_event_facility = {
    .name = "vmstate-event-facility",
    .version_id = 0,
    .minimum_version_id = 0,
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(receive_mask, SCLPEventFacility),
        VMSTATE_END_OF_LIST()
     }
};

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

    /* Spawn a new bus for SCLP events */
    qbus_create_inplace(&event_facility->sbus, sizeof(event_facility->sbus),
                        TYPE_SCLP_EVENTS_BUS, sdev, NULL);

    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)
{
    SCLPEventFacility *sdev = EVENT_FACILITY(dev);

    sdev->receive_mask = 0;
}

static void init_event_facility_class(ObjectClass *klass, void *data)
{
    SysBusDeviceClass *sbdc = SYS_BUS_DEVICE_CLASS(klass);
    DeviceClass *dc = DEVICE_CLASS(sbdc);
    SCLPEventFacilityClass *k = EVENT_FACILITY_CLASS(dc);

    dc->reset = reset_event_facility;
    dc->vmsd = &vmstate_event_facility;
    set_bit(DEVICE_CATEGORY_MISC, dc->categories);
    k->init = init_event_facility;
    k->command_handler = command_handler;
    k->event_pending = event_pending;
}

static const TypeInfo sclp_event_facility_info = {
    .name          = TYPE_SCLP_EVENT_FACILITY,
    .parent        = TYPE_SYS_BUS_DEVICE,
    .instance_size = sizeof(SCLPEventFacility),
    .class_init    = init_event_facility_class,
    .class_size    = sizeof(SCLPEventFacilityClass),
};

static void event_realize(DeviceState *qdev, Error **errp)
{
    SCLPEvent *event = SCLP_EVENT(qdev);
    SCLPEventClass *child = SCLP_EVENT_GET_CLASS(event);

    if (child->init) {
        int rc = child->init(event);
        if (rc < 0) {
            error_setg(errp, "SCLP event initialization failed.");
            return;
        }
    }
}

static void event_unrealize(DeviceState *qdev, Error **errp)
{
    SCLPEvent *event = SCLP_EVENT(qdev);
    SCLPEventClass *child = SCLP_EVENT_GET_CLASS(event);
    if (child->exit) {
        int rc = child->exit(event);
        if (rc < 0) {
            error_setg(errp, "SCLP event exit failed.");
            return;
        }
    }
}

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

    dc->bus_type = TYPE_SCLP_EVENTS_BUS;
    dc->realize = event_realize;
    dc->unrealize = event_unrealize;
}

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 <[email protected]>
	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
9c17d615	18	#include "sysemu/sysemu.h"
559a17a1	19
83c9f4ca PB	20	#include "hw/s390x/sclp.h"
83c9f4ca PB	21	#include "hw/s390x/event-facility.h"
559a17a1	22
65e526c2	23	typedef struct SCLPEventsBus {
559a17a1	24	BusState qbus;
65e526c2	25	} SCLPEventsBus;
559a17a1 HG	26
559a17a1 HG	27	struct SCLPEventFacility {
477a72a1	28	SysBusDevice parent_obj;
65e526c2	29	SCLPEventsBus sbus;
559a17a1 HG	30	/* guest' receive mask */
	31	unsigned int receive_mask;
	32	};
	33
bfaaad02	34	static SCLPEvent cpu_hotplug;
49204458	35
559a17a1 HG	36	/* return true if any child has event pending set */
	37	static bool event_pending(SCLPEventFacility *ef)
	38	{
	39	BusChild *kid;
	40	SCLPEvent *event;
	41	SCLPEventClass *event_class;
	42
	43	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	44	DeviceState *qdev = kid->child;
	45	event = DO_UPCAST(SCLPEvent, qdev, qdev);
	46	event_class = SCLP_EVENT_GET_CLASS(event);
	47	if (event->event_pending &&
	48	event_class->get_send_mask() & ef->receive_mask) {
	49	return true;
	50	}
	51	}
	52	return false;
	53	}
	54
	55	static unsigned int get_host_send_mask(SCLPEventFacility *ef)
	56	{
	57	unsigned int mask;
	58	BusChild *kid;
	59	SCLPEventClass *child;
	60
	61	mask = 0;
	62
	63	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	64	DeviceState *qdev = kid->child;
	65	child = SCLP_EVENT_GET_CLASS((SCLPEvent *) qdev);
	66	mask \|= child->get_send_mask();
	67	}
	68	return mask;
	69	}
	70
	71	static unsigned int get_host_receive_mask(SCLPEventFacility *ef)
	72	{
	73	unsigned int mask;
	74	BusChild *kid;
	75	SCLPEventClass *child;
	76
	77	mask = 0;
	78
	79	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	80	DeviceState *qdev = kid->child;
	81	child = SCLP_EVENT_GET_CLASS((SCLPEvent *) qdev);
	82	mask \|= child->get_receive_mask();
	83	}
	84	return mask;
	85	}
	86
	87	static uint16_t write_event_length_check(SCCB *sccb)
	88	{
	89	int slen;
	90	unsigned elen = 0;
	91	EventBufferHeader *event;
	92	WriteEventData wed = (WriteEventData ) sccb;
	93
	94	event = (EventBufferHeader *) &wed->ebh;
	95	for (slen = sccb_data_len(sccb); slen > 0; slen -= elen) {
	96	elen = be16_to_cpu(event->length);
	97	if (elen < sizeof(*event) \|\| elen > slen) {
	98	return SCLP_RC_EVENT_BUFFER_SYNTAX_ERROR;
	99	}
100	event = (void *) event + elen;
101	}
102	if (slen) {
103	return SCLP_RC_INCONSISTENT_LENGTHS;
104	}
105	return SCLP_RC_NORMAL_COMPLETION;
106	}
107
108	static uint16_t handle_write_event_buf(SCLPEventFacility *ef,
109	EventBufferHeader event_buf, SCCB sccb)
110	{
111	uint16_t rc;
112	BusChild *kid;
113	SCLPEvent *event;
114	SCLPEventClass *ec;
115
773de5c7 CH	116	rc = SCLP_RC_INVALID_FUNCTION;
773de5c7 CH	117
559a17a1 HG	118	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	119	DeviceState *qdev = kid->child;
	120	event = (SCLPEvent *) qdev;
	121	ec = SCLP_EVENT_GET_CLASS(event);
	122
559a17a1	123	if (ec->write_event_data &&
c3d9f24a	124	ec->can_handle_event(event_buf->type)) {
559a17a1 HG	125	rc = ec->write_event_data(event, event_buf);
	126	break;
	127	}
	128	}
	129	return rc;
	130	}
	131
	132	static uint16_t handle_sccb_write_events(SCLPEventFacility ef, SCCB sccb)
	133	{
	134	uint16_t rc;
	135	int slen;
	136	unsigned elen = 0;
	137	EventBufferHeader *event_buf;
	138	WriteEventData wed = (WriteEventData ) sccb;
	139
	140	event_buf = &wed->ebh;
	141	rc = SCLP_RC_NORMAL_COMPLETION;
	142
	143	/* loop over all contained event buffers */
	144	for (slen = sccb_data_len(sccb); slen > 0; slen -= elen) {
	145	elen = be16_to_cpu(event_buf->length);
	146
	147	/* in case of a previous error mark all trailing buffers
	148	* as not accepted */
	149	if (rc != SCLP_RC_NORMAL_COMPLETION) {
	150	event_buf->flags &= ~(SCLP_EVENT_BUFFER_ACCEPTED);
	151	} else {
	152	rc = handle_write_event_buf(ef, event_buf, sccb);
	153	}
	154	event_buf = (void *) event_buf + elen;
	155	}
	156	return rc;
	157	}
	158
	159	static void write_event_data(SCLPEventFacility ef, SCCB sccb)
	160	{
	161	if (sccb->h.function_code != SCLP_FC_NORMAL_WRITE) {
	162	sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_FUNCTION);
	163	goto out;
	164	}
	165	if (be16_to_cpu(sccb->h.length) < 8) {
	166	sccb->h.response_code = cpu_to_be16(SCLP_RC_INSUFFICIENT_SCCB_LENGTH);
	167	goto out;
	168	}
	169	/* first do a sanity check of the write events */
	170	sccb->h.response_code = cpu_to_be16(write_event_length_check(sccb));
	171
	172	/* if no early error, then execute */
	173	if (sccb->h.response_code == be16_to_cpu(SCLP_RC_NORMAL_COMPLETION)) {
	174	sccb->h.response_code =
	175	cpu_to_be16(handle_sccb_write_events(ef, sccb));
	176	}
	177
	178	out:
	179	return;
	180	}
	181
	182	static uint16_t handle_sccb_read_events(SCLPEventFacility ef, SCCB sccb,
	183	unsigned int mask)
	184	{
	185	uint16_t rc;
	186	int slen;
a0c8699b	187	unsigned elen;
559a17a1 HG	188	BusChild *kid;
	189	SCLPEvent *event;
	190	SCLPEventClass *ec;
	191	EventBufferHeader *event_buf;
	192	ReadEventData red = (ReadEventData ) sccb;
	193
	194	event_buf = &red->ebh;
	195	event_buf->length = 0;
	196	slen = sizeof(sccb->data);
	197
	198	rc = SCLP_RC_NO_EVENT_BUFFERS_STORED;
	199
	200	QTAILQ_FOREACH(kid, &ef->sbus.qbus.children, sibling) {
	201	DeviceState *qdev = kid->child;
	202	event = (SCLPEvent *) qdev;
	203	ec = SCLP_EVENT_GET_CLASS(event);
	204
	205	if (mask & ec->get_send_mask()) {
	206	if (ec->read_event_data(event, event_buf, &slen)) {
a0c8699b RH	207	elen = be16_to_cpu(event_buf->length);
a0c8699b RH	208	event_buf = (EventBufferHeader ) ((char )event_buf + elen);
559a17a1 HG	209	rc = SCLP_RC_NORMAL_COMPLETION;
	210	}
	211	}
559a17a1 HG	212	}
	213
	214	if (sccb->h.control_mask[2] & SCLP_VARIABLE_LENGTH_RESPONSE) {
	215	/* architecture suggests to reset variable-length-response bit */
	216	sccb->h.control_mask[2] &= ~SCLP_VARIABLE_LENGTH_RESPONSE;
	217	/* with a new length value */
	218	sccb->h.length = cpu_to_be16(SCCB_SIZE - slen);
	219	}
	220	return rc;
	221	}
	222
	223	static void read_event_data(SCLPEventFacility ef, SCCB sccb)
	224	{
	225	unsigned int sclp_active_selection_mask;
	226	unsigned int sclp_cp_receive_mask;
	227
	228	ReadEventData red = (ReadEventData ) sccb;
	229
	230	if (be16_to_cpu(sccb->h.length) != SCCB_SIZE) {
	231	sccb->h.response_code = cpu_to_be16(SCLP_RC_INSUFFICIENT_SCCB_LENGTH);
	232	goto out;
	233	}
	234
	235	sclp_cp_receive_mask = ef->receive_mask;
	236
	237	/* get active selection mask */
	238	switch (sccb->h.function_code) {
	239	case SCLP_UNCONDITIONAL_READ:
	240	sclp_active_selection_mask = sclp_cp_receive_mask;
	241	break;
	242	case SCLP_SELECTIVE_READ:
3335dddd CH	243	sclp_active_selection_mask = be32_to_cpu(red->mask);
	244	if (!sclp_cp_receive_mask \|\|
	245	(sclp_active_selection_mask & ~sclp_cp_receive_mask)) {
559a17a1 HG	246	sccb->h.response_code =
	247	cpu_to_be16(SCLP_RC_INVALID_SELECTION_MASK);
	248	goto out;
	249	}
559a17a1 HG	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
6fbef18a HG	318	static const VMStateDescription vmstate_event_facility = {
	319	.name = "vmstate-event-facility",
	320	.version_id = 0,
	321	.minimum_version_id = 0,
35d08458	322	.fields = (VMStateField[]) {
6fbef18a HG	323	VMSTATE_UINT32(receive_mask, SCLPEventFacility),
	324	VMSTATE_END_OF_LIST()
	325	}
	326	};
	327
477a72a1	328	static int init_event_facility(SCLPEventFacility *event_facility)
559a17a1	329	{
477a72a1	330	DeviceState *sdev = DEVICE(event_facility);
ab9074b5	331	DeviceState *quiesce;
559a17a1	332
477a72a1	333	/* Spawn a new bus for SCLP events */
fb17dfe0	334	qbus_create_inplace(&event_facility->sbus, sizeof(event_facility->sbus),
477a72a1	335	TYPE_SCLP_EVENTS_BUS, sdev, NULL);
559a17a1	336
ab9074b5 HG	337	quiesce = qdev_create(&event_facility->sbus.qbus, "sclpquiesce");
	338	if (!quiesce) {
	339	return -1;
	340	}
	341	qdev_init_nofail(quiesce);
	342
49204458 JH	343	object_initialize(&cpu_hotplug, sizeof(cpu_hotplug), TYPE_SCLP_CPU_HOTPLUG);
	344	qdev_set_parent_bus(DEVICE(&cpu_hotplug), BUS(&event_facility->sbus));
	345	object_property_set_bool(OBJECT(&cpu_hotplug), true, "realized", NULL);
	346
559a17a1 HG	347	return 0;
	348	}
	349
3af6de32 HG	350	static void reset_event_facility(DeviceState *dev)
3af6de32 HG	351	{
477a72a1	352	SCLPEventFacility *sdev = EVENT_FACILITY(dev);
3af6de32	353
477a72a1	354	sdev->receive_mask = 0;
3af6de32 HG	355	}
3af6de32 HG	356
559a17a1 HG	357	static void init_event_facility_class(ObjectClass klass, void data)
559a17a1 HG	358	{
477a72a1 HG	359	SysBusDeviceClass *sbdc = SYS_BUS_DEVICE_CLASS(klass);
	360	DeviceClass *dc = DEVICE_CLASS(sbdc);
	361	SCLPEventFacilityClass *k = EVENT_FACILITY_CLASS(dc);
559a17a1	362
3af6de32	363	dc->reset = reset_event_facility;
6fbef18a	364	dc->vmsd = &vmstate_event_facility;
183f6b8d	365	set_bit(DEVICE_CATEGORY_MISC, dc->categories);
559a17a1	366	k->init = init_event_facility;
477a72a1 HG	367	k->command_handler = command_handler;
477a72a1 HG	368	k->event_pending = event_pending;
559a17a1 HG	369	}
559a17a1 HG	370
65e526c2	371	static const TypeInfo sclp_event_facility_info = {
477a72a1 HG	372	.name = TYPE_SCLP_EVENT_FACILITY,
	373	.parent = TYPE_SYS_BUS_DEVICE,
	374	.instance_size = sizeof(SCLPEventFacility),
559a17a1	375	.class_init = init_event_facility_class,
477a72a1	376	.class_size = sizeof(SCLPEventFacilityClass),
559a17a1 HG	377	};
559a17a1 HG	378
c804c2a7	379	static void event_realize(DeviceState qdev, Error *errp)
559a17a1	380	{
c804c2a7	381	SCLPEvent *event = SCLP_EVENT(qdev);
559a17a1 HG	382	SCLPEventClass *child = SCLP_EVENT_GET_CLASS(event);
559a17a1 HG	383
c804c2a7 HG	384	if (child->init) {
	385	int rc = child->init(event);
	386	if (rc < 0) {
	387	error_setg(errp, "SCLP event initialization failed.");
	388	return;
	389	}
	390	}
559a17a1 HG	391	}
559a17a1 HG	392
c804c2a7	393	static void event_unrealize(DeviceState qdev, Error *errp)
559a17a1	394	{
c804c2a7	395	SCLPEvent *event = SCLP_EVENT(qdev);
559a17a1 HG	396	SCLPEventClass *child = SCLP_EVENT_GET_CLASS(event);
559a17a1 HG	397	if (child->exit) {
c804c2a7 HG	398	int rc = child->exit(event);
	399	if (rc < 0) {
	400	error_setg(errp, "SCLP event exit failed.");
	401	return;
	402	}
559a17a1	403	}
559a17a1 HG	404	}
	405
	406	static void event_class_init(ObjectClass klass, void data)
	407	{
	408	DeviceClass *dc = DEVICE_CLASS(klass);
	409
	410	dc->bus_type = TYPE_SCLP_EVENTS_BUS;
c804c2a7 HG	411	dc->realize = event_realize;
c804c2a7 HG	412	dc->unrealize = event_unrealize;
559a17a1 HG	413	}
559a17a1 HG	414
65e526c2	415	static const TypeInfo sclp_event_type_info = {
559a17a1 HG	416	.name = TYPE_SCLP_EVENT,
	417	.parent = TYPE_DEVICE,
	418	.instance_size = sizeof(SCLPEvent),
	419	.class_init = event_class_init,
	420	.class_size = sizeof(SCLPEventClass),
	421	.abstract = true,
	422	};
	423
	424	static void register_types(void)
	425	{
65e526c2 HG	426	type_register_static(&sclp_events_bus_info);
	427	type_register_static(&sclp_event_facility_info);
	428	type_register_static(&sclp_event_type_info);
559a17a1 HG	429	}
	430
	431	type_init(register_types)