Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 1 | /* |
| 2 | * diag.c - handling diagnose instructions |
| 3 | * |
Christian Borntraeger | 388186b | 2011-10-30 15:17:03 +0100 | [diff] [blame] | 4 | * Copyright IBM Corp. 2008,2011 |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License (version 2 only) |
| 8 | * as published by the Free Software Foundation. |
| 9 | * |
| 10 | * Author(s): Carsten Otte <cotte@de.ibm.com> |
| 11 | * Christian Borntraeger <borntraeger@de.ibm.com> |
| 12 | */ |
| 13 | |
| 14 | #include <linux/kvm.h> |
| 15 | #include <linux/kvm_host.h> |
| 16 | #include "kvm-s390.h" |
| 17 | |
Christian Borntraeger | 388186b | 2011-10-30 15:17:03 +0100 | [diff] [blame] | 18 | static int diag_release_pages(struct kvm_vcpu *vcpu) |
| 19 | { |
| 20 | unsigned long start, end; |
| 21 | unsigned long prefix = vcpu->arch.sie_block->prefix; |
| 22 | |
Christian Borntraeger | 5a32c1a | 2012-01-11 11:20:32 +0100 | [diff] [blame] | 23 | start = vcpu->run->s.regs.gprs[(vcpu->arch.sie_block->ipa & 0xf0) >> 4]; |
| 24 | end = vcpu->run->s.regs.gprs[vcpu->arch.sie_block->ipa & 0xf] + 4096; |
Christian Borntraeger | 388186b | 2011-10-30 15:17:03 +0100 | [diff] [blame] | 25 | |
| 26 | if (start & ~PAGE_MASK || end & ~PAGE_MASK || start > end |
| 27 | || start < 2 * PAGE_SIZE) |
| 28 | return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION); |
| 29 | |
| 30 | VCPU_EVENT(vcpu, 5, "diag release pages %lX %lX", start, end); |
| 31 | vcpu->stat.diagnose_10++; |
| 32 | |
| 33 | /* we checked for start > end above */ |
| 34 | if (end < prefix || start >= prefix + 2 * PAGE_SIZE) { |
| 35 | gmap_discard(start, end, vcpu->arch.gmap); |
| 36 | } else { |
| 37 | if (start < prefix) |
| 38 | gmap_discard(start, prefix, vcpu->arch.gmap); |
| 39 | if (end >= prefix) |
| 40 | gmap_discard(prefix + 2 * PAGE_SIZE, |
| 41 | end, vcpu->arch.gmap); |
| 42 | } |
| 43 | return 0; |
| 44 | } |
| 45 | |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 46 | static int __diag_time_slice_end(struct kvm_vcpu *vcpu) |
| 47 | { |
| 48 | VCPU_EVENT(vcpu, 5, "%s", "diag time slice end"); |
| 49 | vcpu->stat.diagnose_44++; |
Christian Borntraeger | 8733ac3 | 2012-04-25 15:30:39 +0200 | [diff] [blame^] | 50 | kvm_vcpu_on_spin(vcpu); |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 51 | return 0; |
| 52 | } |
| 53 | |
Konstantin Weitz | 41628d3 | 2012-04-25 15:30:38 +0200 | [diff] [blame] | 54 | static int __diag_time_slice_end_directed(struct kvm_vcpu *vcpu) |
| 55 | { |
| 56 | struct kvm *kvm = vcpu->kvm; |
| 57 | struct kvm_vcpu *tcpu; |
| 58 | int tid; |
| 59 | int i; |
| 60 | |
| 61 | tid = vcpu->run->s.regs.gprs[(vcpu->arch.sie_block->ipa & 0xf0) >> 4]; |
| 62 | vcpu->stat.diagnose_9c++; |
| 63 | VCPU_EVENT(vcpu, 5, "diag time slice end directed to %d", tid); |
| 64 | |
| 65 | if (tid == vcpu->vcpu_id) |
| 66 | return 0; |
| 67 | |
| 68 | kvm_for_each_vcpu(i, tcpu, kvm) |
| 69 | if (tcpu->vcpu_id == tid) { |
| 70 | kvm_vcpu_yield_to(tcpu); |
| 71 | break; |
| 72 | } |
| 73 | |
| 74 | return 0; |
| 75 | } |
| 76 | |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 77 | static int __diag_ipl_functions(struct kvm_vcpu *vcpu) |
| 78 | { |
| 79 | unsigned int reg = vcpu->arch.sie_block->ipa & 0xf; |
Christian Borntraeger | 5a32c1a | 2012-01-11 11:20:32 +0100 | [diff] [blame] | 80 | unsigned long subcode = vcpu->run->s.regs.gprs[reg] & 0xffff; |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 81 | |
| 82 | VCPU_EVENT(vcpu, 5, "diag ipl functions, subcode %lx", subcode); |
| 83 | switch (subcode) { |
| 84 | case 3: |
| 85 | vcpu->run->s390_reset_flags = KVM_S390_RESET_CLEAR; |
| 86 | break; |
| 87 | case 4: |
| 88 | vcpu->run->s390_reset_flags = 0; |
| 89 | break; |
| 90 | default: |
Heiko Carstens | b8e660b | 2010-02-26 22:37:41 +0100 | [diff] [blame] | 91 | return -EOPNOTSUPP; |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 92 | } |
| 93 | |
Cornelia Huck | 9e6dabe | 2011-11-17 11:00:41 +0100 | [diff] [blame] | 94 | atomic_set_mask(CPUSTAT_STOPPED, &vcpu->arch.sie_block->cpuflags); |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 95 | vcpu->run->s390_reset_flags |= KVM_S390_RESET_SUBSYSTEM; |
| 96 | vcpu->run->s390_reset_flags |= KVM_S390_RESET_IPL; |
| 97 | vcpu->run->s390_reset_flags |= KVM_S390_RESET_CPU_INIT; |
| 98 | vcpu->run->exit_reason = KVM_EXIT_S390_RESET; |
Heiko Carstens | 33e1911 | 2009-01-09 12:14:56 +0100 | [diff] [blame] | 99 | VCPU_EVENT(vcpu, 3, "requesting userspace resets %llx", |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 100 | vcpu->run->s390_reset_flags); |
| 101 | return -EREMOTE; |
| 102 | } |
| 103 | |
| 104 | int kvm_s390_handle_diag(struct kvm_vcpu *vcpu) |
| 105 | { |
| 106 | int code = (vcpu->arch.sie_block->ipb & 0xfff0000) >> 16; |
| 107 | |
| 108 | switch (code) { |
Christian Borntraeger | 388186b | 2011-10-30 15:17:03 +0100 | [diff] [blame] | 109 | case 0x10: |
| 110 | return diag_release_pages(vcpu); |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 111 | case 0x44: |
| 112 | return __diag_time_slice_end(vcpu); |
Konstantin Weitz | 41628d3 | 2012-04-25 15:30:38 +0200 | [diff] [blame] | 113 | case 0x9c: |
| 114 | return __diag_time_slice_end_directed(vcpu); |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 115 | case 0x308: |
| 116 | return __diag_ipl_functions(vcpu); |
| 117 | default: |
Heiko Carstens | b8e660b | 2010-02-26 22:37:41 +0100 | [diff] [blame] | 118 | return -EOPNOTSUPP; |
Christian Borntraeger | e28acfe | 2008-03-25 18:47:34 +0100 | [diff] [blame] | 119 | } |
| 120 | } |