|
@@ -16,6 +16,25 @@
|
|
|
#include "hw/s390x/ioinst.h"
|
|
|
#include "trace.h"
|
|
|
#include "hw/s390x/s390-pci-bus.h"
|
|
|
+#include "hw/s390x/pv.h"
|
|
|
+
|
|
|
+/* All I/O instructions but chsc use the s format */
|
|
|
+static uint64_t get_address_from_regs(CPUS390XState *env, uint32_t ipb,
|
|
|
+ uint8_t *ar)
|
|
|
+{
|
|
|
+ /*
|
|
|
+ * Addresses for protected guests are all offsets into the
|
|
|
+ * satellite block which holds the IO control structures. Those
|
|
|
+ * control structures are always starting at offset 0 and are
|
|
|
+ * always aligned and accessible. So we can return 0 here which
|
|
|
+ * will pass the following address checks.
|
|
|
+ */
|
|
|
+ if (s390_is_pv()) {
|
|
|
+ *ar = 0;
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+ return decode_basedisp_s(env, ipb, ar);
|
|
|
+}
|
|
|
|
|
|
int ioinst_disassemble_sch_ident(uint32_t value, int *m, int *cssid, int *ssid,
|
|
|
int *schid)
|
|
@@ -114,12 +133,14 @@ void ioinst_handle_msch(S390CPU *cpu, uint64_t reg1, uint32_t ipb, uintptr_t ra)
|
|
|
CPUS390XState *env = &cpu->env;
|
|
|
uint8_t ar;
|
|
|
|
|
|
- addr = decode_basedisp_s(env, ipb, &ar);
|
|
|
+ addr = get_address_from_regs(env, ipb, &ar);
|
|
|
if (addr & 3) {
|
|
|
s390_program_interrupt(env, PGM_SPECIFICATION, ra);
|
|
|
return;
|
|
|
}
|
|
|
- if (s390_cpu_virt_mem_read(cpu, addr, ar, &schib, sizeof(schib))) {
|
|
|
+ if (s390_is_pv()) {
|
|
|
+ s390_cpu_pv_mem_read(cpu, addr, &schib, sizeof(schib));
|
|
|
+ } else if (s390_cpu_virt_mem_read(cpu, addr, ar, &schib, sizeof(schib))) {
|
|
|
s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
return;
|
|
|
}
|
|
@@ -171,12 +192,14 @@ void ioinst_handle_ssch(S390CPU *cpu, uint64_t reg1, uint32_t ipb, uintptr_t ra)
|
|
|
CPUS390XState *env = &cpu->env;
|
|
|
uint8_t ar;
|
|
|
|
|
|
- addr = decode_basedisp_s(env, ipb, &ar);
|
|
|
+ addr = get_address_from_regs(env, ipb, &ar);
|
|
|
if (addr & 3) {
|
|
|
s390_program_interrupt(env, PGM_SPECIFICATION, ra);
|
|
|
return;
|
|
|
}
|
|
|
- if (s390_cpu_virt_mem_read(cpu, addr, ar, &orig_orb, sizeof(orb))) {
|
|
|
+ if (s390_is_pv()) {
|
|
|
+ s390_cpu_pv_mem_read(cpu, addr, &orig_orb, sizeof(orb));
|
|
|
+ } else if (s390_cpu_virt_mem_read(cpu, addr, ar, &orig_orb, sizeof(orb))) {
|
|
|
s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
return;
|
|
|
}
|
|
@@ -203,7 +226,7 @@ void ioinst_handle_stcrw(S390CPU *cpu, uint32_t ipb, uintptr_t ra)
|
|
|
CPUS390XState *env = &cpu->env;
|
|
|
uint8_t ar;
|
|
|
|
|
|
- addr = decode_basedisp_s(env, ipb, &ar);
|
|
|
+ addr = get_address_from_regs(env, ipb, &ar);
|
|
|
if (addr & 3) {
|
|
|
s390_program_interrupt(env, PGM_SPECIFICATION, ra);
|
|
|
return;
|
|
@@ -212,14 +235,19 @@ void ioinst_handle_stcrw(S390CPU *cpu, uint32_t ipb, uintptr_t ra)
|
|
|
cc = css_do_stcrw(&crw);
|
|
|
/* 0 - crw stored, 1 - zeroes stored */
|
|
|
|
|
|
- if (s390_cpu_virt_mem_write(cpu, addr, ar, &crw, sizeof(crw)) == 0) {
|
|
|
+ if (s390_is_pv()) {
|
|
|
+ s390_cpu_pv_mem_write(cpu, addr, &crw, sizeof(crw));
|
|
|
setcc(cpu, cc);
|
|
|
} else {
|
|
|
- if (cc == 0) {
|
|
|
- /* Write failed: requeue CRW since STCRW is suppressing */
|
|
|
- css_undo_stcrw(&crw);
|
|
|
+ if (s390_cpu_virt_mem_write(cpu, addr, ar, &crw, sizeof(crw)) == 0) {
|
|
|
+ setcc(cpu, cc);
|
|
|
+ } else {
|
|
|
+ if (cc == 0) {
|
|
|
+ /* Write failed: requeue CRW since STCRW is suppressing */
|
|
|
+ css_undo_stcrw(&crw);
|
|
|
+ }
|
|
|
+ s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
}
|
|
|
- s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -234,13 +262,20 @@ void ioinst_handle_stsch(S390CPU *cpu, uint64_t reg1, uint32_t ipb,
|
|
|
CPUS390XState *env = &cpu->env;
|
|
|
uint8_t ar;
|
|
|
|
|
|
- addr = decode_basedisp_s(env, ipb, &ar);
|
|
|
+ addr = get_address_from_regs(env, ipb, &ar);
|
|
|
if (addr & 3) {
|
|
|
s390_program_interrupt(env, PGM_SPECIFICATION, ra);
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
if (ioinst_disassemble_sch_ident(reg1, &m, &cssid, &ssid, &schid)) {
|
|
|
+ /*
|
|
|
+ * The Ultravisor checks schid bit 16 to be one and bits 0-12
|
|
|
+ * to be 0 and injects a operand exception itself.
|
|
|
+ *
|
|
|
+ * Hence we should never end up here.
|
|
|
+ */
|
|
|
+ g_assert(!s390_is_pv());
|
|
|
/*
|
|
|
* As operand exceptions have a lower priority than access exceptions,
|
|
|
* we check whether the memory area is writeable (injecting the
|
|
@@ -273,14 +308,17 @@ void ioinst_handle_stsch(S390CPU *cpu, uint64_t reg1, uint32_t ipb,
|
|
|
}
|
|
|
}
|
|
|
if (cc != 3) {
|
|
|
- if (s390_cpu_virt_mem_write(cpu, addr, ar, &schib,
|
|
|
- sizeof(schib)) != 0) {
|
|
|
+ if (s390_is_pv()) {
|
|
|
+ s390_cpu_pv_mem_write(cpu, addr, &schib, sizeof(schib));
|
|
|
+ } else if (s390_cpu_virt_mem_write(cpu, addr, ar, &schib,
|
|
|
+ sizeof(schib)) != 0) {
|
|
|
s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
return;
|
|
|
}
|
|
|
} else {
|
|
|
/* Access exceptions have a higher priority than cc3 */
|
|
|
- if (s390_cpu_virt_mem_check_write(cpu, addr, ar, sizeof(schib)) != 0) {
|
|
|
+ if (!s390_is_pv() &&
|
|
|
+ s390_cpu_virt_mem_check_write(cpu, addr, ar, sizeof(schib)) != 0) {
|
|
|
s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
return;
|
|
|
}
|
|
@@ -303,7 +341,7 @@ int ioinst_handle_tsch(S390CPU *cpu, uint64_t reg1, uint32_t ipb, uintptr_t ra)
|
|
|
return -EIO;
|
|
|
}
|
|
|
trace_ioinst_sch_id("tsch", cssid, ssid, schid);
|
|
|
- addr = decode_basedisp_s(env, ipb, &ar);
|
|
|
+ addr = get_address_from_regs(env, ipb, &ar);
|
|
|
if (addr & 3) {
|
|
|
s390_program_interrupt(env, PGM_SPECIFICATION, ra);
|
|
|
return -EIO;
|
|
@@ -317,7 +355,9 @@ int ioinst_handle_tsch(S390CPU *cpu, uint64_t reg1, uint32_t ipb, uintptr_t ra)
|
|
|
}
|
|
|
/* 0 - status pending, 1 - not status pending, 3 - not operational */
|
|
|
if (cc != 3) {
|
|
|
- if (s390_cpu_virt_mem_write(cpu, addr, ar, &irb, irb_len) != 0) {
|
|
|
+ if (s390_is_pv()) {
|
|
|
+ s390_cpu_pv_mem_write(cpu, addr, &irb, irb_len);
|
|
|
+ } else if (s390_cpu_virt_mem_write(cpu, addr, ar, &irb, irb_len) != 0) {
|
|
|
s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
return -EFAULT;
|
|
|
}
|
|
@@ -325,7 +365,8 @@ int ioinst_handle_tsch(S390CPU *cpu, uint64_t reg1, uint32_t ipb, uintptr_t ra)
|
|
|
} else {
|
|
|
irb_len = sizeof(irb) - sizeof(irb.emw);
|
|
|
/* Access exceptions have a higher priority than cc3 */
|
|
|
- if (s390_cpu_virt_mem_check_write(cpu, addr, ar, irb_len) != 0) {
|
|
|
+ if (!s390_is_pv() &&
|
|
|
+ s390_cpu_virt_mem_check_write(cpu, addr, ar, irb_len) != 0) {
|
|
|
s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
return -EFAULT;
|
|
|
}
|
|
@@ -601,7 +642,7 @@ void ioinst_handle_chsc(S390CPU *cpu, uint32_t ipb, uintptr_t ra)
|
|
|
{
|
|
|
ChscReq *req;
|
|
|
ChscResp *res;
|
|
|
- uint64_t addr;
|
|
|
+ uint64_t addr = 0;
|
|
|
int reg;
|
|
|
uint16_t len;
|
|
|
uint16_t command;
|
|
@@ -610,7 +651,9 @@ void ioinst_handle_chsc(S390CPU *cpu, uint32_t ipb, uintptr_t ra)
|
|
|
|
|
|
trace_ioinst("chsc");
|
|
|
reg = (ipb >> 20) & 0x00f;
|
|
|
- addr = env->regs[reg];
|
|
|
+ if (!s390_is_pv()) {
|
|
|
+ addr = env->regs[reg];
|
|
|
+ }
|
|
|
/* Page boundary? */
|
|
|
if (addr & 0xfff) {
|
|
|
s390_program_interrupt(env, PGM_SPECIFICATION, ra);
|
|
@@ -621,7 +664,9 @@ void ioinst_handle_chsc(S390CPU *cpu, uint32_t ipb, uintptr_t ra)
|
|
|
* present CHSC sub-handlers ... if we ever need more, we should take
|
|
|
* care of req->len here first.
|
|
|
*/
|
|
|
- if (s390_cpu_virt_mem_read(cpu, addr, reg, buf, sizeof(ChscReq))) {
|
|
|
+ if (s390_is_pv()) {
|
|
|
+ s390_cpu_pv_mem_read(cpu, addr, buf, sizeof(ChscReq));
|
|
|
+ } else if (s390_cpu_virt_mem_read(cpu, addr, reg, buf, sizeof(ChscReq))) {
|
|
|
s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
return;
|
|
|
}
|
|
@@ -654,11 +699,16 @@ void ioinst_handle_chsc(S390CPU *cpu, uint32_t ipb, uintptr_t ra)
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
- if (!s390_cpu_virt_mem_write(cpu, addr + len, reg, res,
|
|
|
- be16_to_cpu(res->len))) {
|
|
|
+ if (s390_is_pv()) {
|
|
|
+ s390_cpu_pv_mem_write(cpu, addr + len, res, be16_to_cpu(res->len));
|
|
|
setcc(cpu, 0); /* Command execution complete */
|
|
|
} else {
|
|
|
- s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
+ if (!s390_cpu_virt_mem_write(cpu, addr + len, reg, res,
|
|
|
+ be16_to_cpu(res->len))) {
|
|
|
+ setcc(cpu, 0); /* Command execution complete */
|
|
|
+ } else {
|
|
|
+ s390_cpu_virt_mem_handle_exc(cpu, ra);
|
|
|
+ }
|
|
|
}
|
|
|
}
|
|
|
|