| /* |
| * 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); |
| } |