interrupt.c 50 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877
  1. /*
  2. * handling kvm guest interrupts
  3. *
  4. * Copyright IBM Corp. 2008,2014
  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/mmu_context.h>
  16. #include <linux/signal.h>
  17. #include <linux/slab.h>
  18. #include <linux/bitmap.h>
  19. #include <asm/asm-offsets.h>
  20. #include <asm/uaccess.h>
  21. #include "kvm-s390.h"
  22. #include "gaccess.h"
  23. #include "trace-s390.h"
  24. #define IOINT_SCHID_MASK 0x0000ffff
  25. #define IOINT_SSID_MASK 0x00030000
  26. #define IOINT_CSSID_MASK 0x03fc0000
  27. #define IOINT_AI_MASK 0x04000000
  28. #define PFAULT_INIT 0x0600
  29. #define PFAULT_DONE 0x0680
  30. #define VIRTIO_PARAM 0x0d00
  31. static int is_ioint(u64 type)
  32. {
  33. return ((type & 0xfffe0000u) != 0xfffe0000u);
  34. }
  35. int psw_extint_disabled(struct kvm_vcpu *vcpu)
  36. {
  37. return !(vcpu->arch.sie_block->gpsw.mask & PSW_MASK_EXT);
  38. }
  39. static int psw_ioint_disabled(struct kvm_vcpu *vcpu)
  40. {
  41. return !(vcpu->arch.sie_block->gpsw.mask & PSW_MASK_IO);
  42. }
  43. static int psw_mchk_disabled(struct kvm_vcpu *vcpu)
  44. {
  45. return !(vcpu->arch.sie_block->gpsw.mask & PSW_MASK_MCHECK);
  46. }
  47. static int psw_interrupts_disabled(struct kvm_vcpu *vcpu)
  48. {
  49. if ((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PER) ||
  50. (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_IO) ||
  51. (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_EXT))
  52. return 0;
  53. return 1;
  54. }
  55. static int ckc_interrupts_enabled(struct kvm_vcpu *vcpu)
  56. {
  57. if (psw_extint_disabled(vcpu) ||
  58. !(vcpu->arch.sie_block->gcr[0] & 0x800ul))
  59. return 0;
  60. if (guestdbg_enabled(vcpu) && guestdbg_sstep_enabled(vcpu))
  61. /* No timer interrupts when single stepping */
  62. return 0;
  63. return 1;
  64. }
  65. static u64 int_word_to_isc_bits(u32 int_word)
  66. {
  67. u8 isc = (int_word & 0x38000000) >> 27;
  68. return (0x80 >> isc) << 24;
  69. }
  70. static int __must_check __interrupt_is_deliverable(struct kvm_vcpu *vcpu,
  71. struct kvm_s390_interrupt_info *inti)
  72. {
  73. switch (inti->type) {
  74. case KVM_S390_INT_EXTERNAL_CALL:
  75. if (psw_extint_disabled(vcpu))
  76. return 0;
  77. if (vcpu->arch.sie_block->gcr[0] & 0x2000ul)
  78. return 1;
  79. return 0;
  80. case KVM_S390_INT_EMERGENCY:
  81. if (psw_extint_disabled(vcpu))
  82. return 0;
  83. if (vcpu->arch.sie_block->gcr[0] & 0x4000ul)
  84. return 1;
  85. return 0;
  86. case KVM_S390_INT_CLOCK_COMP:
  87. return ckc_interrupts_enabled(vcpu);
  88. case KVM_S390_INT_CPU_TIMER:
  89. if (psw_extint_disabled(vcpu))
  90. return 0;
  91. if (vcpu->arch.sie_block->gcr[0] & 0x400ul)
  92. return 1;
  93. return 0;
  94. case KVM_S390_INT_SERVICE:
  95. case KVM_S390_INT_PFAULT_INIT:
  96. case KVM_S390_INT_PFAULT_DONE:
  97. case KVM_S390_INT_VIRTIO:
  98. if (psw_extint_disabled(vcpu))
  99. return 0;
  100. if (vcpu->arch.sie_block->gcr[0] & 0x200ul)
  101. return 1;
  102. return 0;
  103. case KVM_S390_PROGRAM_INT:
  104. case KVM_S390_SIGP_STOP:
  105. case KVM_S390_SIGP_SET_PREFIX:
  106. case KVM_S390_RESTART:
  107. return 1;
  108. case KVM_S390_MCHK:
  109. if (psw_mchk_disabled(vcpu))
  110. return 0;
  111. if (vcpu->arch.sie_block->gcr[14] & inti->mchk.cr14)
  112. return 1;
  113. return 0;
  114. case KVM_S390_INT_IO_MIN...KVM_S390_INT_IO_MAX:
  115. if (psw_ioint_disabled(vcpu))
  116. return 0;
  117. if (vcpu->arch.sie_block->gcr[6] &
  118. int_word_to_isc_bits(inti->io.io_int_word))
  119. return 1;
  120. return 0;
  121. default:
  122. printk(KERN_WARNING "illegal interrupt type %llx\n",
  123. inti->type);
  124. BUG();
  125. }
  126. return 0;
  127. }
  128. static inline unsigned long pending_local_irqs(struct kvm_vcpu *vcpu)
  129. {
  130. return vcpu->arch.local_int.pending_irqs;
  131. }
  132. static unsigned long deliverable_local_irqs(struct kvm_vcpu *vcpu)
  133. {
  134. unsigned long active_mask = pending_local_irqs(vcpu);
  135. if (psw_extint_disabled(vcpu))
  136. active_mask &= ~IRQ_PEND_EXT_MASK;
  137. if (!(vcpu->arch.sie_block->gcr[0] & 0x2000ul))
  138. __clear_bit(IRQ_PEND_EXT_EXTERNAL, &active_mask);
  139. if (!(vcpu->arch.sie_block->gcr[0] & 0x4000ul))
  140. __clear_bit(IRQ_PEND_EXT_EMERGENCY, &active_mask);
  141. if (!(vcpu->arch.sie_block->gcr[0] & 0x800ul))
  142. __clear_bit(IRQ_PEND_EXT_CLOCK_COMP, &active_mask);
  143. if (!(vcpu->arch.sie_block->gcr[0] & 0x400ul))
  144. __clear_bit(IRQ_PEND_EXT_CPU_TIMER, &active_mask);
  145. if (psw_mchk_disabled(vcpu))
  146. active_mask &= ~IRQ_PEND_MCHK_MASK;
  147. return active_mask;
  148. }
  149. static void __set_cpu_idle(struct kvm_vcpu *vcpu)
  150. {
  151. atomic_set_mask(CPUSTAT_WAIT, &vcpu->arch.sie_block->cpuflags);
  152. set_bit(vcpu->vcpu_id, vcpu->arch.local_int.float_int->idle_mask);
  153. }
  154. static void __unset_cpu_idle(struct kvm_vcpu *vcpu)
  155. {
  156. atomic_clear_mask(CPUSTAT_WAIT, &vcpu->arch.sie_block->cpuflags);
  157. clear_bit(vcpu->vcpu_id, vcpu->arch.local_int.float_int->idle_mask);
  158. }
  159. static void __reset_intercept_indicators(struct kvm_vcpu *vcpu)
  160. {
  161. atomic_clear_mask(CPUSTAT_IO_INT | CPUSTAT_EXT_INT | CPUSTAT_STOP_INT,
  162. &vcpu->arch.sie_block->cpuflags);
  163. vcpu->arch.sie_block->lctl = 0x0000;
  164. vcpu->arch.sie_block->ictl &= ~(ICTL_LPSW | ICTL_STCTL | ICTL_PINT);
  165. if (guestdbg_enabled(vcpu)) {
  166. vcpu->arch.sie_block->lctl |= (LCTL_CR0 | LCTL_CR9 |
  167. LCTL_CR10 | LCTL_CR11);
  168. vcpu->arch.sie_block->ictl |= (ICTL_STCTL | ICTL_PINT);
  169. }
  170. if (vcpu->arch.local_int.action_bits & ACTION_STOP_ON_STOP)
  171. atomic_set_mask(CPUSTAT_STOP_INT, &vcpu->arch.sie_block->cpuflags);
  172. }
  173. static void __set_cpuflag(struct kvm_vcpu *vcpu, u32 flag)
  174. {
  175. atomic_set_mask(flag, &vcpu->arch.sie_block->cpuflags);
  176. }
  177. static void set_intercept_indicators_ext(struct kvm_vcpu *vcpu)
  178. {
  179. if (!(pending_local_irqs(vcpu) & IRQ_PEND_EXT_MASK))
  180. return;
  181. if (psw_extint_disabled(vcpu))
  182. __set_cpuflag(vcpu, CPUSTAT_EXT_INT);
  183. else
  184. vcpu->arch.sie_block->lctl |= LCTL_CR0;
  185. }
  186. static void set_intercept_indicators_mchk(struct kvm_vcpu *vcpu)
  187. {
  188. if (!(pending_local_irqs(vcpu) & IRQ_PEND_MCHK_MASK))
  189. return;
  190. if (psw_mchk_disabled(vcpu))
  191. vcpu->arch.sie_block->ictl |= ICTL_LPSW;
  192. else
  193. vcpu->arch.sie_block->lctl |= LCTL_CR14;
  194. }
  195. /* Set interception request for non-deliverable local interrupts */
  196. static void set_intercept_indicators_local(struct kvm_vcpu *vcpu)
  197. {
  198. set_intercept_indicators_ext(vcpu);
  199. set_intercept_indicators_mchk(vcpu);
  200. }
  201. static void __set_intercept_indicator(struct kvm_vcpu *vcpu,
  202. struct kvm_s390_interrupt_info *inti)
  203. {
  204. switch (inti->type) {
  205. case KVM_S390_INT_SERVICE:
  206. case KVM_S390_INT_PFAULT_DONE:
  207. case KVM_S390_INT_VIRTIO:
  208. if (psw_extint_disabled(vcpu))
  209. __set_cpuflag(vcpu, CPUSTAT_EXT_INT);
  210. else
  211. vcpu->arch.sie_block->lctl |= LCTL_CR0;
  212. break;
  213. case KVM_S390_MCHK:
  214. if (psw_mchk_disabled(vcpu))
  215. vcpu->arch.sie_block->ictl |= ICTL_LPSW;
  216. else
  217. vcpu->arch.sie_block->lctl |= LCTL_CR14;
  218. break;
  219. case KVM_S390_INT_IO_MIN...KVM_S390_INT_IO_MAX:
  220. if (psw_ioint_disabled(vcpu))
  221. __set_cpuflag(vcpu, CPUSTAT_IO_INT);
  222. else
  223. vcpu->arch.sie_block->lctl |= LCTL_CR6;
  224. break;
  225. default:
  226. BUG();
  227. }
  228. }
  229. static u16 get_ilc(struct kvm_vcpu *vcpu)
  230. {
  231. const unsigned short table[] = { 2, 4, 4, 6 };
  232. switch (vcpu->arch.sie_block->icptcode) {
  233. case ICPT_INST:
  234. case ICPT_INSTPROGI:
  235. case ICPT_OPEREXC:
  236. case ICPT_PARTEXEC:
  237. case ICPT_IOINST:
  238. /* last instruction only stored for these icptcodes */
  239. return table[vcpu->arch.sie_block->ipa >> 14];
  240. case ICPT_PROGI:
  241. return vcpu->arch.sie_block->pgmilc;
  242. default:
  243. return 0;
  244. }
  245. }
  246. static int __must_check __deliver_cpu_timer(struct kvm_vcpu *vcpu)
  247. {
  248. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  249. int rc;
  250. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, KVM_S390_INT_CPU_TIMER,
  251. 0, 0);
  252. rc = put_guest_lc(vcpu, EXT_IRQ_CPU_TIMER,
  253. (u16 *)__LC_EXT_INT_CODE);
  254. rc |= put_guest_lc(vcpu, 0, (u16 *)__LC_EXT_CPU_ADDR);
  255. rc |= write_guest_lc(vcpu, __LC_EXT_OLD_PSW,
  256. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  257. rc |= read_guest_lc(vcpu, __LC_EXT_NEW_PSW,
  258. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  259. clear_bit(IRQ_PEND_EXT_CPU_TIMER, &li->pending_irqs);
  260. return rc ? -EFAULT : 0;
  261. }
  262. static int __must_check __deliver_ckc(struct kvm_vcpu *vcpu)
  263. {
  264. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  265. int rc;
  266. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, KVM_S390_INT_CLOCK_COMP,
  267. 0, 0);
  268. rc = put_guest_lc(vcpu, EXT_IRQ_CLK_COMP,
  269. (u16 __user *)__LC_EXT_INT_CODE);
  270. rc |= put_guest_lc(vcpu, 0, (u16 *)__LC_EXT_CPU_ADDR);
  271. rc |= write_guest_lc(vcpu, __LC_EXT_OLD_PSW,
  272. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  273. rc |= read_guest_lc(vcpu, __LC_EXT_NEW_PSW,
  274. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  275. clear_bit(IRQ_PEND_EXT_CLOCK_COMP, &li->pending_irqs);
  276. return rc ? -EFAULT : 0;
  277. }
  278. static int __must_check __deliver_pfault_init(struct kvm_vcpu *vcpu)
  279. {
  280. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  281. struct kvm_s390_ext_info ext;
  282. int rc;
  283. spin_lock(&li->lock);
  284. ext = li->irq.ext;
  285. clear_bit(IRQ_PEND_PFAULT_INIT, &li->pending_irqs);
  286. li->irq.ext.ext_params2 = 0;
  287. spin_unlock(&li->lock);
  288. VCPU_EVENT(vcpu, 4, "interrupt: pfault init parm:%x,parm64:%llx",
  289. 0, ext.ext_params2);
  290. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id,
  291. KVM_S390_INT_PFAULT_INIT,
  292. 0, ext.ext_params2);
  293. rc = put_guest_lc(vcpu, EXT_IRQ_CP_SERVICE, (u16 *) __LC_EXT_INT_CODE);
  294. rc |= put_guest_lc(vcpu, PFAULT_INIT, (u16 *) __LC_EXT_CPU_ADDR);
  295. rc |= write_guest_lc(vcpu, __LC_EXT_OLD_PSW,
  296. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  297. rc |= read_guest_lc(vcpu, __LC_EXT_NEW_PSW,
  298. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  299. rc |= put_guest_lc(vcpu, ext.ext_params2, (u64 *) __LC_EXT_PARAMS2);
  300. return rc ? -EFAULT : 0;
  301. }
  302. static int __must_check __deliver_machine_check(struct kvm_vcpu *vcpu)
  303. {
  304. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  305. struct kvm_s390_mchk_info mchk;
  306. int rc;
  307. spin_lock(&li->lock);
  308. mchk = li->irq.mchk;
  309. /*
  310. * If there was an exigent machine check pending, then any repressible
  311. * machine checks that might have been pending are indicated along
  312. * with it, so always clear both bits
  313. */
  314. clear_bit(IRQ_PEND_MCHK_EX, &li->pending_irqs);
  315. clear_bit(IRQ_PEND_MCHK_REP, &li->pending_irqs);
  316. memset(&li->irq.mchk, 0, sizeof(mchk));
  317. spin_unlock(&li->lock);
  318. VCPU_EVENT(vcpu, 4, "interrupt: machine check mcic=%llx",
  319. mchk.mcic);
  320. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, KVM_S390_MCHK,
  321. mchk.cr14, mchk.mcic);
  322. rc = kvm_s390_vcpu_store_status(vcpu, KVM_S390_STORE_STATUS_PREFIXED);
  323. rc |= put_guest_lc(vcpu, mchk.mcic,
  324. (u64 __user *) __LC_MCCK_CODE);
  325. rc |= put_guest_lc(vcpu, mchk.failing_storage_address,
  326. (u64 __user *) __LC_MCCK_FAIL_STOR_ADDR);
  327. rc |= write_guest_lc(vcpu, __LC_PSW_SAVE_AREA,
  328. &mchk.fixed_logout, sizeof(mchk.fixed_logout));
  329. rc |= write_guest_lc(vcpu, __LC_MCK_OLD_PSW,
  330. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  331. rc |= read_guest_lc(vcpu, __LC_MCK_NEW_PSW,
  332. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  333. return rc ? -EFAULT : 0;
  334. }
  335. static int __must_check __deliver_restart(struct kvm_vcpu *vcpu)
  336. {
  337. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  338. int rc;
  339. VCPU_EVENT(vcpu, 4, "%s", "interrupt: cpu restart");
  340. vcpu->stat.deliver_restart_signal++;
  341. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, KVM_S390_RESTART, 0, 0);
  342. rc = write_guest_lc(vcpu,
  343. offsetof(struct _lowcore, restart_old_psw),
  344. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  345. rc |= read_guest_lc(vcpu, offsetof(struct _lowcore, restart_psw),
  346. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  347. clear_bit(IRQ_PEND_RESTART, &li->pending_irqs);
  348. return rc ? -EFAULT : 0;
  349. }
  350. static int __must_check __deliver_stop(struct kvm_vcpu *vcpu)
  351. {
  352. VCPU_EVENT(vcpu, 4, "%s", "interrupt: cpu stop");
  353. vcpu->stat.deliver_stop_signal++;
  354. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, KVM_S390_SIGP_STOP,
  355. 0, 0);
  356. __set_cpuflag(vcpu, CPUSTAT_STOP_INT);
  357. clear_bit(IRQ_PEND_SIGP_STOP, &vcpu->arch.local_int.pending_irqs);
  358. return 0;
  359. }
  360. static int __must_check __deliver_set_prefix(struct kvm_vcpu *vcpu)
  361. {
  362. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  363. struct kvm_s390_prefix_info prefix;
  364. spin_lock(&li->lock);
  365. prefix = li->irq.prefix;
  366. li->irq.prefix.address = 0;
  367. clear_bit(IRQ_PEND_SET_PREFIX, &li->pending_irqs);
  368. spin_unlock(&li->lock);
  369. VCPU_EVENT(vcpu, 4, "interrupt: set prefix to %x", prefix.address);
  370. vcpu->stat.deliver_prefix_signal++;
  371. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id,
  372. KVM_S390_SIGP_SET_PREFIX,
  373. prefix.address, 0);
  374. kvm_s390_set_prefix(vcpu, prefix.address);
  375. return 0;
  376. }
  377. static int __must_check __deliver_emergency_signal(struct kvm_vcpu *vcpu)
  378. {
  379. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  380. int rc;
  381. int cpu_addr;
  382. spin_lock(&li->lock);
  383. cpu_addr = find_first_bit(li->sigp_emerg_pending, KVM_MAX_VCPUS);
  384. clear_bit(cpu_addr, li->sigp_emerg_pending);
  385. if (bitmap_empty(li->sigp_emerg_pending, KVM_MAX_VCPUS))
  386. clear_bit(IRQ_PEND_EXT_EMERGENCY, &li->pending_irqs);
  387. spin_unlock(&li->lock);
  388. VCPU_EVENT(vcpu, 4, "%s", "interrupt: sigp emerg");
  389. vcpu->stat.deliver_emergency_signal++;
  390. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, KVM_S390_INT_EMERGENCY,
  391. cpu_addr, 0);
  392. rc = put_guest_lc(vcpu, EXT_IRQ_EMERGENCY_SIG,
  393. (u16 *)__LC_EXT_INT_CODE);
  394. rc |= put_guest_lc(vcpu, cpu_addr, (u16 *)__LC_EXT_CPU_ADDR);
  395. rc |= write_guest_lc(vcpu, __LC_EXT_OLD_PSW,
  396. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  397. rc |= read_guest_lc(vcpu, __LC_EXT_NEW_PSW,
  398. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  399. return rc ? -EFAULT : 0;
  400. }
  401. static int __must_check __deliver_external_call(struct kvm_vcpu *vcpu)
  402. {
  403. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  404. struct kvm_s390_extcall_info extcall;
  405. int rc;
  406. spin_lock(&li->lock);
  407. extcall = li->irq.extcall;
  408. li->irq.extcall.code = 0;
  409. clear_bit(IRQ_PEND_EXT_EXTERNAL, &li->pending_irqs);
  410. spin_unlock(&li->lock);
  411. VCPU_EVENT(vcpu, 4, "%s", "interrupt: sigp ext call");
  412. vcpu->stat.deliver_external_call++;
  413. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id,
  414. KVM_S390_INT_EXTERNAL_CALL,
  415. extcall.code, 0);
  416. rc = put_guest_lc(vcpu, EXT_IRQ_EXTERNAL_CALL,
  417. (u16 *)__LC_EXT_INT_CODE);
  418. rc |= put_guest_lc(vcpu, extcall.code, (u16 *)__LC_EXT_CPU_ADDR);
  419. rc |= write_guest_lc(vcpu, __LC_EXT_OLD_PSW,
  420. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  421. rc |= read_guest_lc(vcpu, __LC_EXT_NEW_PSW, &vcpu->arch.sie_block->gpsw,
  422. sizeof(psw_t));
  423. return rc ? -EFAULT : 0;
  424. }
  425. static int __must_check __deliver_prog(struct kvm_vcpu *vcpu)
  426. {
  427. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  428. struct kvm_s390_pgm_info pgm_info;
  429. int rc = 0;
  430. u16 ilc = get_ilc(vcpu);
  431. spin_lock(&li->lock);
  432. pgm_info = li->irq.pgm;
  433. clear_bit(IRQ_PEND_PROG, &li->pending_irqs);
  434. memset(&li->irq.pgm, 0, sizeof(pgm_info));
  435. spin_unlock(&li->lock);
  436. VCPU_EVENT(vcpu, 4, "interrupt: pgm check code:%x, ilc:%x",
  437. pgm_info.code, ilc);
  438. vcpu->stat.deliver_program_int++;
  439. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, KVM_S390_PROGRAM_INT,
  440. pgm_info.code, 0);
  441. switch (pgm_info.code & ~PGM_PER) {
  442. case PGM_AFX_TRANSLATION:
  443. case PGM_ASX_TRANSLATION:
  444. case PGM_EX_TRANSLATION:
  445. case PGM_LFX_TRANSLATION:
  446. case PGM_LSTE_SEQUENCE:
  447. case PGM_LSX_TRANSLATION:
  448. case PGM_LX_TRANSLATION:
  449. case PGM_PRIMARY_AUTHORITY:
  450. case PGM_SECONDARY_AUTHORITY:
  451. case PGM_SPACE_SWITCH:
  452. rc = put_guest_lc(vcpu, pgm_info.trans_exc_code,
  453. (u64 *)__LC_TRANS_EXC_CODE);
  454. break;
  455. case PGM_ALEN_TRANSLATION:
  456. case PGM_ALE_SEQUENCE:
  457. case PGM_ASTE_INSTANCE:
  458. case PGM_ASTE_SEQUENCE:
  459. case PGM_ASTE_VALIDITY:
  460. case PGM_EXTENDED_AUTHORITY:
  461. rc = put_guest_lc(vcpu, pgm_info.exc_access_id,
  462. (u8 *)__LC_EXC_ACCESS_ID);
  463. break;
  464. case PGM_ASCE_TYPE:
  465. case PGM_PAGE_TRANSLATION:
  466. case PGM_REGION_FIRST_TRANS:
  467. case PGM_REGION_SECOND_TRANS:
  468. case PGM_REGION_THIRD_TRANS:
  469. case PGM_SEGMENT_TRANSLATION:
  470. rc = put_guest_lc(vcpu, pgm_info.trans_exc_code,
  471. (u64 *)__LC_TRANS_EXC_CODE);
  472. rc |= put_guest_lc(vcpu, pgm_info.exc_access_id,
  473. (u8 *)__LC_EXC_ACCESS_ID);
  474. rc |= put_guest_lc(vcpu, pgm_info.op_access_id,
  475. (u8 *)__LC_OP_ACCESS_ID);
  476. break;
  477. case PGM_MONITOR:
  478. rc = put_guest_lc(vcpu, pgm_info.mon_class_nr,
  479. (u16 *)__LC_MON_CLASS_NR);
  480. rc |= put_guest_lc(vcpu, pgm_info.mon_code,
  481. (u64 *)__LC_MON_CODE);
  482. break;
  483. case PGM_DATA:
  484. rc = put_guest_lc(vcpu, pgm_info.data_exc_code,
  485. (u32 *)__LC_DATA_EXC_CODE);
  486. break;
  487. case PGM_PROTECTION:
  488. rc = put_guest_lc(vcpu, pgm_info.trans_exc_code,
  489. (u64 *)__LC_TRANS_EXC_CODE);
  490. rc |= put_guest_lc(vcpu, pgm_info.exc_access_id,
  491. (u8 *)__LC_EXC_ACCESS_ID);
  492. break;
  493. }
  494. if (pgm_info.code & PGM_PER) {
  495. rc |= put_guest_lc(vcpu, pgm_info.per_code,
  496. (u8 *) __LC_PER_CODE);
  497. rc |= put_guest_lc(vcpu, pgm_info.per_atmid,
  498. (u8 *)__LC_PER_ATMID);
  499. rc |= put_guest_lc(vcpu, pgm_info.per_address,
  500. (u64 *) __LC_PER_ADDRESS);
  501. rc |= put_guest_lc(vcpu, pgm_info.per_access_id,
  502. (u8 *) __LC_PER_ACCESS_ID);
  503. }
  504. rc |= put_guest_lc(vcpu, ilc, (u16 *) __LC_PGM_ILC);
  505. rc |= put_guest_lc(vcpu, pgm_info.code,
  506. (u16 *)__LC_PGM_INT_CODE);
  507. rc |= write_guest_lc(vcpu, __LC_PGM_OLD_PSW,
  508. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  509. rc |= read_guest_lc(vcpu, __LC_PGM_NEW_PSW,
  510. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  511. return rc ? -EFAULT : 0;
  512. }
  513. static int __must_check __deliver_service(struct kvm_vcpu *vcpu,
  514. struct kvm_s390_interrupt_info *inti)
  515. {
  516. int rc;
  517. VCPU_EVENT(vcpu, 4, "interrupt: sclp parm:%x",
  518. inti->ext.ext_params);
  519. vcpu->stat.deliver_service_signal++;
  520. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  521. inti->ext.ext_params, 0);
  522. rc = put_guest_lc(vcpu, EXT_IRQ_SERVICE_SIG, (u16 *)__LC_EXT_INT_CODE);
  523. rc |= put_guest_lc(vcpu, 0, (u16 *)__LC_EXT_CPU_ADDR);
  524. rc |= write_guest_lc(vcpu, __LC_EXT_OLD_PSW,
  525. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  526. rc |= read_guest_lc(vcpu, __LC_EXT_NEW_PSW,
  527. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  528. rc |= put_guest_lc(vcpu, inti->ext.ext_params,
  529. (u32 *)__LC_EXT_PARAMS);
  530. return rc ? -EFAULT : 0;
  531. }
  532. static int __must_check __deliver_pfault_done(struct kvm_vcpu *vcpu,
  533. struct kvm_s390_interrupt_info *inti)
  534. {
  535. int rc;
  536. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id,
  537. KVM_S390_INT_PFAULT_DONE, 0,
  538. inti->ext.ext_params2);
  539. rc = put_guest_lc(vcpu, EXT_IRQ_CP_SERVICE, (u16 *)__LC_EXT_INT_CODE);
  540. rc |= put_guest_lc(vcpu, PFAULT_DONE, (u16 *)__LC_EXT_CPU_ADDR);
  541. rc |= write_guest_lc(vcpu, __LC_EXT_OLD_PSW,
  542. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  543. rc |= read_guest_lc(vcpu, __LC_EXT_NEW_PSW,
  544. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  545. rc |= put_guest_lc(vcpu, inti->ext.ext_params2,
  546. (u64 *)__LC_EXT_PARAMS2);
  547. return rc ? -EFAULT : 0;
  548. }
  549. static int __must_check __deliver_virtio(struct kvm_vcpu *vcpu,
  550. struct kvm_s390_interrupt_info *inti)
  551. {
  552. int rc;
  553. VCPU_EVENT(vcpu, 4, "interrupt: virtio parm:%x,parm64:%llx",
  554. inti->ext.ext_params, inti->ext.ext_params2);
  555. vcpu->stat.deliver_virtio_interrupt++;
  556. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  557. inti->ext.ext_params,
  558. inti->ext.ext_params2);
  559. rc = put_guest_lc(vcpu, EXT_IRQ_CP_SERVICE, (u16 *)__LC_EXT_INT_CODE);
  560. rc |= put_guest_lc(vcpu, VIRTIO_PARAM, (u16 *)__LC_EXT_CPU_ADDR);
  561. rc |= write_guest_lc(vcpu, __LC_EXT_OLD_PSW,
  562. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  563. rc |= read_guest_lc(vcpu, __LC_EXT_NEW_PSW,
  564. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  565. rc |= put_guest_lc(vcpu, inti->ext.ext_params,
  566. (u32 *)__LC_EXT_PARAMS);
  567. rc |= put_guest_lc(vcpu, inti->ext.ext_params2,
  568. (u64 *)__LC_EXT_PARAMS2);
  569. return rc ? -EFAULT : 0;
  570. }
  571. static int __must_check __deliver_io(struct kvm_vcpu *vcpu,
  572. struct kvm_s390_interrupt_info *inti)
  573. {
  574. int rc;
  575. VCPU_EVENT(vcpu, 4, "interrupt: I/O %llx", inti->type);
  576. vcpu->stat.deliver_io_int++;
  577. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, inti->type,
  578. ((__u32)inti->io.subchannel_id << 16) |
  579. inti->io.subchannel_nr,
  580. ((__u64)inti->io.io_int_parm << 32) |
  581. inti->io.io_int_word);
  582. rc = put_guest_lc(vcpu, inti->io.subchannel_id,
  583. (u16 *)__LC_SUBCHANNEL_ID);
  584. rc |= put_guest_lc(vcpu, inti->io.subchannel_nr,
  585. (u16 *)__LC_SUBCHANNEL_NR);
  586. rc |= put_guest_lc(vcpu, inti->io.io_int_parm,
  587. (u32 *)__LC_IO_INT_PARM);
  588. rc |= put_guest_lc(vcpu, inti->io.io_int_word,
  589. (u32 *)__LC_IO_INT_WORD);
  590. rc |= write_guest_lc(vcpu, __LC_IO_OLD_PSW,
  591. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  592. rc |= read_guest_lc(vcpu, __LC_IO_NEW_PSW,
  593. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  594. return rc ? -EFAULT : 0;
  595. }
  596. static int __must_check __deliver_mchk_floating(struct kvm_vcpu *vcpu,
  597. struct kvm_s390_interrupt_info *inti)
  598. {
  599. struct kvm_s390_mchk_info *mchk = &inti->mchk;
  600. int rc;
  601. VCPU_EVENT(vcpu, 4, "interrupt: machine check mcic=%llx",
  602. mchk->mcic);
  603. trace_kvm_s390_deliver_interrupt(vcpu->vcpu_id, KVM_S390_MCHK,
  604. mchk->cr14, mchk->mcic);
  605. rc = kvm_s390_vcpu_store_status(vcpu, KVM_S390_STORE_STATUS_PREFIXED);
  606. rc |= put_guest_lc(vcpu, mchk->mcic,
  607. (u64 __user *) __LC_MCCK_CODE);
  608. rc |= put_guest_lc(vcpu, mchk->failing_storage_address,
  609. (u64 __user *) __LC_MCCK_FAIL_STOR_ADDR);
  610. rc |= write_guest_lc(vcpu, __LC_PSW_SAVE_AREA,
  611. &mchk->fixed_logout, sizeof(mchk->fixed_logout));
  612. rc |= write_guest_lc(vcpu, __LC_MCK_OLD_PSW,
  613. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  614. rc |= read_guest_lc(vcpu, __LC_MCK_NEW_PSW,
  615. &vcpu->arch.sie_block->gpsw, sizeof(psw_t));
  616. return rc ? -EFAULT : 0;
  617. }
  618. typedef int (*deliver_irq_t)(struct kvm_vcpu *vcpu);
  619. static const deliver_irq_t deliver_irq_funcs[] = {
  620. [IRQ_PEND_MCHK_EX] = __deliver_machine_check,
  621. [IRQ_PEND_PROG] = __deliver_prog,
  622. [IRQ_PEND_EXT_EMERGENCY] = __deliver_emergency_signal,
  623. [IRQ_PEND_EXT_EXTERNAL] = __deliver_external_call,
  624. [IRQ_PEND_EXT_CLOCK_COMP] = __deliver_ckc,
  625. [IRQ_PEND_EXT_CPU_TIMER] = __deliver_cpu_timer,
  626. [IRQ_PEND_RESTART] = __deliver_restart,
  627. [IRQ_PEND_SIGP_STOP] = __deliver_stop,
  628. [IRQ_PEND_SET_PREFIX] = __deliver_set_prefix,
  629. [IRQ_PEND_PFAULT_INIT] = __deliver_pfault_init,
  630. };
  631. static int __must_check __deliver_floating_interrupt(struct kvm_vcpu *vcpu,
  632. struct kvm_s390_interrupt_info *inti)
  633. {
  634. int rc;
  635. switch (inti->type) {
  636. case KVM_S390_INT_SERVICE:
  637. rc = __deliver_service(vcpu, inti);
  638. break;
  639. case KVM_S390_INT_PFAULT_DONE:
  640. rc = __deliver_pfault_done(vcpu, inti);
  641. break;
  642. case KVM_S390_INT_VIRTIO:
  643. rc = __deliver_virtio(vcpu, inti);
  644. break;
  645. case KVM_S390_MCHK:
  646. rc = __deliver_mchk_floating(vcpu, inti);
  647. break;
  648. case KVM_S390_INT_IO_MIN...KVM_S390_INT_IO_MAX:
  649. rc = __deliver_io(vcpu, inti);
  650. break;
  651. default:
  652. BUG();
  653. }
  654. return rc;
  655. }
  656. /* Check whether SIGP interpretation facility has an external call pending */
  657. int kvm_s390_si_ext_call_pending(struct kvm_vcpu *vcpu)
  658. {
  659. atomic_t *sigp_ctrl = &vcpu->kvm->arch.sca->cpu[vcpu->vcpu_id].ctrl;
  660. if (!psw_extint_disabled(vcpu) &&
  661. (vcpu->arch.sie_block->gcr[0] & 0x2000ul) &&
  662. (atomic_read(sigp_ctrl) & SIGP_CTRL_C) &&
  663. (atomic_read(&vcpu->arch.sie_block->cpuflags) & CPUSTAT_ECALL_PEND))
  664. return 1;
  665. return 0;
  666. }
  667. int kvm_cpu_has_interrupt(struct kvm_vcpu *vcpu)
  668. {
  669. struct kvm_s390_float_interrupt *fi = vcpu->arch.local_int.float_int;
  670. struct kvm_s390_interrupt_info *inti;
  671. int rc;
  672. rc = !!deliverable_local_irqs(vcpu);
  673. if ((!rc) && atomic_read(&fi->active)) {
  674. spin_lock(&fi->lock);
  675. list_for_each_entry(inti, &fi->list, list)
  676. if (__interrupt_is_deliverable(vcpu, inti)) {
  677. rc = 1;
  678. break;
  679. }
  680. spin_unlock(&fi->lock);
  681. }
  682. if (!rc && kvm_cpu_has_pending_timer(vcpu))
  683. rc = 1;
  684. if (!rc && kvm_s390_si_ext_call_pending(vcpu))
  685. rc = 1;
  686. return rc;
  687. }
  688. int kvm_cpu_has_pending_timer(struct kvm_vcpu *vcpu)
  689. {
  690. if (!(vcpu->arch.sie_block->ckc <
  691. get_tod_clock_fast() + vcpu->arch.sie_block->epoch))
  692. return 0;
  693. if (!ckc_interrupts_enabled(vcpu))
  694. return 0;
  695. return 1;
  696. }
  697. int kvm_s390_handle_wait(struct kvm_vcpu *vcpu)
  698. {
  699. u64 now, sltime;
  700. vcpu->stat.exit_wait_state++;
  701. /* fast path */
  702. if (kvm_cpu_has_pending_timer(vcpu) || kvm_arch_vcpu_runnable(vcpu))
  703. return 0;
  704. if (psw_interrupts_disabled(vcpu)) {
  705. VCPU_EVENT(vcpu, 3, "%s", "disabled wait");
  706. return -EOPNOTSUPP; /* disabled wait */
  707. }
  708. __set_cpu_idle(vcpu);
  709. if (!ckc_interrupts_enabled(vcpu)) {
  710. VCPU_EVENT(vcpu, 3, "%s", "enabled wait w/o timer");
  711. goto no_timer;
  712. }
  713. now = get_tod_clock_fast() + vcpu->arch.sie_block->epoch;
  714. sltime = tod_to_ns(vcpu->arch.sie_block->ckc - now);
  715. hrtimer_start(&vcpu->arch.ckc_timer, ktime_set (0, sltime) , HRTIMER_MODE_REL);
  716. VCPU_EVENT(vcpu, 5, "enabled wait via clock comparator: %llx ns", sltime);
  717. no_timer:
  718. srcu_read_unlock(&vcpu->kvm->srcu, vcpu->srcu_idx);
  719. kvm_vcpu_block(vcpu);
  720. __unset_cpu_idle(vcpu);
  721. vcpu->srcu_idx = srcu_read_lock(&vcpu->kvm->srcu);
  722. hrtimer_try_to_cancel(&vcpu->arch.ckc_timer);
  723. return 0;
  724. }
  725. void kvm_s390_vcpu_wakeup(struct kvm_vcpu *vcpu)
  726. {
  727. if (waitqueue_active(&vcpu->wq)) {
  728. /*
  729. * The vcpu gave up the cpu voluntarily, mark it as a good
  730. * yield-candidate.
  731. */
  732. vcpu->preempted = true;
  733. wake_up_interruptible(&vcpu->wq);
  734. vcpu->stat.halt_wakeup++;
  735. }
  736. }
  737. enum hrtimer_restart kvm_s390_idle_wakeup(struct hrtimer *timer)
  738. {
  739. struct kvm_vcpu *vcpu;
  740. vcpu = container_of(timer, struct kvm_vcpu, arch.ckc_timer);
  741. kvm_s390_vcpu_wakeup(vcpu);
  742. return HRTIMER_NORESTART;
  743. }
  744. void kvm_s390_clear_local_irqs(struct kvm_vcpu *vcpu)
  745. {
  746. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  747. spin_lock(&li->lock);
  748. li->pending_irqs = 0;
  749. bitmap_zero(li->sigp_emerg_pending, KVM_MAX_VCPUS);
  750. memset(&li->irq, 0, sizeof(li->irq));
  751. spin_unlock(&li->lock);
  752. /* clear pending external calls set by sigp interpretation facility */
  753. atomic_clear_mask(CPUSTAT_ECALL_PEND, li->cpuflags);
  754. atomic_clear_mask(SIGP_CTRL_C,
  755. &vcpu->kvm->arch.sca->cpu[vcpu->vcpu_id].ctrl);
  756. }
  757. int __must_check kvm_s390_deliver_pending_interrupts(struct kvm_vcpu *vcpu)
  758. {
  759. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  760. struct kvm_s390_float_interrupt *fi = vcpu->arch.local_int.float_int;
  761. struct kvm_s390_interrupt_info *n, *inti = NULL;
  762. deliver_irq_t func;
  763. int deliver;
  764. int rc = 0;
  765. unsigned long irq_type;
  766. unsigned long deliverable_irqs;
  767. __reset_intercept_indicators(vcpu);
  768. /* pending ckc conditions might have been invalidated */
  769. clear_bit(IRQ_PEND_EXT_CLOCK_COMP, &li->pending_irqs);
  770. if (kvm_cpu_has_pending_timer(vcpu))
  771. set_bit(IRQ_PEND_EXT_CLOCK_COMP, &li->pending_irqs);
  772. do {
  773. deliverable_irqs = deliverable_local_irqs(vcpu);
  774. /* bits are in the order of interrupt priority */
  775. irq_type = find_first_bit(&deliverable_irqs, IRQ_PEND_COUNT);
  776. if (irq_type == IRQ_PEND_COUNT)
  777. break;
  778. func = deliver_irq_funcs[irq_type];
  779. if (!func) {
  780. WARN_ON_ONCE(func == NULL);
  781. clear_bit(irq_type, &li->pending_irqs);
  782. continue;
  783. }
  784. rc = func(vcpu);
  785. } while (!rc && irq_type != IRQ_PEND_COUNT);
  786. set_intercept_indicators_local(vcpu);
  787. if (!rc && atomic_read(&fi->active)) {
  788. do {
  789. deliver = 0;
  790. spin_lock(&fi->lock);
  791. list_for_each_entry_safe(inti, n, &fi->list, list) {
  792. if (__interrupt_is_deliverable(vcpu, inti)) {
  793. list_del(&inti->list);
  794. fi->irq_count--;
  795. deliver = 1;
  796. break;
  797. }
  798. __set_intercept_indicator(vcpu, inti);
  799. }
  800. if (list_empty(&fi->list))
  801. atomic_set(&fi->active, 0);
  802. spin_unlock(&fi->lock);
  803. if (deliver) {
  804. rc = __deliver_floating_interrupt(vcpu, inti);
  805. kfree(inti);
  806. }
  807. } while (!rc && deliver);
  808. }
  809. return rc;
  810. }
  811. static int __inject_prog(struct kvm_vcpu *vcpu, struct kvm_s390_irq *irq)
  812. {
  813. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  814. li->irq.pgm = irq->u.pgm;
  815. set_bit(IRQ_PEND_PROG, &li->pending_irqs);
  816. return 0;
  817. }
  818. int kvm_s390_inject_program_int(struct kvm_vcpu *vcpu, u16 code)
  819. {
  820. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  821. struct kvm_s390_irq irq;
  822. VCPU_EVENT(vcpu, 3, "inject: program check %d (from kernel)", code);
  823. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_PROGRAM_INT, code,
  824. 0, 1);
  825. spin_lock(&li->lock);
  826. irq.u.pgm.code = code;
  827. __inject_prog(vcpu, &irq);
  828. BUG_ON(waitqueue_active(li->wq));
  829. spin_unlock(&li->lock);
  830. return 0;
  831. }
  832. int kvm_s390_inject_prog_irq(struct kvm_vcpu *vcpu,
  833. struct kvm_s390_pgm_info *pgm_info)
  834. {
  835. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  836. struct kvm_s390_irq irq;
  837. int rc;
  838. VCPU_EVENT(vcpu, 3, "inject: prog irq %d (from kernel)",
  839. pgm_info->code);
  840. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_PROGRAM_INT,
  841. pgm_info->code, 0, 1);
  842. spin_lock(&li->lock);
  843. irq.u.pgm = *pgm_info;
  844. rc = __inject_prog(vcpu, &irq);
  845. BUG_ON(waitqueue_active(li->wq));
  846. spin_unlock(&li->lock);
  847. return rc;
  848. }
  849. static int __inject_pfault_init(struct kvm_vcpu *vcpu, struct kvm_s390_irq *irq)
  850. {
  851. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  852. VCPU_EVENT(vcpu, 3, "inject: external irq params:%x, params2:%llx",
  853. irq->u.ext.ext_params, irq->u.ext.ext_params2);
  854. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_INT_PFAULT_INIT,
  855. irq->u.ext.ext_params,
  856. irq->u.ext.ext_params2, 2);
  857. li->irq.ext = irq->u.ext;
  858. set_bit(IRQ_PEND_PFAULT_INIT, &li->pending_irqs);
  859. atomic_set_mask(CPUSTAT_EXT_INT, li->cpuflags);
  860. return 0;
  861. }
  862. int __inject_extcall(struct kvm_vcpu *vcpu, struct kvm_s390_irq *irq)
  863. {
  864. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  865. struct kvm_s390_extcall_info *extcall = &li->irq.extcall;
  866. VCPU_EVENT(vcpu, 3, "inject: external call source-cpu:%u",
  867. irq->u.extcall.code);
  868. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_INT_EXTERNAL_CALL,
  869. irq->u.extcall.code, 0, 2);
  870. *extcall = irq->u.extcall;
  871. set_bit(IRQ_PEND_EXT_EXTERNAL, &li->pending_irqs);
  872. atomic_set_mask(CPUSTAT_EXT_INT, li->cpuflags);
  873. return 0;
  874. }
  875. static int __inject_set_prefix(struct kvm_vcpu *vcpu, struct kvm_s390_irq *irq)
  876. {
  877. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  878. struct kvm_s390_prefix_info *prefix = &li->irq.prefix;
  879. VCPU_EVENT(vcpu, 3, "inject: set prefix to %x (from user)",
  880. prefix->address);
  881. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_SIGP_SET_PREFIX,
  882. prefix->address, 0, 2);
  883. *prefix = irq->u.prefix;
  884. set_bit(IRQ_PEND_SET_PREFIX, &li->pending_irqs);
  885. return 0;
  886. }
  887. static int __inject_sigp_stop(struct kvm_vcpu *vcpu, struct kvm_s390_irq *irq)
  888. {
  889. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  890. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_SIGP_STOP, 0, 0, 2);
  891. li->action_bits |= ACTION_STOP_ON_STOP;
  892. set_bit(IRQ_PEND_SIGP_STOP, &li->pending_irqs);
  893. return 0;
  894. }
  895. static int __inject_sigp_restart(struct kvm_vcpu *vcpu,
  896. struct kvm_s390_irq *irq)
  897. {
  898. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  899. VCPU_EVENT(vcpu, 3, "inject: restart type %llx", irq->type);
  900. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_RESTART, 0, 0, 2);
  901. set_bit(IRQ_PEND_RESTART, &li->pending_irqs);
  902. return 0;
  903. }
  904. static int __inject_sigp_emergency(struct kvm_vcpu *vcpu,
  905. struct kvm_s390_irq *irq)
  906. {
  907. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  908. struct kvm_s390_emerg_info *emerg = &li->irq.emerg;
  909. VCPU_EVENT(vcpu, 3, "inject: emergency %u\n",
  910. irq->u.emerg.code);
  911. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_INT_EMERGENCY,
  912. emerg->code, 0, 2);
  913. set_bit(emerg->code, li->sigp_emerg_pending);
  914. set_bit(IRQ_PEND_EXT_EMERGENCY, &li->pending_irqs);
  915. atomic_set_mask(CPUSTAT_EXT_INT, li->cpuflags);
  916. return 0;
  917. }
  918. static int __inject_mchk(struct kvm_vcpu *vcpu, struct kvm_s390_irq *irq)
  919. {
  920. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  921. struct kvm_s390_mchk_info *mchk = &li->irq.mchk;
  922. VCPU_EVENT(vcpu, 5, "inject: machine check parm64:%llx",
  923. mchk->mcic);
  924. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_MCHK, 0,
  925. mchk->mcic, 2);
  926. /*
  927. * Because repressible machine checks can be indicated along with
  928. * exigent machine checks (PoP, Chapter 11, Interruption action)
  929. * we need to combine cr14, mcic and external damage code.
  930. * Failing storage address and the logout area should not be or'ed
  931. * together, we just indicate the last occurrence of the corresponding
  932. * machine check
  933. */
  934. mchk->cr14 |= irq->u.mchk.cr14;
  935. mchk->mcic |= irq->u.mchk.mcic;
  936. mchk->ext_damage_code |= irq->u.mchk.ext_damage_code;
  937. mchk->failing_storage_address = irq->u.mchk.failing_storage_address;
  938. memcpy(&mchk->fixed_logout, &irq->u.mchk.fixed_logout,
  939. sizeof(mchk->fixed_logout));
  940. if (mchk->mcic & MCHK_EX_MASK)
  941. set_bit(IRQ_PEND_MCHK_EX, &li->pending_irqs);
  942. else if (mchk->mcic & MCHK_REP_MASK)
  943. set_bit(IRQ_PEND_MCHK_REP, &li->pending_irqs);
  944. return 0;
  945. }
  946. static int __inject_ckc(struct kvm_vcpu *vcpu)
  947. {
  948. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  949. VCPU_EVENT(vcpu, 3, "inject: type %x", KVM_S390_INT_CLOCK_COMP);
  950. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_INT_CLOCK_COMP,
  951. 0, 0, 2);
  952. set_bit(IRQ_PEND_EXT_CLOCK_COMP, &li->pending_irqs);
  953. atomic_set_mask(CPUSTAT_EXT_INT, li->cpuflags);
  954. return 0;
  955. }
  956. static int __inject_cpu_timer(struct kvm_vcpu *vcpu)
  957. {
  958. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  959. VCPU_EVENT(vcpu, 3, "inject: type %x", KVM_S390_INT_CPU_TIMER);
  960. trace_kvm_s390_inject_vcpu(vcpu->vcpu_id, KVM_S390_INT_CPU_TIMER,
  961. 0, 0, 2);
  962. set_bit(IRQ_PEND_EXT_CPU_TIMER, &li->pending_irqs);
  963. atomic_set_mask(CPUSTAT_EXT_INT, li->cpuflags);
  964. return 0;
  965. }
  966. struct kvm_s390_interrupt_info *kvm_s390_get_io_int(struct kvm *kvm,
  967. u64 cr6, u64 schid)
  968. {
  969. struct kvm_s390_float_interrupt *fi;
  970. struct kvm_s390_interrupt_info *inti, *iter;
  971. if ((!schid && !cr6) || (schid && cr6))
  972. return NULL;
  973. mutex_lock(&kvm->lock);
  974. fi = &kvm->arch.float_int;
  975. spin_lock(&fi->lock);
  976. inti = NULL;
  977. list_for_each_entry(iter, &fi->list, list) {
  978. if (!is_ioint(iter->type))
  979. continue;
  980. if (cr6 &&
  981. ((cr6 & int_word_to_isc_bits(iter->io.io_int_word)) == 0))
  982. continue;
  983. if (schid) {
  984. if (((schid & 0x00000000ffff0000) >> 16) !=
  985. iter->io.subchannel_id)
  986. continue;
  987. if ((schid & 0x000000000000ffff) !=
  988. iter->io.subchannel_nr)
  989. continue;
  990. }
  991. inti = iter;
  992. break;
  993. }
  994. if (inti) {
  995. list_del_init(&inti->list);
  996. fi->irq_count--;
  997. }
  998. if (list_empty(&fi->list))
  999. atomic_set(&fi->active, 0);
  1000. spin_unlock(&fi->lock);
  1001. mutex_unlock(&kvm->lock);
  1002. return inti;
  1003. }
  1004. static int __inject_vm(struct kvm *kvm, struct kvm_s390_interrupt_info *inti)
  1005. {
  1006. struct kvm_s390_local_interrupt *li;
  1007. struct kvm_s390_float_interrupt *fi;
  1008. struct kvm_s390_interrupt_info *iter;
  1009. struct kvm_vcpu *dst_vcpu = NULL;
  1010. int sigcpu;
  1011. int rc = 0;
  1012. mutex_lock(&kvm->lock);
  1013. fi = &kvm->arch.float_int;
  1014. spin_lock(&fi->lock);
  1015. if (fi->irq_count >= KVM_S390_MAX_FLOAT_IRQS) {
  1016. rc = -EINVAL;
  1017. goto unlock_fi;
  1018. }
  1019. fi->irq_count++;
  1020. if (!is_ioint(inti->type)) {
  1021. list_add_tail(&inti->list, &fi->list);
  1022. } else {
  1023. u64 isc_bits = int_word_to_isc_bits(inti->io.io_int_word);
  1024. /* Keep I/O interrupts sorted in isc order. */
  1025. list_for_each_entry(iter, &fi->list, list) {
  1026. if (!is_ioint(iter->type))
  1027. continue;
  1028. if (int_word_to_isc_bits(iter->io.io_int_word)
  1029. <= isc_bits)
  1030. continue;
  1031. break;
  1032. }
  1033. list_add_tail(&inti->list, &iter->list);
  1034. }
  1035. atomic_set(&fi->active, 1);
  1036. sigcpu = find_first_bit(fi->idle_mask, KVM_MAX_VCPUS);
  1037. if (sigcpu == KVM_MAX_VCPUS) {
  1038. do {
  1039. sigcpu = fi->next_rr_cpu++;
  1040. if (sigcpu == KVM_MAX_VCPUS)
  1041. sigcpu = fi->next_rr_cpu = 0;
  1042. } while (kvm_get_vcpu(kvm, sigcpu) == NULL);
  1043. }
  1044. dst_vcpu = kvm_get_vcpu(kvm, sigcpu);
  1045. li = &dst_vcpu->arch.local_int;
  1046. spin_lock(&li->lock);
  1047. switch (inti->type) {
  1048. case KVM_S390_MCHK:
  1049. atomic_set_mask(CPUSTAT_STOP_INT, li->cpuflags);
  1050. break;
  1051. case KVM_S390_INT_IO_MIN...KVM_S390_INT_IO_MAX:
  1052. atomic_set_mask(CPUSTAT_IO_INT, li->cpuflags);
  1053. break;
  1054. default:
  1055. atomic_set_mask(CPUSTAT_EXT_INT, li->cpuflags);
  1056. break;
  1057. }
  1058. spin_unlock(&li->lock);
  1059. kvm_s390_vcpu_wakeup(kvm_get_vcpu(kvm, sigcpu));
  1060. unlock_fi:
  1061. spin_unlock(&fi->lock);
  1062. mutex_unlock(&kvm->lock);
  1063. return rc;
  1064. }
  1065. int kvm_s390_inject_vm(struct kvm *kvm,
  1066. struct kvm_s390_interrupt *s390int)
  1067. {
  1068. struct kvm_s390_interrupt_info *inti;
  1069. inti = kzalloc(sizeof(*inti), GFP_KERNEL);
  1070. if (!inti)
  1071. return -ENOMEM;
  1072. inti->type = s390int->type;
  1073. switch (inti->type) {
  1074. case KVM_S390_INT_VIRTIO:
  1075. VM_EVENT(kvm, 5, "inject: virtio parm:%x,parm64:%llx",
  1076. s390int->parm, s390int->parm64);
  1077. inti->ext.ext_params = s390int->parm;
  1078. inti->ext.ext_params2 = s390int->parm64;
  1079. break;
  1080. case KVM_S390_INT_SERVICE:
  1081. VM_EVENT(kvm, 5, "inject: sclp parm:%x", s390int->parm);
  1082. inti->ext.ext_params = s390int->parm;
  1083. break;
  1084. case KVM_S390_INT_PFAULT_DONE:
  1085. inti->type = s390int->type;
  1086. inti->ext.ext_params2 = s390int->parm64;
  1087. break;
  1088. case KVM_S390_MCHK:
  1089. VM_EVENT(kvm, 5, "inject: machine check parm64:%llx",
  1090. s390int->parm64);
  1091. inti->mchk.cr14 = s390int->parm; /* upper bits are not used */
  1092. inti->mchk.mcic = s390int->parm64;
  1093. break;
  1094. case KVM_S390_INT_IO_MIN...KVM_S390_INT_IO_MAX:
  1095. if (inti->type & IOINT_AI_MASK)
  1096. VM_EVENT(kvm, 5, "%s", "inject: I/O (AI)");
  1097. else
  1098. VM_EVENT(kvm, 5, "inject: I/O css %x ss %x schid %04x",
  1099. s390int->type & IOINT_CSSID_MASK,
  1100. s390int->type & IOINT_SSID_MASK,
  1101. s390int->type & IOINT_SCHID_MASK);
  1102. inti->io.subchannel_id = s390int->parm >> 16;
  1103. inti->io.subchannel_nr = s390int->parm & 0x0000ffffu;
  1104. inti->io.io_int_parm = s390int->parm64 >> 32;
  1105. inti->io.io_int_word = s390int->parm64 & 0x00000000ffffffffull;
  1106. break;
  1107. default:
  1108. kfree(inti);
  1109. return -EINVAL;
  1110. }
  1111. trace_kvm_s390_inject_vm(s390int->type, s390int->parm, s390int->parm64,
  1112. 2);
  1113. return __inject_vm(kvm, inti);
  1114. }
  1115. void kvm_s390_reinject_io_int(struct kvm *kvm,
  1116. struct kvm_s390_interrupt_info *inti)
  1117. {
  1118. __inject_vm(kvm, inti);
  1119. }
  1120. int s390int_to_s390irq(struct kvm_s390_interrupt *s390int,
  1121. struct kvm_s390_irq *irq)
  1122. {
  1123. irq->type = s390int->type;
  1124. switch (irq->type) {
  1125. case KVM_S390_PROGRAM_INT:
  1126. if (s390int->parm & 0xffff0000)
  1127. return -EINVAL;
  1128. irq->u.pgm.code = s390int->parm;
  1129. break;
  1130. case KVM_S390_SIGP_SET_PREFIX:
  1131. irq->u.prefix.address = s390int->parm;
  1132. break;
  1133. case KVM_S390_INT_EXTERNAL_CALL:
  1134. if (irq->u.extcall.code & 0xffff0000)
  1135. return -EINVAL;
  1136. irq->u.extcall.code = s390int->parm;
  1137. break;
  1138. case KVM_S390_INT_EMERGENCY:
  1139. if (irq->u.emerg.code & 0xffff0000)
  1140. return -EINVAL;
  1141. irq->u.emerg.code = s390int->parm;
  1142. break;
  1143. case KVM_S390_MCHK:
  1144. irq->u.mchk.mcic = s390int->parm64;
  1145. break;
  1146. }
  1147. return 0;
  1148. }
  1149. int kvm_s390_inject_vcpu(struct kvm_vcpu *vcpu, struct kvm_s390_irq *irq)
  1150. {
  1151. struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
  1152. int rc;
  1153. spin_lock(&li->lock);
  1154. switch (irq->type) {
  1155. case KVM_S390_PROGRAM_INT:
  1156. VCPU_EVENT(vcpu, 3, "inject: program check %d (from user)",
  1157. irq->u.pgm.code);
  1158. rc = __inject_prog(vcpu, irq);
  1159. break;
  1160. case KVM_S390_SIGP_SET_PREFIX:
  1161. rc = __inject_set_prefix(vcpu, irq);
  1162. break;
  1163. case KVM_S390_SIGP_STOP:
  1164. rc = __inject_sigp_stop(vcpu, irq);
  1165. break;
  1166. case KVM_S390_RESTART:
  1167. rc = __inject_sigp_restart(vcpu, irq);
  1168. break;
  1169. case KVM_S390_INT_CLOCK_COMP:
  1170. rc = __inject_ckc(vcpu);
  1171. break;
  1172. case KVM_S390_INT_CPU_TIMER:
  1173. rc = __inject_cpu_timer(vcpu);
  1174. break;
  1175. case KVM_S390_INT_EXTERNAL_CALL:
  1176. rc = __inject_extcall(vcpu, irq);
  1177. break;
  1178. case KVM_S390_INT_EMERGENCY:
  1179. rc = __inject_sigp_emergency(vcpu, irq);
  1180. break;
  1181. case KVM_S390_MCHK:
  1182. rc = __inject_mchk(vcpu, irq);
  1183. break;
  1184. case KVM_S390_INT_PFAULT_INIT:
  1185. rc = __inject_pfault_init(vcpu, irq);
  1186. break;
  1187. case KVM_S390_INT_VIRTIO:
  1188. case KVM_S390_INT_SERVICE:
  1189. case KVM_S390_INT_IO_MIN...KVM_S390_INT_IO_MAX:
  1190. default:
  1191. rc = -EINVAL;
  1192. }
  1193. spin_unlock(&li->lock);
  1194. if (!rc)
  1195. kvm_s390_vcpu_wakeup(vcpu);
  1196. return rc;
  1197. }
  1198. void kvm_s390_clear_float_irqs(struct kvm *kvm)
  1199. {
  1200. struct kvm_s390_float_interrupt *fi;
  1201. struct kvm_s390_interrupt_info *n, *inti = NULL;
  1202. mutex_lock(&kvm->lock);
  1203. fi = &kvm->arch.float_int;
  1204. spin_lock(&fi->lock);
  1205. list_for_each_entry_safe(inti, n, &fi->list, list) {
  1206. list_del(&inti->list);
  1207. kfree(inti);
  1208. }
  1209. fi->irq_count = 0;
  1210. atomic_set(&fi->active, 0);
  1211. spin_unlock(&fi->lock);
  1212. mutex_unlock(&kvm->lock);
  1213. }
  1214. static inline int copy_irq_to_user(struct kvm_s390_interrupt_info *inti,
  1215. u8 *addr)
  1216. {
  1217. struct kvm_s390_irq __user *uptr = (struct kvm_s390_irq __user *) addr;
  1218. struct kvm_s390_irq irq = {0};
  1219. irq.type = inti->type;
  1220. switch (inti->type) {
  1221. case KVM_S390_INT_PFAULT_INIT:
  1222. case KVM_S390_INT_PFAULT_DONE:
  1223. case KVM_S390_INT_VIRTIO:
  1224. case KVM_S390_INT_SERVICE:
  1225. irq.u.ext = inti->ext;
  1226. break;
  1227. case KVM_S390_INT_IO_MIN...KVM_S390_INT_IO_MAX:
  1228. irq.u.io = inti->io;
  1229. break;
  1230. case KVM_S390_MCHK:
  1231. irq.u.mchk = inti->mchk;
  1232. break;
  1233. default:
  1234. return -EINVAL;
  1235. }
  1236. if (copy_to_user(uptr, &irq, sizeof(irq)))
  1237. return -EFAULT;
  1238. return 0;
  1239. }
  1240. static int get_all_floating_irqs(struct kvm *kvm, __u8 *buf, __u64 len)
  1241. {
  1242. struct kvm_s390_interrupt_info *inti;
  1243. struct kvm_s390_float_interrupt *fi;
  1244. int ret = 0;
  1245. int n = 0;
  1246. mutex_lock(&kvm->lock);
  1247. fi = &kvm->arch.float_int;
  1248. spin_lock(&fi->lock);
  1249. list_for_each_entry(inti, &fi->list, list) {
  1250. if (len < sizeof(struct kvm_s390_irq)) {
  1251. /* signal userspace to try again */
  1252. ret = -ENOMEM;
  1253. break;
  1254. }
  1255. ret = copy_irq_to_user(inti, buf);
  1256. if (ret)
  1257. break;
  1258. buf += sizeof(struct kvm_s390_irq);
  1259. len -= sizeof(struct kvm_s390_irq);
  1260. n++;
  1261. }
  1262. spin_unlock(&fi->lock);
  1263. mutex_unlock(&kvm->lock);
  1264. return ret < 0 ? ret : n;
  1265. }
  1266. static int flic_get_attr(struct kvm_device *dev, struct kvm_device_attr *attr)
  1267. {
  1268. int r;
  1269. switch (attr->group) {
  1270. case KVM_DEV_FLIC_GET_ALL_IRQS:
  1271. r = get_all_floating_irqs(dev->kvm, (u8 *) attr->addr,
  1272. attr->attr);
  1273. break;
  1274. default:
  1275. r = -EINVAL;
  1276. }
  1277. return r;
  1278. }
  1279. static inline int copy_irq_from_user(struct kvm_s390_interrupt_info *inti,
  1280. u64 addr)
  1281. {
  1282. struct kvm_s390_irq __user *uptr = (struct kvm_s390_irq __user *) addr;
  1283. void *target = NULL;
  1284. void __user *source;
  1285. u64 size;
  1286. if (get_user(inti->type, (u64 __user *)addr))
  1287. return -EFAULT;
  1288. switch (inti->type) {
  1289. case KVM_S390_INT_PFAULT_INIT:
  1290. case KVM_S390_INT_PFAULT_DONE:
  1291. case KVM_S390_INT_VIRTIO:
  1292. case KVM_S390_INT_SERVICE:
  1293. target = (void *) &inti->ext;
  1294. source = &uptr->u.ext;
  1295. size = sizeof(inti->ext);
  1296. break;
  1297. case KVM_S390_INT_IO_MIN...KVM_S390_INT_IO_MAX:
  1298. target = (void *) &inti->io;
  1299. source = &uptr->u.io;
  1300. size = sizeof(inti->io);
  1301. break;
  1302. case KVM_S390_MCHK:
  1303. target = (void *) &inti->mchk;
  1304. source = &uptr->u.mchk;
  1305. size = sizeof(inti->mchk);
  1306. break;
  1307. default:
  1308. return -EINVAL;
  1309. }
  1310. if (copy_from_user(target, source, size))
  1311. return -EFAULT;
  1312. return 0;
  1313. }
  1314. static int enqueue_floating_irq(struct kvm_device *dev,
  1315. struct kvm_device_attr *attr)
  1316. {
  1317. struct kvm_s390_interrupt_info *inti = NULL;
  1318. int r = 0;
  1319. int len = attr->attr;
  1320. if (len % sizeof(struct kvm_s390_irq) != 0)
  1321. return -EINVAL;
  1322. else if (len > KVM_S390_FLIC_MAX_BUFFER)
  1323. return -EINVAL;
  1324. while (len >= sizeof(struct kvm_s390_irq)) {
  1325. inti = kzalloc(sizeof(*inti), GFP_KERNEL);
  1326. if (!inti)
  1327. return -ENOMEM;
  1328. r = copy_irq_from_user(inti, attr->addr);
  1329. if (r) {
  1330. kfree(inti);
  1331. return r;
  1332. }
  1333. r = __inject_vm(dev->kvm, inti);
  1334. if (r) {
  1335. kfree(inti);
  1336. return r;
  1337. }
  1338. len -= sizeof(struct kvm_s390_irq);
  1339. attr->addr += sizeof(struct kvm_s390_irq);
  1340. }
  1341. return r;
  1342. }
  1343. static struct s390_io_adapter *get_io_adapter(struct kvm *kvm, unsigned int id)
  1344. {
  1345. if (id >= MAX_S390_IO_ADAPTERS)
  1346. return NULL;
  1347. return kvm->arch.adapters[id];
  1348. }
  1349. static int register_io_adapter(struct kvm_device *dev,
  1350. struct kvm_device_attr *attr)
  1351. {
  1352. struct s390_io_adapter *adapter;
  1353. struct kvm_s390_io_adapter adapter_info;
  1354. if (copy_from_user(&adapter_info,
  1355. (void __user *)attr->addr, sizeof(adapter_info)))
  1356. return -EFAULT;
  1357. if ((adapter_info.id >= MAX_S390_IO_ADAPTERS) ||
  1358. (dev->kvm->arch.adapters[adapter_info.id] != NULL))
  1359. return -EINVAL;
  1360. adapter = kzalloc(sizeof(*adapter), GFP_KERNEL);
  1361. if (!adapter)
  1362. return -ENOMEM;
  1363. INIT_LIST_HEAD(&adapter->maps);
  1364. init_rwsem(&adapter->maps_lock);
  1365. atomic_set(&adapter->nr_maps, 0);
  1366. adapter->id = adapter_info.id;
  1367. adapter->isc = adapter_info.isc;
  1368. adapter->maskable = adapter_info.maskable;
  1369. adapter->masked = false;
  1370. adapter->swap = adapter_info.swap;
  1371. dev->kvm->arch.adapters[adapter->id] = adapter;
  1372. return 0;
  1373. }
  1374. int kvm_s390_mask_adapter(struct kvm *kvm, unsigned int id, bool masked)
  1375. {
  1376. int ret;
  1377. struct s390_io_adapter *adapter = get_io_adapter(kvm, id);
  1378. if (!adapter || !adapter->maskable)
  1379. return -EINVAL;
  1380. ret = adapter->masked;
  1381. adapter->masked = masked;
  1382. return ret;
  1383. }
  1384. static int kvm_s390_adapter_map(struct kvm *kvm, unsigned int id, __u64 addr)
  1385. {
  1386. struct s390_io_adapter *adapter = get_io_adapter(kvm, id);
  1387. struct s390_map_info *map;
  1388. int ret;
  1389. if (!adapter || !addr)
  1390. return -EINVAL;
  1391. map = kzalloc(sizeof(*map), GFP_KERNEL);
  1392. if (!map) {
  1393. ret = -ENOMEM;
  1394. goto out;
  1395. }
  1396. INIT_LIST_HEAD(&map->list);
  1397. map->guest_addr = addr;
  1398. map->addr = gmap_translate(kvm->arch.gmap, addr);
  1399. if (map->addr == -EFAULT) {
  1400. ret = -EFAULT;
  1401. goto out;
  1402. }
  1403. ret = get_user_pages_fast(map->addr, 1, 1, &map->page);
  1404. if (ret < 0)
  1405. goto out;
  1406. BUG_ON(ret != 1);
  1407. down_write(&adapter->maps_lock);
  1408. if (atomic_inc_return(&adapter->nr_maps) < MAX_S390_ADAPTER_MAPS) {
  1409. list_add_tail(&map->list, &adapter->maps);
  1410. ret = 0;
  1411. } else {
  1412. put_page(map->page);
  1413. ret = -EINVAL;
  1414. }
  1415. up_write(&adapter->maps_lock);
  1416. out:
  1417. if (ret)
  1418. kfree(map);
  1419. return ret;
  1420. }
  1421. static int kvm_s390_adapter_unmap(struct kvm *kvm, unsigned int id, __u64 addr)
  1422. {
  1423. struct s390_io_adapter *adapter = get_io_adapter(kvm, id);
  1424. struct s390_map_info *map, *tmp;
  1425. int found = 0;
  1426. if (!adapter || !addr)
  1427. return -EINVAL;
  1428. down_write(&adapter->maps_lock);
  1429. list_for_each_entry_safe(map, tmp, &adapter->maps, list) {
  1430. if (map->guest_addr == addr) {
  1431. found = 1;
  1432. atomic_dec(&adapter->nr_maps);
  1433. list_del(&map->list);
  1434. put_page(map->page);
  1435. kfree(map);
  1436. break;
  1437. }
  1438. }
  1439. up_write(&adapter->maps_lock);
  1440. return found ? 0 : -EINVAL;
  1441. }
  1442. void kvm_s390_destroy_adapters(struct kvm *kvm)
  1443. {
  1444. int i;
  1445. struct s390_map_info *map, *tmp;
  1446. for (i = 0; i < MAX_S390_IO_ADAPTERS; i++) {
  1447. if (!kvm->arch.adapters[i])
  1448. continue;
  1449. list_for_each_entry_safe(map, tmp,
  1450. &kvm->arch.adapters[i]->maps, list) {
  1451. list_del(&map->list);
  1452. put_page(map->page);
  1453. kfree(map);
  1454. }
  1455. kfree(kvm->arch.adapters[i]);
  1456. }
  1457. }
  1458. static int modify_io_adapter(struct kvm_device *dev,
  1459. struct kvm_device_attr *attr)
  1460. {
  1461. struct kvm_s390_io_adapter_req req;
  1462. struct s390_io_adapter *adapter;
  1463. int ret;
  1464. if (copy_from_user(&req, (void __user *)attr->addr, sizeof(req)))
  1465. return -EFAULT;
  1466. adapter = get_io_adapter(dev->kvm, req.id);
  1467. if (!adapter)
  1468. return -EINVAL;
  1469. switch (req.type) {
  1470. case KVM_S390_IO_ADAPTER_MASK:
  1471. ret = kvm_s390_mask_adapter(dev->kvm, req.id, req.mask);
  1472. if (ret > 0)
  1473. ret = 0;
  1474. break;
  1475. case KVM_S390_IO_ADAPTER_MAP:
  1476. ret = kvm_s390_adapter_map(dev->kvm, req.id, req.addr);
  1477. break;
  1478. case KVM_S390_IO_ADAPTER_UNMAP:
  1479. ret = kvm_s390_adapter_unmap(dev->kvm, req.id, req.addr);
  1480. break;
  1481. default:
  1482. ret = -EINVAL;
  1483. }
  1484. return ret;
  1485. }
  1486. static int flic_set_attr(struct kvm_device *dev, struct kvm_device_attr *attr)
  1487. {
  1488. int r = 0;
  1489. unsigned int i;
  1490. struct kvm_vcpu *vcpu;
  1491. switch (attr->group) {
  1492. case KVM_DEV_FLIC_ENQUEUE:
  1493. r = enqueue_floating_irq(dev, attr);
  1494. break;
  1495. case KVM_DEV_FLIC_CLEAR_IRQS:
  1496. kvm_s390_clear_float_irqs(dev->kvm);
  1497. break;
  1498. case KVM_DEV_FLIC_APF_ENABLE:
  1499. dev->kvm->arch.gmap->pfault_enabled = 1;
  1500. break;
  1501. case KVM_DEV_FLIC_APF_DISABLE_WAIT:
  1502. dev->kvm->arch.gmap->pfault_enabled = 0;
  1503. /*
  1504. * Make sure no async faults are in transition when
  1505. * clearing the queues. So we don't need to worry
  1506. * about late coming workers.
  1507. */
  1508. synchronize_srcu(&dev->kvm->srcu);
  1509. kvm_for_each_vcpu(i, vcpu, dev->kvm)
  1510. kvm_clear_async_pf_completion_queue(vcpu);
  1511. break;
  1512. case KVM_DEV_FLIC_ADAPTER_REGISTER:
  1513. r = register_io_adapter(dev, attr);
  1514. break;
  1515. case KVM_DEV_FLIC_ADAPTER_MODIFY:
  1516. r = modify_io_adapter(dev, attr);
  1517. break;
  1518. default:
  1519. r = -EINVAL;
  1520. }
  1521. return r;
  1522. }
  1523. static int flic_create(struct kvm_device *dev, u32 type)
  1524. {
  1525. if (!dev)
  1526. return -EINVAL;
  1527. if (dev->kvm->arch.flic)
  1528. return -EINVAL;
  1529. dev->kvm->arch.flic = dev;
  1530. return 0;
  1531. }
  1532. static void flic_destroy(struct kvm_device *dev)
  1533. {
  1534. dev->kvm->arch.flic = NULL;
  1535. kfree(dev);
  1536. }
  1537. /* s390 floating irq controller (flic) */
  1538. struct kvm_device_ops kvm_flic_ops = {
  1539. .name = "kvm-flic",
  1540. .get_attr = flic_get_attr,
  1541. .set_attr = flic_set_attr,
  1542. .create = flic_create,
  1543. .destroy = flic_destroy,
  1544. };
  1545. static unsigned long get_ind_bit(__u64 addr, unsigned long bit_nr, bool swap)
  1546. {
  1547. unsigned long bit;
  1548. bit = bit_nr + (addr % PAGE_SIZE) * 8;
  1549. return swap ? (bit ^ (BITS_PER_LONG - 1)) : bit;
  1550. }
  1551. static struct s390_map_info *get_map_info(struct s390_io_adapter *adapter,
  1552. u64 addr)
  1553. {
  1554. struct s390_map_info *map;
  1555. if (!adapter)
  1556. return NULL;
  1557. list_for_each_entry(map, &adapter->maps, list) {
  1558. if (map->guest_addr == addr)
  1559. return map;
  1560. }
  1561. return NULL;
  1562. }
  1563. static int adapter_indicators_set(struct kvm *kvm,
  1564. struct s390_io_adapter *adapter,
  1565. struct kvm_s390_adapter_int *adapter_int)
  1566. {
  1567. unsigned long bit;
  1568. int summary_set, idx;
  1569. struct s390_map_info *info;
  1570. void *map;
  1571. info = get_map_info(adapter, adapter_int->ind_addr);
  1572. if (!info)
  1573. return -1;
  1574. map = page_address(info->page);
  1575. bit = get_ind_bit(info->addr, adapter_int->ind_offset, adapter->swap);
  1576. set_bit(bit, map);
  1577. idx = srcu_read_lock(&kvm->srcu);
  1578. mark_page_dirty(kvm, info->guest_addr >> PAGE_SHIFT);
  1579. set_page_dirty_lock(info->page);
  1580. info = get_map_info(adapter, adapter_int->summary_addr);
  1581. if (!info) {
  1582. srcu_read_unlock(&kvm->srcu, idx);
  1583. return -1;
  1584. }
  1585. map = page_address(info->page);
  1586. bit = get_ind_bit(info->addr, adapter_int->summary_offset,
  1587. adapter->swap);
  1588. summary_set = test_and_set_bit(bit, map);
  1589. mark_page_dirty(kvm, info->guest_addr >> PAGE_SHIFT);
  1590. set_page_dirty_lock(info->page);
  1591. srcu_read_unlock(&kvm->srcu, idx);
  1592. return summary_set ? 0 : 1;
  1593. }
  1594. /*
  1595. * < 0 - not injected due to error
  1596. * = 0 - coalesced, summary indicator already active
  1597. * > 0 - injected interrupt
  1598. */
  1599. static int set_adapter_int(struct kvm_kernel_irq_routing_entry *e,
  1600. struct kvm *kvm, int irq_source_id, int level,
  1601. bool line_status)
  1602. {
  1603. int ret;
  1604. struct s390_io_adapter *adapter;
  1605. /* We're only interested in the 0->1 transition. */
  1606. if (!level)
  1607. return 0;
  1608. adapter = get_io_adapter(kvm, e->adapter.adapter_id);
  1609. if (!adapter)
  1610. return -1;
  1611. down_read(&adapter->maps_lock);
  1612. ret = adapter_indicators_set(kvm, adapter, &e->adapter);
  1613. up_read(&adapter->maps_lock);
  1614. if ((ret > 0) && !adapter->masked) {
  1615. struct kvm_s390_interrupt s390int = {
  1616. .type = KVM_S390_INT_IO(1, 0, 0, 0),
  1617. .parm = 0,
  1618. .parm64 = (adapter->isc << 27) | 0x80000000,
  1619. };
  1620. ret = kvm_s390_inject_vm(kvm, &s390int);
  1621. if (ret == 0)
  1622. ret = 1;
  1623. }
  1624. return ret;
  1625. }
  1626. int kvm_set_routing_entry(struct kvm_kernel_irq_routing_entry *e,
  1627. const struct kvm_irq_routing_entry *ue)
  1628. {
  1629. int ret;
  1630. switch (ue->type) {
  1631. case KVM_IRQ_ROUTING_S390_ADAPTER:
  1632. e->set = set_adapter_int;
  1633. e->adapter.summary_addr = ue->u.adapter.summary_addr;
  1634. e->adapter.ind_addr = ue->u.adapter.ind_addr;
  1635. e->adapter.summary_offset = ue->u.adapter.summary_offset;
  1636. e->adapter.ind_offset = ue->u.adapter.ind_offset;
  1637. e->adapter.adapter_id = ue->u.adapter.adapter_id;
  1638. ret = 0;
  1639. break;
  1640. default:
  1641. ret = -EINVAL;
  1642. }
  1643. return ret;
  1644. }
  1645. int kvm_set_msi(struct kvm_kernel_irq_routing_entry *e, struct kvm *kvm,
  1646. int irq_source_id, int level, bool line_status)
  1647. {
  1648. return -EINVAL;
  1649. }