Archipelago » qemu

/*

 * SCLP Support

 *

 * Copyright IBM, Corp. 2012

 *

 * Authors:

 *  Christian Borntraeger <borntraeger@de.ibm.com>

 *  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 "cpu.h"

#include "sysemu/kvm.h"

#include "exec/memory.h"

#include "sysemu/sysemu.h"

#include "hw/s390x/sclp.h"

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

static inline SCLPEventFacility *get_event_facility(void)

{

    ObjectProperty *op = object_property_find(qdev_get_machine(),

                                              TYPE_SCLP_EVENT_FACILITY,

                                              NULL);

    assert(op);

    return op->opaque;

}

/* Provide information about the configuration, CPUs and storage */

static void read_SCP_info(SCCB *sccb)

{

    ReadInfo *read_info = (ReadInfo *) sccb;

    CPUState *cpu;

    int shift = 0;

    int cpu_count = 0;

    int i = 0;

    CPU_FOREACH(cpu) {

        cpu_count++;

    }

    /* CPU information */

    read_info->entries_cpu = cpu_to_be16(cpu_count);

    read_info->offset_cpu = cpu_to_be16(offsetof(ReadInfo, entries));

    read_info->highest_cpu = cpu_to_be16(max_cpus);

    for (i = 0; i < cpu_count; i++) {

        read_info->entries[i].address = i;

        read_info->entries[i].type = 0;

    }

    read_info->facilities = cpu_to_be64(SCLP_HAS_CPU_INFO);

    while ((ram_size >> (20 + shift)) > 65535) {

        shift++;

    }

    read_info->rnmax = cpu_to_be16(ram_size >> (20 + shift));

    read_info->rnsize = 1 << shift;

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

}

/* Provide information about the CPU */

static void sclp_read_cpu_info(SCCB *sccb)

{

    ReadCpuInfo *cpu_info = (ReadCpuInfo *) sccb;

    CPUState *cpu;

    int cpu_count = 0;

    int i = 0;

    CPU_FOREACH(cpu) {

        cpu_count++;

    }

    cpu_info->nr_configured = cpu_to_be16(cpu_count);

    cpu_info->offset_configured = cpu_to_be16(offsetof(ReadCpuInfo, entries));

    cpu_info->nr_standby = cpu_to_be16(0);

    /* The standby offset is 16-byte for each CPU */

    cpu_info->offset_standby = cpu_to_be16(cpu_info->offset_configured

        + cpu_info->nr_configured*sizeof(CPUEntry));

    for (i = 0; i < cpu_count; i++) {

        cpu_info->entries[i].address = i;

        cpu_info->entries[i].type = 0;

    }

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

}

static void sclp_execute(SCCB *sccb, uint32_t code)

{

    SCLPEventFacility *ef = get_event_facility();

    SCLPEventFacilityClass *efc = EVENT_FACILITY_GET_CLASS(ef);

    switch (code & SCLP_CMD_CODE_MASK) {

    case SCLP_CMDW_READ_SCP_INFO:

    case SCLP_CMDW_READ_SCP_INFO_FORCED:

        read_SCP_info(sccb);

        break;

    case SCLP_CMDW_READ_CPU_INFO:

        sclp_read_cpu_info(sccb);

        break;

    default:

        efc->command_handler(ef, sccb, code);

        break;

    }

}

int sclp_service_call(CPUS390XState *env, uint64_t sccb, uint32_t code)

{

    int r = 0;

    SCCB work_sccb;

    hwaddr sccb_len = sizeof(SCCB);

    /* first some basic checks on program checks */

    if (env->psw.mask & PSW_MASK_PSTATE) {

        r = -PGM_PRIVILEGED;

        goto out;

    }

    if (cpu_physical_memory_is_io(sccb)) {

        r = -PGM_ADDRESSING;

        goto out;

    }

    if ((sccb & ~0x1fffUL) == 0 || (sccb & ~0x1fffUL) == env->psa

        || (sccb & ~0x7ffffff8UL) != 0) {

        r = -PGM_SPECIFICATION;

        goto out;

    }

    /*

     * we want to work on a private copy of the sccb, to prevent guests

     * from playing dirty tricks by modifying the memory content after

     * the host has checked the values

     */

    cpu_physical_memory_read(sccb, &work_sccb, sccb_len);

    /* Valid sccb sizes */

    if (be16_to_cpu(work_sccb.h.length) < sizeof(SCCBHeader) ||

        be16_to_cpu(work_sccb.h.length) > SCCB_SIZE) {

        r = -PGM_SPECIFICATION;

        goto out;

    }

    sclp_execute((SCCB *)&work_sccb, code);

    cpu_physical_memory_write(sccb, &work_sccb,

                              be16_to_cpu(work_sccb.h.length));

    sclp_service_interrupt(sccb);

out:

    return r;

}

void sclp_service_interrupt(uint32_t sccb)

{

    SCLPEventFacility *ef = get_event_facility();

    SCLPEventFacilityClass *efc = EVENT_FACILITY_GET_CLASS(ef);

    uint32_t param = sccb & ~3;

    /* Indicate whether an event is still pending */

    param |= efc->event_pending(ef) ? 1 : 0;

    if (!param) {

        /* No need to send an interrupt, there's nothing to be notified about */

        return;

    }

    s390_sclp_extint(param);

}

/* qemu object creation and initialization functions */

void s390_sclp_init(void)

{

    DeviceState *dev  = qdev_create(NULL, TYPE_SCLP_EVENT_FACILITY);

    object_property_add_child(qdev_get_machine(), TYPE_SCLP_EVENT_FACILITY,

                              OBJECT(dev), NULL);

    qdev_init_nofail(dev);

}