2 * handling kvm guest interrupts
4 * Copyright IBM Corp. 2008,2014
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>
13 #include <linux/interrupt.h>
14 #include <linux/kvm_host.h>
15 #include <linux/hrtimer.h>
16 #include <linux/mmu_context.h>
17 #include <linux/signal.h>
18 #include <linux/slab.h>
19 #include <asm/asm-offsets.h>
20 #include <asm/uaccess.h>
23 #include "trace-s390.h"
25 #define IOINT_SCHID_MASK 0x0000ffff
26 #define IOINT_SSID_MASK 0x00030000
27 #define IOINT_CSSID_MASK 0x03fc0000
28 #define IOINT_AI_MASK 0x04000000
30 static void deliver_ckc_interrupt(struct kvm_vcpu
*vcpu
);
32 static int is_ioint(u64 type
)
34 return ((type
& 0xfffe0000u
) != 0xfffe0000u
);
37 int psw_extint_disabled(struct kvm_vcpu
*vcpu
)
39 return !(vcpu
->arch
.sie_block
->gpsw
.mask
& PSW_MASK_EXT
);
42 static int psw_ioint_disabled(struct kvm_vcpu
*vcpu
)
44 return !(vcpu
->arch
.sie_block
->gpsw
.mask
& PSW_MASK_IO
);
47 static int psw_mchk_disabled(struct kvm_vcpu
*vcpu
)
49 return !(vcpu
->arch
.sie_block
->gpsw
.mask
& PSW_MASK_MCHECK
);
52 static int psw_interrupts_disabled(struct kvm_vcpu
*vcpu
)
54 if ((vcpu
->arch
.sie_block
->gpsw
.mask
& PSW_MASK_PER
) ||
55 (vcpu
->arch
.sie_block
->gpsw
.mask
& PSW_MASK_IO
) ||
56 (vcpu
->arch
.sie_block
->gpsw
.mask
& PSW_MASK_EXT
))
61 static int ckc_interrupts_enabled(struct kvm_vcpu
*vcpu
)
63 if (psw_extint_disabled(vcpu
) ||
64 !(vcpu
->arch
.sie_block
->gcr
[0] & 0x800ul
))
66 if (guestdbg_enabled(vcpu
) && guestdbg_sstep_enabled(vcpu
))
67 /* No timer interrupts when single stepping */
72 static u64
int_word_to_isc_bits(u32 int_word
)
74 u8 isc
= (int_word
& 0x38000000) >> 27;
76 return (0x80 >> isc
) << 24;
79 static int __interrupt_is_deliverable(struct kvm_vcpu
*vcpu
,
80 struct kvm_s390_interrupt_info
*inti
)
83 case KVM_S390_INT_EXTERNAL_CALL
:
84 if (psw_extint_disabled(vcpu
))
86 if (vcpu
->arch
.sie_block
->gcr
[0] & 0x2000ul
)
88 case KVM_S390_INT_EMERGENCY
:
89 if (psw_extint_disabled(vcpu
))
91 if (vcpu
->arch
.sie_block
->gcr
[0] & 0x4000ul
)
94 case KVM_S390_INT_CLOCK_COMP
:
95 return ckc_interrupts_enabled(vcpu
);
96 case KVM_S390_INT_CPU_TIMER
:
97 if (psw_extint_disabled(vcpu
))
99 if (vcpu
->arch
.sie_block
->gcr
[0] & 0x400ul
)
102 case KVM_S390_INT_SERVICE
:
103 case KVM_S390_INT_PFAULT_INIT
:
104 case KVM_S390_INT_PFAULT_DONE
:
105 case KVM_S390_INT_VIRTIO
:
106 if (psw_extint_disabled(vcpu
))
108 if (vcpu
->arch
.sie_block
->gcr
[0] & 0x200ul
)
111 case KVM_S390_PROGRAM_INT
:
112 case KVM_S390_SIGP_STOP
:
113 case KVM_S390_SIGP_SET_PREFIX
:
114 case KVM_S390_RESTART
:
117 if (psw_mchk_disabled(vcpu
))
119 if (vcpu
->arch
.sie_block
->gcr
[14] & inti
->mchk
.cr14
)
122 case KVM_S390_INT_IO_MIN
...KVM_S390_INT_IO_MAX
:
123 if (psw_ioint_disabled(vcpu
))
125 if (vcpu
->arch
.sie_block
->gcr
[6] &
126 int_word_to_isc_bits(inti
->io
.io_int_word
))
130 printk(KERN_WARNING
"illegal interrupt type %llx\n",
137 static void __set_cpu_idle(struct kvm_vcpu
*vcpu
)
139 atomic_set_mask(CPUSTAT_WAIT
, &vcpu
->arch
.sie_block
->cpuflags
);
140 set_bit(vcpu
->vcpu_id
, vcpu
->arch
.local_int
.float_int
->idle_mask
);
143 static void __unset_cpu_idle(struct kvm_vcpu
*vcpu
)
145 atomic_clear_mask(CPUSTAT_WAIT
, &vcpu
->arch
.sie_block
->cpuflags
);
146 clear_bit(vcpu
->vcpu_id
, vcpu
->arch
.local_int
.float_int
->idle_mask
);
149 static void __reset_intercept_indicators(struct kvm_vcpu
*vcpu
)
151 atomic_clear_mask(CPUSTAT_ECALL_PEND
|
152 CPUSTAT_IO_INT
| CPUSTAT_EXT_INT
| CPUSTAT_STOP_INT
,
153 &vcpu
->arch
.sie_block
->cpuflags
);
154 vcpu
->arch
.sie_block
->lctl
= 0x0000;
155 vcpu
->arch
.sie_block
->ictl
&= ~(ICTL_LPSW
| ICTL_STCTL
| ICTL_PINT
);
157 if (guestdbg_enabled(vcpu
)) {
158 vcpu
->arch
.sie_block
->lctl
|= (LCTL_CR0
| LCTL_CR9
|
159 LCTL_CR10
| LCTL_CR11
);
160 vcpu
->arch
.sie_block
->ictl
|= (ICTL_STCTL
| ICTL_PINT
);
164 static void __set_cpuflag(struct kvm_vcpu
*vcpu
, u32 flag
)
166 atomic_set_mask(flag
, &vcpu
->arch
.sie_block
->cpuflags
);
169 static void __set_intercept_indicator(struct kvm_vcpu
*vcpu
,
170 struct kvm_s390_interrupt_info
*inti
)
172 switch (inti
->type
) {
173 case KVM_S390_INT_EXTERNAL_CALL
:
174 case KVM_S390_INT_EMERGENCY
:
175 case KVM_S390_INT_SERVICE
:
176 case KVM_S390_INT_PFAULT_INIT
:
177 case KVM_S390_INT_PFAULT_DONE
:
178 case KVM_S390_INT_VIRTIO
:
179 case KVM_S390_INT_CLOCK_COMP
:
180 case KVM_S390_INT_CPU_TIMER
:
181 if (psw_extint_disabled(vcpu
))
182 __set_cpuflag(vcpu
, CPUSTAT_EXT_INT
);
184 vcpu
->arch
.sie_block
->lctl
|= LCTL_CR0
;
186 case KVM_S390_SIGP_STOP
:
187 __set_cpuflag(vcpu
, CPUSTAT_STOP_INT
);
190 if (psw_mchk_disabled(vcpu
))
191 vcpu
->arch
.sie_block
->ictl
|= ICTL_LPSW
;
193 vcpu
->arch
.sie_block
->lctl
|= LCTL_CR14
;
195 case KVM_S390_INT_IO_MIN
...KVM_S390_INT_IO_MAX
:
196 if (psw_ioint_disabled(vcpu
))
197 __set_cpuflag(vcpu
, CPUSTAT_IO_INT
);
199 vcpu
->arch
.sie_block
->lctl
|= LCTL_CR6
;
206 static int __deliver_prog_irq(struct kvm_vcpu
*vcpu
,
207 struct kvm_s390_pgm_info
*pgm_info
)
209 const unsigned short table
[] = { 2, 4, 4, 6 };
212 switch (pgm_info
->code
& ~PGM_PER
) {
213 case PGM_AFX_TRANSLATION
:
214 case PGM_ASX_TRANSLATION
:
215 case PGM_EX_TRANSLATION
:
216 case PGM_LFX_TRANSLATION
:
217 case PGM_LSTE_SEQUENCE
:
218 case PGM_LSX_TRANSLATION
:
219 case PGM_LX_TRANSLATION
:
220 case PGM_PRIMARY_AUTHORITY
:
221 case PGM_SECONDARY_AUTHORITY
:
222 case PGM_SPACE_SWITCH
:
223 rc
= put_guest_lc(vcpu
, pgm_info
->trans_exc_code
,
224 (u64
*)__LC_TRANS_EXC_CODE
);
226 case PGM_ALEN_TRANSLATION
:
227 case PGM_ALE_SEQUENCE
:
228 case PGM_ASTE_INSTANCE
:
229 case PGM_ASTE_SEQUENCE
:
230 case PGM_ASTE_VALIDITY
:
231 case PGM_EXTENDED_AUTHORITY
:
232 rc
= put_guest_lc(vcpu
, pgm_info
->exc_access_id
,
233 (u8
*)__LC_EXC_ACCESS_ID
);
236 case PGM_PAGE_TRANSLATION
:
237 case PGM_REGION_FIRST_TRANS
:
238 case PGM_REGION_SECOND_TRANS
:
239 case PGM_REGION_THIRD_TRANS
:
240 case PGM_SEGMENT_TRANSLATION
:
241 rc
= put_guest_lc(vcpu
, pgm_info
->trans_exc_code
,
242 (u64
*)__LC_TRANS_EXC_CODE
);
243 rc
|= put_guest_lc(vcpu
, pgm_info
->exc_access_id
,
244 (u8
*)__LC_EXC_ACCESS_ID
);
245 rc
|= put_guest_lc(vcpu
, pgm_info
->op_access_id
,
246 (u8
*)__LC_OP_ACCESS_ID
);
249 rc
= put_guest_lc(vcpu
, pgm_info
->mon_class_nr
,
250 (u64
*)__LC_MON_CLASS_NR
);
251 rc
|= put_guest_lc(vcpu
, pgm_info
->mon_code
,
252 (u64
*)__LC_MON_CODE
);
255 rc
= put_guest_lc(vcpu
, pgm_info
->data_exc_code
,
256 (u32
*)__LC_DATA_EXC_CODE
);
259 rc
= put_guest_lc(vcpu
, pgm_info
->trans_exc_code
,
260 (u64
*)__LC_TRANS_EXC_CODE
);
261 rc
|= put_guest_lc(vcpu
, pgm_info
->exc_access_id
,
262 (u8
*)__LC_EXC_ACCESS_ID
);
266 if (pgm_info
->code
& PGM_PER
) {
267 rc
|= put_guest_lc(vcpu
, pgm_info
->per_code
,
268 (u8
*) __LC_PER_CODE
);
269 rc
|= put_guest_lc(vcpu
, pgm_info
->per_atmid
,
270 (u8
*)__LC_PER_ATMID
);
271 rc
|= put_guest_lc(vcpu
, pgm_info
->per_address
,
272 (u64
*) __LC_PER_ADDRESS
);
273 rc
|= put_guest_lc(vcpu
, pgm_info
->per_access_id
,
274 (u8
*) __LC_PER_ACCESS_ID
);
277 switch (vcpu
->arch
.sie_block
->icptcode
) {
283 /* last instruction only stored for these icptcodes */
284 rc
|= put_guest_lc(vcpu
, table
[vcpu
->arch
.sie_block
->ipa
>> 14],
285 (u16
*) __LC_PGM_ILC
);
288 rc
|= put_guest_lc(vcpu
, vcpu
->arch
.sie_block
->pgmilc
,
289 (u16
*) __LC_PGM_ILC
);
292 rc
|= put_guest_lc(vcpu
, 0,
293 (u16
*) __LC_PGM_ILC
);
296 rc
|= put_guest_lc(vcpu
, pgm_info
->code
,
297 (u16
*)__LC_PGM_INT_CODE
);
298 rc
|= write_guest_lc(vcpu
, __LC_PGM_OLD_PSW
,
299 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
300 rc
|= read_guest_lc(vcpu
, __LC_PGM_NEW_PSW
,
301 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
306 static void __do_deliver_interrupt(struct kvm_vcpu
*vcpu
,
307 struct kvm_s390_interrupt_info
*inti
)
309 const unsigned short table
[] = { 2, 4, 4, 6 };
312 switch (inti
->type
) {
313 case KVM_S390_INT_EMERGENCY
:
314 VCPU_EVENT(vcpu
, 4, "%s", "interrupt: sigp emerg");
315 vcpu
->stat
.deliver_emergency_signal
++;
316 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
317 inti
->emerg
.code
, 0);
318 rc
= put_guest_lc(vcpu
, 0x1201, (u16
*)__LC_EXT_INT_CODE
);
319 rc
|= put_guest_lc(vcpu
, inti
->emerg
.code
,
320 (u16
*)__LC_EXT_CPU_ADDR
);
321 rc
|= write_guest_lc(vcpu
, __LC_EXT_OLD_PSW
,
322 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
323 rc
|= read_guest_lc(vcpu
, __LC_EXT_NEW_PSW
,
324 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
326 case KVM_S390_INT_EXTERNAL_CALL
:
327 VCPU_EVENT(vcpu
, 4, "%s", "interrupt: sigp ext call");
328 vcpu
->stat
.deliver_external_call
++;
329 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
330 inti
->extcall
.code
, 0);
331 rc
= put_guest_lc(vcpu
, 0x1202, (u16
*)__LC_EXT_INT_CODE
);
332 rc
|= put_guest_lc(vcpu
, inti
->extcall
.code
,
333 (u16
*)__LC_EXT_CPU_ADDR
);
334 rc
|= write_guest_lc(vcpu
, __LC_EXT_OLD_PSW
,
335 &vcpu
->arch
.sie_block
->gpsw
,
337 rc
|= read_guest_lc(vcpu
, __LC_EXT_NEW_PSW
,
338 &vcpu
->arch
.sie_block
->gpsw
,
341 case KVM_S390_INT_CLOCK_COMP
:
342 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
343 inti
->ext
.ext_params
, 0);
344 deliver_ckc_interrupt(vcpu
);
346 case KVM_S390_INT_CPU_TIMER
:
347 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
348 inti
->ext
.ext_params
, 0);
349 rc
= put_guest_lc(vcpu
, EXT_IRQ_CPU_TIMER
,
350 (u16
*)__LC_EXT_INT_CODE
);
351 rc
|= write_guest_lc(vcpu
, __LC_EXT_OLD_PSW
,
352 &vcpu
->arch
.sie_block
->gpsw
,
354 rc
|= read_guest_lc(vcpu
, __LC_EXT_NEW_PSW
,
355 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
356 rc
|= put_guest_lc(vcpu
, inti
->ext
.ext_params
,
357 (u32
*)__LC_EXT_PARAMS
);
359 case KVM_S390_INT_SERVICE
:
360 VCPU_EVENT(vcpu
, 4, "interrupt: sclp parm:%x",
361 inti
->ext
.ext_params
);
362 vcpu
->stat
.deliver_service_signal
++;
363 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
364 inti
->ext
.ext_params
, 0);
365 rc
= put_guest_lc(vcpu
, 0x2401, (u16
*)__LC_EXT_INT_CODE
);
366 rc
|= write_guest_lc(vcpu
, __LC_EXT_OLD_PSW
,
367 &vcpu
->arch
.sie_block
->gpsw
,
369 rc
|= read_guest_lc(vcpu
, __LC_EXT_NEW_PSW
,
370 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
371 rc
|= put_guest_lc(vcpu
, inti
->ext
.ext_params
,
372 (u32
*)__LC_EXT_PARAMS
);
374 case KVM_S390_INT_PFAULT_INIT
:
375 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
, 0,
376 inti
->ext
.ext_params2
);
377 rc
= put_guest_lc(vcpu
, 0x2603, (u16
*) __LC_EXT_INT_CODE
);
378 rc
|= put_guest_lc(vcpu
, 0x0600, (u16
*) __LC_EXT_CPU_ADDR
);
379 rc
|= write_guest_lc(vcpu
, __LC_EXT_OLD_PSW
,
380 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
381 rc
|= read_guest_lc(vcpu
, __LC_EXT_NEW_PSW
,
382 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
383 rc
|= put_guest_lc(vcpu
, inti
->ext
.ext_params2
,
384 (u64
*) __LC_EXT_PARAMS2
);
386 case KVM_S390_INT_PFAULT_DONE
:
387 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
, 0,
388 inti
->ext
.ext_params2
);
389 rc
= put_guest_lc(vcpu
, 0x2603, (u16
*)__LC_EXT_INT_CODE
);
390 rc
|= put_guest_lc(vcpu
, 0x0680, (u16
*)__LC_EXT_CPU_ADDR
);
391 rc
|= write_guest_lc(vcpu
, __LC_EXT_OLD_PSW
,
392 &vcpu
->arch
.sie_block
->gpsw
,
394 rc
|= read_guest_lc(vcpu
, __LC_EXT_NEW_PSW
,
395 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
396 rc
|= put_guest_lc(vcpu
, inti
->ext
.ext_params2
,
397 (u64
*)__LC_EXT_PARAMS2
);
399 case KVM_S390_INT_VIRTIO
:
400 VCPU_EVENT(vcpu
, 4, "interrupt: virtio parm:%x,parm64:%llx",
401 inti
->ext
.ext_params
, inti
->ext
.ext_params2
);
402 vcpu
->stat
.deliver_virtio_interrupt
++;
403 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
404 inti
->ext
.ext_params
,
405 inti
->ext
.ext_params2
);
406 rc
= put_guest_lc(vcpu
, 0x2603, (u16
*)__LC_EXT_INT_CODE
);
407 rc
|= put_guest_lc(vcpu
, 0x0d00, (u16
*)__LC_EXT_CPU_ADDR
);
408 rc
|= write_guest_lc(vcpu
, __LC_EXT_OLD_PSW
,
409 &vcpu
->arch
.sie_block
->gpsw
,
411 rc
|= read_guest_lc(vcpu
, __LC_EXT_NEW_PSW
,
412 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
413 rc
|= put_guest_lc(vcpu
, inti
->ext
.ext_params
,
414 (u32
*)__LC_EXT_PARAMS
);
415 rc
|= put_guest_lc(vcpu
, inti
->ext
.ext_params2
,
416 (u64
*)__LC_EXT_PARAMS2
);
418 case KVM_S390_SIGP_STOP
:
419 VCPU_EVENT(vcpu
, 4, "%s", "interrupt: cpu stop");
420 vcpu
->stat
.deliver_stop_signal
++;
421 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
423 __set_intercept_indicator(vcpu
, inti
);
426 case KVM_S390_SIGP_SET_PREFIX
:
427 VCPU_EVENT(vcpu
, 4, "interrupt: set prefix to %x",
428 inti
->prefix
.address
);
429 vcpu
->stat
.deliver_prefix_signal
++;
430 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
431 inti
->prefix
.address
, 0);
432 kvm_s390_set_prefix(vcpu
, inti
->prefix
.address
);
435 case KVM_S390_RESTART
:
436 VCPU_EVENT(vcpu
, 4, "%s", "interrupt: cpu restart");
437 vcpu
->stat
.deliver_restart_signal
++;
438 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
440 rc
= write_guest_lc(vcpu
,
441 offsetof(struct _lowcore
, restart_old_psw
),
442 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
443 rc
|= read_guest_lc(vcpu
, offsetof(struct _lowcore
, restart_psw
),
444 &vcpu
->arch
.sie_block
->gpsw
,
446 kvm_s390_vcpu_start(vcpu
);
448 case KVM_S390_PROGRAM_INT
:
449 VCPU_EVENT(vcpu
, 4, "interrupt: pgm check code:%x, ilc:%x",
451 table
[vcpu
->arch
.sie_block
->ipa
>> 14]);
452 vcpu
->stat
.deliver_program_int
++;
453 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
455 rc
= __deliver_prog_irq(vcpu
, &inti
->pgm
);
459 VCPU_EVENT(vcpu
, 4, "interrupt: machine check mcic=%llx",
461 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
464 rc
= kvm_s390_vcpu_store_status(vcpu
,
465 KVM_S390_STORE_STATUS_PREFIXED
);
466 rc
|= put_guest_lc(vcpu
, inti
->mchk
.mcic
, (u64
*)__LC_MCCK_CODE
);
467 rc
|= write_guest_lc(vcpu
, __LC_MCK_OLD_PSW
,
468 &vcpu
->arch
.sie_block
->gpsw
,
470 rc
|= read_guest_lc(vcpu
, __LC_MCK_NEW_PSW
,
471 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
474 case KVM_S390_INT_IO_MIN
...KVM_S390_INT_IO_MAX
:
476 __u32 param0
= ((__u32
)inti
->io
.subchannel_id
<< 16) |
477 inti
->io
.subchannel_nr
;
478 __u64 param1
= ((__u64
)inti
->io
.io_int_parm
<< 32) |
479 inti
->io
.io_int_word
;
480 VCPU_EVENT(vcpu
, 4, "interrupt: I/O %llx", inti
->type
);
481 vcpu
->stat
.deliver_io_int
++;
482 trace_kvm_s390_deliver_interrupt(vcpu
->vcpu_id
, inti
->type
,
484 rc
= put_guest_lc(vcpu
, inti
->io
.subchannel_id
,
485 (u16
*)__LC_SUBCHANNEL_ID
);
486 rc
|= put_guest_lc(vcpu
, inti
->io
.subchannel_nr
,
487 (u16
*)__LC_SUBCHANNEL_NR
);
488 rc
|= put_guest_lc(vcpu
, inti
->io
.io_int_parm
,
489 (u32
*)__LC_IO_INT_PARM
);
490 rc
|= put_guest_lc(vcpu
, inti
->io
.io_int_word
,
491 (u32
*)__LC_IO_INT_WORD
);
492 rc
|= write_guest_lc(vcpu
, __LC_IO_OLD_PSW
,
493 &vcpu
->arch
.sie_block
->gpsw
,
495 rc
|= read_guest_lc(vcpu
, __LC_IO_NEW_PSW
,
496 &vcpu
->arch
.sie_block
->gpsw
,
504 printk("kvm: The guest lowcore is not mapped during interrupt "
505 "delivery, killing userspace\n");
510 static void deliver_ckc_interrupt(struct kvm_vcpu
*vcpu
)
514 rc
= put_guest_lc(vcpu
, 0x1004, (u16 __user
*)__LC_EXT_INT_CODE
);
515 rc
|= write_guest_lc(vcpu
, __LC_EXT_OLD_PSW
,
516 &vcpu
->arch
.sie_block
->gpsw
, sizeof(psw_t
));
517 rc
|= read_guest_lc(vcpu
, __LC_EXT_NEW_PSW
,
518 &vcpu
->arch
.sie_block
->gpsw
,
521 printk("kvm: The guest lowcore is not mapped during interrupt "
522 "delivery, killing userspace\n");
527 int kvm_cpu_has_interrupt(struct kvm_vcpu
*vcpu
)
529 struct kvm_s390_local_interrupt
*li
= &vcpu
->arch
.local_int
;
530 struct kvm_s390_float_interrupt
*fi
= vcpu
->arch
.local_int
.float_int
;
531 struct kvm_s390_interrupt_info
*inti
;
534 if (atomic_read(&li
->active
)) {
535 spin_lock_bh(&li
->lock
);
536 list_for_each_entry(inti
, &li
->list
, list
)
537 if (__interrupt_is_deliverable(vcpu
, inti
)) {
541 spin_unlock_bh(&li
->lock
);
544 if ((!rc
) && atomic_read(&fi
->active
)) {
545 spin_lock(&fi
->lock
);
546 list_for_each_entry(inti
, &fi
->list
, list
)
547 if (__interrupt_is_deliverable(vcpu
, inti
)) {
551 spin_unlock(&fi
->lock
);
554 if (!rc
&& kvm_cpu_has_pending_timer(vcpu
))
560 int kvm_cpu_has_pending_timer(struct kvm_vcpu
*vcpu
)
562 if (!(vcpu
->arch
.sie_block
->ckc
<
563 get_tod_clock_fast() + vcpu
->arch
.sie_block
->epoch
))
565 if (!ckc_interrupts_enabled(vcpu
))
570 int kvm_s390_handle_wait(struct kvm_vcpu
*vcpu
)
573 DECLARE_WAITQUEUE(wait
, current
);
575 vcpu
->stat
.exit_wait_state
++;
576 if (kvm_cpu_has_interrupt(vcpu
))
579 __set_cpu_idle(vcpu
);
580 spin_lock_bh(&vcpu
->arch
.local_int
.lock
);
581 vcpu
->arch
.local_int
.timer_due
= 0;
582 spin_unlock_bh(&vcpu
->arch
.local_int
.lock
);
584 if (psw_interrupts_disabled(vcpu
)) {
585 VCPU_EVENT(vcpu
, 3, "%s", "disabled wait");
586 __unset_cpu_idle(vcpu
);
587 return -EOPNOTSUPP
; /* disabled wait */
590 if (!ckc_interrupts_enabled(vcpu
)) {
591 VCPU_EVENT(vcpu
, 3, "%s", "enabled wait w/o timer");
595 now
= get_tod_clock_fast() + vcpu
->arch
.sie_block
->epoch
;
596 if (vcpu
->arch
.sie_block
->ckc
< now
) {
597 __unset_cpu_idle(vcpu
);
601 sltime
= tod_to_ns(vcpu
->arch
.sie_block
->ckc
- now
);
603 hrtimer_start(&vcpu
->arch
.ckc_timer
, ktime_set (0, sltime
) , HRTIMER_MODE_REL
);
604 VCPU_EVENT(vcpu
, 5, "enabled wait via clock comparator: %llx ns", sltime
);
606 srcu_read_unlock(&vcpu
->kvm
->srcu
, vcpu
->srcu_idx
);
607 spin_lock(&vcpu
->arch
.local_int
.float_int
->lock
);
608 spin_lock_bh(&vcpu
->arch
.local_int
.lock
);
609 add_wait_queue(&vcpu
->wq
, &wait
);
610 while (list_empty(&vcpu
->arch
.local_int
.list
) &&
611 list_empty(&vcpu
->arch
.local_int
.float_int
->list
) &&
612 (!vcpu
->arch
.local_int
.timer_due
) &&
613 !signal_pending(current
)) {
614 set_current_state(TASK_INTERRUPTIBLE
);
615 spin_unlock_bh(&vcpu
->arch
.local_int
.lock
);
616 spin_unlock(&vcpu
->arch
.local_int
.float_int
->lock
);
618 spin_lock(&vcpu
->arch
.local_int
.float_int
->lock
);
619 spin_lock_bh(&vcpu
->arch
.local_int
.lock
);
621 __unset_cpu_idle(vcpu
);
622 __set_current_state(TASK_RUNNING
);
623 remove_wait_queue(&vcpu
->wq
, &wait
);
624 spin_unlock_bh(&vcpu
->arch
.local_int
.lock
);
625 spin_unlock(&vcpu
->arch
.local_int
.float_int
->lock
);
626 vcpu
->srcu_idx
= srcu_read_lock(&vcpu
->kvm
->srcu
);
628 hrtimer_try_to_cancel(&vcpu
->arch
.ckc_timer
);
632 void kvm_s390_tasklet(unsigned long parm
)
634 struct kvm_vcpu
*vcpu
= (struct kvm_vcpu
*) parm
;
636 spin_lock(&vcpu
->arch
.local_int
.lock
);
637 vcpu
->arch
.local_int
.timer_due
= 1;
638 if (waitqueue_active(&vcpu
->wq
))
639 wake_up_interruptible(&vcpu
->wq
);
640 spin_unlock(&vcpu
->arch
.local_int
.lock
);
644 * low level hrtimer wake routine. Because this runs in hardirq context
645 * we schedule a tasklet to do the real work.
647 enum hrtimer_restart
kvm_s390_idle_wakeup(struct hrtimer
*timer
)
649 struct kvm_vcpu
*vcpu
;
651 vcpu
= container_of(timer
, struct kvm_vcpu
, arch
.ckc_timer
);
652 vcpu
->preempted
= true;
653 tasklet_schedule(&vcpu
->arch
.tasklet
);
655 return HRTIMER_NORESTART
;
658 void kvm_s390_clear_local_irqs(struct kvm_vcpu
*vcpu
)
660 struct kvm_s390_local_interrupt
*li
= &vcpu
->arch
.local_int
;
661 struct kvm_s390_interrupt_info
*n
, *inti
= NULL
;
663 spin_lock_bh(&li
->lock
);
664 list_for_each_entry_safe(inti
, n
, &li
->list
, list
) {
665 list_del(&inti
->list
);
668 atomic_set(&li
->active
, 0);
669 spin_unlock_bh(&li
->lock
);
672 void kvm_s390_deliver_pending_interrupts(struct kvm_vcpu
*vcpu
)
674 struct kvm_s390_local_interrupt
*li
= &vcpu
->arch
.local_int
;
675 struct kvm_s390_float_interrupt
*fi
= vcpu
->arch
.local_int
.float_int
;
676 struct kvm_s390_interrupt_info
*n
, *inti
= NULL
;
679 __reset_intercept_indicators(vcpu
);
680 if (atomic_read(&li
->active
)) {
683 spin_lock_bh(&li
->lock
);
684 list_for_each_entry_safe(inti
, n
, &li
->list
, list
) {
685 if (__interrupt_is_deliverable(vcpu
, inti
)) {
686 list_del(&inti
->list
);
690 __set_intercept_indicator(vcpu
, inti
);
692 if (list_empty(&li
->list
))
693 atomic_set(&li
->active
, 0);
694 spin_unlock_bh(&li
->lock
);
696 __do_deliver_interrupt(vcpu
, inti
);
702 if (kvm_cpu_has_pending_timer(vcpu
))
703 deliver_ckc_interrupt(vcpu
);
705 if (atomic_read(&fi
->active
)) {
708 spin_lock(&fi
->lock
);
709 list_for_each_entry_safe(inti
, n
, &fi
->list
, list
) {
710 if (__interrupt_is_deliverable(vcpu
, inti
)) {
711 list_del(&inti
->list
);
716 __set_intercept_indicator(vcpu
, inti
);
718 if (list_empty(&fi
->list
))
719 atomic_set(&fi
->active
, 0);
720 spin_unlock(&fi
->lock
);
722 __do_deliver_interrupt(vcpu
, inti
);
729 void kvm_s390_deliver_pending_machine_checks(struct kvm_vcpu
*vcpu
)
731 struct kvm_s390_local_interrupt
*li
= &vcpu
->arch
.local_int
;
732 struct kvm_s390_float_interrupt
*fi
= vcpu
->arch
.local_int
.float_int
;
733 struct kvm_s390_interrupt_info
*n
, *inti
= NULL
;
736 __reset_intercept_indicators(vcpu
);
737 if (atomic_read(&li
->active
)) {
740 spin_lock_bh(&li
->lock
);
741 list_for_each_entry_safe(inti
, n
, &li
->list
, list
) {
742 if ((inti
->type
== KVM_S390_MCHK
) &&
743 __interrupt_is_deliverable(vcpu
, inti
)) {
744 list_del(&inti
->list
);
748 __set_intercept_indicator(vcpu
, inti
);
750 if (list_empty(&li
->list
))
751 atomic_set(&li
->active
, 0);
752 spin_unlock_bh(&li
->lock
);
754 __do_deliver_interrupt(vcpu
, inti
);
760 if (atomic_read(&fi
->active
)) {
763 spin_lock(&fi
->lock
);
764 list_for_each_entry_safe(inti
, n
, &fi
->list
, list
) {
765 if ((inti
->type
== KVM_S390_MCHK
) &&
766 __interrupt_is_deliverable(vcpu
, inti
)) {
767 list_del(&inti
->list
);
772 __set_intercept_indicator(vcpu
, inti
);
774 if (list_empty(&fi
->list
))
775 atomic_set(&fi
->active
, 0);
776 spin_unlock(&fi
->lock
);
778 __do_deliver_interrupt(vcpu
, inti
);
785 int kvm_s390_inject_program_int(struct kvm_vcpu
*vcpu
, u16 code
)
787 struct kvm_s390_local_interrupt
*li
= &vcpu
->arch
.local_int
;
788 struct kvm_s390_interrupt_info
*inti
;
790 inti
= kzalloc(sizeof(*inti
), GFP_KERNEL
);
794 inti
->type
= KVM_S390_PROGRAM_INT
;
795 inti
->pgm
.code
= code
;
797 VCPU_EVENT(vcpu
, 3, "inject: program check %d (from kernel)", code
);
798 trace_kvm_s390_inject_vcpu(vcpu
->vcpu_id
, inti
->type
, code
, 0, 1);
799 spin_lock_bh(&li
->lock
);
800 list_add(&inti
->list
, &li
->list
);
801 atomic_set(&li
->active
, 1);
802 BUG_ON(waitqueue_active(li
->wq
));
803 spin_unlock_bh(&li
->lock
);
807 int kvm_s390_inject_prog_irq(struct kvm_vcpu
*vcpu
,
808 struct kvm_s390_pgm_info
*pgm_info
)
810 struct kvm_s390_local_interrupt
*li
= &vcpu
->arch
.local_int
;
811 struct kvm_s390_interrupt_info
*inti
;
813 inti
= kzalloc(sizeof(*inti
), GFP_KERNEL
);
817 VCPU_EVENT(vcpu
, 3, "inject: prog irq %d (from kernel)",
819 trace_kvm_s390_inject_vcpu(vcpu
->vcpu_id
, KVM_S390_PROGRAM_INT
,
820 pgm_info
->code
, 0, 1);
822 inti
->type
= KVM_S390_PROGRAM_INT
;
823 memcpy(&inti
->pgm
, pgm_info
, sizeof(inti
->pgm
));
824 spin_lock_bh(&li
->lock
);
825 list_add(&inti
->list
, &li
->list
);
826 atomic_set(&li
->active
, 1);
827 BUG_ON(waitqueue_active(li
->wq
));
828 spin_unlock_bh(&li
->lock
);
832 struct kvm_s390_interrupt_info
*kvm_s390_get_io_int(struct kvm
*kvm
,
835 struct kvm_s390_float_interrupt
*fi
;
836 struct kvm_s390_interrupt_info
*inti
, *iter
;
838 if ((!schid
&& !cr6
) || (schid
&& cr6
))
840 mutex_lock(&kvm
->lock
);
841 fi
= &kvm
->arch
.float_int
;
842 spin_lock(&fi
->lock
);
844 list_for_each_entry(iter
, &fi
->list
, list
) {
845 if (!is_ioint(iter
->type
))
848 ((cr6
& int_word_to_isc_bits(iter
->io
.io_int_word
)) == 0))
851 if (((schid
& 0x00000000ffff0000) >> 16) !=
852 iter
->io
.subchannel_id
)
854 if ((schid
& 0x000000000000ffff) !=
855 iter
->io
.subchannel_nr
)
862 list_del_init(&inti
->list
);
865 if (list_empty(&fi
->list
))
866 atomic_set(&fi
->active
, 0);
867 spin_unlock(&fi
->lock
);
868 mutex_unlock(&kvm
->lock
);
872 static int __inject_vm(struct kvm
*kvm
, struct kvm_s390_interrupt_info
*inti
)
874 struct kvm_s390_local_interrupt
*li
;
875 struct kvm_s390_float_interrupt
*fi
;
876 struct kvm_s390_interrupt_info
*iter
;
877 struct kvm_vcpu
*dst_vcpu
= NULL
;
881 mutex_lock(&kvm
->lock
);
882 fi
= &kvm
->arch
.float_int
;
883 spin_lock(&fi
->lock
);
884 if (fi
->irq_count
>= KVM_S390_MAX_FLOAT_IRQS
) {
889 if (!is_ioint(inti
->type
)) {
890 list_add_tail(&inti
->list
, &fi
->list
);
892 u64 isc_bits
= int_word_to_isc_bits(inti
->io
.io_int_word
);
894 /* Keep I/O interrupts sorted in isc order. */
895 list_for_each_entry(iter
, &fi
->list
, list
) {
896 if (!is_ioint(iter
->type
))
898 if (int_word_to_isc_bits(iter
->io
.io_int_word
)
903 list_add_tail(&inti
->list
, &iter
->list
);
905 atomic_set(&fi
->active
, 1);
906 sigcpu
= find_first_bit(fi
->idle_mask
, KVM_MAX_VCPUS
);
907 if (sigcpu
== KVM_MAX_VCPUS
) {
909 sigcpu
= fi
->next_rr_cpu
++;
910 if (sigcpu
== KVM_MAX_VCPUS
)
911 sigcpu
= fi
->next_rr_cpu
= 0;
912 } while (kvm_get_vcpu(kvm
, sigcpu
) == NULL
);
914 dst_vcpu
= kvm_get_vcpu(kvm
, sigcpu
);
915 li
= &dst_vcpu
->arch
.local_int
;
916 spin_lock_bh(&li
->lock
);
917 atomic_set_mask(CPUSTAT_EXT_INT
, li
->cpuflags
);
918 if (waitqueue_active(li
->wq
))
919 wake_up_interruptible(li
->wq
);
920 kvm_get_vcpu(kvm
, sigcpu
)->preempted
= true;
921 spin_unlock_bh(&li
->lock
);
923 spin_unlock(&fi
->lock
);
924 mutex_unlock(&kvm
->lock
);
928 int kvm_s390_inject_vm(struct kvm
*kvm
,
929 struct kvm_s390_interrupt
*s390int
)
931 struct kvm_s390_interrupt_info
*inti
;
933 inti
= kzalloc(sizeof(*inti
), GFP_KERNEL
);
937 inti
->type
= s390int
->type
;
938 switch (inti
->type
) {
939 case KVM_S390_INT_VIRTIO
:
940 VM_EVENT(kvm
, 5, "inject: virtio parm:%x,parm64:%llx",
941 s390int
->parm
, s390int
->parm64
);
942 inti
->ext
.ext_params
= s390int
->parm
;
943 inti
->ext
.ext_params2
= s390int
->parm64
;
945 case KVM_S390_INT_SERVICE
:
946 VM_EVENT(kvm
, 5, "inject: sclp parm:%x", s390int
->parm
);
947 inti
->ext
.ext_params
= s390int
->parm
;
949 case KVM_S390_INT_PFAULT_DONE
:
950 inti
->type
= s390int
->type
;
951 inti
->ext
.ext_params2
= s390int
->parm64
;
954 VM_EVENT(kvm
, 5, "inject: machine check parm64:%llx",
956 inti
->mchk
.cr14
= s390int
->parm
; /* upper bits are not used */
957 inti
->mchk
.mcic
= s390int
->parm64
;
959 case KVM_S390_INT_IO_MIN
...KVM_S390_INT_IO_MAX
:
960 if (inti
->type
& IOINT_AI_MASK
)
961 VM_EVENT(kvm
, 5, "%s", "inject: I/O (AI)");
963 VM_EVENT(kvm
, 5, "inject: I/O css %x ss %x schid %04x",
964 s390int
->type
& IOINT_CSSID_MASK
,
965 s390int
->type
& IOINT_SSID_MASK
,
966 s390int
->type
& IOINT_SCHID_MASK
);
967 inti
->io
.subchannel_id
= s390int
->parm
>> 16;
968 inti
->io
.subchannel_nr
= s390int
->parm
& 0x0000ffffu
;
969 inti
->io
.io_int_parm
= s390int
->parm64
>> 32;
970 inti
->io
.io_int_word
= s390int
->parm64
& 0x00000000ffffffffull
;
976 trace_kvm_s390_inject_vm(s390int
->type
, s390int
->parm
, s390int
->parm64
,
979 return __inject_vm(kvm
, inti
);
982 void kvm_s390_reinject_io_int(struct kvm
*kvm
,
983 struct kvm_s390_interrupt_info
*inti
)
985 __inject_vm(kvm
, inti
);
988 int kvm_s390_inject_vcpu(struct kvm_vcpu
*vcpu
,
989 struct kvm_s390_interrupt
*s390int
)
991 struct kvm_s390_local_interrupt
*li
;
992 struct kvm_s390_interrupt_info
*inti
;
994 inti
= kzalloc(sizeof(*inti
), GFP_KERNEL
);
998 switch (s390int
->type
) {
999 case KVM_S390_PROGRAM_INT
:
1000 if (s390int
->parm
& 0xffff0000) {
1004 inti
->type
= s390int
->type
;
1005 inti
->pgm
.code
= s390int
->parm
;
1006 VCPU_EVENT(vcpu
, 3, "inject: program check %d (from user)",
1009 case KVM_S390_SIGP_SET_PREFIX
:
1010 inti
->prefix
.address
= s390int
->parm
;
1011 inti
->type
= s390int
->type
;
1012 VCPU_EVENT(vcpu
, 3, "inject: set prefix to %x (from user)",
1015 case KVM_S390_SIGP_STOP
:
1016 case KVM_S390_RESTART
:
1017 case KVM_S390_INT_CLOCK_COMP
:
1018 case KVM_S390_INT_CPU_TIMER
:
1019 VCPU_EVENT(vcpu
, 3, "inject: type %x", s390int
->type
);
1020 inti
->type
= s390int
->type
;
1022 case KVM_S390_INT_EXTERNAL_CALL
:
1023 if (s390int
->parm
& 0xffff0000) {
1027 VCPU_EVENT(vcpu
, 3, "inject: external call source-cpu:%u",
1029 inti
->type
= s390int
->type
;
1030 inti
->extcall
.code
= s390int
->parm
;
1032 case KVM_S390_INT_EMERGENCY
:
1033 if (s390int
->parm
& 0xffff0000) {
1037 VCPU_EVENT(vcpu
, 3, "inject: emergency %u\n", s390int
->parm
);
1038 inti
->type
= s390int
->type
;
1039 inti
->emerg
.code
= s390int
->parm
;
1042 VCPU_EVENT(vcpu
, 5, "inject: machine check parm64:%llx",
1044 inti
->type
= s390int
->type
;
1045 inti
->mchk
.mcic
= s390int
->parm64
;
1047 case KVM_S390_INT_PFAULT_INIT
:
1048 inti
->type
= s390int
->type
;
1049 inti
->ext
.ext_params2
= s390int
->parm64
;
1051 case KVM_S390_INT_VIRTIO
:
1052 case KVM_S390_INT_SERVICE
:
1053 case KVM_S390_INT_IO_MIN
...KVM_S390_INT_IO_MAX
:
1058 trace_kvm_s390_inject_vcpu(vcpu
->vcpu_id
, s390int
->type
, s390int
->parm
,
1059 s390int
->parm64
, 2);
1061 mutex_lock(&vcpu
->kvm
->lock
);
1062 li
= &vcpu
->arch
.local_int
;
1063 spin_lock_bh(&li
->lock
);
1064 if (inti
->type
== KVM_S390_PROGRAM_INT
)
1065 list_add(&inti
->list
, &li
->list
);
1067 list_add_tail(&inti
->list
, &li
->list
);
1068 atomic_set(&li
->active
, 1);
1069 if (inti
->type
== KVM_S390_SIGP_STOP
)
1070 li
->action_bits
|= ACTION_STOP_ON_STOP
;
1071 atomic_set_mask(CPUSTAT_EXT_INT
, li
->cpuflags
);
1072 if (waitqueue_active(&vcpu
->wq
))
1073 wake_up_interruptible(&vcpu
->wq
);
1074 vcpu
->preempted
= true;
1075 spin_unlock_bh(&li
->lock
);
1076 mutex_unlock(&vcpu
->kvm
->lock
);
1080 void kvm_s390_clear_float_irqs(struct kvm
*kvm
)
1082 struct kvm_s390_float_interrupt
*fi
;
1083 struct kvm_s390_interrupt_info
*n
, *inti
= NULL
;
1085 mutex_lock(&kvm
->lock
);
1086 fi
= &kvm
->arch
.float_int
;
1087 spin_lock(&fi
->lock
);
1088 list_for_each_entry_safe(inti
, n
, &fi
->list
, list
) {
1089 list_del(&inti
->list
);
1093 atomic_set(&fi
->active
, 0);
1094 spin_unlock(&fi
->lock
);
1095 mutex_unlock(&kvm
->lock
);
1098 static inline int copy_irq_to_user(struct kvm_s390_interrupt_info
*inti
,
1101 struct kvm_s390_irq __user
*uptr
= (struct kvm_s390_irq __user
*) addr
;
1102 struct kvm_s390_irq irq
= {0};
1104 irq
.type
= inti
->type
;
1105 switch (inti
->type
) {
1106 case KVM_S390_INT_PFAULT_INIT
:
1107 case KVM_S390_INT_PFAULT_DONE
:
1108 case KVM_S390_INT_VIRTIO
:
1109 case KVM_S390_INT_SERVICE
:
1110 irq
.u
.ext
= inti
->ext
;
1112 case KVM_S390_INT_IO_MIN
...KVM_S390_INT_IO_MAX
:
1113 irq
.u
.io
= inti
->io
;
1116 irq
.u
.mchk
= inti
->mchk
;
1122 if (copy_to_user(uptr
, &irq
, sizeof(irq
)))
1128 static int get_all_floating_irqs(struct kvm
*kvm
, __u8
*buf
, __u64 len
)
1130 struct kvm_s390_interrupt_info
*inti
;
1131 struct kvm_s390_float_interrupt
*fi
;
1135 mutex_lock(&kvm
->lock
);
1136 fi
= &kvm
->arch
.float_int
;
1137 spin_lock(&fi
->lock
);
1139 list_for_each_entry(inti
, &fi
->list
, list
) {
1140 if (len
< sizeof(struct kvm_s390_irq
)) {
1141 /* signal userspace to try again */
1145 ret
= copy_irq_to_user(inti
, buf
);
1148 buf
+= sizeof(struct kvm_s390_irq
);
1149 len
-= sizeof(struct kvm_s390_irq
);
1153 spin_unlock(&fi
->lock
);
1154 mutex_unlock(&kvm
->lock
);
1156 return ret
< 0 ? ret
: n
;
1159 static int flic_get_attr(struct kvm_device
*dev
, struct kvm_device_attr
*attr
)
1163 switch (attr
->group
) {
1164 case KVM_DEV_FLIC_GET_ALL_IRQS
:
1165 r
= get_all_floating_irqs(dev
->kvm
, (u8
*) attr
->addr
,
1175 static inline int copy_irq_from_user(struct kvm_s390_interrupt_info
*inti
,
1178 struct kvm_s390_irq __user
*uptr
= (struct kvm_s390_irq __user
*) addr
;
1179 void *target
= NULL
;
1180 void __user
*source
;
1183 if (get_user(inti
->type
, (u64 __user
*)addr
))
1186 switch (inti
->type
) {
1187 case KVM_S390_INT_PFAULT_INIT
:
1188 case KVM_S390_INT_PFAULT_DONE
:
1189 case KVM_S390_INT_VIRTIO
:
1190 case KVM_S390_INT_SERVICE
:
1191 target
= (void *) &inti
->ext
;
1192 source
= &uptr
->u
.ext
;
1193 size
= sizeof(inti
->ext
);
1195 case KVM_S390_INT_IO_MIN
...KVM_S390_INT_IO_MAX
:
1196 target
= (void *) &inti
->io
;
1197 source
= &uptr
->u
.io
;
1198 size
= sizeof(inti
->io
);
1201 target
= (void *) &inti
->mchk
;
1202 source
= &uptr
->u
.mchk
;
1203 size
= sizeof(inti
->mchk
);
1209 if (copy_from_user(target
, source
, size
))
1215 static int enqueue_floating_irq(struct kvm_device
*dev
,
1216 struct kvm_device_attr
*attr
)
1218 struct kvm_s390_interrupt_info
*inti
= NULL
;
1220 int len
= attr
->attr
;
1222 if (len
% sizeof(struct kvm_s390_irq
) != 0)
1224 else if (len
> KVM_S390_FLIC_MAX_BUFFER
)
1227 while (len
>= sizeof(struct kvm_s390_irq
)) {
1228 inti
= kzalloc(sizeof(*inti
), GFP_KERNEL
);
1232 r
= copy_irq_from_user(inti
, attr
->addr
);
1237 r
= __inject_vm(dev
->kvm
, inti
);
1242 len
-= sizeof(struct kvm_s390_irq
);
1243 attr
->addr
+= sizeof(struct kvm_s390_irq
);
1249 static struct s390_io_adapter
*get_io_adapter(struct kvm
*kvm
, unsigned int id
)
1251 if (id
>= MAX_S390_IO_ADAPTERS
)
1253 return kvm
->arch
.adapters
[id
];
1256 static int register_io_adapter(struct kvm_device
*dev
,
1257 struct kvm_device_attr
*attr
)
1259 struct s390_io_adapter
*adapter
;
1260 struct kvm_s390_io_adapter adapter_info
;
1262 if (copy_from_user(&adapter_info
,
1263 (void __user
*)attr
->addr
, sizeof(adapter_info
)))
1266 if ((adapter_info
.id
>= MAX_S390_IO_ADAPTERS
) ||
1267 (dev
->kvm
->arch
.adapters
[adapter_info
.id
] != NULL
))
1270 adapter
= kzalloc(sizeof(*adapter
), GFP_KERNEL
);
1274 INIT_LIST_HEAD(&adapter
->maps
);
1275 init_rwsem(&adapter
->maps_lock
);
1276 atomic_set(&adapter
->nr_maps
, 0);
1277 adapter
->id
= adapter_info
.id
;
1278 adapter
->isc
= adapter_info
.isc
;
1279 adapter
->maskable
= adapter_info
.maskable
;
1280 adapter
->masked
= false;
1281 adapter
->swap
= adapter_info
.swap
;
1282 dev
->kvm
->arch
.adapters
[adapter
->id
] = adapter
;
1287 int kvm_s390_mask_adapter(struct kvm
*kvm
, unsigned int id
, bool masked
)
1290 struct s390_io_adapter
*adapter
= get_io_adapter(kvm
, id
);
1292 if (!adapter
|| !adapter
->maskable
)
1294 ret
= adapter
->masked
;
1295 adapter
->masked
= masked
;
1299 static int kvm_s390_adapter_map(struct kvm
*kvm
, unsigned int id
, __u64 addr
)
1301 struct s390_io_adapter
*adapter
= get_io_adapter(kvm
, id
);
1302 struct s390_map_info
*map
;
1305 if (!adapter
|| !addr
)
1308 map
= kzalloc(sizeof(*map
), GFP_KERNEL
);
1313 INIT_LIST_HEAD(&map
->list
);
1314 map
->guest_addr
= addr
;
1315 map
->addr
= gmap_translate(addr
, kvm
->arch
.gmap
);
1316 if (map
->addr
== -EFAULT
) {
1320 ret
= get_user_pages_fast(map
->addr
, 1, 1, &map
->page
);
1324 down_write(&adapter
->maps_lock
);
1325 if (atomic_inc_return(&adapter
->nr_maps
) < MAX_S390_ADAPTER_MAPS
) {
1326 list_add_tail(&map
->list
, &adapter
->maps
);
1329 put_page(map
->page
);
1332 up_write(&adapter
->maps_lock
);
1339 static int kvm_s390_adapter_unmap(struct kvm
*kvm
, unsigned int id
, __u64 addr
)
1341 struct s390_io_adapter
*adapter
= get_io_adapter(kvm
, id
);
1342 struct s390_map_info
*map
, *tmp
;
1345 if (!adapter
|| !addr
)
1348 down_write(&adapter
->maps_lock
);
1349 list_for_each_entry_safe(map
, tmp
, &adapter
->maps
, list
) {
1350 if (map
->guest_addr
== addr
) {
1352 atomic_dec(&adapter
->nr_maps
);
1353 list_del(&map
->list
);
1354 put_page(map
->page
);
1359 up_write(&adapter
->maps_lock
);
1361 return found
? 0 : -EINVAL
;
1364 void kvm_s390_destroy_adapters(struct kvm
*kvm
)
1367 struct s390_map_info
*map
, *tmp
;
1369 for (i
= 0; i
< MAX_S390_IO_ADAPTERS
; i
++) {
1370 if (!kvm
->arch
.adapters
[i
])
1372 list_for_each_entry_safe(map
, tmp
,
1373 &kvm
->arch
.adapters
[i
]->maps
, list
) {
1374 list_del(&map
->list
);
1375 put_page(map
->page
);
1378 kfree(kvm
->arch
.adapters
[i
]);
1382 static int modify_io_adapter(struct kvm_device
*dev
,
1383 struct kvm_device_attr
*attr
)
1385 struct kvm_s390_io_adapter_req req
;
1386 struct s390_io_adapter
*adapter
;
1389 if (copy_from_user(&req
, (void __user
*)attr
->addr
, sizeof(req
)))
1392 adapter
= get_io_adapter(dev
->kvm
, req
.id
);
1396 case KVM_S390_IO_ADAPTER_MASK
:
1397 ret
= kvm_s390_mask_adapter(dev
->kvm
, req
.id
, req
.mask
);
1401 case KVM_S390_IO_ADAPTER_MAP
:
1402 ret
= kvm_s390_adapter_map(dev
->kvm
, req
.id
, req
.addr
);
1404 case KVM_S390_IO_ADAPTER_UNMAP
:
1405 ret
= kvm_s390_adapter_unmap(dev
->kvm
, req
.id
, req
.addr
);
1414 static int flic_set_attr(struct kvm_device
*dev
, struct kvm_device_attr
*attr
)
1418 struct kvm_vcpu
*vcpu
;
1420 switch (attr
->group
) {
1421 case KVM_DEV_FLIC_ENQUEUE
:
1422 r
= enqueue_floating_irq(dev
, attr
);
1424 case KVM_DEV_FLIC_CLEAR_IRQS
:
1426 kvm_s390_clear_float_irqs(dev
->kvm
);
1428 case KVM_DEV_FLIC_APF_ENABLE
:
1429 dev
->kvm
->arch
.gmap
->pfault_enabled
= 1;
1431 case KVM_DEV_FLIC_APF_DISABLE_WAIT
:
1432 dev
->kvm
->arch
.gmap
->pfault_enabled
= 0;
1434 * Make sure no async faults are in transition when
1435 * clearing the queues. So we don't need to worry
1436 * about late coming workers.
1438 synchronize_srcu(&dev
->kvm
->srcu
);
1439 kvm_for_each_vcpu(i
, vcpu
, dev
->kvm
)
1440 kvm_clear_async_pf_completion_queue(vcpu
);
1442 case KVM_DEV_FLIC_ADAPTER_REGISTER
:
1443 r
= register_io_adapter(dev
, attr
);
1445 case KVM_DEV_FLIC_ADAPTER_MODIFY
:
1446 r
= modify_io_adapter(dev
, attr
);
1455 static int flic_create(struct kvm_device
*dev
, u32 type
)
1459 if (dev
->kvm
->arch
.flic
)
1461 dev
->kvm
->arch
.flic
= dev
;
1465 static void flic_destroy(struct kvm_device
*dev
)
1467 dev
->kvm
->arch
.flic
= NULL
;
1471 /* s390 floating irq controller (flic) */
1472 struct kvm_device_ops kvm_flic_ops
= {
1474 .get_attr
= flic_get_attr
,
1475 .set_attr
= flic_set_attr
,
1476 .create
= flic_create
,
1477 .destroy
= flic_destroy
,
1480 static unsigned long get_ind_bit(__u64 addr
, unsigned long bit_nr
, bool swap
)
1484 bit
= bit_nr
+ (addr
% PAGE_SIZE
) * 8;
1486 return swap
? (bit
^ (BITS_PER_LONG
- 1)) : bit
;
1489 static struct s390_map_info
*get_map_info(struct s390_io_adapter
*adapter
,
1492 struct s390_map_info
*map
;
1497 list_for_each_entry(map
, &adapter
->maps
, list
) {
1498 if (map
->guest_addr
== addr
)
1504 static int adapter_indicators_set(struct kvm
*kvm
,
1505 struct s390_io_adapter
*adapter
,
1506 struct kvm_s390_adapter_int
*adapter_int
)
1509 int summary_set
, idx
;
1510 struct s390_map_info
*info
;
1513 info
= get_map_info(adapter
, adapter_int
->ind_addr
);
1516 map
= page_address(info
->page
);
1517 bit
= get_ind_bit(info
->addr
, adapter_int
->ind_offset
, adapter
->swap
);
1519 idx
= srcu_read_lock(&kvm
->srcu
);
1520 mark_page_dirty(kvm
, info
->guest_addr
>> PAGE_SHIFT
);
1521 set_page_dirty_lock(info
->page
);
1522 info
= get_map_info(adapter
, adapter_int
->summary_addr
);
1524 srcu_read_unlock(&kvm
->srcu
, idx
);
1527 map
= page_address(info
->page
);
1528 bit
= get_ind_bit(info
->addr
, adapter_int
->summary_offset
,
1530 summary_set
= test_and_set_bit(bit
, map
);
1531 mark_page_dirty(kvm
, info
->guest_addr
>> PAGE_SHIFT
);
1532 set_page_dirty_lock(info
->page
);
1533 srcu_read_unlock(&kvm
->srcu
, idx
);
1534 return summary_set
? 0 : 1;
1538 * < 0 - not injected due to error
1539 * = 0 - coalesced, summary indicator already active
1540 * > 0 - injected interrupt
1542 static int set_adapter_int(struct kvm_kernel_irq_routing_entry
*e
,
1543 struct kvm
*kvm
, int irq_source_id
, int level
,
1547 struct s390_io_adapter
*adapter
;
1549 /* We're only interested in the 0->1 transition. */
1552 adapter
= get_io_adapter(kvm
, e
->adapter
.adapter_id
);
1555 down_read(&adapter
->maps_lock
);
1556 ret
= adapter_indicators_set(kvm
, adapter
, &e
->adapter
);
1557 up_read(&adapter
->maps_lock
);
1558 if ((ret
> 0) && !adapter
->masked
) {
1559 struct kvm_s390_interrupt s390int
= {
1560 .type
= KVM_S390_INT_IO(1, 0, 0, 0),
1562 .parm64
= (adapter
->isc
<< 27) | 0x80000000,
1564 ret
= kvm_s390_inject_vm(kvm
, &s390int
);
1571 int kvm_set_routing_entry(struct kvm_irq_routing_table
*rt
,
1572 struct kvm_kernel_irq_routing_entry
*e
,
1573 const struct kvm_irq_routing_entry
*ue
)
1578 case KVM_IRQ_ROUTING_S390_ADAPTER
:
1579 e
->set
= set_adapter_int
;
1580 e
->adapter
.summary_addr
= ue
->u
.adapter
.summary_addr
;
1581 e
->adapter
.ind_addr
= ue
->u
.adapter
.ind_addr
;
1582 e
->adapter
.summary_offset
= ue
->u
.adapter
.summary_offset
;
1583 e
->adapter
.ind_offset
= ue
->u
.adapter
.ind_offset
;
1584 e
->adapter
.adapter_id
= ue
->u
.adapter
.adapter_id
;
1594 int kvm_set_msi(struct kvm_kernel_irq_routing_entry
*e
, struct kvm
*kvm
,
1595 int irq_source_id
, int level
, bool line_status
)