projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
s390/qdio: bridgeport support - CHSC part
[deliverable/linux.git] / arch / s390 / kvm / priv.c
CommitLineData
453423dc 1/*
a53c8fab 2 * handling privileged instructions
453423dc 3 *
69d0d3a3 4 * Copyright IBM Corp. 2008, 2013
453423dc
CB		 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>
5a0e3ad6 15#include <linux/gfp.h>
453423dc 16#include <linux/errno.h>
b13b5dc7 17#include <linux/compat.h>
7c959e82 18#include <asm/asm-offsets.h>
e769ece3 19#include <asm/facility.h>
453423dc
CB		 20#include <asm/current.h>
21#include <asm/debug.h>
22#include <asm/ebcdic.h>
23#include <asm/sysinfo.h>
69d0d3a3
CB		 24#include <asm/pgtable.h>
25#include <asm/pgalloc.h>
26#include <asm/io.h>
48a3e950
CH		 27#include <asm/ptrace.h>
28#include <asm/compat.h>
453423dc
CB		 29#include "gaccess.h"
30#include "kvm-s390.h"
5786fffa 31#include "trace.h"
453423dc 32
6a3f95a6
TH		 33/* Handle SCK (SET CLOCK) interception */
34static int handle_set_clock(struct kvm_vcpu *vcpu)
35{
36 struct kvm_vcpu *cpup;
37 s64 hostclk, val;
38 u64 op2;
39 int i;
40
41 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
42 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
43
44 op2 = kvm_s390_get_base_disp_s(vcpu);
45 if (op2 & 7) /* Operand must be on a doubleword boundary */
46 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
47 if (get_guest(vcpu, val, (u64 __user *) op2))
48 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
49
50 if (store_tod_clock(&hostclk)) {
51 kvm_s390_set_psw_cc(vcpu, 3);
52 return 0;
53 }
54 val = (val - hostclk) & ~0x3fUL;
55
56 mutex_lock(&vcpu->kvm->lock);
57 kvm_for_each_vcpu(i, cpup, vcpu->kvm)
58 cpup->arch.sie_block->epoch = val;
59 mutex_unlock(&vcpu->kvm->lock);
60
61 kvm_s390_set_psw_cc(vcpu, 0);
62 return 0;
63}
64
453423dc
CB		 65static int handle_set_prefix(struct kvm_vcpu *vcpu)
66{
453423dc
CB		 67 u64 operand2;
68 u32 address = 0;
69 u8 tmp;
70
71 vcpu->stat.instruction_spx++;
72
5087dfa6
TH		 73 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
74 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
75
b1c571a5 76 operand2 = kvm_s390_get_base_disp_s(vcpu);
453423dc
CB		 77
78 /* must be word boundary */
db4a29cb
HC		 79 if (operand2 & 3)
80 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
453423dc
CB		 81
82 /* get the value */
db4a29cb
HC		 83 if (get_guest(vcpu, address, (u32 __user *) operand2))
84 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
453423dc
CB		 85
86 address = address & 0x7fffe000u;
87
88 /* make sure that the new value is valid memory */
89 if (copy_from_guest_absolute(vcpu, &tmp, address, 1) ||
db4a29cb
HC		 90 (copy_from_guest_absolute(vcpu, &tmp, address + PAGE_SIZE, 1)))
91 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
453423dc 92
8d26cf7b 93 kvm_s390_set_prefix(vcpu, address);
453423dc
CB		 94
95 VCPU_EVENT(vcpu, 5, "setting prefix to %x", address);
5786fffa 96 trace_kvm_s390_handle_prefix(vcpu, 1, address);
453423dc
CB		 97 return 0;
98}
99
100static int handle_store_prefix(struct kvm_vcpu *vcpu)
101{
453423dc
CB		 102 u64 operand2;
103 u32 address;
104
105 vcpu->stat.instruction_stpx++;
b1c571a5 106
5087dfa6
TH		 107 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
108 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
109
b1c571a5 110 operand2 = kvm_s390_get_base_disp_s(vcpu);
453423dc
CB		 111
112 /* must be word boundary */
db4a29cb
HC		 113 if (operand2 & 3)
114 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
453423dc
CB		 115
116 address = vcpu->arch.sie_block->prefix;
117 address = address & 0x7fffe000u;
118
119 /* get the value */
db4a29cb
HC		 120 if (put_guest(vcpu, address, (u32 __user *)operand2))
121 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
453423dc
CB		 122
123 VCPU_EVENT(vcpu, 5, "storing prefix to %x", address);
5786fffa 124 trace_kvm_s390_handle_prefix(vcpu, 0, address);
453423dc
CB		 125 return 0;
126}
127
128static int handle_store_cpu_address(struct kvm_vcpu *vcpu)
129{
453423dc 130 u64 useraddr;
453423dc
CB		 131
132 vcpu->stat.instruction_stap++;
b1c571a5 133
5087dfa6
TH		 134 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
135 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
136
b1c571a5 137 useraddr = kvm_s390_get_base_disp_s(vcpu);
453423dc 138
db4a29cb
HC		 139 if (useraddr & 1)
140 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
453423dc 141
db4a29cb
HC		 142 if (put_guest(vcpu, vcpu->vcpu_id, (u16 __user *)useraddr))
143 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
453423dc 144
33e19115 145 VCPU_EVENT(vcpu, 5, "storing cpu address to %llx", useraddr);
5786fffa 146 trace_kvm_s390_handle_stap(vcpu, useraddr);
453423dc
CB		 147 return 0;
148}
149
150static int handle_skey(struct kvm_vcpu *vcpu)
151{
152 vcpu->stat.instruction_storage_key++;
5087dfa6
TH		 153
154 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
155 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
156
dfcf7dc6
MS		 157 vcpu->arch.sie_block->gpsw.addr =
158 __rewind_psw(vcpu->arch.sie_block->gpsw, 4);
453423dc
CB		 159 VCPU_EVENT(vcpu, 4, "%s", "retrying storage key operation");
160 return 0;
161}
162
aca84241
TH		 163static int handle_test_block(struct kvm_vcpu *vcpu)
164{
165 unsigned long hva;
166 gpa_t addr;
167 int reg2;
168
169 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
170 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
171
172 kvm_s390_get_regs_rre(vcpu, NULL, &reg2);
173 addr = vcpu->run->s.regs.gprs[reg2] & PAGE_MASK;
174 addr = kvm_s390_real_to_abs(vcpu, addr);
175
176 hva = gfn_to_hva(vcpu->kvm, gpa_to_gfn(addr));
177 if (kvm_is_error_hva(hva))
178 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
179 /*
180 * We don't expect errors on modern systems, and do not care
181 * about storage keys (yet), so let's just clear the page.
182 */
183 if (clear_user((void __user *)hva, PAGE_SIZE) != 0)
184 return -EFAULT;
185 kvm_s390_set_psw_cc(vcpu, 0);
186 vcpu->run->s.regs.gprs[0] = 0;
187 return 0;
188}
189
fa6b7fe9 190static int handle_tpi(struct kvm_vcpu *vcpu)
453423dc 191{
fa6b7fe9 192 struct kvm_s390_interrupt_info *inti;
7c959e82 193 u64 addr;
fa6b7fe9
CH		 194 int cc;
195
196 addr = kvm_s390_get_base_disp_s(vcpu);
db4a29cb
HC		 197 if (addr & 3)
198 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
7c959e82 199 cc = 0;
fa6b7fe9 200 inti = kvm_s390_get_io_int(vcpu->kvm, vcpu->run->s.regs.crs[6], 0);
7c959e82
HC		 201 if (!inti)
202 goto no_interrupt;
203 cc = 1;
204 if (addr) {
205 /*
206 * Store the two-word I/O interruption code into the
207 * provided area.
208 */
133608f3
TH		 209 if (put_guest(vcpu, inti->io.subchannel_id, (u16 __user *)addr)
210 || put_guest(vcpu, inti->io.subchannel_nr, (u16 __user *)(addr + 2))
211 || put_guest(vcpu, inti->io.io_int_parm, (u32 __user *)(addr + 4)))
212 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
7c959e82
HC		 213 } else {
214 /*
215 * Store the three-word I/O interruption code into
216 * the appropriate lowcore area.
217 */
0a75ca27
HC		 218 put_guest(vcpu, inti->io.subchannel_id, (u16 __user *) __LC_SUBCHANNEL_ID);
219 put_guest(vcpu, inti->io.subchannel_nr, (u16 __user *) __LC_SUBCHANNEL_NR);
220 put_guest(vcpu, inti->io.io_int_parm, (u32 __user *) __LC_IO_INT_PARM);
221 put_guest(vcpu, inti->io.io_int_word, (u32 __user *) __LC_IO_INT_WORD);
7c959e82 222 }
fa6b7fe9 223 kfree(inti);
7c959e82 224no_interrupt:
fa6b7fe9 225 /* Set condition code and we're done. */
ea828ebf 226 kvm_s390_set_psw_cc(vcpu, cc);
453423dc
CB		 227 return 0;
228}
229
fa6b7fe9
CH		 230static int handle_tsch(struct kvm_vcpu *vcpu)
231{
232 struct kvm_s390_interrupt_info *inti;
233
234 inti = kvm_s390_get_io_int(vcpu->kvm, 0,
235 vcpu->run->s.regs.gprs[1]);
236
237 /*
238 * Prepare exit to userspace.
239 * We indicate whether we dequeued a pending I/O interrupt
240 * so that userspace can re-inject it if the instruction gets
241 * a program check. While this may re-order the pending I/O
242 * interrupts, this is no problem since the priority is kept
243 * intact.
244 */
245 vcpu->run->exit_reason = KVM_EXIT_S390_TSCH;
246 vcpu->run->s390_tsch.dequeued = !!inti;
247 if (inti) {
248 vcpu->run->s390_tsch.subchannel_id = inti->io.subchannel_id;
249 vcpu->run->s390_tsch.subchannel_nr = inti->io.subchannel_nr;
250 vcpu->run->s390_tsch.io_int_parm = inti->io.io_int_parm;
251 vcpu->run->s390_tsch.io_int_word = inti->io.io_int_word;
252 }
253 vcpu->run->s390_tsch.ipb = vcpu->arch.sie_block->ipb;
254 kfree(inti);
255 return -EREMOTE;
256}
257
258static int handle_io_inst(struct kvm_vcpu *vcpu)
259{
260 VCPU_EVENT(vcpu, 4, "%s", "I/O instruction");
261
5087dfa6
TH		 262 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
263 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
264
fa6b7fe9
CH		 265 if (vcpu->kvm->arch.css_support) {
266 /*
267 * Most I/O instructions will be handled by userspace.
268 * Exceptions are tpi and the interrupt portion of tsch.
269 */
270 if (vcpu->arch.sie_block->ipa == 0xb236)
271 return handle_tpi(vcpu);
272 if (vcpu->arch.sie_block->ipa == 0xb235)
273 return handle_tsch(vcpu);
274 /* Handle in userspace. */
275 return -EOPNOTSUPP;
276 } else {
277 /*
278 * Set condition code 3 to stop the guest from issueing channel
279 * I/O instructions.
280 */
ea828ebf 281 kvm_s390_set_psw_cc(vcpu, 3);
fa6b7fe9
CH		 282 return 0;
283 }
284}
285
453423dc
CB		 286static int handle_stfl(struct kvm_vcpu *vcpu)
287{
453423dc
CB		 288 int rc;
289
290 vcpu->stat.instruction_stfl++;
5087dfa6
TH		 291
292 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
293 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
294
453423dc 295 rc = copy_to_guest(vcpu, offsetof(struct _lowcore, stfl_fac_list),
78c4b59f 296 vfacilities, 4);
dc5008b9 297 if (rc)
db4a29cb 298 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
78c4b59f
MM		 299 VCPU_EVENT(vcpu, 5, "store facility list value %x",
300 *(unsigned int *) vfacilities);
301 trace_kvm_s390_handle_stfl(vcpu, *(unsigned int *) vfacilities);
453423dc
CB		 302 return 0;
303}
304
48a3e950
CH		 305static void handle_new_psw(struct kvm_vcpu *vcpu)
306{
307 /* Check whether the new psw is enabled for machine checks. */
308 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_MCHECK)
309 kvm_s390_deliver_pending_machine_checks(vcpu);
310}
311
312#define PSW_MASK_ADDR_MODE (PSW_MASK_EA | PSW_MASK_BA)
313#define PSW_MASK_UNASSIGNED 0xb80800fe7fffffffUL
d21683ea 314#define PSW_ADDR_24 0x0000000000ffffffUL
48a3e950
CH		 315#define PSW_ADDR_31 0x000000007fffffffUL
316
3736b874
HC		 317static int is_valid_psw(psw_t *psw) {
318 if (psw->mask & PSW_MASK_UNASSIGNED)
319 return 0;
320 if ((psw->mask & PSW_MASK_ADDR_MODE) == PSW_MASK_BA) {
321 if (psw->addr & ~PSW_ADDR_31)
322 return 0;
323 }
324 if (!(psw->mask & PSW_MASK_ADDR_MODE) && (psw->addr & ~PSW_ADDR_24))
325 return 0;
326 if ((psw->mask & PSW_MASK_ADDR_MODE) == PSW_MASK_EA)
327 return 0;
328 return 1;
329}
330
48a3e950
CH		 331int kvm_s390_handle_lpsw(struct kvm_vcpu *vcpu)
332{
3736b874 333 psw_t *gpsw = &vcpu->arch.sie_block->gpsw;
48a3e950 334 psw_compat_t new_psw;
3736b874 335 u64 addr;
48a3e950 336
3736b874 337 if (gpsw->mask & PSW_MASK_PSTATE)
208dd756
TH		 338 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
339
48a3e950 340 addr = kvm_s390_get_base_disp_s(vcpu);
6fd0fcc9
HC		 341 if (addr & 7)
342 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
6fd0fcc9
HC		 343 if (copy_from_guest(vcpu, &new_psw, addr, sizeof(new_psw)))
344 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
6fd0fcc9
HC		 345 if (!(new_psw.mask & PSW32_MASK_BASE))
346 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
3736b874
HC		 347 gpsw->mask = (new_psw.mask & ~PSW32_MASK_BASE) << 32;
348 gpsw->mask |= new_psw.addr & PSW32_ADDR_AMODE;
349 gpsw->addr = new_psw.addr & ~PSW32_ADDR_AMODE;
350 if (!is_valid_psw(gpsw))
6fd0fcc9 351 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
48a3e950 352 handle_new_psw(vcpu);
48a3e950
CH		 353 return 0;
354}
355
356static int handle_lpswe(struct kvm_vcpu *vcpu)
357{
48a3e950 358 psw_t new_psw;
3736b874 359 u64 addr;
48a3e950 360
5087dfa6
TH		 361 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
362 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
363
48a3e950 364 addr = kvm_s390_get_base_disp_s(vcpu);
6fd0fcc9
HC		 365 if (addr & 7)
366 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
6fd0fcc9
HC		 367 if (copy_from_guest(vcpu, &new_psw, addr, sizeof(new_psw)))
368 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
3736b874
HC		 369 vcpu->arch.sie_block->gpsw = new_psw;
370 if (!is_valid_psw(&vcpu->arch.sie_block->gpsw))
6fd0fcc9 371 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
48a3e950 372 handle_new_psw(vcpu);
48a3e950
CH		 373 return 0;
374}
375
453423dc
CB		 376static int handle_stidp(struct kvm_vcpu *vcpu)
377{
453423dc 378 u64 operand2;
453423dc
CB		 379
380 vcpu->stat.instruction_stidp++;
b1c571a5 381
5087dfa6
TH		 382 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
383 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
384
b1c571a5 385 operand2 = kvm_s390_get_base_disp_s(vcpu);
453423dc 386
db4a29cb
HC		 387 if (operand2 & 7)
388 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
453423dc 389
db4a29cb
HC		 390 if (put_guest(vcpu, vcpu->arch.stidp_data, (u64 __user *)operand2))
391 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
453423dc
CB		 392
393 VCPU_EVENT(vcpu, 5, "%s", "store cpu id");
453423dc
CB		 394 return 0;
395}
396
397static void handle_stsi_3_2_2(struct kvm_vcpu *vcpu, struct sysinfo_3_2_2 *mem)
398{
180c12fb 399 struct kvm_s390_float_interrupt *fi = &vcpu->kvm->arch.float_int;
453423dc
CB		 400 int cpus = 0;
401 int n;
402
b037a4f3 403 spin_lock(&fi->lock);
453423dc
CB		 404 for (n = 0; n < KVM_MAX_VCPUS; n++)
405 if (fi->local_int[n])
406 cpus++;
b037a4f3 407 spin_unlock(&fi->lock);
453423dc
CB		 408
409 /* deal with other level 3 hypervisors */
caf757c6 410 if (stsi(mem, 3, 2, 2))
453423dc
CB		 411 mem->count = 0;
412 if (mem->count < 8)
413 mem->count++;
414 for (n = mem->count - 1; n > 0 ; n--)
415 memcpy(&mem->vm[n], &mem->vm[n - 1], sizeof(mem->vm[0]));
416
417 mem->vm[0].cpus_total = cpus;
418 mem->vm[0].cpus_configured = cpus;
419 mem->vm[0].cpus_standby = 0;
420 mem->vm[0].cpus_reserved = 0;
421 mem->vm[0].caf = 1000;
422 memcpy(mem->vm[0].name, "KVMguest", 8);
423 ASCEBC(mem->vm[0].name, 8);
424 memcpy(mem->vm[0].cpi, "KVM/Linux ", 16);
425 ASCEBC(mem->vm[0].cpi, 16);
426}
427
428static int handle_stsi(struct kvm_vcpu *vcpu)
429{
5a32c1af
CB		 430 int fc = (vcpu->run->s.regs.gprs[0] & 0xf0000000) >> 28;
431 int sel1 = vcpu->run->s.regs.gprs[0] & 0xff;
432 int sel2 = vcpu->run->s.regs.gprs[1] & 0xffff;
c51f068c 433 unsigned long mem = 0;
453423dc 434 u64 operand2;
db4a29cb 435 int rc = 0;
453423dc
CB		 436
437 vcpu->stat.instruction_stsi++;
438 VCPU_EVENT(vcpu, 4, "stsi: fc: %x sel1: %x sel2: %x", fc, sel1, sel2);
439
5087dfa6
TH		 440 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
441 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
442
87d41fb4 443 if (fc > 3) {
ea828ebf 444 kvm_s390_set_psw_cc(vcpu, 3);
87d41fb4
TH		 445 return 0;
446 }
453423dc 447
87d41fb4
TH		 448 if (vcpu->run->s.regs.gprs[0] & 0x0fffff00
449 || vcpu->run->s.regs.gprs[1] & 0xffff0000)
453423dc
CB		 450 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
451
87d41fb4 452 if (fc == 0) {
5a32c1af 453 vcpu->run->s.regs.gprs[0] = 3 << 28;
ea828ebf 454 kvm_s390_set_psw_cc(vcpu, 0);
453423dc 455 return 0;
87d41fb4
TH		 456 }
457
458 operand2 = kvm_s390_get_base_disp_s(vcpu);
459
460 if (operand2 & 0xfff)
461 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
462
463 switch (fc) {
453423dc
CB		 464 case 1: /* same handling for 1 and 2 */
465 case 2:
466 mem = get_zeroed_page(GFP_KERNEL);
467 if (!mem)
c51f068c 468 goto out_no_data;
caf757c6 469 if (stsi((void *) mem, fc, sel1, sel2))
c51f068c 470 goto out_no_data;
453423dc
CB		 471 break;
472 case 3:
473 if (sel1 != 2 || sel2 != 2)
c51f068c 474 goto out_no_data;
453423dc
CB		 475 mem = get_zeroed_page(GFP_KERNEL);
476 if (!mem)
c51f068c 477 goto out_no_data;
453423dc
CB		 478 handle_stsi_3_2_2(vcpu, (void *) mem);
479 break;
453423dc
CB		 480 }
481
482 if (copy_to_guest_absolute(vcpu, operand2, (void *) mem, PAGE_SIZE)) {
db4a29cb 483 rc = kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
c51f068c 484 goto out_exception;
453423dc 485 }
5786fffa 486 trace_kvm_s390_handle_stsi(vcpu, fc, sel1, sel2, operand2);
453423dc 487 free_page(mem);
ea828ebf 488 kvm_s390_set_psw_cc(vcpu, 0);
5a32c1af 489 vcpu->run->s.regs.gprs[0] = 0;
453423dc 490 return 0;
c51f068c 491out_no_data:
ea828ebf 492 kvm_s390_set_psw_cc(vcpu, 3);
c51f068c
HC		 493out_exception:
494 free_page(mem);
db4a29cb 495 return rc;
453423dc
CB		 496}
497
f379aae5 498static const intercept_handler_t b2_handlers[256] = {
453423dc 499 [0x02] = handle_stidp,
6a3f95a6 500 [0x04] = handle_set_clock,
453423dc
CB		 501 [0x10] = handle_set_prefix,
502 [0x11] = handle_store_prefix,
503 [0x12] = handle_store_cpu_address,
504 [0x29] = handle_skey,
505 [0x2a] = handle_skey,
506 [0x2b] = handle_skey,
aca84241 507 [0x2c] = handle_test_block,
f379aae5
CH		 508 [0x30] = handle_io_inst,
509 [0x31] = handle_io_inst,
510 [0x32] = handle_io_inst,
511 [0x33] = handle_io_inst,
512 [0x34] = handle_io_inst,
513 [0x35] = handle_io_inst,
514 [0x36] = handle_io_inst,
515 [0x37] = handle_io_inst,
516 [0x38] = handle_io_inst,
517 [0x39] = handle_io_inst,
518 [0x3a] = handle_io_inst,
519 [0x3b] = handle_io_inst,
520 [0x3c] = handle_io_inst,
521 [0x5f] = handle_io_inst,
522 [0x74] = handle_io_inst,
523 [0x76] = handle_io_inst,
453423dc
CB		 524 [0x7d] = handle_stsi,
525 [0xb1] = handle_stfl,
48a3e950 526 [0xb2] = handle_lpswe,
453423dc
CB		 527};
528
70455a36 529int kvm_s390_handle_b2(struct kvm_vcpu *vcpu)
453423dc
CB		 530{
531 intercept_handler_t handler;
532
70455a36 533 /*
5087dfa6
TH		 534 * A lot of B2 instructions are priviledged. Here we check for
535 * the privileged ones, that we can handle in the kernel.
536 * Anything else goes to userspace.
537 */
f379aae5 538 handler = b2_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
5087dfa6
TH		 539 if (handler)
540 return handler(vcpu);
541
b8e660b8 542 return -EOPNOTSUPP;
453423dc 543}
bb25b9ba 544
48a3e950
CH		 545static int handle_epsw(struct kvm_vcpu *vcpu)
546{
547 int reg1, reg2;
548
aeb87c3c 549 kvm_s390_get_regs_rre(vcpu, &reg1, &reg2);
48a3e950
CH		 550
551 /* This basically extracts the mask half of the psw. */
843200e7 552 vcpu->run->s.regs.gprs[reg1] &= 0xffffffff00000000UL;
48a3e950
CH		 553 vcpu->run->s.regs.gprs[reg1] |= vcpu->arch.sie_block->gpsw.mask >> 32;
554 if (reg2) {
843200e7 555 vcpu->run->s.regs.gprs[reg2] &= 0xffffffff00000000UL;
48a3e950 556 vcpu->run->s.regs.gprs[reg2] |=
843200e7 557 vcpu->arch.sie_block->gpsw.mask & 0x00000000ffffffffUL;
48a3e950
CH		 558 }
559 return 0;
560}
561
69d0d3a3
CB		 562#define PFMF_RESERVED 0xfffc0101UL
563#define PFMF_SK 0x00020000UL
564#define PFMF_CF 0x00010000UL
565#define PFMF_UI 0x00008000UL
566#define PFMF_FSC 0x00007000UL
567#define PFMF_NQ 0x00000800UL
568#define PFMF_MR 0x00000400UL
569#define PFMF_MC 0x00000200UL
570#define PFMF_KEY 0x000000feUL
571
572static int handle_pfmf(struct kvm_vcpu *vcpu)
573{
574 int reg1, reg2;
575 unsigned long start, end;
576
577 vcpu->stat.instruction_pfmf++;
578
579 kvm_s390_get_regs_rre(vcpu, &reg1, &reg2);
580
581 if (!MACHINE_HAS_PFMF)
582 return kvm_s390_inject_program_int(vcpu, PGM_OPERATION);
583
584 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
208dd756 585 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
69d0d3a3
CB		 586
587 if (vcpu->run->s.regs.gprs[reg1] & PFMF_RESERVED)
588 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
589
590 /* Only provide non-quiescing support if the host supports it */
e769ece3 591 if (vcpu->run->s.regs.gprs[reg1] & PFMF_NQ && !test_facility(14))
69d0d3a3
CB		 592 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
593
594 /* No support for conditional-SSKE */
595 if (vcpu->run->s.regs.gprs[reg1] & (PFMF_MR | PFMF_MC))
596 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
597
598 start = vcpu->run->s.regs.gprs[reg2] & PAGE_MASK;
599 switch (vcpu->run->s.regs.gprs[reg1] & PFMF_FSC) {
600 case 0x00000000:
601 end = (start + (1UL << 12)) & ~((1UL << 12) - 1);
602 break;
603 case 0x00001000:
604 end = (start + (1UL << 20)) & ~((1UL << 20) - 1);
605 break;
606 /* We dont support EDAT2
607 case 0x00002000:
608 end = (start + (1UL << 31)) & ~((1UL << 31) - 1);
609 break;*/
610 default:
611 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
612 }
613 while (start < end) {
614 unsigned long useraddr;
615
616 useraddr = gmap_translate(start, vcpu->arch.gmap);
617 if (IS_ERR((void *)useraddr))
618 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
619
620 if (vcpu->run->s.regs.gprs[reg1] & PFMF_CF) {
621 if (clear_user((void __user *)useraddr, PAGE_SIZE))
622 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
623 }
624
625 if (vcpu->run->s.regs.gprs[reg1] & PFMF_SK) {
626 if (set_guest_storage_key(current->mm, useraddr,
627 vcpu->run->s.regs.gprs[reg1] & PFMF_KEY,
628 vcpu->run->s.regs.gprs[reg1] & PFMF_NQ))
629 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
630 }
631
632 start += PAGE_SIZE;
633 }
634 if (vcpu->run->s.regs.gprs[reg1] & PFMF_FSC)
635 vcpu->run->s.regs.gprs[reg2] = end;
636 return 0;
637}
638
48a3e950
CH		 639static const intercept_handler_t b9_handlers[256] = {
640 [0x8d] = handle_epsw,
f379aae5 641 [0x9c] = handle_io_inst,
69d0d3a3 642 [0xaf] = handle_pfmf,
48a3e950
CH		 643};
644
645int kvm_s390_handle_b9(struct kvm_vcpu *vcpu)
646{
647 intercept_handler_t handler;
648
649 /* This is handled just as for the B2 instructions. */
650 handler = b9_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
5087dfa6
TH		 651 if (handler)
652 return handler(vcpu);
653
48a3e950
CH		 654 return -EOPNOTSUPP;
655}
656
953ed88d
TH		 657int kvm_s390_handle_lctl(struct kvm_vcpu *vcpu)
658{
659 int reg1 = (vcpu->arch.sie_block->ipa & 0x00f0) >> 4;
660 int reg3 = vcpu->arch.sie_block->ipa & 0x000f;
661 u64 useraddr;
662 u32 val = 0;
663 int reg, rc;
664
665 vcpu->stat.instruction_lctl++;
666
667 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
668 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
669
670 useraddr = kvm_s390_get_base_disp_rs(vcpu);
671
672 if (useraddr & 3)
673 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
674
675 VCPU_EVENT(vcpu, 5, "lctl r1:%x, r3:%x, addr:%llx", reg1, reg3,
676 useraddr);
677 trace_kvm_s390_handle_lctl(vcpu, 0, reg1, reg3, useraddr);
678
679 reg = reg1;
680 do {
681 rc = get_guest(vcpu, val, (u32 __user *) useraddr);
682 if (rc)
683 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
684 vcpu->arch.sie_block->gcr[reg] &= 0xffffffff00000000ul;
685 vcpu->arch.sie_block->gcr[reg] |= val;
686 useraddr += 4;
687 if (reg == reg3)
688 break;
689 reg = (reg + 1) % 16;
690 } while (1);
691
692 return 0;
693}
694
695static int handle_lctlg(struct kvm_vcpu *vcpu)
696{
697 int reg1 = (vcpu->arch.sie_block->ipa & 0x00f0) >> 4;
698 int reg3 = vcpu->arch.sie_block->ipa & 0x000f;
699 u64 useraddr;
700 int reg, rc;
701
702 vcpu->stat.instruction_lctlg++;
703
704 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
705 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
706
707 useraddr = kvm_s390_get_base_disp_rsy(vcpu);
708
709 if (useraddr & 7)
710 return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
711
712 reg = reg1;
713
714 VCPU_EVENT(vcpu, 5, "lctlg r1:%x, r3:%x, addr:%llx", reg1, reg3,
715 useraddr);
716 trace_kvm_s390_handle_lctl(vcpu, 1, reg1, reg3, useraddr);
717
718 do {
719 rc = get_guest(vcpu, vcpu->arch.sie_block->gcr[reg],
720 (u64 __user *) useraddr);
721 if (rc)
722 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
723 useraddr += 8;
724 if (reg == reg3)
725 break;
726 reg = (reg + 1) % 16;
727 } while (1);
728
729 return 0;
730}
731
f379aae5 732static const intercept_handler_t eb_handlers[256] = {
953ed88d 733 [0x2f] = handle_lctlg,
f379aae5
CH		 734 [0x8a] = handle_io_inst,
735};
736
953ed88d 737int kvm_s390_handle_eb(struct kvm_vcpu *vcpu)
f379aae5
CH		 738{
739 intercept_handler_t handler;
740
f379aae5
CH		 741 handler = eb_handlers[vcpu->arch.sie_block->ipb & 0xff];
742 if (handler)
743 return handler(vcpu);
744 return -EOPNOTSUPP;
745}
746
bb25b9ba
CB		 747static int handle_tprot(struct kvm_vcpu *vcpu)
748{
b1c571a5 749 u64 address1, address2;
bb25b9ba 750 struct vm_area_struct *vma;
1eddb85f 751 unsigned long user_address;
bb25b9ba
CB		 752
753 vcpu->stat.instruction_tprot++;
754
f9f6bbc6
TH		 755 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
756 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
757
b1c571a5
CH		 758 kvm_s390_get_base_disp_sse(vcpu, &address1, &address2);
759
bb25b9ba
CB		 760 /* we only handle the Linux memory detection case:
761 * access key == 0
762 * guest DAT == off
763 * everything else goes to userspace. */
764 if (address2 & 0xf0)
765 return -EOPNOTSUPP;
766 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_DAT)
767 return -EOPNOTSUPP;
768
bb25b9ba 769 down_read(&current->mm->mmap_sem);
59a1fa2d
HC		 770 user_address = __gmap_translate(address1, vcpu->arch.gmap);
771 if (IS_ERR_VALUE(user_address))
772 goto out_inject;
1eddb85f 773 vma = find_vma(current->mm, user_address);
59a1fa2d
HC		 774 if (!vma)
775 goto out_inject;
bb25b9ba
CB		 776 vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
777 if (!(vma->vm_flags & VM_WRITE) && (vma->vm_flags & VM_READ))
778 vcpu->arch.sie_block->gpsw.mask |= (1ul << 44);
779 if (!(vma->vm_flags & VM_WRITE) && !(vma->vm_flags & VM_READ))
780 vcpu->arch.sie_block->gpsw.mask |= (2ul << 44);
781
782 up_read(&current->mm->mmap_sem);
783 return 0;
59a1fa2d
HC		 784
785out_inject:
786 up_read(&current->mm->mmap_sem);
787 return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
bb25b9ba
CB		 788}
789
790int kvm_s390_handle_e5(struct kvm_vcpu *vcpu)
791{
792 /* For e5xx... instructions we only handle TPROT */
793 if ((vcpu->arch.sie_block->ipa & 0x00ff) == 0x01)
794 return handle_tprot(vcpu);
795 return -EOPNOTSUPP;
796}
797
8c3f61e2
CH		 798static int handle_sckpf(struct kvm_vcpu *vcpu)
799{
800 u32 value;
801
802 if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
208dd756 803 return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP);
8c3f61e2
CH		 804
805 if (vcpu->run->s.regs.gprs[0] & 0x00000000ffff0000)
806 return kvm_s390_inject_program_int(vcpu,
807 PGM_SPECIFICATION);
808
809 value = vcpu->run->s.regs.gprs[0] & 0x000000000000ffff;
810 vcpu->arch.sie_block->todpr = value;
811
812 return 0;
813}
814
77975357 815static const intercept_handler_t x01_handlers[256] = {
8c3f61e2
CH		 816 [0x07] = handle_sckpf,
817};
818
819int kvm_s390_handle_01(struct kvm_vcpu *vcpu)
820{
821 intercept_handler_t handler;
822
823 handler = x01_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
824 if (handler)
825 return handler(vcpu);
826 return -EOPNOTSUPP;
827}
Linux kernel - Deliverables
This page took 0.726088 seconds and 5 git commands to generate.