interrupt.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664
  1. /*
  2. * handling kvm guest interrupts
  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. */
  12. #include <linux/interrupt.h>
  13. #include <linux/kvm_host.h>
  14. #include <linux/hrtimer.h>
  15. #include <linux/signal.h>
  16. #include <linux/slab.h>
  17. #include <asm/asm-offsets.h>
  18. #include <asm/uaccess.h>
  19. #include "kvm-s390.h"
  20. #include "gaccess.h"
  21. #include "trace-s390.h"
  22. static int psw_extint_disabled(struct kvm_vcpu *vcpu)
  23. {
  24. return !(vcpu->arch.sie_block->gpsw.mask & PSW_MASK_EXT);
  25. }
  26. static int psw_interrupts_disabled(struct kvm_vcpu *vcpu)
  27. {
  28. if ((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PER) ||
  29. (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_IO) ||
  30. (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_EXT))
  31. return 0;
  32. return 1;
  33. }
  34. static int __interrupt_is_deliverable(struct kvm_vcpu *vcpu,
  35. struct kvm_s390_interrupt_info *inti)
  36. {
  37. switch (inti->type) {
  38. case KVM_S390_INT_EXTERNAL_CALL:
  39. if (psw_extint_disabled(vcpu))
  40. return 0;
  41. if (vcpu->arch.sie_block->gcr[0] & 0x2000ul)
  42. return 1;
  43. case KVM_S390_INT_EMERGENCY:
  44. if (psw_extint_disabled(vcpu))
  45. return 0;
  46. if (vcpu->arch.sie_block->gcr[0] & 0x4000ul)
  47. return 1;
  48. return 0;
  49. case KVM_S390_INT_SERVICE:
  50. if (psw_extint_disabled(vcpu))
  51. return 0;
  52. if (vcpu->arch.sie_block->gcr[0] & 0x200ul)
  53. return 1;
  54. return 0;
  55. case KVM_S390_INT_VIRTIO:
  56. if (psw_extint_disabled(vcpu))
  57. return 0;
  58. if (vcpu->arch.sie_block->gcr[0] & 0x200ul)
  59. return 1;
  60. return 0;
  61. case KVM_S390_PROGRAM_INT:
  62. case KVM_S390_SIGP_STOP:
  63. case KVM_S390_SIGP_SET_PREFIX:
  64. case KVM_S390_RESTART:
  65. return 1;
  66. default:
  67. BUG();
  68. }
  69. return 0;
  70. }
  71. static void __set_cpu_idle(struct kvm_vcpu *vcpu)
  72. {
  73. BUG_ON(vcpu->vcpu_id > KVM_MAX_VCPUS - 1);
  74. atomic_set_mask(CPUSTAT_WAIT, &vcpu->arch.sie_block->cpuflags);
  75. set_bit(vcpu->vcpu_id, vcpu->arch.local_int.float_int->idle_mask);
  76. }
  77. static void __unset_cpu_idle(struct kvm_vcpu *vcpu)
  78. {
  79. BUG_ON(vcpu->vcpu_id > KVM_MAX_VCPUS - 1);
  80. atomic_clear_mask(CPUSTAT_WAIT, &vcpu->arch.sie_block->cpuflags);
  81. clear_bit(vcpu->vcpu_id, vcpu->arch.local_int.float_int->idle_mask);
  82. }
  83. static void __reset_intercept_indicators(struct kvm_vcpu *vcpu)
  84. {
  85. atomic_clear_mask(CPUSTAT_ECALL_PEND |
  86. CPUSTAT_IO_INT | CPUSTAT_EXT_INT | CPUSTAT_STOP_INT,
  87. &vcpu->arch.sie_block->cpuflags);
  88. vcpu->arch.sie_block->lctl = 0x0000;
  89. }
  90. static void __set_cpuflag(struct kvm_vcpu *vcpu, u32 flag)
  91. {
  92. atomic_set_mask(flag, &vcpu->arch.sie_block->cpuflags);
  93. }
  94. static void __set_intercept_indicator(struct kvm_vcpu *vcpu,
  95. struct kvm_s390_interrupt_info *inti)
  96. {
  97. switch (inti->type) {
  98. case KVM_S390_INT_EXTERNAL_CALL:
  99. case KVM_S390_INT_EMERGENCY:
  100. case KVM_S390_INT_SERVICE:
  101. case KVM_S390_INT_VIRTIO:
  102. if (psw_extint_disabled(vcpu))
  103. __set_cpuflag(vcpu, CPUSTAT_EXT_INT);
  104. else
  105. vcpu->arch.sie_block->lctl |= LCTL_CR0;
  106. break;
  107. case KVM_S390_SIGP_STOP:
  108. __set_cpuflag(vcpu, CPUSTAT_STOP_INT);
  109. break;
  110. default:
  111. BUG();
  112. }
  113. }
  114. static void __do_deliver_interrupt(struct kvm_vcpu *vcpu,
  115. struct kvm_s390_interrupt_info *inti)
  116. {
  117. const unsigned short table[] = { 2, 4, 4, 6 };
  118. int rc, exception = 0;
  119. switch (inti->type) {
  120. case KVM_S390_INT_EMERGENCY:
  121. VCPU_EVENT(vcpu, 4, "%s", "interrupt: sigp emerg");
  122. vcpu->stat.deliver_emergency_signal++;
  123. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  124. inti->emerg.code, 0);
  125. rc = put_guest_u16(vcpu, __LC_EXT_INT_CODE, 0x1201);
  126. if (rc == -EFAULT)
  127. exception = 1;
  128. rc = put_guest_u16(vcpu, __LC_EXT_CPU_ADDR, inti->emerg.code);
  129. if (rc == -EFAULT)
  130. exception = 1;
  131. rc = copy_to_guest(vcpu, __LC_EXT_OLD_PSW,
  132. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  133. if (rc == -EFAULT)
  134. exception = 1;
  135. rc = copy_from_guest(vcpu, &vcpu->arch.sie_block->gpsw,
  136. __LC_EXT_NEW_PSW, sizeof(psw_t));
  137. if (rc == -EFAULT)
  138. exception = 1;
  139. break;
  140. case KVM_S390_INT_EXTERNAL_CALL:
  141. VCPU_EVENT(vcpu, 4, "%s", "interrupt: sigp ext call");
  142. vcpu->stat.deliver_external_call++;
  143. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  144. inti->extcall.code, 0);
  145. rc = put_guest_u16(vcpu, __LC_EXT_INT_CODE, 0x1202);
  146. if (rc == -EFAULT)
  147. exception = 1;
  148. rc = put_guest_u16(vcpu, __LC_EXT_CPU_ADDR, inti->extcall.code);
  149. if (rc == -EFAULT)
  150. exception = 1;
  151. rc = copy_to_guest(vcpu, __LC_EXT_OLD_PSW,
  152. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  153. if (rc == -EFAULT)
  154. exception = 1;
  155. rc = copy_from_guest(vcpu, &vcpu->arch.sie_block->gpsw,
  156. __LC_EXT_NEW_PSW, sizeof(psw_t));
  157. if (rc == -EFAULT)
  158. exception = 1;
  159. break;
  160. case KVM_S390_INT_SERVICE:
  161. VCPU_EVENT(vcpu, 4, "interrupt: sclp parm:%x",
  162. inti->ext.ext_params);
  163. vcpu->stat.deliver_service_signal++;
  164. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  165. inti->ext.ext_params, 0);
  166. rc = put_guest_u16(vcpu, __LC_EXT_INT_CODE, 0x2401);
  167. if (rc == -EFAULT)
  168. exception = 1;
  169. rc = copy_to_guest(vcpu, __LC_EXT_OLD_PSW,
  170. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  171. if (rc == -EFAULT)
  172. exception = 1;
  173. rc = copy_from_guest(vcpu, &vcpu->arch.sie_block->gpsw,
  174. __LC_EXT_NEW_PSW, sizeof(psw_t));
  175. if (rc == -EFAULT)
  176. exception = 1;
  177. rc = put_guest_u32(vcpu, __LC_EXT_PARAMS, inti->ext.ext_params);
  178. if (rc == -EFAULT)
  179. exception = 1;
  180. break;
  181. case KVM_S390_INT_VIRTIO:
  182. VCPU_EVENT(vcpu, 4, "interrupt: virtio parm:%x,parm64:%llx",
  183. inti->ext.ext_params, inti->ext.ext_params2);
  184. vcpu->stat.deliver_virtio_interrupt++;
  185. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  186. inti->ext.ext_params,
  187. inti->ext.ext_params2);
  188. rc = put_guest_u16(vcpu, __LC_EXT_INT_CODE, 0x2603);
  189. if (rc == -EFAULT)
  190. exception = 1;
  191. rc = put_guest_u16(vcpu, __LC_EXT_CPU_ADDR, 0x0d00);
  192. if (rc == -EFAULT)
  193. exception = 1;
  194. rc = copy_to_guest(vcpu, __LC_EXT_OLD_PSW,
  195. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  196. if (rc == -EFAULT)
  197. exception = 1;
  198. rc = copy_from_guest(vcpu, &vcpu->arch.sie_block->gpsw,
  199. __LC_EXT_NEW_PSW, sizeof(psw_t));
  200. if (rc == -EFAULT)
  201. exception = 1;
  202. rc = put_guest_u32(vcpu, __LC_EXT_PARAMS, inti->ext.ext_params);
  203. if (rc == -EFAULT)
  204. exception = 1;
  205. rc = put_guest_u64(vcpu, __LC_EXT_PARAMS2,
  206. inti->ext.ext_params2);
  207. if (rc == -EFAULT)
  208. exception = 1;
  209. break;
  210. case KVM_S390_SIGP_STOP:
  211. VCPU_EVENT(vcpu, 4, "%s", "interrupt: cpu stop");
  212. vcpu->stat.deliver_stop_signal++;
  213. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  214. 0, 0);
  215. __set_intercept_indicator(vcpu, inti);
  216. break;
  217. case KVM_S390_SIGP_SET_PREFIX:
  218. VCPU_EVENT(vcpu, 4, "interrupt: set prefix to %x",
  219. inti->prefix.address);
  220. vcpu->stat.deliver_prefix_signal++;
  221. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  222. inti->prefix.address, 0);
  223. kvm_s390_set_prefix(vcpu, inti->prefix.address);
  224. break;
  225. case KVM_S390_RESTART:
  226. VCPU_EVENT(vcpu, 4, "%s", "interrupt: cpu restart");
  227. vcpu->stat.deliver_restart_signal++;
  228. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  229. 0, 0);
  230. rc = copy_to_guest(vcpu, offsetof(struct _lowcore,
  231. restart_old_psw), &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  232. if (rc == -EFAULT)
  233. exception = 1;
  234. rc = copy_from_guest(vcpu, &vcpu->arch.sie_block->gpsw,
  235. offsetof(struct _lowcore, restart_psw), sizeof(psw_t));
  236. if (rc == -EFAULT)
  237. exception = 1;
  238. atomic_clear_mask(CPUSTAT_STOPPED, &vcpu->arch.sie_block->cpuflags);
  239. break;
  240. case KVM_S390_PROGRAM_INT:
  241. VCPU_EVENT(vcpu, 4, "interrupt: pgm check code:%x, ilc:%x",
  242. inti->pgm.code,
  243. table[vcpu->arch.sie_block->ipa >> 14]);
  244. vcpu->stat.deliver_program_int++;
  245. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  246. inti->pgm.code, 0);
  247. rc = put_guest_u16(vcpu, __LC_PGM_INT_CODE, inti->pgm.code);
  248. if (rc == -EFAULT)
  249. exception = 1;
  250. rc = put_guest_u16(vcpu, __LC_PGM_ILC,
  251. table[vcpu->arch.sie_block->ipa >> 14]);
  252. if (rc == -EFAULT)
  253. exception = 1;
  254. rc = copy_to_guest(vcpu, __LC_PGM_OLD_PSW,
  255. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  256. if (rc == -EFAULT)
  257. exception = 1;
  258. rc = copy_from_guest(vcpu, &vcpu->arch.sie_block->gpsw,
  259. __LC_PGM_NEW_PSW, sizeof(psw_t));
  260. if (rc == -EFAULT)
  261. exception = 1;
  262. break;
  263. default:
  264. BUG();
  265. }
  266. if (exception) {
  267. printk("kvm: The guest lowcore is not mapped during interrupt "
  268. "delivery, killing userspace\n");
  269. do_exit(SIGKILL);
  270. }
  271. }
  272. static int __try_deliver_ckc_interrupt(struct kvm_vcpu *vcpu)
  273. {
  274. int rc, exception = 0;
  275. if (psw_extint_disabled(vcpu))
  276. return 0;
  277. if (!(vcpu->arch.sie_block->gcr[0] & 0x800ul))
  278. return 0;
  279. rc = put_guest_u16(vcpu, __LC_EXT_INT_CODE, 0x1004);
  280. if (rc == -EFAULT)
  281. exception = 1;
  282. rc = copy_to_guest(vcpu, __LC_EXT_OLD_PSW,
  283. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  284. if (rc == -EFAULT)
  285. exception = 1;
  286. rc = copy_from_guest(vcpu, &vcpu->arch.sie_block->gpsw,
  287. __LC_EXT_NEW_PSW, sizeof(psw_t));
  288. if (rc == -EFAULT)
  289. exception = 1;
  290. if (exception) {
  291. printk("kvm: The guest lowcore is not mapped during interrupt "
  292. "delivery, killing userspace\n");
  293. do_exit(SIGKILL);
  294. }
  295. return 1;
  296. }
  297. static int kvm_cpu_has_interrupt(struct kvm_vcpu *vcpu)
  298. {
  299. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  300. struct kvm_s390_float_interrupt *fi = vcpu->arch.local_int.float_int;
  301. struct kvm_s390_interrupt_info *inti;
  302. int rc = 0;
  303. if (atomic_read(&li->active)) {
  304. spin_lock_bh(&li->lock);
  305. list_for_each_entry(inti, &li->list, list)
  306. if (__interrupt_is_deliverable(vcpu, inti)) {
  307. rc = 1;
  308. break;
  309. }
  310. spin_unlock_bh(&li->lock);
  311. }
  312. if ((!rc) && atomic_read(&fi->active)) {
  313. spin_lock(&fi->lock);
  314. list_for_each_entry(inti, &fi->list, list)
  315. if (__interrupt_is_deliverable(vcpu, inti)) {
  316. rc = 1;
  317. break;
  318. }
  319. spin_unlock(&fi->lock);
  320. }
  321. if ((!rc) && (vcpu->arch.sie_block->ckc <
  322. get_clock() + vcpu->arch.sie_block->epoch)) {
  323. if ((!psw_extint_disabled(vcpu)) &&
  324. (vcpu->arch.sie_block->gcr[0] & 0x800ul))
  325. rc = 1;
  326. }
  327. return rc;
  328. }
  329. int kvm_cpu_has_pending_timer(struct kvm_vcpu *vcpu)
  330. {
  331. return 0;
  332. }
  333. int kvm_s390_handle_wait(struct kvm_vcpu *vcpu)
  334. {
  335. u64 now, sltime;
  336. DECLARE_WAITQUEUE(wait, current);
  337. vcpu->stat.exit_wait_state++;
  338. if (kvm_cpu_has_interrupt(vcpu))
  339. return 0;
  340. __set_cpu_idle(vcpu);
  341. spin_lock_bh(&vcpu->arch.local_int.lock);
  342. vcpu->arch.local_int.timer_due = 0;
  343. spin_unlock_bh(&vcpu->arch.local_int.lock);
  344. if (psw_interrupts_disabled(vcpu)) {
  345. VCPU_EVENT(vcpu, 3, "%s", "disabled wait");
  346. __unset_cpu_idle(vcpu);
  347. return -EOPNOTSUPP; /* disabled wait */
  348. }
  349. if (psw_extint_disabled(vcpu) ||
  350. (!(vcpu->arch.sie_block->gcr[0] & 0x800ul))) {
  351. VCPU_EVENT(vcpu, 3, "%s", "enabled wait w/o timer");
  352. goto no_timer;
  353. }
  354. now = get_clock() + vcpu->arch.sie_block->epoch;
  355. if (vcpu->arch.sie_block->ckc < now) {
  356. __unset_cpu_idle(vcpu);
  357. return 0;
  358. }
  359. sltime = ((vcpu->arch.sie_block->ckc - now)*125)>>9;
  360. hrtimer_start(&vcpu->arch.ckc_timer, ktime_set (0, sltime) , HRTIMER_MODE_REL);
  361. VCPU_EVENT(vcpu, 5, "enabled wait via clock comparator: %llx ns", sltime);
  362. no_timer:
  363. spin_lock(&vcpu->arch.local_int.float_int->lock);
  364. spin_lock_bh(&vcpu->arch.local_int.lock);
  365. add_wait_queue(&vcpu->arch.local_int.wq, &wait);
  366. while (list_empty(&vcpu->arch.local_int.list) &&
  367. list_empty(&vcpu->arch.local_int.float_int->list) &&
  368. (!vcpu->arch.local_int.timer_due) &&
  369. !signal_pending(current)) {
  370. set_current_state(TASK_INTERRUPTIBLE);
  371. spin_unlock_bh(&vcpu->arch.local_int.lock);
  372. spin_unlock(&vcpu->arch.local_int.float_int->lock);
  373. vcpu_put(vcpu);
  374. schedule();
  375. vcpu_load(vcpu);
  376. spin_lock(&vcpu->arch.local_int.float_int->lock);
  377. spin_lock_bh(&vcpu->arch.local_int.lock);
  378. }
  379. __unset_cpu_idle(vcpu);
  380. __set_current_state(TASK_RUNNING);
  381. remove_wait_queue(&vcpu->arch.local_int.wq, &wait);
  382. spin_unlock_bh(&vcpu->arch.local_int.lock);
  383. spin_unlock(&vcpu->arch.local_int.float_int->lock);
  384. hrtimer_try_to_cancel(&vcpu->arch.ckc_timer);
  385. return 0;
  386. }
  387. void kvm_s390_tasklet(unsigned long parm)
  388. {
  389. struct kvm_vcpu *vcpu = (struct kvm_vcpu *) parm;
  390. spin_lock(&vcpu->arch.local_int.lock);
  391. vcpu->arch.local_int.timer_due = 1;
  392. if (waitqueue_active(&vcpu->arch.local_int.wq))
  393. wake_up_interruptible(&vcpu->arch.local_int.wq);
  394. spin_unlock(&vcpu->arch.local_int.lock);
  395. }
  396. /*
  397. * low level hrtimer wake routine. Because this runs in hardirq context
  398. * we schedule a tasklet to do the real work.
  399. */
  400. enum hrtimer_restart kvm_s390_idle_wakeup(struct hrtimer *timer)
  401. {
  402. struct kvm_vcpu *vcpu;
  403. vcpu = container_of(timer, struct kvm_vcpu, arch.ckc_timer);
  404. tasklet_schedule(&vcpu->arch.tasklet);
  405. return HRTIMER_NORESTART;
  406. }
  407. void kvm_s390_deliver_pending_interrupts(struct kvm_vcpu *vcpu)
  408. {
  409. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  410. struct kvm_s390_float_interrupt *fi = vcpu->arch.local_int.float_int;
  411. struct kvm_s390_interrupt_info *n, *inti = NULL;
  412. int deliver;
  413. __reset_intercept_indicators(vcpu);
  414. if (atomic_read(&li->active)) {
  415. do {
  416. deliver = 0;
  417. spin_lock_bh(&li->lock);
  418. list_for_each_entry_safe(inti, n, &li->list, list) {
  419. if (__interrupt_is_deliverable(vcpu, inti)) {
  420. list_del(&inti->list);
  421. deliver = 1;
  422. break;
  423. }
  424. __set_intercept_indicator(vcpu, inti);
  425. }
  426. if (list_empty(&li->list))
  427. atomic_set(&li->active, 0);
  428. spin_unlock_bh(&li->lock);
  429. if (deliver) {
  430. __do_deliver_interrupt(vcpu, inti);
  431. kfree(inti);
  432. }
  433. } while (deliver);
  434. }
  435. if ((vcpu->arch.sie_block->ckc <
  436. get_clock() + vcpu->arch.sie_block->epoch))
  437. __try_deliver_ckc_interrupt(vcpu);
  438. if (atomic_read(&fi->active)) {
  439. do {
  440. deliver = 0;
  441. spin_lock(&fi->lock);
  442. list_for_each_entry_safe(inti, n, &fi->list, list) {
  443. if (__interrupt_is_deliverable(vcpu, inti)) {
  444. list_del(&inti->list);
  445. deliver = 1;
  446. break;
  447. }
  448. __set_intercept_indicator(vcpu, inti);
  449. }
  450. if (list_empty(&fi->list))
  451. atomic_set(&fi->active, 0);
  452. spin_unlock(&fi->lock);
  453. if (deliver) {
  454. __do_deliver_interrupt(vcpu, inti);
  455. kfree(inti);
  456. }
  457. } while (deliver);
  458. }
  459. }
  460. int kvm_s390_inject_program_int(struct kvm_vcpu *vcpu, u16 code)
  461. {
  462. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  463. struct kvm_s390_interrupt_info *inti;
  464. inti = kzalloc(sizeof(*inti), GFP_KERNEL);
  465. if (!inti)
  466. return -ENOMEM;
  467. inti->type = KVM_S390_PROGRAM_INT;
  468. inti->pgm.code = code;
  469. VCPU_EVENT(vcpu, 3, "inject: program check %d (from kernel)", code);
  470. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, inti->type, code, 0, 1);
  471. spin_lock_bh(&li->lock);
  472. list_add(&inti->list, &li->list);
  473. atomic_set(&li->active, 1);
  474. BUG_ON(waitqueue_active(&li->wq));
  475. spin_unlock_bh(&li->lock);
  476. return 0;
  477. }
  478. int kvm_s390_inject_vm(struct kvm *kvm,
  479. struct kvm_s390_interrupt *s390int)
  480. {
  481. struct kvm_s390_local_interrupt *li;
  482. struct kvm_s390_float_interrupt *fi;
  483. struct kvm_s390_interrupt_info *inti;
  484. int sigcpu;
  485. inti = kzalloc(sizeof(*inti), GFP_KERNEL);
  486. if (!inti)
  487. return -ENOMEM;
  488. switch (s390int->type) {
  489. case KVM_S390_INT_VIRTIO:
  490. VM_EVENT(kvm, 5, "inject: virtio parm:%x,parm64:%llx",
  491. s390int->parm, s390int->parm64);
  492. inti->type = s390int->type;
  493. inti->ext.ext_params = s390int->parm;
  494. inti->ext.ext_params2 = s390int->parm64;
  495. break;
  496. case KVM_S390_INT_SERVICE:
  497. VM_EVENT(kvm, 5, "inject: sclp parm:%x", s390int->parm);
  498. inti->type = s390int->type;
  499. inti->ext.ext_params = s390int->parm;
  500. break;
  501. case KVM_S390_PROGRAM_INT:
  502. case KVM_S390_SIGP_STOP:
  503. case KVM_S390_INT_EXTERNAL_CALL:
  504. case KVM_S390_INT_EMERGENCY:
  505. default:
  506. kfree(inti);
  507. return -EINVAL;
  508. }
  509. trace_kvm_s390_inject_vm(s390int->type, s390int->parm, s390int->parm64,
  510. 2);
  511. mutex_lock(&kvm->lock);
  512. fi = &kvm->arch.float_int;
  513. spin_lock(&fi->lock);
  514. list_add_tail(&inti->list, &fi->list);
  515. atomic_set(&fi->active, 1);
  516. sigcpu = find_first_bit(fi->idle_mask, KVM_MAX_VCPUS);
  517. if (sigcpu == KVM_MAX_VCPUS) {
  518. do {
  519. sigcpu = fi->next_rr_cpu++;
  520. if (sigcpu == KVM_MAX_VCPUS)
  521. sigcpu = fi->next_rr_cpu = 0;
  522. } while (fi->local_int[sigcpu] == NULL);
  523. }
  524. li = fi->local_int[sigcpu];
  525. spin_lock_bh(&li->lock);
  526. atomic_set_mask(CPUSTAT_EXT_INT, li->cpuflags);
  527. if (waitqueue_active(&li->wq))
  528. wake_up_interruptible(&li->wq);
  529. spin_unlock_bh(&li->lock);
  530. spin_unlock(&fi->lock);
  531. mutex_unlock(&kvm->lock);
  532. return 0;
  533. }
  534. int kvm_s390_inject_vcpu(struct kvm_vcpu *vcpu,
  535. struct kvm_s390_interrupt *s390int)
  536. {
  537. struct kvm_s390_local_interrupt *li;
  538. struct kvm_s390_interrupt_info *inti;
  539. inti = kzalloc(sizeof(*inti), GFP_KERNEL);
  540. if (!inti)
  541. return -ENOMEM;
  542. switch (s390int->type) {
  543. case KVM_S390_PROGRAM_INT:
  544. if (s390int->parm & 0xffff0000) {
  545. kfree(inti);
  546. return -EINVAL;
  547. }
  548. inti->type = s390int->type;
  549. inti->pgm.code = s390int->parm;
  550. VCPU_EVENT(vcpu, 3, "inject: program check %d (from user)",
  551. s390int->parm);
  552. break;
  553. case KVM_S390_SIGP_SET_PREFIX:
  554. inti->prefix.address = s390int->parm;
  555. inti->type = s390int->type;
  556. VCPU_EVENT(vcpu, 3, "inject: set prefix to %x (from user)",
  557. s390int->parm);
  558. break;
  559. case KVM_S390_SIGP_STOP:
  560. case KVM_S390_RESTART:
  561. case KVM_S390_INT_EXTERNAL_CALL:
  562. case KVM_S390_INT_EMERGENCY:
  563. VCPU_EVENT(vcpu, 3, "inject: type %x", s390int->type);
  564. inti->type = s390int->type;
  565. break;
  566. case KVM_S390_INT_VIRTIO:
  567. case KVM_S390_INT_SERVICE:
  568. default:
  569. kfree(inti);
  570. return -EINVAL;
  571. }
  572. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, s390int->type, s390int->parm,
  573. s390int->parm64, 2);
  574. mutex_lock(&vcpu->kvm->lock);
  575. li = &vcpu->arch.local_int;
  576. spin_lock_bh(&li->lock);
  577. if (inti->type == KVM_S390_PROGRAM_INT)
  578. list_add(&inti->list, &li->list);
  579. else
  580. list_add_tail(&inti->list, &li->list);
  581. atomic_set(&li->active, 1);
  582. if (inti->type == KVM_S390_SIGP_STOP)
  583. li->action_bits |= ACTION_STOP_ON_STOP;
  584. atomic_set_mask(CPUSTAT_EXT_INT, li->cpuflags);
  585. if (waitqueue_active(&li->wq))
  586. wake_up_interruptible(&vcpu->arch.local_int.wq);
  587. spin_unlock_bh(&li->lock);
  588. mutex_unlock(&vcpu->kvm->lock);
  589. return 0;
  590. }