1 files changed, 67 insertions, 0 deletions

diff --git a/arch/s390/kvm/diag.c b/arch/s390/kvm/diag.c
new file mode 100644
index 000000000000..f639a152869f
--- /dev/null
+++ b/arch/s390/kvm/diag.c
@@ -0,0 +1,67 @@
+/*
+ * diag.c - handling diagnose instructions
+ *
+ * Copyright IBM Corp. 2008
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License (version 2 only)
+ * as published by the Free Software Foundation.
+ *
+ *    Author(s): Carsten Otte <cotte@de.ibm.com>
+ *               Christian Borntraeger <borntraeger@de.ibm.com>
+ */
+
+#include <linux/kvm.h>
+#include <linux/kvm_host.h>
+#include "kvm-s390.h"
+
+static int __diag_time_slice_end(struct kvm_vcpu *vcpu)
+{
+        VCPU_EVENT(vcpu, 5, "%s", "diag time slice end");
+        vcpu->stat.diagnose_44++;
+        vcpu_put(vcpu);
+        schedule();
+        vcpu_load(vcpu);
+        return 0;
+}
+
+static int __diag_ipl_functions(struct kvm_vcpu *vcpu)
+{
+        unsigned int reg = vcpu->arch.sie_block->ipa & 0xf;
+        unsigned long subcode = vcpu->arch.guest_gprs[reg] & 0xffff;
+
+        VCPU_EVENT(vcpu, 5, "diag ipl functions, subcode %lx", subcode);
+        switch (subcode) {
+        case 3:
+                vcpu->run->s390_reset_flags = KVM_S390_RESET_CLEAR;
+                break;
+        case 4:
+                vcpu->run->s390_reset_flags = 0;
+                break;
+        default:
+                return -ENOTSUPP;
+        }
+
+        atomic_clear_mask(CPUSTAT_RUNNING, &vcpu->arch.sie_block->cpuflags);
+        vcpu->run->s390_reset_flags |= KVM_S390_RESET_SUBSYSTEM;
+        vcpu->run->s390_reset_flags |= KVM_S390_RESET_IPL;
+        vcpu->run->s390_reset_flags |= KVM_S390_RESET_CPU_INIT;
+        vcpu->run->exit_reason = KVM_EXIT_S390_RESET;
+        VCPU_EVENT(vcpu, 3, "requesting userspace resets %lx",
+          vcpu->run->s390_reset_flags);
+        return -EREMOTE;
+}
+
+int kvm_s390_handle_diag(struct kvm_vcpu *vcpu)
+{
+        int code = (vcpu->arch.sie_block->ipb & 0xfff0000) >> 16;
+
+        switch (code) {
+        case 0x44:
+                return __diag_time_slice_end(vcpu);
+        case 0x308:
+                return __diag_ipl_functions(vcpu);
+        default:
+                return -ENOTSUPP;
+        }
+}