This is a bunch of fixes/changes for the s390 architecture. It also
contains the fixes from the previous pull request, which did not make it yet. Overall it contains - a fix for kexec without kdump (which uses diag308 subcode 0 instead of 1) - several sclp related fixes - some initial sclp migration code - the sclp line mode console - A fix for a boot problem with the virtio ccw ipl bios - zeroed out padding bytes for the notes section of dump-guest-memory - some cleanups -----BEGIN PGP SIGNATURE----- Version: GnuPG v1.4.11 (GNU/Linux) iQIcBAABAgAGBQJSQTzUAAoJEBF7vIC1phx8hR8P/R2DsdjnNhDbfVxr/1JVj8Ad v/IOoqSPA8Nf5nGpFe2pmFokHJ88Jzv/8DGlPQfBNH95SBmU6qarHTUG9l6/BWTL yTx7kzYfy4FGQE6zdoTHByScnzPSJh2hTAiPyXCo7L2QjGPfZgZmxZZVvQUbRoRo uKslsWSHaSBYs4cYvvZMiUdSA0q4FSIcUNTewMZDoILcIExSvES/dll12q1iRgSF r8HSK7WppES5nXeJQAZEjJsDXah8Fl71ngcqi+d96if5KrYexkG91Rxz8qavhsFO 2UbXcMIal1Iuq8dEryjymxuKHcfpqKIqmielMjyg4icTS0WXf+Z7uH7jfEmrkYnP wZbfSZ2AcGd6chRptXsXTxbXYeSKfUxj8VFYg8765DlU+9ACwMZeXwaK0PrtBkl8 WEIyi4XNa2KQ6T+ZoRcl5lqaaGcZZAyJlZzcOeZq4EhbtcLymHTNIVY9gbGloWR8 FLgEcfvx71N2LPH0AapUNfrl5DlLGOHX9gR58ZlRCupULc86NniOsH0y2mcVjjoT Tbc+4NV3Es0qUIwB44HVRKo+WpRqM7/bMOhDDsfONcKyozuxbySaCcfn8CnoR5LD C/HqyU3OClg9P785wVvgf7GPT03Zf0KrHKMqQYjsrPu1rX319asgOAz8W5IxnjAw 2d8ZzMX9CZfJDCr7I8hO =4rT1 -----END PGP SIGNATURE----- Merge remote-tracking branch 'borntraeger/tags/s390-next-20130924' into staging This is a bunch of fixes/changes for the s390 architecture. It also contains the fixes from the previous pull request, which did not make it yet. Overall it contains - a fix for kexec without kdump (which uses diag308 subcode 0 instead of 1) - several sclp related fixes - some initial sclp migration code - the sclp line mode console - A fix for a boot problem with the virtio ccw ipl bios - zeroed out padding bytes for the notes section of dump-guest-memory - some cleanups # gpg: Signature made Tue 24 Sep 2013 02:18:44 AM CDT using RSA key ID B5A61C7C # gpg: Can't check signature: public key not found # By Christian Borntraeger (6) and others # Via Christian Borntraeger * borntraeger/tags/s390-next-20130924: s390/sclplmconsole: Add support for SCLP line-mode console s390/ebcdic: Move conversion tables to header file s390/eventfacility: allow childs to handle more than 1 event type s390/eventfacility: remove unused event_type variable s390/eventfacility: Fix receive/send masks s390/eventfacility: fix multiple Read Event Data sources s390/sclp: add reset() functions s390/sclpquiesce: Add code to support live migration s390/sclpconsole: Add code to support live migration for sclpconsole s390/sclpconsole: modify definition of input buffer s390/kexec: Implement diag308 subcode 0 s390/ioinst: Moved the CC setting to the IO instruction handlers s390/cpu: Make setcc() function available to other files s390/ipl: Update the s390-ccw.img rom s390/ipl: Fix waiting for virtio processing s390/dump: zero out padding bytes in notes sections s390/kvm: Add check for priviledged SCLP handler Message-id: 1380007671-18976-1-git-send-email-borntraeger@de.ibm.com
This commit is contained in:
commit
1b365b2eb6
@ -22,6 +22,6 @@ common-obj-$(CONFIG_IMX) += imx_serial.o
|
||||
common-obj-$(CONFIG_LM32) += lm32_juart.o
|
||||
common-obj-$(CONFIG_LM32) += lm32_uart.o
|
||||
common-obj-$(CONFIG_MILKYMIST) += milkymist-uart.o
|
||||
common-obj-$(CONFIG_SCLPCONSOLE) += sclpconsole.o
|
||||
common-obj-$(CONFIG_SCLPCONSOLE) += sclpconsole.o sclpconsole-lm.o
|
||||
|
||||
obj-$(CONFIG_VIRTIO) += virtio-serial-bus.o
|
||||
|
398
hw/char/sclpconsole-lm.c
Normal file
398
hw/char/sclpconsole-lm.c
Normal file
@ -0,0 +1,398 @@
|
||||
/*
|
||||
* SCLP event types
|
||||
* Operations Command - Line Mode input
|
||||
* Message - Line Mode output
|
||||
*
|
||||
* Copyright IBM, Corp. 2013
|
||||
*
|
||||
* Authors:
|
||||
* Heinz Graalfs <graalfs@linux.vnet.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 "hw/qdev.h"
|
||||
#include "qemu/thread.h"
|
||||
#include "qemu/error-report.h"
|
||||
#include "sysemu/char.h"
|
||||
|
||||
#include "hw/s390x/sclp.h"
|
||||
#include "hw/s390x/event-facility.h"
|
||||
#include "hw/s390x/ebcdic.h"
|
||||
|
||||
#define SIZE_BUFFER 4096
|
||||
#define NEWLINE "\n"
|
||||
|
||||
typedef struct OprtnsCommand {
|
||||
EventBufferHeader header;
|
||||
MDMSU message_unit;
|
||||
char data[0];
|
||||
} QEMU_PACKED OprtnsCommand;
|
||||
|
||||
/* max size for line-mode data in 4K SCCB page */
|
||||
#define SIZE_CONSOLE_BUFFER (SCCB_DATA_LEN - sizeof(OprtnsCommand))
|
||||
|
||||
typedef struct SCLPConsoleLM {
|
||||
SCLPEvent event;
|
||||
CharDriverState *chr;
|
||||
bool echo; /* immediate echo of input if true */
|
||||
uint32_t write_errors; /* errors writing to char layer */
|
||||
uint32_t length; /* length of byte stream in buffer */
|
||||
uint8_t buf[SIZE_CONSOLE_BUFFER];
|
||||
qemu_irq irq_console_read;
|
||||
} SCLPConsoleLM;
|
||||
|
||||
/*
|
||||
* Character layer call-back functions
|
||||
*
|
||||
* Allow 1 character at a time
|
||||
*
|
||||
* Accumulate bytes from character layer in console buffer,
|
||||
* event_pending is set when a newline character is encountered
|
||||
*
|
||||
* The maximum command line length is limited by the maximum
|
||||
* space available in an SCCB
|
||||
*/
|
||||
|
||||
static int chr_can_read(void *opaque)
|
||||
{
|
||||
SCLPConsoleLM *scon = opaque;
|
||||
|
||||
if (scon->event.event_pending) {
|
||||
return 0;
|
||||
} else if (SIZE_CONSOLE_BUFFER - scon->length) {
|
||||
return 1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void receive_from_chr_layer(SCLPConsoleLM *scon, const uint8_t *buf,
|
||||
int size)
|
||||
{
|
||||
assert(size == 1);
|
||||
|
||||
if (*buf == '\r' || *buf == '\n') {
|
||||
scon->event.event_pending = true;
|
||||
return;
|
||||
}
|
||||
scon->buf[scon->length] = *buf;
|
||||
scon->length += 1;
|
||||
if (scon->echo) {
|
||||
qemu_chr_fe_write(scon->chr, buf, size);
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Send data from a char device over to the guest
|
||||
*/
|
||||
static void chr_read(void *opaque, const uint8_t *buf, int size)
|
||||
{
|
||||
SCLPConsoleLM *scon = opaque;
|
||||
|
||||
receive_from_chr_layer(scon, buf, size);
|
||||
if (scon->event.event_pending) {
|
||||
/* trigger SCLP read operation */
|
||||
qemu_irq_raise(scon->irq_console_read);
|
||||
}
|
||||
}
|
||||
|
||||
/* functions to be called by event facility */
|
||||
|
||||
static bool can_handle_event(uint8_t type)
|
||||
{
|
||||
return type == SCLP_EVENT_MESSAGE || type == SCLP_EVENT_PMSGCMD;
|
||||
}
|
||||
|
||||
static unsigned int send_mask(void)
|
||||
{
|
||||
return SCLP_EVENT_MASK_OP_CMD | SCLP_EVENT_MASK_PMSGCMD;
|
||||
}
|
||||
|
||||
static unsigned int receive_mask(void)
|
||||
{
|
||||
return SCLP_EVENT_MASK_MSG | SCLP_EVENT_MASK_PMSGCMD;
|
||||
}
|
||||
|
||||
/*
|
||||
* Triggered by SCLP's read_event_data
|
||||
* - convert ASCII byte stream to EBCDIC and
|
||||
* - copy converted data into provided (SCLP) buffer
|
||||
*/
|
||||
static int get_console_data(SCLPEvent *event, uint8_t *buf, size_t *size,
|
||||
int avail)
|
||||
{
|
||||
int len;
|
||||
|
||||
SCLPConsoleLM *cons = DO_UPCAST(SCLPConsoleLM, event, event);
|
||||
|
||||
len = cons->length;
|
||||
/* data need to fit into provided SCLP buffer */
|
||||
if (len > avail) {
|
||||
return 1;
|
||||
}
|
||||
|
||||
ebcdic_put(buf, (char *)&cons->buf, len);
|
||||
*size = len;
|
||||
cons->length = 0;
|
||||
/* data provided and no more data pending */
|
||||
event->event_pending = false;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int read_event_data(SCLPEvent *event, EventBufferHeader *evt_buf_hdr,
|
||||
int *slen)
|
||||
{
|
||||
int avail, rc;
|
||||
size_t src_len;
|
||||
uint8_t *to;
|
||||
OprtnsCommand *oc = (OprtnsCommand *) evt_buf_hdr;
|
||||
|
||||
if (!event->event_pending) {
|
||||
/* no data pending */
|
||||
return 0;
|
||||
}
|
||||
|
||||
to = (uint8_t *)&oc->data;
|
||||
avail = *slen - sizeof(OprtnsCommand);
|
||||
rc = get_console_data(event, to, &src_len, avail);
|
||||
if (rc) {
|
||||
/* data didn't fit, try next SCCB */
|
||||
return 1;
|
||||
}
|
||||
|
||||
oc->message_unit.mdmsu.gds_id = GDS_ID_MDSMU;
|
||||
oc->message_unit.mdmsu.length = cpu_to_be16(sizeof(struct MDMSU));
|
||||
|
||||
oc->message_unit.cpmsu.gds_id = GDS_ID_CPMSU;
|
||||
oc->message_unit.cpmsu.length =
|
||||
cpu_to_be16(sizeof(struct MDMSU) - sizeof(GdsVector));
|
||||
|
||||
oc->message_unit.text_command.gds_id = GDS_ID_TEXTCMD;
|
||||
oc->message_unit.text_command.length =
|
||||
cpu_to_be16(sizeof(struct MDMSU) - (2 * sizeof(GdsVector)));
|
||||
|
||||
oc->message_unit.self_def_text_message.key = GDS_KEY_SELFDEFTEXTMSG;
|
||||
oc->message_unit.self_def_text_message.length =
|
||||
cpu_to_be16(sizeof(struct MDMSU) - (3 * sizeof(GdsVector)));
|
||||
|
||||
oc->message_unit.text_message.key = GDS_KEY_TEXTMSG;
|
||||
oc->message_unit.text_message.length =
|
||||
cpu_to_be16(sizeof(GdsSubvector) + src_len);
|
||||
|
||||
oc->header.length = cpu_to_be16(sizeof(OprtnsCommand) + src_len);
|
||||
oc->header.type = SCLP_EVENT_OPRTNS_COMMAND;
|
||||
*slen = avail - src_len;
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
/*
|
||||
* Triggered by SCLP's write_event_data
|
||||
* - write console data to character layer
|
||||
* returns < 0 if an error occurred
|
||||
*/
|
||||
static int write_console_data(SCLPEvent *event, const uint8_t *buf, int len)
|
||||
{
|
||||
int ret = 0;
|
||||
const uint8_t *buf_offset;
|
||||
|
||||
SCLPConsoleLM *scon = DO_UPCAST(SCLPConsoleLM, event, event);
|
||||
|
||||
if (!scon->chr) {
|
||||
/* If there's no backend, we can just say we consumed all data. */
|
||||
return len;
|
||||
}
|
||||
|
||||
buf_offset = buf;
|
||||
while (len > 0) {
|
||||
ret = qemu_chr_fe_write(scon->chr, buf, len);
|
||||
if (ret == 0) {
|
||||
/* a pty doesn't seem to be connected - no error */
|
||||
len = 0;
|
||||
} else if (ret == -EAGAIN || (ret > 0 && ret < len)) {
|
||||
len -= ret;
|
||||
buf_offset += ret;
|
||||
} else {
|
||||
len = 0;
|
||||
}
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int process_mdb(SCLPEvent *event, MDBO *mdbo)
|
||||
{
|
||||
int rc;
|
||||
int len;
|
||||
uint8_t buffer[SIZE_BUFFER];
|
||||
|
||||
len = be16_to_cpu(mdbo->length);
|
||||
len -= sizeof(mdbo->length) + sizeof(mdbo->type)
|
||||
+ sizeof(mdbo->mto.line_type_flags)
|
||||
+ sizeof(mdbo->mto.alarm_control)
|
||||
+ sizeof(mdbo->mto._reserved);
|
||||
|
||||
assert(len <= SIZE_BUFFER);
|
||||
|
||||
/* convert EBCDIC SCLP contents to ASCII console message */
|
||||
ascii_put(buffer, mdbo->mto.message, len);
|
||||
rc = write_console_data(event, (uint8_t *)NEWLINE, 1);
|
||||
if (rc < 0) {
|
||||
return rc;
|
||||
}
|
||||
return write_console_data(event, buffer, len);
|
||||
}
|
||||
|
||||
static int write_event_data(SCLPEvent *event, EventBufferHeader *ebh)
|
||||
{
|
||||
int len;
|
||||
int written;
|
||||
int errors = 0;
|
||||
MDBO *mdbo;
|
||||
SclpMsg *data = (SclpMsg *) ebh;
|
||||
SCLPConsoleLM *scon = DO_UPCAST(SCLPConsoleLM, event, event);
|
||||
|
||||
len = be16_to_cpu(data->mdb.header.length);
|
||||
if (len < sizeof(data->mdb.header)) {
|
||||
return SCLP_RC_INCONSISTENT_LENGTHS;
|
||||
}
|
||||
len -= sizeof(data->mdb.header);
|
||||
|
||||
/* first check message buffers */
|
||||
mdbo = data->mdb.mdbo;
|
||||
while (len > 0) {
|
||||
if (be16_to_cpu(mdbo->length) > len
|
||||
|| be16_to_cpu(mdbo->length) == 0) {
|
||||
return SCLP_RC_INCONSISTENT_LENGTHS;
|
||||
}
|
||||
len -= be16_to_cpu(mdbo->length);
|
||||
mdbo = (void *) mdbo + be16_to_cpu(mdbo->length);
|
||||
}
|
||||
|
||||
/* then execute */
|
||||
len = be16_to_cpu(data->mdb.header.length) - sizeof(data->mdb.header);
|
||||
mdbo = data->mdb.mdbo;
|
||||
while (len > 0) {
|
||||
switch (be16_to_cpu(mdbo->type)) {
|
||||
case MESSAGE_TEXT:
|
||||
/* message text object */
|
||||
written = process_mdb(event, mdbo);
|
||||
if (written < 0) {
|
||||
/* character layer error */
|
||||
errors++;
|
||||
}
|
||||
break;
|
||||
default: /* ignore */
|
||||
break;
|
||||
}
|
||||
len -= be16_to_cpu(mdbo->length);
|
||||
mdbo = (void *) mdbo + be16_to_cpu(mdbo->length);
|
||||
}
|
||||
if (errors) {
|
||||
scon->write_errors += errors;
|
||||
}
|
||||
data->header.flags = SCLP_EVENT_BUFFER_ACCEPTED;
|
||||
|
||||
return SCLP_RC_NORMAL_COMPLETION;
|
||||
}
|
||||
|
||||
static void trigger_console_data(void *opaque, int n, int level)
|
||||
{
|
||||
sclp_service_interrupt(0);
|
||||
}
|
||||
|
||||
/* functions for live migration */
|
||||
|
||||
static const VMStateDescription vmstate_sclplmconsole = {
|
||||
.name = "sclplmconsole",
|
||||
.version_id = 0,
|
||||
.minimum_version_id = 0,
|
||||
.minimum_version_id_old = 0,
|
||||
.fields = (VMStateField[]) {
|
||||
VMSTATE_BOOL(event.event_pending, SCLPConsoleLM),
|
||||
VMSTATE_UINT32(write_errors, SCLPConsoleLM),
|
||||
VMSTATE_UINT32(length, SCLPConsoleLM),
|
||||
VMSTATE_UINT8_ARRAY(buf, SCLPConsoleLM, SIZE_CONSOLE_BUFFER),
|
||||
VMSTATE_END_OF_LIST()
|
||||
}
|
||||
};
|
||||
|
||||
/* qemu object creation and initialization functions */
|
||||
|
||||
/* tell character layer our call-back functions */
|
||||
|
||||
static int console_init(SCLPEvent *event)
|
||||
{
|
||||
static bool console_available;
|
||||
|
||||
SCLPConsoleLM *scon = DO_UPCAST(SCLPConsoleLM, event, event);
|
||||
|
||||
if (console_available) {
|
||||
error_report("Multiple line-mode operator consoles are not supported");
|
||||
return -1;
|
||||
}
|
||||
console_available = true;
|
||||
|
||||
if (scon->chr) {
|
||||
qemu_chr_add_handlers(scon->chr, chr_can_read, chr_read, NULL, scon);
|
||||
}
|
||||
scon->irq_console_read = *qemu_allocate_irqs(trigger_console_data, NULL, 1);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int console_exit(SCLPEvent *event)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void console_reset(DeviceState *dev)
|
||||
{
|
||||
SCLPEvent *event = SCLP_EVENT(dev);
|
||||
SCLPConsoleLM *scon = DO_UPCAST(SCLPConsoleLM, event, event);
|
||||
|
||||
event->event_pending = false;
|
||||
scon->length = 0;
|
||||
scon->write_errors = 0;
|
||||
}
|
||||
|
||||
static Property console_properties[] = {
|
||||
DEFINE_PROP_CHR("chardev", SCLPConsoleLM, chr),
|
||||
DEFINE_PROP_UINT32("write_errors", SCLPConsoleLM, write_errors, 0),
|
||||
DEFINE_PROP_BOOL("echo", SCLPConsoleLM, echo, true),
|
||||
DEFINE_PROP_END_OF_LIST(),
|
||||
};
|
||||
|
||||
static void console_class_init(ObjectClass *klass, void *data)
|
||||
{
|
||||
DeviceClass *dc = DEVICE_CLASS(klass);
|
||||
SCLPEventClass *ec = SCLP_EVENT_CLASS(klass);
|
||||
|
||||
dc->props = console_properties;
|
||||
dc->reset = console_reset;
|
||||
dc->vmsd = &vmstate_sclplmconsole;
|
||||
ec->init = console_init;
|
||||
ec->exit = console_exit;
|
||||
ec->get_send_mask = send_mask;
|
||||
ec->get_receive_mask = receive_mask;
|
||||
ec->can_handle_event = can_handle_event;
|
||||
ec->read_event_data = read_event_data;
|
||||
ec->write_event_data = write_event_data;
|
||||
}
|
||||
|
||||
static const TypeInfo sclp_console_info = {
|
||||
.name = "sclplmconsole",
|
||||
.parent = TYPE_SCLP_EVENT,
|
||||
.instance_size = sizeof(SCLPConsoleLM),
|
||||
.class_init = console_class_init,
|
||||
.class_size = sizeof(SCLPEventClass),
|
||||
};
|
||||
|
||||
static void register_types(void)
|
||||
{
|
||||
type_register_static(&sclp_console_info);
|
||||
}
|
||||
|
||||
type_init(register_types)
|
@ -31,10 +31,9 @@ typedef struct ASCIIConsoleData {
|
||||
typedef struct SCLPConsole {
|
||||
SCLPEvent event;
|
||||
CharDriverState *chr;
|
||||
/* io vector */
|
||||
uint8_t *iov; /* iov buffer pointer */
|
||||
uint8_t *iov_sclp; /* pointer to SCLP read offset */
|
||||
uint8_t *iov_bs; /* pointer byte stream read offset */
|
||||
uint8_t iov[SIZE_BUFFER_VT220];
|
||||
uint32_t iov_sclp; /* offset in buf for SCLP read operation */
|
||||
uint32_t iov_bs; /* offset in buf for char layer read operation */
|
||||
uint32_t iov_data_len; /* length of byte stream in buffer */
|
||||
uint32_t iov_sclp_rest; /* length of byte stream not read via SCLP */
|
||||
qemu_irq irq_read_vt220;
|
||||
@ -47,7 +46,7 @@ static int chr_can_read(void *opaque)
|
||||
{
|
||||
SCLPConsole *scon = opaque;
|
||||
|
||||
return scon->iov ? SIZE_BUFFER_VT220 - scon->iov_data_len : 0;
|
||||
return SIZE_BUFFER_VT220 - scon->iov_data_len;
|
||||
}
|
||||
|
||||
/* Receive n bytes from character layer, save in iov buffer,
|
||||
@ -55,13 +54,11 @@ static int chr_can_read(void *opaque)
|
||||
static void receive_from_chr_layer(SCLPConsole *scon, const uint8_t *buf,
|
||||
int size)
|
||||
{
|
||||
assert(scon->iov);
|
||||
|
||||
/* read data must fit into current buffer */
|
||||
assert(size <= SIZE_BUFFER_VT220 - scon->iov_data_len);
|
||||
|
||||
/* put byte-stream from character layer into buffer */
|
||||
memcpy(scon->iov_bs, buf, size);
|
||||
memcpy(&scon->iov[scon->iov_bs], buf, size);
|
||||
scon->iov_data_len += size;
|
||||
scon->iov_sclp_rest += size;
|
||||
scon->iov_bs += size;
|
||||
@ -80,34 +77,11 @@ static void chr_read(void *opaque, const uint8_t *buf, int size)
|
||||
qemu_irq_raise(scon->irq_read_vt220);
|
||||
}
|
||||
|
||||
static void chr_event(void *opaque, int event)
|
||||
{
|
||||
SCLPConsole *scon = opaque;
|
||||
|
||||
switch (event) {
|
||||
case CHR_EVENT_OPENED:
|
||||
if (!scon->iov) {
|
||||
scon->iov = g_malloc0(SIZE_BUFFER_VT220);
|
||||
scon->iov_sclp = scon->iov;
|
||||
scon->iov_bs = scon->iov;
|
||||
scon->iov_data_len = 0;
|
||||
scon->iov_sclp_rest = 0;
|
||||
}
|
||||
break;
|
||||
case CHR_EVENT_CLOSED:
|
||||
if (scon->iov) {
|
||||
g_free(scon->iov);
|
||||
scon->iov = NULL;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* functions to be called by event facility */
|
||||
|
||||
static int event_type(void)
|
||||
static bool can_handle_event(uint8_t type)
|
||||
{
|
||||
return SCLP_EVENT_ASCII_CONSOLE_DATA;
|
||||
return type == SCLP_EVENT_ASCII_CONSOLE_DATA;
|
||||
}
|
||||
|
||||
static unsigned int send_mask(void)
|
||||
@ -134,17 +108,17 @@ static void get_console_data(SCLPEvent *event, uint8_t *buf, size_t *size,
|
||||
/* if all data fit into provided SCLP buffer */
|
||||
if (avail >= cons->iov_sclp_rest) {
|
||||
/* copy character byte-stream to SCLP buffer */
|
||||
memcpy(buf, cons->iov_sclp, cons->iov_sclp_rest);
|
||||
memcpy(buf, &cons->iov[cons->iov_sclp], cons->iov_sclp_rest);
|
||||
*size = cons->iov_sclp_rest + 1;
|
||||
cons->iov_sclp = cons->iov;
|
||||
cons->iov_bs = cons->iov;
|
||||
cons->iov_sclp = 0;
|
||||
cons->iov_bs = 0;
|
||||
cons->iov_data_len = 0;
|
||||
cons->iov_sclp_rest = 0;
|
||||
event->event_pending = false;
|
||||
/* data provided and no more data pending */
|
||||
} else {
|
||||
/* if provided buffer is too small, just copy part */
|
||||
memcpy(buf, cons->iov_sclp, avail);
|
||||
memcpy(buf, &cons->iov[cons->iov_sclp], avail);
|
||||
*size = avail + 1;
|
||||
cons->iov_sclp_rest -= avail;
|
||||
cons->iov_sclp += avail;
|
||||
@ -223,9 +197,26 @@ static void trigger_ascii_console_data(void *opaque, int n, int level)
|
||||
sclp_service_interrupt(0);
|
||||
}
|
||||
|
||||
static const VMStateDescription vmstate_sclpconsole = {
|
||||
.name = "sclpconsole",
|
||||
.version_id = 0,
|
||||
.minimum_version_id = 0,
|
||||
.minimum_version_id_old = 0,
|
||||
.fields = (VMStateField[]) {
|
||||
VMSTATE_BOOL(event.event_pending, SCLPConsole),
|
||||
VMSTATE_UINT8_ARRAY(iov, SCLPConsole, SIZE_BUFFER_VT220),
|
||||
VMSTATE_UINT32(iov_sclp, SCLPConsole),
|
||||
VMSTATE_UINT32(iov_bs, SCLPConsole),
|
||||
VMSTATE_UINT32(iov_data_len, SCLPConsole),
|
||||
VMSTATE_UINT32(iov_sclp_rest, SCLPConsole),
|
||||
VMSTATE_END_OF_LIST()
|
||||
}
|
||||
};
|
||||
|
||||
/* qemu object creation and initialization functions */
|
||||
|
||||
/* tell character layer our call-back functions */
|
||||
|
||||
static int console_init(SCLPEvent *event)
|
||||
{
|
||||
static bool console_available;
|
||||
@ -237,10 +228,9 @@ static int console_init(SCLPEvent *event)
|
||||
return -1;
|
||||
}
|
||||
console_available = true;
|
||||
event->event_type = SCLP_EVENT_ASCII_CONSOLE_DATA;
|
||||
if (scon->chr) {
|
||||
qemu_chr_add_handlers(scon->chr, chr_can_read,
|
||||
chr_read, chr_event, scon);
|
||||
chr_read, NULL, scon);
|
||||
}
|
||||
scon->irq_read_vt220 = *qemu_allocate_irqs(trigger_ascii_console_data,
|
||||
NULL, 1);
|
||||
@ -248,6 +238,18 @@ static int console_init(SCLPEvent *event)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void console_reset(DeviceState *dev)
|
||||
{
|
||||
SCLPEvent *event = SCLP_EVENT(dev);
|
||||
SCLPConsole *scon = DO_UPCAST(SCLPConsole, event, event);
|
||||
|
||||
event->event_pending = false;
|
||||
scon->iov_sclp = 0;
|
||||
scon->iov_bs = 0;
|
||||
scon->iov_data_len = 0;
|
||||
scon->iov_sclp_rest = 0;
|
||||
}
|
||||
|
||||
static int console_exit(SCLPEvent *event)
|
||||
{
|
||||
return 0;
|
||||
@ -264,11 +266,13 @@ static void console_class_init(ObjectClass *klass, void *data)
|
||||
SCLPEventClass *ec = SCLP_EVENT_CLASS(klass);
|
||||
|
||||
dc->props = console_properties;
|
||||
dc->reset = console_reset;
|
||||
dc->vmsd = &vmstate_sclpconsole;
|
||||
ec->init = console_init;
|
||||
ec->exit = console_exit;
|
||||
ec->get_send_mask = send_mask;
|
||||
ec->get_receive_mask = receive_mask;
|
||||
ec->event_type = event_type;
|
||||
ec->can_handle_event = can_handle_event;
|
||||
ec->read_event_data = read_event_data;
|
||||
ec->write_event_data = write_event_data;
|
||||
}
|
||||
|
@ -120,7 +120,7 @@ static uint16_t handle_write_event_buf(SCLPEventFacility *ef,
|
||||
ec = SCLP_EVENT_GET_CLASS(event);
|
||||
|
||||
if (ec->write_event_data &&
|
||||
ec->event_type() == event_buf->type) {
|
||||
ec->can_handle_event(event_buf->type)) {
|
||||
rc = ec->write_event_data(event, event_buf);
|
||||
break;
|
||||
}
|
||||
@ -183,7 +183,7 @@ static uint16_t handle_sccb_read_events(SCLPEventFacility *ef, SCCB *sccb,
|
||||
{
|
||||
uint16_t rc;
|
||||
int slen;
|
||||
unsigned elen = 0;
|
||||
unsigned elen;
|
||||
BusChild *kid;
|
||||
SCLPEvent *event;
|
||||
SCLPEventClass *ec;
|
||||
@ -203,11 +203,11 @@ static uint16_t handle_sccb_read_events(SCLPEventFacility *ef, SCCB *sccb,
|
||||
|
||||
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;
|
||||
}
|
||||
}
|
||||
elen = be16_to_cpu(event_buf->length);
|
||||
event_buf = (void *) event_buf + elen;
|
||||
}
|
||||
|
||||
if (sccb->h.control_mask[2] & SCLP_VARIABLE_LENGTH_RESPONSE) {
|
||||
@ -338,10 +338,19 @@ static int init_event_facility(S390SCLPDevice *sdev)
|
||||
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;
|
||||
}
|
||||
|
||||
|
@ -22,9 +22,9 @@ typedef struct SignalQuiesce {
|
||||
uint8_t unit;
|
||||
} QEMU_PACKED SignalQuiesce;
|
||||
|
||||
static int event_type(void)
|
||||
static bool can_handle_event(uint8_t type)
|
||||
{
|
||||
return SCLP_EVENT_SIGNAL_QUIESCE;
|
||||
return type == SCLP_EVENT_SIGNAL_QUIESCE;
|
||||
}
|
||||
|
||||
static unsigned int send_mask(void)
|
||||
@ -65,6 +65,17 @@ static int read_event_data(SCLPEvent *event, EventBufferHeader *evt_buf_hdr,
|
||||
return 1;
|
||||
}
|
||||
|
||||
static const VMStateDescription vmstate_sclpquiesce = {
|
||||
.name = "sclpquiesce",
|
||||
.version_id = 0,
|
||||
.minimum_version_id = 0,
|
||||
.minimum_version_id_old = 0,
|
||||
.fields = (VMStateField[]) {
|
||||
VMSTATE_BOOL(event_pending, SCLPEvent),
|
||||
VMSTATE_END_OF_LIST()
|
||||
}
|
||||
};
|
||||
|
||||
typedef struct QuiesceNotifier QuiesceNotifier;
|
||||
|
||||
static struct QuiesceNotifier {
|
||||
@ -84,8 +95,6 @@ static void quiesce_powerdown_req(Notifier *n, void *opaque)
|
||||
|
||||
static int quiesce_init(SCLPEvent *event)
|
||||
{
|
||||
event->event_type = SCLP_EVENT_SIGNAL_QUIESCE;
|
||||
|
||||
qn.notifier.notify = quiesce_powerdown_req;
|
||||
qn.event = event;
|
||||
|
||||
@ -94,15 +103,25 @@ static int quiesce_init(SCLPEvent *event)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void quiesce_reset(DeviceState *dev)
|
||||
{
|
||||
SCLPEvent *event = SCLP_EVENT(dev);
|
||||
|
||||
event->event_pending = false;
|
||||
}
|
||||
|
||||
static void quiesce_class_init(ObjectClass *klass, void *data)
|
||||
{
|
||||
DeviceClass *dc = DEVICE_CLASS(klass);
|
||||
SCLPEventClass *k = SCLP_EVENT_CLASS(klass);
|
||||
|
||||
dc->reset = quiesce_reset;
|
||||
dc->vmsd = &vmstate_sclpquiesce;
|
||||
k->init = quiesce_init;
|
||||
|
||||
k->get_send_mask = send_mask;
|
||||
k->get_receive_mask = receive_mask;
|
||||
k->event_type = event_type;
|
||||
k->can_handle_event = can_handle_event;
|
||||
k->read_event_data = read_event_data;
|
||||
k->write_event_data = NULL;
|
||||
}
|
||||
|
104
include/hw/s390x/ebcdic.h
Normal file
104
include/hw/s390x/ebcdic.h
Normal file
@ -0,0 +1,104 @@
|
||||
/*
|
||||
* EBCDIC/ASCII conversion Support
|
||||
*
|
||||
* Copyright (c) 2011 Alexander Graf
|
||||
* Copyright IBM, Corp. 2013
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
*/
|
||||
|
||||
#ifndef EBCDIC_H_
|
||||
#define EBCDIC_H_
|
||||
|
||||
/* EBCDIC handling */
|
||||
static const uint8_t ebcdic2ascii[] = {
|
||||
0x00, 0x01, 0x02, 0x03, 0x07, 0x09, 0x07, 0x7F,
|
||||
0x07, 0x07, 0x07, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
|
||||
0x10, 0x11, 0x12, 0x13, 0x07, 0x0A, 0x08, 0x07,
|
||||
0x18, 0x19, 0x07, 0x07, 0x07, 0x07, 0x07, 0x07,
|
||||
0x07, 0x07, 0x1C, 0x07, 0x07, 0x0A, 0x17, 0x1B,
|
||||
0x07, 0x07, 0x07, 0x07, 0x07, 0x05, 0x06, 0x07,
|
||||
0x07, 0x07, 0x16, 0x07, 0x07, 0x07, 0x07, 0x04,
|
||||
0x07, 0x07, 0x07, 0x07, 0x14, 0x15, 0x07, 0x1A,
|
||||
0x20, 0xFF, 0x83, 0x84, 0x85, 0xA0, 0x07, 0x86,
|
||||
0x87, 0xA4, 0x5B, 0x2E, 0x3C, 0x28, 0x2B, 0x21,
|
||||
0x26, 0x82, 0x88, 0x89, 0x8A, 0xA1, 0x8C, 0x07,
|
||||
0x8D, 0xE1, 0x5D, 0x24, 0x2A, 0x29, 0x3B, 0x5E,
|
||||
0x2D, 0x2F, 0x07, 0x8E, 0x07, 0x07, 0x07, 0x8F,
|
||||
0x80, 0xA5, 0x07, 0x2C, 0x25, 0x5F, 0x3E, 0x3F,
|
||||
0x07, 0x90, 0x07, 0x07, 0x07, 0x07, 0x07, 0x07,
|
||||
0x70, 0x60, 0x3A, 0x23, 0x40, 0x27, 0x3D, 0x22,
|
||||
0x07, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67,
|
||||
0x68, 0x69, 0xAE, 0xAF, 0x07, 0x07, 0x07, 0xF1,
|
||||
0xF8, 0x6A, 0x6B, 0x6C, 0x6D, 0x6E, 0x6F, 0x70,
|
||||
0x71, 0x72, 0xA6, 0xA7, 0x91, 0x07, 0x92, 0x07,
|
||||
0xE6, 0x7E, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78,
|
||||
0x79, 0x7A, 0xAD, 0xAB, 0x07, 0x07, 0x07, 0x07,
|
||||
0x9B, 0x9C, 0x9D, 0xFA, 0x07, 0x07, 0x07, 0xAC,
|
||||
0xAB, 0x07, 0xAA, 0x7C, 0x07, 0x07, 0x07, 0x07,
|
||||
0x7B, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47,
|
||||
0x48, 0x49, 0x07, 0x93, 0x94, 0x95, 0xA2, 0x07,
|
||||
0x7D, 0x4A, 0x4B, 0x4C, 0x4D, 0x4E, 0x4F, 0x50,
|
||||
0x51, 0x52, 0x07, 0x96, 0x81, 0x97, 0xA3, 0x98,
|
||||
0x5C, 0xF6, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58,
|
||||
0x59, 0x5A, 0xFD, 0x07, 0x99, 0x07, 0x07, 0x07,
|
||||
0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37,
|
||||
0x38, 0x39, 0x07, 0x07, 0x9A, 0x07, 0x07, 0x07,
|
||||
};
|
||||
|
||||
static const uint8_t ascii2ebcdic[] = {
|
||||
0x00, 0x01, 0x02, 0x03, 0x37, 0x2D, 0x2E, 0x2F,
|
||||
0x16, 0x05, 0x15, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
|
||||
0x10, 0x11, 0x12, 0x13, 0x3C, 0x3D, 0x32, 0x26,
|
||||
0x18, 0x19, 0x3F, 0x27, 0x22, 0x1D, 0x1E, 0x1F,
|
||||
0x40, 0x5A, 0x7F, 0x7B, 0x5B, 0x6C, 0x50, 0x7D,
|
||||
0x4D, 0x5D, 0x5C, 0x4E, 0x6B, 0x60, 0x4B, 0x61,
|
||||
0xF0, 0xF1, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7,
|
||||
0xF8, 0xF9, 0x7A, 0x5E, 0x4C, 0x7E, 0x6E, 0x6F,
|
||||
0x7C, 0xC1, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7,
|
||||
0xC8, 0xC9, 0xD1, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6,
|
||||
0xD7, 0xD8, 0xD9, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6,
|
||||
0xE7, 0xE8, 0xE9, 0xBA, 0xE0, 0xBB, 0xB0, 0x6D,
|
||||
0x79, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87,
|
||||
0x88, 0x89, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96,
|
||||
0x97, 0x98, 0x99, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6,
|
||||
0xA7, 0xA8, 0xA9, 0xC0, 0x4F, 0xD0, 0xA1, 0x07,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x59, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x90, 0x3F, 0x3F, 0x3F, 0x3F, 0xEA, 0x3F, 0xFF
|
||||
};
|
||||
|
||||
static inline void ebcdic_put(uint8_t *p, const char *ascii, int len)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < len; i++) {
|
||||
p[i] = ascii2ebcdic[(uint8_t)ascii[i]];
|
||||
}
|
||||
}
|
||||
|
||||
static inline void ascii_put(uint8_t *p, const char *ebcdic, int len)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < len; i++) {
|
||||
p[i] = ebcdic2ascii[(uint8_t)ebcdic[i]];
|
||||
}
|
||||
}
|
||||
|
||||
#endif /* EBCDIC_H_ */
|
@ -19,12 +19,18 @@
|
||||
#include "qemu/thread.h"
|
||||
|
||||
/* SCLP event types */
|
||||
#define SCLP_EVENT_OPRTNS_COMMAND 0x01
|
||||
#define SCLP_EVENT_MESSAGE 0x02
|
||||
#define SCLP_EVENT_PMSGCMD 0x09
|
||||
#define SCLP_EVENT_ASCII_CONSOLE_DATA 0x1a
|
||||
#define SCLP_EVENT_SIGNAL_QUIESCE 0x1d
|
||||
|
||||
/* SCLP event masks */
|
||||
#define SCLP_EVENT_MASK_SIGNAL_QUIESCE 0x00000008
|
||||
#define SCLP_EVENT_MASK_MSG_ASCII 0x00000040
|
||||
#define SCLP_EVENT_MASK_OP_CMD 0x80000000
|
||||
#define SCLP_EVENT_MASK_MSG 0x40000000
|
||||
#define SCLP_EVENT_MASK_PMSGCMD 0x00800000
|
||||
|
||||
#define SCLP_UNCONDITIONAL_READ 0x00
|
||||
#define SCLP_SELECTIVE_READ 0x01
|
||||
@ -43,8 +49,8 @@ typedef struct WriteEventMask {
|
||||
uint16_t mask_length;
|
||||
uint32_t cp_receive_mask;
|
||||
uint32_t cp_send_mask;
|
||||
uint32_t send_mask;
|
||||
uint32_t receive_mask;
|
||||
uint32_t send_mask;
|
||||
} QEMU_PACKED WriteEventMask;
|
||||
|
||||
typedef struct EventBufferHeader {
|
||||
@ -54,6 +60,80 @@ typedef struct EventBufferHeader {
|
||||
uint16_t _reserved;
|
||||
} QEMU_PACKED EventBufferHeader;
|
||||
|
||||
typedef struct MdbHeader {
|
||||
uint16_t length;
|
||||
uint16_t type;
|
||||
uint32_t tag;
|
||||
uint32_t revision_code;
|
||||
} QEMU_PACKED MdbHeader;
|
||||
|
||||
typedef struct MTO {
|
||||
uint16_t line_type_flags;
|
||||
uint8_t alarm_control;
|
||||
uint8_t _reserved[3];
|
||||
char message[];
|
||||
} QEMU_PACKED MTO;
|
||||
|
||||
typedef struct GO {
|
||||
uint32_t domid;
|
||||
uint8_t hhmmss_time[8];
|
||||
uint8_t th_time[3];
|
||||
uint8_t _reserved_0;
|
||||
uint8_t dddyyyy_date[7];
|
||||
uint8_t _reserved_1;
|
||||
uint16_t general_msg_flags;
|
||||
uint8_t _reserved_2[10];
|
||||
uint8_t originating_system_name[8];
|
||||
uint8_t job_guest_name[8];
|
||||
} QEMU_PACKED GO;
|
||||
|
||||
#define MESSAGE_TEXT 0x0004
|
||||
|
||||
typedef struct MDBO {
|
||||
uint16_t length;
|
||||
uint16_t type;
|
||||
union {
|
||||
GO go;
|
||||
MTO mto;
|
||||
};
|
||||
} QEMU_PACKED MDBO;
|
||||
|
||||
typedef struct MDB {
|
||||
MdbHeader header;
|
||||
MDBO mdbo[0];
|
||||
} QEMU_PACKED MDB;
|
||||
|
||||
typedef struct SclpMsg {
|
||||
EventBufferHeader header;
|
||||
MDB mdb;
|
||||
} QEMU_PACKED SclpMsg;
|
||||
|
||||
#define GDS_ID_MDSMU 0x1310
|
||||
#define GDS_ID_CPMSU 0x1212
|
||||
#define GDS_ID_TEXTCMD 0x1320
|
||||
|
||||
typedef struct GdsVector {
|
||||
uint16_t length;
|
||||
uint16_t gds_id;
|
||||
} QEMU_PACKED GdsVector;
|
||||
|
||||
#define GDS_KEY_SELFDEFTEXTMSG 0x31
|
||||
#define GDS_KEY_TEXTMSG 0x30
|
||||
|
||||
typedef struct GdsSubvector {
|
||||
uint8_t length;
|
||||
uint8_t key;
|
||||
} QEMU_PACKED GdsSubvector;
|
||||
|
||||
/* MDS Message Unit */
|
||||
typedef struct MDMSU {
|
||||
GdsVector mdmsu;
|
||||
GdsVector cpmsu;
|
||||
GdsVector text_command;
|
||||
GdsSubvector self_def_text_message;
|
||||
GdsSubvector text_message;
|
||||
} QEMU_PACKED MDMSU;
|
||||
|
||||
typedef struct WriteEventData {
|
||||
SCCBHeader h;
|
||||
EventBufferHeader ebh;
|
||||
@ -68,7 +148,6 @@ typedef struct ReadEventData {
|
||||
typedef struct SCLPEvent {
|
||||
DeviceState qdev;
|
||||
bool event_pending;
|
||||
uint32_t event_type;
|
||||
char *name;
|
||||
} SCLPEvent;
|
||||
|
||||
@ -88,9 +167,8 @@ typedef struct SCLPEventClass {
|
||||
|
||||
int (*write_event_data)(SCLPEvent *event, EventBufferHeader *evt_buf_hdr);
|
||||
|
||||
/* returns the supported event type */
|
||||
int (*event_type)(void);
|
||||
|
||||
/* can we handle this event type? */
|
||||
bool (*can_handle_event)(uint8_t type);
|
||||
} SCLPEventClass;
|
||||
|
||||
#endif
|
||||
|
Binary file not shown.
@ -123,6 +123,7 @@ static void vring_init(struct vring *vr, unsigned int num, void *p,
|
||||
/* We're running with interrupts off anyways, so don't bother */
|
||||
vr->used->flags = VRING_USED_F_NO_NOTIFY;
|
||||
vr->used->idx = 0;
|
||||
vr->used_idx = 0;
|
||||
|
||||
debug_print_addr("init vr", vr);
|
||||
}
|
||||
@ -150,8 +151,6 @@ static void vring_send_buf(struct vring *vr, void *p, int len, int flags)
|
||||
if (!(flags & VRING_DESC_F_NEXT)) {
|
||||
vr->avail->idx++;
|
||||
}
|
||||
|
||||
vr->used->idx = vr->next_idx;
|
||||
}
|
||||
|
||||
static u64 get_clock(void)
|
||||
@ -180,7 +179,8 @@ static int vring_wait_reply(struct vring *vr, int timeout)
|
||||
struct subchannel_id schid = vr->schid;
|
||||
int r = 0;
|
||||
|
||||
while (vr->used->idx == vr->next_idx) {
|
||||
/* Wait until the used index has moved. */
|
||||
while (vr->used->idx == vr->used_idx) {
|
||||
vring_notify(schid);
|
||||
if (timeout && (get_second() >= target_second)) {
|
||||
r = 1;
|
||||
@ -189,6 +189,7 @@ static int vring_wait_reply(struct vring *vr, int timeout)
|
||||
yield();
|
||||
}
|
||||
|
||||
vr->used_idx = vr->used->idx;
|
||||
vr->next_idx = 0;
|
||||
vr->desc[0].len = 0;
|
||||
vr->desc[0].flags = 0;
|
||||
|
@ -115,6 +115,7 @@ struct vring_used {
|
||||
struct vring {
|
||||
unsigned int num;
|
||||
int next_idx;
|
||||
int used_idx;
|
||||
struct vring_desc *desc;
|
||||
struct vring_avail *avail;
|
||||
struct vring_used *used;
|
||||
|
@ -151,6 +151,7 @@ static int s390x_write_all_elf64_notes(const char *note_name,
|
||||
int ret = -1;
|
||||
|
||||
for (nf = note_func; nf->note_contents_func; nf++) {
|
||||
memset(¬e, 0, sizeof(note));
|
||||
note.hdr.n_namesz = cpu_to_be32(sizeof(note.name));
|
||||
note.hdr.n_descsz = cpu_to_be32(nf->contents_size);
|
||||
strncpy(note.name, note_name, sizeof(note.name));
|
||||
|
@ -148,6 +148,7 @@ typedef struct CPUS390XState {
|
||||
} CPUS390XState;
|
||||
|
||||
#include "cpu-qom.h"
|
||||
#include <sysemu/kvm.h>
|
||||
|
||||
/* distinguish between 24 bit and 31 bit addressing */
|
||||
#define HIGH_ORDER_BIT 0x80000000
|
||||
@ -692,6 +693,14 @@ static inline const char *cc_name(int cc_op)
|
||||
return cc_names[cc_op];
|
||||
}
|
||||
|
||||
static inline void setcc(S390CPU *cpu, uint64_t cc)
|
||||
{
|
||||
CPUS390XState *env = &cpu->env;
|
||||
|
||||
env->psw.mask &= ~(3ull << 44);
|
||||
env->psw.mask |= (cc & 3) << 44;
|
||||
}
|
||||
|
||||
typedef struct LowCore
|
||||
{
|
||||
/* prefix area: defined by architecture */
|
||||
@ -1058,8 +1067,6 @@ void program_interrupt(CPUS390XState *env, uint32_t code, int ilen);
|
||||
void QEMU_NORETURN runtime_exception(CPUS390XState *env, int excp,
|
||||
uintptr_t retaddr);
|
||||
|
||||
#include <sysemu/kvm.h>
|
||||
|
||||
#ifdef CONFIG_KVM
|
||||
void kvm_s390_io_interrupt(S390CPU *cpu, uint16_t subchannel_id,
|
||||
uint16_t subchannel_nr, uint32_t io_int_parm,
|
||||
|
@ -36,7 +36,7 @@ int ioinst_disassemble_sch_ident(uint32_t value, int *m, int *cssid, int *ssid,
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ioinst_handle_xsch(CPUS390XState *env, uint64_t reg1)
|
||||
void ioinst_handle_xsch(S390CPU *cpu, uint64_t reg1)
|
||||
{
|
||||
int cssid, ssid, schid, m;
|
||||
SubchDev *sch;
|
||||
@ -44,8 +44,8 @@ int ioinst_handle_xsch(CPUS390XState *env, uint64_t reg1)
|
||||
int cc;
|
||||
|
||||
if (ioinst_disassemble_sch_ident(reg1, &m, &cssid, &ssid, &schid)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
return -EIO;
|
||||
program_interrupt(&cpu->env, PGM_OPERAND, 2);
|
||||
return;
|
||||
}
|
||||
trace_ioinst_sch_id("xsch", cssid, ssid, schid);
|
||||
sch = css_find_subch(m, cssid, ssid, schid);
|
||||
@ -66,11 +66,10 @@ int ioinst_handle_xsch(CPUS390XState *env, uint64_t reg1)
|
||||
cc = 1;
|
||||
break;
|
||||
}
|
||||
|
||||
return cc;
|
||||
setcc(cpu, cc);
|
||||
}
|
||||
|
||||
int ioinst_handle_csch(CPUS390XState *env, uint64_t reg1)
|
||||
void ioinst_handle_csch(S390CPU *cpu, uint64_t reg1)
|
||||
{
|
||||
int cssid, ssid, schid, m;
|
||||
SubchDev *sch;
|
||||
@ -78,8 +77,8 @@ int ioinst_handle_csch(CPUS390XState *env, uint64_t reg1)
|
||||
int cc;
|
||||
|
||||
if (ioinst_disassemble_sch_ident(reg1, &m, &cssid, &ssid, &schid)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
return -EIO;
|
||||
program_interrupt(&cpu->env, PGM_OPERAND, 2);
|
||||
return;
|
||||
}
|
||||
trace_ioinst_sch_id("csch", cssid, ssid, schid);
|
||||
sch = css_find_subch(m, cssid, ssid, schid);
|
||||
@ -91,10 +90,10 @@ int ioinst_handle_csch(CPUS390XState *env, uint64_t reg1)
|
||||
} else {
|
||||
cc = 0;
|
||||
}
|
||||
return cc;
|
||||
setcc(cpu, cc);
|
||||
}
|
||||
|
||||
int ioinst_handle_hsch(CPUS390XState *env, uint64_t reg1)
|
||||
void ioinst_handle_hsch(S390CPU *cpu, uint64_t reg1)
|
||||
{
|
||||
int cssid, ssid, schid, m;
|
||||
SubchDev *sch;
|
||||
@ -102,8 +101,8 @@ int ioinst_handle_hsch(CPUS390XState *env, uint64_t reg1)
|
||||
int cc;
|
||||
|
||||
if (ioinst_disassemble_sch_ident(reg1, &m, &cssid, &ssid, &schid)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
return -EIO;
|
||||
program_interrupt(&cpu->env, PGM_OPERAND, 2);
|
||||
return;
|
||||
}
|
||||
trace_ioinst_sch_id("hsch", cssid, ssid, schid);
|
||||
sch = css_find_subch(m, cssid, ssid, schid);
|
||||
@ -124,8 +123,7 @@ int ioinst_handle_hsch(CPUS390XState *env, uint64_t reg1)
|
||||
cc = 1;
|
||||
break;
|
||||
}
|
||||
|
||||
return cc;
|
||||
setcc(cpu, cc);
|
||||
}
|
||||
|
||||
static int ioinst_schib_valid(SCHIB *schib)
|
||||
@ -141,7 +139,7 @@ static int ioinst_schib_valid(SCHIB *schib)
|
||||
return 1;
|
||||
}
|
||||
|
||||
int ioinst_handle_msch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
void ioinst_handle_msch(S390CPU *cpu, uint64_t reg1, uint32_t ipb)
|
||||
{
|
||||
int cssid, ssid, schid, m;
|
||||
SubchDev *sch;
|
||||
@ -150,22 +148,21 @@ int ioinst_handle_msch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
int ret = -ENODEV;
|
||||
int cc;
|
||||
hwaddr len = sizeof(*schib);
|
||||
CPUS390XState *env = &cpu->env;
|
||||
|
||||
addr = decode_basedisp_s(env, ipb);
|
||||
if (addr & 3) {
|
||||
program_interrupt(env, PGM_SPECIFICATION, 2);
|
||||
return -EIO;
|
||||
return;
|
||||
}
|
||||
schib = s390_cpu_physical_memory_map(env, addr, &len, 0);
|
||||
if (!schib || len != sizeof(*schib)) {
|
||||
program_interrupt(env, PGM_ADDRESSING, 2);
|
||||
cc = -EIO;
|
||||
goto out;
|
||||
}
|
||||
if (ioinst_disassemble_sch_ident(reg1, &m, &cssid, &ssid, &schid) ||
|
||||
!ioinst_schib_valid(schib)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
cc = -EIO;
|
||||
goto out;
|
||||
}
|
||||
trace_ioinst_sch_id("msch", cssid, ssid, schid);
|
||||
@ -187,9 +184,10 @@ int ioinst_handle_msch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
cc = 1;
|
||||
break;
|
||||
}
|
||||
setcc(cpu, cc);
|
||||
|
||||
out:
|
||||
s390_cpu_physical_memory_unmap(env, schib, len, 0);
|
||||
return cc;
|
||||
}
|
||||
|
||||
static void copy_orb_from_guest(ORB *dest, const ORB *src)
|
||||
@ -213,7 +211,7 @@ static int ioinst_orb_valid(ORB *orb)
|
||||
return 1;
|
||||
}
|
||||
|
||||
int ioinst_handle_ssch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
void ioinst_handle_ssch(S390CPU *cpu, uint64_t reg1, uint32_t ipb)
|
||||
{
|
||||
int cssid, ssid, schid, m;
|
||||
SubchDev *sch;
|
||||
@ -222,23 +220,22 @@ int ioinst_handle_ssch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
int ret = -ENODEV;
|
||||
int cc;
|
||||
hwaddr len = sizeof(*orig_orb);
|
||||
CPUS390XState *env = &cpu->env;
|
||||
|
||||
addr = decode_basedisp_s(env, ipb);
|
||||
if (addr & 3) {
|
||||
program_interrupt(env, PGM_SPECIFICATION, 2);
|
||||
return -EIO;
|
||||
return;
|
||||
}
|
||||
orig_orb = s390_cpu_physical_memory_map(env, addr, &len, 0);
|
||||
if (!orig_orb || len != sizeof(*orig_orb)) {
|
||||
program_interrupt(env, PGM_ADDRESSING, 2);
|
||||
cc = -EIO;
|
||||
goto out;
|
||||
}
|
||||
copy_orb_from_guest(&orb, orig_orb);
|
||||
if (ioinst_disassemble_sch_ident(reg1, &m, &cssid, &ssid, &schid) ||
|
||||
!ioinst_orb_valid(&orb)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
cc = -EIO;
|
||||
goto out;
|
||||
}
|
||||
trace_ioinst_sch_id("ssch", cssid, ssid, schid);
|
||||
@ -260,38 +257,39 @@ int ioinst_handle_ssch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
cc = 1;
|
||||
break;
|
||||
}
|
||||
setcc(cpu, cc);
|
||||
|
||||
out:
|
||||
s390_cpu_physical_memory_unmap(env, orig_orb, len, 0);
|
||||
return cc;
|
||||
}
|
||||
|
||||
int ioinst_handle_stcrw(CPUS390XState *env, uint32_t ipb)
|
||||
void ioinst_handle_stcrw(S390CPU *cpu, uint32_t ipb)
|
||||
{
|
||||
CRW *crw;
|
||||
uint64_t addr;
|
||||
int cc;
|
||||
hwaddr len = sizeof(*crw);
|
||||
CPUS390XState *env = &cpu->env;
|
||||
|
||||
addr = decode_basedisp_s(env, ipb);
|
||||
if (addr & 3) {
|
||||
program_interrupt(env, PGM_SPECIFICATION, 2);
|
||||
return -EIO;
|
||||
return;
|
||||
}
|
||||
crw = s390_cpu_physical_memory_map(env, addr, &len, 1);
|
||||
if (!crw || len != sizeof(*crw)) {
|
||||
program_interrupt(env, PGM_ADDRESSING, 2);
|
||||
cc = -EIO;
|
||||
goto out;
|
||||
}
|
||||
cc = css_do_stcrw(crw);
|
||||
/* 0 - crw stored, 1 - zeroes stored */
|
||||
setcc(cpu, cc);
|
||||
|
||||
out:
|
||||
s390_cpu_physical_memory_unmap(env, crw, len, 1);
|
||||
return cc;
|
||||
}
|
||||
|
||||
int ioinst_handle_stsch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
void ioinst_handle_stsch(S390CPU *cpu, uint64_t reg1, uint32_t ipb)
|
||||
{
|
||||
int cssid, ssid, schid, m;
|
||||
SubchDev *sch;
|
||||
@ -299,22 +297,21 @@ int ioinst_handle_stsch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
int cc;
|
||||
SCHIB *schib;
|
||||
hwaddr len = sizeof(*schib);
|
||||
CPUS390XState *env = &cpu->env;
|
||||
|
||||
addr = decode_basedisp_s(env, ipb);
|
||||
if (addr & 3) {
|
||||
program_interrupt(env, PGM_SPECIFICATION, 2);
|
||||
return -EIO;
|
||||
return;
|
||||
}
|
||||
schib = s390_cpu_physical_memory_map(env, addr, &len, 1);
|
||||
if (!schib || len != sizeof(*schib)) {
|
||||
program_interrupt(env, PGM_ADDRESSING, 2);
|
||||
cc = -EIO;
|
||||
goto out;
|
||||
}
|
||||
|
||||
if (ioinst_disassemble_sch_ident(reg1, &m, &cssid, &ssid, &schid)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
cc = -EIO;
|
||||
goto out;
|
||||
}
|
||||
trace_ioinst_sch_id("stsch", cssid, ssid, schid);
|
||||
@ -336,9 +333,10 @@ int ioinst_handle_stsch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
cc = 0;
|
||||
}
|
||||
}
|
||||
setcc(cpu, cc);
|
||||
|
||||
out:
|
||||
s390_cpu_physical_memory_unmap(env, schib, len, 1);
|
||||
return cc;
|
||||
}
|
||||
|
||||
int ioinst_handle_tsch(CPUS390XState *env, uint64_t reg1, uint32_t ipb)
|
||||
@ -575,7 +573,7 @@ static void ioinst_handle_chsc_unimplemented(ChscResp *res)
|
||||
res->param = 0;
|
||||
}
|
||||
|
||||
int ioinst_handle_chsc(CPUS390XState *env, uint32_t ipb)
|
||||
void ioinst_handle_chsc(S390CPU *cpu, uint32_t ipb)
|
||||
{
|
||||
ChscReq *req;
|
||||
ChscResp *res;
|
||||
@ -584,7 +582,7 @@ int ioinst_handle_chsc(CPUS390XState *env, uint32_t ipb)
|
||||
uint16_t len;
|
||||
uint16_t command;
|
||||
hwaddr map_size = TARGET_PAGE_SIZE;
|
||||
int ret = 0;
|
||||
CPUS390XState *env = &cpu->env;
|
||||
|
||||
trace_ioinst("chsc");
|
||||
reg = (ipb >> 20) & 0x00f;
|
||||
@ -592,19 +590,17 @@ int ioinst_handle_chsc(CPUS390XState *env, uint32_t ipb)
|
||||
/* Page boundary? */
|
||||
if (addr & 0xfff) {
|
||||
program_interrupt(env, PGM_SPECIFICATION, 2);
|
||||
return -EIO;
|
||||
return;
|
||||
}
|
||||
req = s390_cpu_physical_memory_map(env, addr, &map_size, 1);
|
||||
if (!req || map_size != TARGET_PAGE_SIZE) {
|
||||
program_interrupt(env, PGM_ADDRESSING, 2);
|
||||
ret = -EIO;
|
||||
goto out;
|
||||
}
|
||||
len = be16_to_cpu(req->len);
|
||||
/* Length field valid? */
|
||||
if ((len < 16) || (len > 4088) || (len & 7)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
ret = -EIO;
|
||||
goto out;
|
||||
}
|
||||
memset((char *)req + len, 0, TARGET_PAGE_SIZE - len);
|
||||
@ -628,7 +624,6 @@ int ioinst_handle_chsc(CPUS390XState *env, uint32_t ipb)
|
||||
|
||||
out:
|
||||
s390_cpu_physical_memory_unmap(env, req, map_size, 1);
|
||||
return ret;
|
||||
}
|
||||
|
||||
int ioinst_handle_tpi(CPUS390XState *env, uint32_t ipb)
|
||||
@ -666,18 +661,19 @@ out:
|
||||
#define SCHM_REG1_UPD(_reg) ((_reg & 0x0000000000000002) >> 1)
|
||||
#define SCHM_REG1_DCT(_reg) (_reg & 0x0000000000000001)
|
||||
|
||||
int ioinst_handle_schm(CPUS390XState *env, uint64_t reg1, uint64_t reg2,
|
||||
void ioinst_handle_schm(S390CPU *cpu, uint64_t reg1, uint64_t reg2,
|
||||
uint32_t ipb)
|
||||
{
|
||||
uint8_t mbk;
|
||||
int update;
|
||||
int dct;
|
||||
CPUS390XState *env = &cpu->env;
|
||||
|
||||
trace_ioinst("schm");
|
||||
|
||||
if (SCHM_REG1_RES(reg1)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
return -EIO;
|
||||
return;
|
||||
}
|
||||
|
||||
mbk = SCHM_REG1_MBK(reg1);
|
||||
@ -686,15 +682,13 @@ int ioinst_handle_schm(CPUS390XState *env, uint64_t reg1, uint64_t reg2,
|
||||
|
||||
if (update && (reg2 & 0x000000000000001f)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
return -EIO;
|
||||
return;
|
||||
}
|
||||
|
||||
css_do_schm(mbk, update, dct, update ? reg2 : 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ioinst_handle_rsch(CPUS390XState *env, uint64_t reg1)
|
||||
void ioinst_handle_rsch(S390CPU *cpu, uint64_t reg1)
|
||||
{
|
||||
int cssid, ssid, schid, m;
|
||||
SubchDev *sch;
|
||||
@ -702,8 +696,8 @@ int ioinst_handle_rsch(CPUS390XState *env, uint64_t reg1)
|
||||
int cc;
|
||||
|
||||
if (ioinst_disassemble_sch_ident(reg1, &m, &cssid, &ssid, &schid)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
return -EIO;
|
||||
program_interrupt(&cpu->env, PGM_OPERAND, 2);
|
||||
return;
|
||||
}
|
||||
trace_ioinst_sch_id("rsch", cssid, ssid, schid);
|
||||
sch = css_find_subch(m, cssid, ssid, schid);
|
||||
@ -724,24 +718,23 @@ int ioinst_handle_rsch(CPUS390XState *env, uint64_t reg1)
|
||||
cc = 1;
|
||||
break;
|
||||
}
|
||||
|
||||
return cc;
|
||||
|
||||
setcc(cpu, cc);
|
||||
}
|
||||
|
||||
#define RCHP_REG1_RES(_reg) (_reg & 0x00000000ff00ff00)
|
||||
#define RCHP_REG1_CSSID(_reg) ((_reg & 0x0000000000ff0000) >> 16)
|
||||
#define RCHP_REG1_CHPID(_reg) (_reg & 0x00000000000000ff)
|
||||
int ioinst_handle_rchp(CPUS390XState *env, uint64_t reg1)
|
||||
void ioinst_handle_rchp(S390CPU *cpu, uint64_t reg1)
|
||||
{
|
||||
int cc;
|
||||
uint8_t cssid;
|
||||
uint8_t chpid;
|
||||
int ret;
|
||||
CPUS390XState *env = &cpu->env;
|
||||
|
||||
if (RCHP_REG1_RES(reg1)) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
return -EIO;
|
||||
return;
|
||||
}
|
||||
|
||||
cssid = RCHP_REG1_CSSID(reg1);
|
||||
@ -764,19 +757,16 @@ int ioinst_handle_rchp(CPUS390XState *env, uint64_t reg1)
|
||||
default:
|
||||
/* Invalid channel subsystem. */
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
return -EIO;
|
||||
return;
|
||||
}
|
||||
|
||||
return cc;
|
||||
setcc(cpu, cc);
|
||||
}
|
||||
|
||||
#define SAL_REG1_INVALID(_reg) (_reg & 0x0000000080000000)
|
||||
int ioinst_handle_sal(CPUS390XState *env, uint64_t reg1)
|
||||
void ioinst_handle_sal(S390CPU *cpu, uint64_t reg1)
|
||||
{
|
||||
/* We do not provide address limit checking, so let's suppress it. */
|
||||
if (SAL_REG1_INVALID(reg1) || reg1 & 0x000000000000ffff) {
|
||||
program_interrupt(env, PGM_OPERAND, 2);
|
||||
return -EIO;
|
||||
program_interrupt(&cpu->env, PGM_OPERAND, 2);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
@ -214,20 +214,20 @@ typedef struct IOIntCode {
|
||||
|
||||
int ioinst_disassemble_sch_ident(uint32_t value, int *m, int *cssid, int *ssid,
|
||||
int *schid);
|
||||
int ioinst_handle_xsch(CPUS390XState *env, uint64_t reg1);
|
||||
int ioinst_handle_csch(CPUS390XState *env, uint64_t reg1);
|
||||
int ioinst_handle_hsch(CPUS390XState *env, uint64_t reg1);
|
||||
int ioinst_handle_msch(CPUS390XState *env, uint64_t reg1, uint32_t ipb);
|
||||
int ioinst_handle_ssch(CPUS390XState *env, uint64_t reg1, uint32_t ipb);
|
||||
int ioinst_handle_stcrw(CPUS390XState *env, uint32_t ipb);
|
||||
int ioinst_handle_stsch(CPUS390XState *env, uint64_t reg1, uint32_t ipb);
|
||||
void ioinst_handle_xsch(S390CPU *cpu, uint64_t reg1);
|
||||
void ioinst_handle_csch(S390CPU *cpu, uint64_t reg1);
|
||||
void ioinst_handle_hsch(S390CPU *cpu, uint64_t reg1);
|
||||
void ioinst_handle_msch(S390CPU *cpu, uint64_t reg1, uint32_t ipb);
|
||||
void ioinst_handle_ssch(S390CPU *cpu, uint64_t reg1, uint32_t ipb);
|
||||
void ioinst_handle_stcrw(S390CPU *cpu, uint32_t ipb);
|
||||
void ioinst_handle_stsch(S390CPU *cpu, uint64_t reg1, uint32_t ipb);
|
||||
int ioinst_handle_tsch(CPUS390XState *env, uint64_t reg1, uint32_t ipb);
|
||||
int ioinst_handle_chsc(CPUS390XState *env, uint32_t ipb);
|
||||
void ioinst_handle_chsc(S390CPU *cpu, uint32_t ipb);
|
||||
int ioinst_handle_tpi(CPUS390XState *env, uint32_t ipb);
|
||||
int ioinst_handle_schm(CPUS390XState *env, uint64_t reg1, uint64_t reg2,
|
||||
void ioinst_handle_schm(S390CPU *cpu, uint64_t reg1, uint64_t reg2,
|
||||
uint32_t ipb);
|
||||
int ioinst_handle_rsch(CPUS390XState *env, uint64_t reg1);
|
||||
int ioinst_handle_rchp(CPUS390XState *env, uint64_t reg1);
|
||||
int ioinst_handle_sal(CPUS390XState *env, uint64_t reg1);
|
||||
void ioinst_handle_rsch(S390CPU *cpu, uint64_t reg1);
|
||||
void ioinst_handle_rchp(S390CPU *cpu, uint64_t reg1);
|
||||
void ioinst_handle_sal(S390CPU *cpu, uint64_t reg1);
|
||||
|
||||
#endif
|
||||
|
@ -418,18 +418,6 @@ static void enter_pgmcheck(S390CPU *cpu, uint16_t code)
|
||||
kvm_s390_interrupt(cpu, KVM_S390_PROGRAM_INT, code);
|
||||
}
|
||||
|
||||
static inline void setcc(S390CPU *cpu, uint64_t cc)
|
||||
{
|
||||
CPUS390XState *env = &cpu->env;
|
||||
CPUState *cs = CPU(cpu);
|
||||
|
||||
cs->kvm_run->psw_mask &= ~(3ull << 44);
|
||||
cs->kvm_run->psw_mask |= (cc & 3) << 44;
|
||||
|
||||
env->psw.mask &= ~(3ul << 44);
|
||||
env->psw.mask |= (cc & 3) << 44;
|
||||
}
|
||||
|
||||
static int kvm_sclp_service_call(S390CPU *cpu, struct kvm_run *run,
|
||||
uint16_t ipbh0)
|
||||
{
|
||||
@ -439,6 +427,10 @@ static int kvm_sclp_service_call(S390CPU *cpu, struct kvm_run *run,
|
||||
int r = 0;
|
||||
|
||||
cpu_synchronize_state(CPU(cpu));
|
||||
if (env->psw.mask & PSW_MASK_PSTATE) {
|
||||
enter_pgmcheck(cpu, PGM_PRIVILEGED);
|
||||
return 0;
|
||||
}
|
||||
sccb = env->regs[ipbh0 & 0xf];
|
||||
code = env->regs[(ipbh0 & 0xf0) >> 4];
|
||||
|
||||
@ -454,8 +446,6 @@ static int kvm_sclp_service_call(S390CPU *cpu, struct kvm_run *run,
|
||||
static int kvm_handle_css_inst(S390CPU *cpu, struct kvm_run *run,
|
||||
uint8_t ipa0, uint8_t ipa1, uint8_t ipb)
|
||||
{
|
||||
int r = 0;
|
||||
int no_cc = 0;
|
||||
CPUS390XState *env = &cpu->env;
|
||||
CPUState *cs = CPU(cpu);
|
||||
|
||||
@ -469,69 +459,61 @@ static int kvm_handle_css_inst(S390CPU *cpu, struct kvm_run *run,
|
||||
|
||||
switch (ipa1) {
|
||||
case PRIV_XSCH:
|
||||
r = ioinst_handle_xsch(env, env->regs[1]);
|
||||
ioinst_handle_xsch(cpu, env->regs[1]);
|
||||
break;
|
||||
case PRIV_CSCH:
|
||||
r = ioinst_handle_csch(env, env->regs[1]);
|
||||
ioinst_handle_csch(cpu, env->regs[1]);
|
||||
break;
|
||||
case PRIV_HSCH:
|
||||
r = ioinst_handle_hsch(env, env->regs[1]);
|
||||
ioinst_handle_hsch(cpu, env->regs[1]);
|
||||
break;
|
||||
case PRIV_MSCH:
|
||||
r = ioinst_handle_msch(env, env->regs[1], run->s390_sieic.ipb);
|
||||
ioinst_handle_msch(cpu, env->regs[1], run->s390_sieic.ipb);
|
||||
break;
|
||||
case PRIV_SSCH:
|
||||
r = ioinst_handle_ssch(env, env->regs[1], run->s390_sieic.ipb);
|
||||
ioinst_handle_ssch(cpu, env->regs[1], run->s390_sieic.ipb);
|
||||
break;
|
||||
case PRIV_STCRW:
|
||||
r = ioinst_handle_stcrw(env, run->s390_sieic.ipb);
|
||||
ioinst_handle_stcrw(cpu, run->s390_sieic.ipb);
|
||||
break;
|
||||
case PRIV_STSCH:
|
||||
r = ioinst_handle_stsch(env, env->regs[1], run->s390_sieic.ipb);
|
||||
ioinst_handle_stsch(cpu, env->regs[1], run->s390_sieic.ipb);
|
||||
break;
|
||||
case PRIV_TSCH:
|
||||
/* We should only get tsch via KVM_EXIT_S390_TSCH. */
|
||||
fprintf(stderr, "Spurious tsch intercept\n");
|
||||
break;
|
||||
case PRIV_CHSC:
|
||||
r = ioinst_handle_chsc(env, run->s390_sieic.ipb);
|
||||
ioinst_handle_chsc(cpu, run->s390_sieic.ipb);
|
||||
break;
|
||||
case PRIV_TPI:
|
||||
/* This should have been handled by kvm already. */
|
||||
fprintf(stderr, "Spurious tpi intercept\n");
|
||||
break;
|
||||
case PRIV_SCHM:
|
||||
no_cc = 1;
|
||||
r = ioinst_handle_schm(env, env->regs[1], env->regs[2],
|
||||
ioinst_handle_schm(cpu, env->regs[1], env->regs[2],
|
||||
run->s390_sieic.ipb);
|
||||
break;
|
||||
case PRIV_RSCH:
|
||||
r = ioinst_handle_rsch(env, env->regs[1]);
|
||||
ioinst_handle_rsch(cpu, env->regs[1]);
|
||||
break;
|
||||
case PRIV_RCHP:
|
||||
r = ioinst_handle_rchp(env, env->regs[1]);
|
||||
ioinst_handle_rchp(cpu, env->regs[1]);
|
||||
break;
|
||||
case PRIV_STCPS:
|
||||
/* We do not provide this instruction, it is suppressed. */
|
||||
no_cc = 1;
|
||||
r = 0;
|
||||
break;
|
||||
case PRIV_SAL:
|
||||
no_cc = 1;
|
||||
r = ioinst_handle_sal(env, env->regs[1]);
|
||||
ioinst_handle_sal(cpu, env->regs[1]);
|
||||
break;
|
||||
case PRIV_SIGA:
|
||||
/* Not provided, set CC = 3 for subchannel not operational */
|
||||
r = 3;
|
||||
setcc(cpu, 3);
|
||||
break;
|
||||
default:
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (r >= 0 && !no_cc) {
|
||||
setcc(cpu, r);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
@ -33,6 +33,7 @@
|
||||
#include "exec/softmmu_exec.h"
|
||||
#include "sysemu/cpus.h"
|
||||
#include "sysemu/sysemu.h"
|
||||
#include "hw/s390x/ebcdic.h"
|
||||
#endif
|
||||
|
||||
/* #define DEBUG_HELPER */
|
||||
@ -72,86 +73,6 @@ void HELPER(exception)(CPUS390XState *env, uint32_t excp)
|
||||
|
||||
#ifndef CONFIG_USER_ONLY
|
||||
|
||||
/* EBCDIC handling */
|
||||
static const uint8_t ebcdic2ascii[] = {
|
||||
0x00, 0x01, 0x02, 0x03, 0x07, 0x09, 0x07, 0x7F,
|
||||
0x07, 0x07, 0x07, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
|
||||
0x10, 0x11, 0x12, 0x13, 0x07, 0x0A, 0x08, 0x07,
|
||||
0x18, 0x19, 0x07, 0x07, 0x07, 0x07, 0x07, 0x07,
|
||||
0x07, 0x07, 0x1C, 0x07, 0x07, 0x0A, 0x17, 0x1B,
|
||||
0x07, 0x07, 0x07, 0x07, 0x07, 0x05, 0x06, 0x07,
|
||||
0x07, 0x07, 0x16, 0x07, 0x07, 0x07, 0x07, 0x04,
|
||||
0x07, 0x07, 0x07, 0x07, 0x14, 0x15, 0x07, 0x1A,
|
||||
0x20, 0xFF, 0x83, 0x84, 0x85, 0xA0, 0x07, 0x86,
|
||||
0x87, 0xA4, 0x5B, 0x2E, 0x3C, 0x28, 0x2B, 0x21,
|
||||
0x26, 0x82, 0x88, 0x89, 0x8A, 0xA1, 0x8C, 0x07,
|
||||
0x8D, 0xE1, 0x5D, 0x24, 0x2A, 0x29, 0x3B, 0x5E,
|
||||
0x2D, 0x2F, 0x07, 0x8E, 0x07, 0x07, 0x07, 0x8F,
|
||||
0x80, 0xA5, 0x07, 0x2C, 0x25, 0x5F, 0x3E, 0x3F,
|
||||
0x07, 0x90, 0x07, 0x07, 0x07, 0x07, 0x07, 0x07,
|
||||
0x70, 0x60, 0x3A, 0x23, 0x40, 0x27, 0x3D, 0x22,
|
||||
0x07, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67,
|
||||
0x68, 0x69, 0xAE, 0xAF, 0x07, 0x07, 0x07, 0xF1,
|
||||
0xF8, 0x6A, 0x6B, 0x6C, 0x6D, 0x6E, 0x6F, 0x70,
|
||||
0x71, 0x72, 0xA6, 0xA7, 0x91, 0x07, 0x92, 0x07,
|
||||
0xE6, 0x7E, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78,
|
||||
0x79, 0x7A, 0xAD, 0xAB, 0x07, 0x07, 0x07, 0x07,
|
||||
0x9B, 0x9C, 0x9D, 0xFA, 0x07, 0x07, 0x07, 0xAC,
|
||||
0xAB, 0x07, 0xAA, 0x7C, 0x07, 0x07, 0x07, 0x07,
|
||||
0x7B, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47,
|
||||
0x48, 0x49, 0x07, 0x93, 0x94, 0x95, 0xA2, 0x07,
|
||||
0x7D, 0x4A, 0x4B, 0x4C, 0x4D, 0x4E, 0x4F, 0x50,
|
||||
0x51, 0x52, 0x07, 0x96, 0x81, 0x97, 0xA3, 0x98,
|
||||
0x5C, 0xF6, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58,
|
||||
0x59, 0x5A, 0xFD, 0x07, 0x99, 0x07, 0x07, 0x07,
|
||||
0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37,
|
||||
0x38, 0x39, 0x07, 0x07, 0x9A, 0x07, 0x07, 0x07,
|
||||
};
|
||||
|
||||
static const uint8_t ascii2ebcdic[] = {
|
||||
0x00, 0x01, 0x02, 0x03, 0x37, 0x2D, 0x2E, 0x2F,
|
||||
0x16, 0x05, 0x15, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
|
||||
0x10, 0x11, 0x12, 0x13, 0x3C, 0x3D, 0x32, 0x26,
|
||||
0x18, 0x19, 0x3F, 0x27, 0x22, 0x1D, 0x1E, 0x1F,
|
||||
0x40, 0x5A, 0x7F, 0x7B, 0x5B, 0x6C, 0x50, 0x7D,
|
||||
0x4D, 0x5D, 0x5C, 0x4E, 0x6B, 0x60, 0x4B, 0x61,
|
||||
0xF0, 0xF1, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7,
|
||||
0xF8, 0xF9, 0x7A, 0x5E, 0x4C, 0x7E, 0x6E, 0x6F,
|
||||
0x7C, 0xC1, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7,
|
||||
0xC8, 0xC9, 0xD1, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6,
|
||||
0xD7, 0xD8, 0xD9, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6,
|
||||
0xE7, 0xE8, 0xE9, 0xBA, 0xE0, 0xBB, 0xB0, 0x6D,
|
||||
0x79, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87,
|
||||
0x88, 0x89, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96,
|
||||
0x97, 0x98, 0x99, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6,
|
||||
0xA7, 0xA8, 0xA9, 0xC0, 0x4F, 0xD0, 0xA1, 0x07,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x59, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
|
||||
0x90, 0x3F, 0x3F, 0x3F, 0x3F, 0xEA, 0x3F, 0xFF
|
||||
};
|
||||
|
||||
static inline void ebcdic_put(uint8_t *p, const char *ascii, int len)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < len; i++) {
|
||||
p[i] = ascii2ebcdic[(uint8_t)ascii[i]];
|
||||
}
|
||||
}
|
||||
|
||||
void program_interrupt(CPUS390XState *env, uint32_t code, int ilen)
|
||||
{
|
||||
qemu_log_mask(CPU_LOG_INT, "program interrupt at %#" PRIx64 "\n",
|
||||
@ -192,6 +113,29 @@ static void cpu_reset_all(void)
|
||||
}
|
||||
}
|
||||
|
||||
static void cpu_full_reset_all(void)
|
||||
{
|
||||
CPUState *cpu;
|
||||
|
||||
CPU_FOREACH(cpu) {
|
||||
cpu_reset(cpu);
|
||||
}
|
||||
}
|
||||
|
||||
static int modified_clear_reset(S390CPU *cpu)
|
||||
{
|
||||
S390CPUClass *scc = S390_CPU_GET_CLASS(cpu);
|
||||
|
||||
pause_all_vcpus();
|
||||
cpu_synchronize_all_states();
|
||||
cpu_full_reset_all();
|
||||
io_subsystem_reset();
|
||||
scc->load_normal(CPU(cpu));
|
||||
cpu_synchronize_all_post_reset();
|
||||
resume_all_vcpus();
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int load_normal_reset(S390CPU *cpu)
|
||||
{
|
||||
S390CPUClass *scc = S390_CPU_GET_CLASS(cpu);
|
||||
@ -225,6 +169,9 @@ void handle_diag_308(CPUS390XState *env, uint64_t r1, uint64_t r3)
|
||||
}
|
||||
|
||||
switch (subcode) {
|
||||
case 0:
|
||||
modified_clear_reset(s390_env_get_cpu(env));
|
||||
break;
|
||||
case 1:
|
||||
load_normal_reset(s390_env_get_cpu(env));
|
||||
break;
|
||||
|
Loading…
Reference in New Issue
Block a user