err.no Git - linux-2.6/blob - arch/s390/kvm/priv.c

   1 /*
   2  * priv.c - handling privileged instructions
   3  *
   4  * Copyright IBM Corp. 2008
   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/errno.h>
  16 #include <asm/current.h>
  17 #include <asm/debug.h>
  18 #include <asm/ebcdic.h>
  19 #include <asm/sysinfo.h>
  20 #include "gaccess.h"
  21 #include "kvm-s390.h"
  22
  23 static int handle_set_prefix(struct kvm_vcpu *vcpu)
  24 {
  25         int base2 = vcpu->arch.sie_block->ipb >> 28;
  26         int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
  27         u64 operand2;
  28         u32 address = 0;
  29         u8 tmp;
  30
  31         vcpu->stat.instruction_spx++;
  32
  33         operand2 = disp2;
  34         if (base2)
  35                 operand2 += vcpu->arch.guest_gprs[base2];
  36
  37         /* must be word boundary */
  38         if (operand2 & 3) {
  39                 kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
  40                 goto out;
  41         }
  42
  43         /* get the value */
  44         if (get_guest_u32(vcpu, operand2, &address)) {
  45                 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
  46                 goto out;
  47         }
  48
  49         address = address & 0x7fffe000u;
  50
  51         /* make sure that the new value is valid memory */
  52         if (copy_from_guest_absolute(vcpu, &tmp, address, 1) ||
  53            (copy_from_guest_absolute(vcpu, &tmp, address + PAGE_SIZE, 1))) {
  54                 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
  55                 goto out;
  56         }
  57
  58         vcpu->arch.sie_block->prefix = address;
  59         vcpu->arch.sie_block->ihcpu = 0xffff;
  60
  61         VCPU_EVENT(vcpu, 5, "setting prefix to %x", address);
  62 out:
  63         return 0;
  64 }
  65
  66 static int handle_store_prefix(struct kvm_vcpu *vcpu)
  67 {
  68         int base2 = vcpu->arch.sie_block->ipb >> 28;
  69         int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
  70         u64 operand2;
  71         u32 address;
  72
  73         vcpu->stat.instruction_stpx++;
  74         operand2 = disp2;
  75         if (base2)
  76                 operand2 += vcpu->arch.guest_gprs[base2];
  77
  78         /* must be word boundary */
  79         if (operand2 & 3) {
  80                 kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
  81                 goto out;
  82         }
  83
  84         address = vcpu->arch.sie_block->prefix;
  85         address = address & 0x7fffe000u;
  86
  87         /* get the value */
  88         if (put_guest_u32(vcpu, operand2, address)) {
  89                 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
  90                 goto out;
  91         }
  92
  93         VCPU_EVENT(vcpu, 5, "storing prefix to %x", address);
  94 out:
  95         return 0;
  96 }
  97
  98 static int handle_store_cpu_address(struct kvm_vcpu *vcpu)
  99 {
 100         int base2 = vcpu->arch.sie_block->ipb >> 28;
 101         int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
 102         u64 useraddr;
 103         int rc;
 104
 105         vcpu->stat.instruction_stap++;
 106         useraddr = disp2;
 107         if (base2)
 108                 useraddr += vcpu->arch.guest_gprs[base2];
 109
 110         if (useraddr & 1) {
 111                 kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
 112                 goto out;
 113         }
 114
 115         rc = put_guest_u16(vcpu, useraddr, vcpu->vcpu_id);
 116         if (rc == -EFAULT) {
 117                 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
 118                 goto out;
 119         }
 120
 121         VCPU_EVENT(vcpu, 5, "storing cpu address to %lx", useraddr);
 122 out:
 123         return 0;
 124 }
 125
 126 static int handle_skey(struct kvm_vcpu *vcpu)
 127 {
 128         vcpu->stat.instruction_storage_key++;
 129         vcpu->arch.sie_block->gpsw.addr -= 4;
 130         VCPU_EVENT(vcpu, 4, "%s", "retrying storage key operation");
 131         return 0;
 132 }
 133
 134 static int handle_stsch(struct kvm_vcpu *vcpu)
 135 {
 136         vcpu->stat.instruction_stsch++;
 137         VCPU_EVENT(vcpu, 4, "%s", "store subchannel - CC3");
 138         /* condition code 3 */
 139         vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
 140         vcpu->arch.sie_block->gpsw.mask |= (3 & 3ul) << 44;
 141         return 0;
 142 }
 143
 144 static int handle_chsc(struct kvm_vcpu *vcpu)
 145 {
 146         vcpu->stat.instruction_chsc++;
 147         VCPU_EVENT(vcpu, 4, "%s", "channel subsystem call - CC3");
 148         /* condition code 3 */
 149         vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
 150         vcpu->arch.sie_block->gpsw.mask |= (3 & 3ul) << 44;
 151         return 0;
 152 }
 153
 154 static unsigned int kvm_stfl(void)
 155 {
 156         asm volatile(
 157                 "       .insn   s,0xb2b10000,0(0)\n" /* stfl */
 158                 "0:\n"
 159                 EX_TABLE(0b, 0b));
 160         return S390_lowcore.stfl_fac_list;
 161 }
 162
 163 static int handle_stfl(struct kvm_vcpu *vcpu)
 164 {
 165         unsigned int facility_list = kvm_stfl();
 166         int rc;
 167
 168         vcpu->stat.instruction_stfl++;
 169         facility_list &= ~(1UL<<24); /* no stfle */
 170
 171         rc = copy_to_guest(vcpu, offsetof(struct _lowcore, stfl_fac_list),
 172                            &facility_list, sizeof(facility_list));
 173         if (rc == -EFAULT)
 174                 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
 175         else
 176                 VCPU_EVENT(vcpu, 5, "store facility list value %x",
 177                            facility_list);
 178         return 0;
 179 }
 180
 181 static int handle_stidp(struct kvm_vcpu *vcpu)
 182 {
 183         int base2 = vcpu->arch.sie_block->ipb >> 28;
 184         int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
 185         u64 operand2;
 186         int rc;
 187
 188         vcpu->stat.instruction_stidp++;
 189         operand2 = disp2;
 190         if (base2)
 191                 operand2 += vcpu->arch.guest_gprs[base2];
 192
 193         if (operand2 & 7) {
 194                 kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
 195                 goto out;
 196         }
 197
 198         rc = put_guest_u64(vcpu, operand2, vcpu->arch.stidp_data);
 199         if (rc == -EFAULT) {
 200                 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
 201                 goto out;
 202         }
 203
 204         VCPU_EVENT(vcpu, 5, "%s", "store cpu id");
 205 out:
 206         return 0;
 207 }
 208
 209 static void handle_stsi_3_2_2(struct kvm_vcpu *vcpu, struct sysinfo_3_2_2 *mem)
 210 {
 211         struct float_interrupt *fi = &vcpu->kvm->arch.float_int;
 212         int cpus = 0;
 213         int n;
 214
 215         spin_lock_bh(&fi->lock);
 216         for (n = 0; n < KVM_MAX_VCPUS; n++)
 217                 if (fi->local_int[n])
 218                         cpus++;
 219         spin_unlock_bh(&fi->lock);
 220
 221         /* deal with other level 3 hypervisors */
 222         if (stsi(mem, 3, 2, 2) == -ENOSYS)
 223                 mem->count = 0;
 224         if (mem->count < 8)
 225                 mem->count++;
 226         for (n = mem->count - 1; n > 0 ; n--)
 227                 memcpy(&mem->vm[n], &mem->vm[n - 1], sizeof(mem->vm[0]));
 228
 229         mem->vm[0].cpus_total = cpus;
 230         mem->vm[0].cpus_configured = cpus;
 231         mem->vm[0].cpus_standby = 0;
 232         mem->vm[0].cpus_reserved = 0;
 233         mem->vm[0].caf = 1000;
 234         memcpy(mem->vm[0].name, "KVMguest", 8);
 235         ASCEBC(mem->vm[0].name, 8);
 236         memcpy(mem->vm[0].cpi, "KVM/Linux       ", 16);
 237         ASCEBC(mem->vm[0].cpi, 16);
 238 }
 239
 240 static int handle_stsi(struct kvm_vcpu *vcpu)
 241 {
 242         int fc = (vcpu->arch.guest_gprs[0] & 0xf0000000) >> 28;
 243         int sel1 = vcpu->arch.guest_gprs[0] & 0xff;
 244         int sel2 = vcpu->arch.guest_gprs[1] & 0xffff;
 245         int base2 = vcpu->arch.sie_block->ipb >> 28;
 246         int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
 247         u64 operand2;
 248         unsigned long mem;
 249
 250         vcpu->stat.instruction_stsi++;
 251         VCPU_EVENT(vcpu, 4, "stsi: fc: %x sel1: %x sel2: %x", fc, sel1, sel2);
 252
 253         operand2 = disp2;
 254         if (base2)
 255                 operand2 += vcpu->arch.guest_gprs[base2];
 256
 257         if (operand2 & 0xfff && fc > 0)
 258                 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
 259
 260         switch (fc) {
 261         case 0:
 262                 vcpu->arch.guest_gprs[0] = 3 << 28;
 263                 vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
 264                 return 0;
 265         case 1: /* same handling for 1 and 2 */
 266         case 2:
 267                 mem = get_zeroed_page(GFP_KERNEL);
 268                 if (!mem)
 269                         goto out_fail;
 270                 if (stsi((void *) mem, fc, sel1, sel2) == -ENOSYS)
 271                         goto out_mem;
 272                 break;
 273         case 3:
 274                 if (sel1 != 2 || sel2 != 2)
 275                         goto out_fail;
 276                 mem = get_zeroed_page(GFP_KERNEL);
 277                 if (!mem)
 278                         goto out_fail;
 279                 handle_stsi_3_2_2(vcpu, (void *) mem);
 280                 break;
 281         default:
 282                 goto out_fail;
 283         }
 284
 285         if (copy_to_guest_absolute(vcpu, operand2, (void *) mem, PAGE_SIZE)) {
 286                 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
 287                 goto out_mem;
 288         }
 289         free_page(mem);
 290         vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
 291         vcpu->arch.guest_gprs[0] = 0;
 292         return 0;
 293 out_mem:
 294         free_page(mem);
 295 out_fail:
 296         /* condition code 3 */
 297         vcpu->arch.sie_block->gpsw.mask |= 3ul << 44;
 298         return 0;
 299 }
 300
 301 static intercept_handler_t priv_handlers[256] = {
 302         [0x02] = handle_stidp,
 303         [0x10] = handle_set_prefix,
 304         [0x11] = handle_store_prefix,
 305         [0x12] = handle_store_cpu_address,
 306         [0x29] = handle_skey,
 307         [0x2a] = handle_skey,
 308         [0x2b] = handle_skey,
 309         [0x34] = handle_stsch,
 310         [0x5f] = handle_chsc,
 311         [0x7d] = handle_stsi,
 312         [0xb1] = handle_stfl,
 313 };
 314
 315 int kvm_s390_handle_priv(struct kvm_vcpu *vcpu)
 316 {
 317         intercept_handler_t handler;
 318
 319         handler = priv_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
 320         if (handler)
 321                 return handler(vcpu);
 322         return -ENOTSUPP;
 323 }