2 * priv.c - handling privileged instructions
4 * Copyright IBM Corp. 2008
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.
10 * Author(s): Carsten Otte <cotte@de.ibm.com>
11 * Christian Borntraeger <borntraeger@de.ibm.com>
14 #include <linux/kvm.h>
15 #include <linux/gfp.h>
16 #include <linux/errno.h>
17 #include <asm/current.h>
18 #include <asm/debug.h>
19 #include <asm/ebcdic.h>
20 #include <asm/sysinfo.h>
24 static int handle_set_prefix(struct kvm_vcpu *vcpu)
26 int base2 = vcpu->arch.sie_block->ipb >> 28;
27 int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
32 vcpu->stat.instruction_spx++;
36 operand2 += vcpu->run->s.regs.gprs[base2];
38 /* must be word boundary */
40 kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
45 if (get_guest_u32(vcpu, operand2, &address)) {
46 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
50 address = address & 0x7fffe000u;
52 /* make sure that the new value is valid memory */
53 if (copy_from_guest_absolute(vcpu, &tmp, address, 1) ||
54 (copy_from_guest_absolute(vcpu, &tmp, address + PAGE_SIZE, 1))) {
55 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
59 kvm_s390_set_prefix(vcpu, address);
61 VCPU_EVENT(vcpu, 5, "setting prefix to %x", address);
66 static int handle_store_prefix(struct kvm_vcpu *vcpu)
68 int base2 = vcpu->arch.sie_block->ipb >> 28;
69 int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
73 vcpu->stat.instruction_stpx++;
76 operand2 += vcpu->run->s.regs.gprs[base2];
78 /* must be word boundary */
80 kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
84 address = vcpu->arch.sie_block->prefix;
85 address = address & 0x7fffe000u;
88 if (put_guest_u32(vcpu, operand2, address)) {
89 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
93 VCPU_EVENT(vcpu, 5, "storing prefix to %x", address);
98 static int handle_store_cpu_address(struct kvm_vcpu *vcpu)
100 int base2 = vcpu->arch.sie_block->ipb >> 28;
101 int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
105 vcpu->stat.instruction_stap++;
108 useraddr += vcpu->run->s.regs.gprs[base2];
111 kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
115 rc = put_guest_u16(vcpu, useraddr, vcpu->vcpu_id);
117 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
121 VCPU_EVENT(vcpu, 5, "storing cpu address to %llx", useraddr);
126 static int handle_skey(struct kvm_vcpu *vcpu)
128 vcpu->stat.instruction_storage_key++;
129 vcpu->arch.sie_block->gpsw.addr -= 4;
130 VCPU_EVENT(vcpu, 4, "%s", "retrying storage key operation");
134 static int handle_stsch(struct kvm_vcpu *vcpu)
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;
144 static int handle_chsc(struct kvm_vcpu *vcpu)
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;
154 static int handle_stfl(struct kvm_vcpu *vcpu)
156 unsigned int facility_list;
159 vcpu->stat.instruction_stfl++;
160 /* only pass the facility bits, which we can handle */
161 facility_list = S390_lowcore.stfl_fac_list & 0xff00fff3;
163 rc = copy_to_guest(vcpu, offsetof(struct _lowcore, stfl_fac_list),
164 &facility_list, sizeof(facility_list));
166 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
168 VCPU_EVENT(vcpu, 5, "store facility list value %x",
173 static int handle_stidp(struct kvm_vcpu *vcpu)
175 int base2 = vcpu->arch.sie_block->ipb >> 28;
176 int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
180 vcpu->stat.instruction_stidp++;
183 operand2 += vcpu->run->s.regs.gprs[base2];
186 kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
190 rc = put_guest_u64(vcpu, operand2, vcpu->arch.stidp_data);
192 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
196 VCPU_EVENT(vcpu, 5, "%s", "store cpu id");
201 static void handle_stsi_3_2_2(struct kvm_vcpu *vcpu, struct sysinfo_3_2_2 *mem)
203 struct kvm_s390_float_interrupt *fi = &vcpu->kvm->arch.float_int;
207 spin_lock(&fi->lock);
208 for (n = 0; n < KVM_MAX_VCPUS; n++)
209 if (fi->local_int[n])
211 spin_unlock(&fi->lock);
213 /* deal with other level 3 hypervisors */
214 if (stsi(mem, 3, 2, 2) == -ENOSYS)
218 for (n = mem->count - 1; n > 0 ; n--)
219 memcpy(&mem->vm[n], &mem->vm[n - 1], sizeof(mem->vm[0]));
221 mem->vm[0].cpus_total = cpus;
222 mem->vm[0].cpus_configured = cpus;
223 mem->vm[0].cpus_standby = 0;
224 mem->vm[0].cpus_reserved = 0;
225 mem->vm[0].caf = 1000;
226 memcpy(mem->vm[0].name, "KVMguest", 8);
227 ASCEBC(mem->vm[0].name, 8);
228 memcpy(mem->vm[0].cpi, "KVM/Linux ", 16);
229 ASCEBC(mem->vm[0].cpi, 16);
232 static int handle_stsi(struct kvm_vcpu *vcpu)
234 int fc = (vcpu->run->s.regs.gprs[0] & 0xf0000000) >> 28;
235 int sel1 = vcpu->run->s.regs.gprs[0] & 0xff;
236 int sel2 = vcpu->run->s.regs.gprs[1] & 0xffff;
237 int base2 = vcpu->arch.sie_block->ipb >> 28;
238 int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
242 vcpu->stat.instruction_stsi++;
243 VCPU_EVENT(vcpu, 4, "stsi: fc: %x sel1: %x sel2: %x", fc, sel1, sel2);
247 operand2 += vcpu->run->s.regs.gprs[base2];
249 if (operand2 & 0xfff && fc > 0)
250 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
254 vcpu->run->s.regs.gprs[0] = 3 << 28;
255 vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
257 case 1: /* same handling for 1 and 2 */
259 mem = get_zeroed_page(GFP_KERNEL);
262 if (stsi((void *) mem, fc, sel1, sel2) == -ENOSYS)
266 if (sel1 != 2 || sel2 != 2)
268 mem = get_zeroed_page(GFP_KERNEL);
271 handle_stsi_3_2_2(vcpu, (void *) mem);
277 if (copy_to_guest_absolute(vcpu, operand2, (void *) mem, PAGE_SIZE)) {
278 kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
282 vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
283 vcpu->run->s.regs.gprs[0] = 0;
288 /* condition code 3 */
289 vcpu->arch.sie_block->gpsw.mask |= 3ul << 44;
293 static intercept_handler_t priv_handlers[256] = {
294 [0x02] = handle_stidp,
295 [0x10] = handle_set_prefix,
296 [0x11] = handle_store_prefix,
297 [0x12] = handle_store_cpu_address,
298 [0x29] = handle_skey,
299 [0x2a] = handle_skey,
300 [0x2b] = handle_skey,
301 [0x34] = handle_stsch,
302 [0x5f] = handle_chsc,
303 [0x7d] = handle_stsi,
304 [0xb1] = handle_stfl,
307 int kvm_s390_handle_b2(struct kvm_vcpu *vcpu)
309 intercept_handler_t handler;
312 * a lot of B2 instructions are priviledged. We first check for
313 * the privileged ones, that we can handle in the kernel. If the
314 * kernel can handle this instruction, we check for the problem
315 * state bit and (a) handle the instruction or (b) send a code 2
317 * Anything else goes to userspace.*/
318 handler = priv_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
320 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
321 return kvm_s390_inject_program_int(vcpu,
322 PGM_PRIVILEGED_OPERATION);
324 return handler(vcpu);
329 static int handle_tprot(struct kvm_vcpu *vcpu)
331 int base1 = (vcpu->arch.sie_block->ipb & 0xf0000000) >> 28;
332 int disp1 = (vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16;
333 int base2 = (vcpu->arch.sie_block->ipb & 0xf000) >> 12;
334 int disp2 = vcpu->arch.sie_block->ipb & 0x0fff;
335 u64 address1 = disp1 + base1 ? vcpu->run->s.regs.gprs[base1] : 0;
336 u64 address2 = disp2 + base2 ? vcpu->run->s.regs.gprs[base2] : 0;
337 struct vm_area_struct *vma;
338 unsigned long user_address;
340 vcpu->stat.instruction_tprot++;
342 /* we only handle the Linux memory detection case:
345 * everything else goes to userspace. */
348 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_DAT)
352 /* we must resolve the address without holding the mmap semaphore.
353 * This is ok since the userspace hypervisor is not supposed to change
354 * the mapping while the guest queries the memory. Otherwise the guest
355 * might crash or get wrong info anyway. */
356 user_address = (unsigned long) __guestaddr_to_user(vcpu, address1);
358 down_read(¤t->mm->mmap_sem);
359 vma = find_vma(current->mm, user_address);
361 up_read(¤t->mm->mmap_sem);
362 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
365 vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
366 if (!(vma->vm_flags & VM_WRITE) && (vma->vm_flags & VM_READ))
367 vcpu->arch.sie_block->gpsw.mask |= (1ul << 44);
368 if (!(vma->vm_flags & VM_WRITE) && !(vma->vm_flags & VM_READ))
369 vcpu->arch.sie_block->gpsw.mask |= (2ul << 44);
371 up_read(¤t->mm->mmap_sem);
375 int kvm_s390_handle_e5(struct kvm_vcpu *vcpu)
377 /* For e5xx... instructions we only handle TPROT */
378 if ((vcpu->arch.sie_block->ipa & 0x00ff) == 0x01)
379 return handle_tprot(vcpu);
383 static int handle_sckpf(struct kvm_vcpu *vcpu)
387 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
388 return kvm_s390_inject_program_int(vcpu,
389 PGM_PRIVILEGED_OPERATION);
391 if (vcpu->run->s.regs.gprs[0] & 0x00000000ffff0000)
392 return kvm_s390_inject_program_int(vcpu,
395 value = vcpu->run->s.regs.gprs[0] & 0x000000000000ffff;
396 vcpu->arch.sie_block->todpr = value;
401 static intercept_handler_t x01_handlers[256] = {
402 [0x07] = handle_sckpf,
405 int kvm_s390_handle_01(struct kvm_vcpu *vcpu)
407 intercept_handler_t handler;
409 handler = x01_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
411 return handler(vcpu);