booke_interrupts.S 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516
  1. /*
  2. * This program is free software; you can redistribute it and/or modify
  3. * it under the terms of the GNU General Public License, version 2, as
  4. * published by the Free Software Foundation.
  5. *
  6. * This program is distributed in the hope that it will be useful,
  7. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  8. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  9. * GNU General Public License for more details.
  10. *
  11. * You should have received a copy of the GNU General Public License
  12. * along with this program; if not, write to the Free Software
  13. * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
  14. *
  15. * Copyright IBM Corp. 2007
  16. * Copyright 2011 Freescale Semiconductor, Inc.
  17. *
  18. * Authors: Hollis Blanchard <hollisb@us.ibm.com>
  19. */
  20. #include <asm/ppc_asm.h>
  21. #include <asm/kvm_asm.h>
  22. #include <asm/reg.h>
  23. #include <asm/mmu-44x.h>
  24. #include <asm/page.h>
  25. #include <asm/asm-offsets.h>
  26. /* The host stack layout: */
  27. #define HOST_R1 0 /* Implied by stwu. */
  28. #define HOST_CALLEE_LR 4
  29. #define HOST_RUN 8
  30. /* r2 is special: it holds 'current', and it made nonvolatile in the
  31. * kernel with the -ffixed-r2 gcc option. */
  32. #define HOST_R2 12
  33. #define HOST_CR 16
  34. #define HOST_NV_GPRS 20
  35. #define __HOST_NV_GPR(n) (HOST_NV_GPRS + ((n - 14) * 4))
  36. #define HOST_NV_GPR(n) __HOST_NV_GPR(__REG_##n)
  37. #define HOST_MIN_STACK_SIZE (HOST_NV_GPR(R31) + 4)
  38. #define HOST_STACK_SIZE (((HOST_MIN_STACK_SIZE + 15) / 16) * 16) /* Align. */
  39. #define HOST_STACK_LR (HOST_STACK_SIZE + 4) /* In caller stack frame. */
  40. #define NEED_INST_MASK ((1<<BOOKE_INTERRUPT_PROGRAM) | \
  41. (1<<BOOKE_INTERRUPT_DTLB_MISS) | \
  42. (1<<BOOKE_INTERRUPT_DEBUG))
  43. #define NEED_DEAR_MASK ((1<<BOOKE_INTERRUPT_DATA_STORAGE) | \
  44. (1<<BOOKE_INTERRUPT_DTLB_MISS) | \
  45. (1<<BOOKE_INTERRUPT_ALIGNMENT))
  46. #define NEED_ESR_MASK ((1<<BOOKE_INTERRUPT_DATA_STORAGE) | \
  47. (1<<BOOKE_INTERRUPT_INST_STORAGE) | \
  48. (1<<BOOKE_INTERRUPT_PROGRAM) | \
  49. (1<<BOOKE_INTERRUPT_DTLB_MISS) | \
  50. (1<<BOOKE_INTERRUPT_ALIGNMENT))
  51. .macro KVM_HANDLER ivor_nr scratch srr0
  52. _GLOBAL(kvmppc_handler_\ivor_nr)
  53. /* Get pointer to vcpu and record exit number. */
  54. mtspr \scratch , r4
  55. mfspr r4, SPRN_SPRG_THREAD
  56. lwz r4, THREAD_KVM_VCPU(r4)
  57. stw r3, VCPU_GPR(R3)(r4)
  58. stw r5, VCPU_GPR(R5)(r4)
  59. stw r6, VCPU_GPR(R6)(r4)
  60. mfspr r3, \scratch
  61. mfctr r5
  62. stw r3, VCPU_GPR(R4)(r4)
  63. stw r5, VCPU_CTR(r4)
  64. mfspr r3, \srr0
  65. lis r6, kvmppc_resume_host@h
  66. stw r3, VCPU_PC(r4)
  67. li r5, \ivor_nr
  68. ori r6, r6, kvmppc_resume_host@l
  69. mtctr r6
  70. bctr
  71. .endm
  72. .macro KVM_HANDLER_ADDR ivor_nr
  73. .long kvmppc_handler_\ivor_nr
  74. .endm
  75. .macro KVM_HANDLER_END
  76. .long kvmppc_handlers_end
  77. .endm
  78. _GLOBAL(kvmppc_handlers_start)
  79. KVM_HANDLER BOOKE_INTERRUPT_CRITICAL SPRN_SPRG_RSCRATCH_CRIT SPRN_CSRR0
  80. KVM_HANDLER BOOKE_INTERRUPT_MACHINE_CHECK SPRN_SPRG_RSCRATCH_MC SPRN_MCSRR0
  81. KVM_HANDLER BOOKE_INTERRUPT_DATA_STORAGE SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  82. KVM_HANDLER BOOKE_INTERRUPT_INST_STORAGE SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  83. KVM_HANDLER BOOKE_INTERRUPT_EXTERNAL SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  84. KVM_HANDLER BOOKE_INTERRUPT_ALIGNMENT SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  85. KVM_HANDLER BOOKE_INTERRUPT_PROGRAM SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  86. KVM_HANDLER BOOKE_INTERRUPT_FP_UNAVAIL SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  87. KVM_HANDLER BOOKE_INTERRUPT_SYSCALL SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  88. KVM_HANDLER BOOKE_INTERRUPT_AP_UNAVAIL SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  89. KVM_HANDLER BOOKE_INTERRUPT_DECREMENTER SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  90. KVM_HANDLER BOOKE_INTERRUPT_FIT SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  91. KVM_HANDLER BOOKE_INTERRUPT_WATCHDOG SPRN_SPRG_RSCRATCH_CRIT SPRN_CSRR0
  92. KVM_HANDLER BOOKE_INTERRUPT_DTLB_MISS SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  93. KVM_HANDLER BOOKE_INTERRUPT_ITLB_MISS SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  94. KVM_HANDLER BOOKE_INTERRUPT_DEBUG SPRN_SPRG_RSCRATCH_CRIT SPRN_CSRR0
  95. KVM_HANDLER BOOKE_INTERRUPT_SPE_UNAVAIL SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  96. KVM_HANDLER BOOKE_INTERRUPT_SPE_FP_DATA SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  97. KVM_HANDLER BOOKE_INTERRUPT_SPE_FP_ROUND SPRN_SPRG_RSCRATCH0 SPRN_SRR0
  98. _GLOBAL(kvmppc_handlers_end)
  99. /* Registers:
  100. * SPRG_SCRATCH0: guest r4
  101. * r4: vcpu pointer
  102. * r5: KVM exit number
  103. */
  104. _GLOBAL(kvmppc_resume_host)
  105. mfcr r3
  106. stw r3, VCPU_CR(r4)
  107. stw r7, VCPU_GPR(R7)(r4)
  108. stw r8, VCPU_GPR(R8)(r4)
  109. stw r9, VCPU_GPR(R9)(r4)
  110. li r6, 1
  111. slw r6, r6, r5
  112. #ifdef CONFIG_KVM_EXIT_TIMING
  113. /* save exit time */
  114. 1:
  115. mfspr r7, SPRN_TBRU
  116. mfspr r8, SPRN_TBRL
  117. mfspr r9, SPRN_TBRU
  118. cmpw r9, r7
  119. bne 1b
  120. stw r8, VCPU_TIMING_EXIT_TBL(r4)
  121. stw r9, VCPU_TIMING_EXIT_TBU(r4)
  122. #endif
  123. /* Save the faulting instruction and all GPRs for emulation. */
  124. andi. r7, r6, NEED_INST_MASK
  125. beq ..skip_inst_copy
  126. mfspr r9, SPRN_SRR0
  127. mfmsr r8
  128. ori r7, r8, MSR_DS
  129. mtmsr r7
  130. isync
  131. lwz r9, 0(r9)
  132. mtmsr r8
  133. isync
  134. stw r9, VCPU_LAST_INST(r4)
  135. stw r15, VCPU_GPR(R15)(r4)
  136. stw r16, VCPU_GPR(R16)(r4)
  137. stw r17, VCPU_GPR(R17)(r4)
  138. stw r18, VCPU_GPR(R18)(r4)
  139. stw r19, VCPU_GPR(R19)(r4)
  140. stw r20, VCPU_GPR(R20)(r4)
  141. stw r21, VCPU_GPR(R21)(r4)
  142. stw r22, VCPU_GPR(R22)(r4)
  143. stw r23, VCPU_GPR(R23)(r4)
  144. stw r24, VCPU_GPR(R24)(r4)
  145. stw r25, VCPU_GPR(R25)(r4)
  146. stw r26, VCPU_GPR(R26)(r4)
  147. stw r27, VCPU_GPR(R27)(r4)
  148. stw r28, VCPU_GPR(R28)(r4)
  149. stw r29, VCPU_GPR(R29)(r4)
  150. stw r30, VCPU_GPR(R30)(r4)
  151. stw r31, VCPU_GPR(R31)(r4)
  152. ..skip_inst_copy:
  153. /* Also grab DEAR and ESR before the host can clobber them. */
  154. andi. r7, r6, NEED_DEAR_MASK
  155. beq ..skip_dear
  156. mfspr r9, SPRN_DEAR
  157. stw r9, VCPU_FAULT_DEAR(r4)
  158. ..skip_dear:
  159. andi. r7, r6, NEED_ESR_MASK
  160. beq ..skip_esr
  161. mfspr r9, SPRN_ESR
  162. stw r9, VCPU_FAULT_ESR(r4)
  163. ..skip_esr:
  164. /* Save remaining volatile guest register state to vcpu. */
  165. stw r0, VCPU_GPR(R0)(r4)
  166. stw r1, VCPU_GPR(R1)(r4)
  167. stw r2, VCPU_GPR(R2)(r4)
  168. stw r10, VCPU_GPR(R10)(r4)
  169. stw r11, VCPU_GPR(R11)(r4)
  170. stw r12, VCPU_GPR(R12)(r4)
  171. stw r13, VCPU_GPR(R13)(r4)
  172. stw r14, VCPU_GPR(R14)(r4) /* We need a NV GPR below. */
  173. mflr r3
  174. stw r3, VCPU_LR(r4)
  175. mfxer r3
  176. stw r3, VCPU_XER(r4)
  177. /* Restore host stack pointer and PID before IVPR, since the host
  178. * exception handlers use them. */
  179. lwz r1, VCPU_HOST_STACK(r4)
  180. lwz r3, VCPU_HOST_PID(r4)
  181. mtspr SPRN_PID, r3
  182. #ifdef CONFIG_FSL_BOOKE
  183. /* we cheat and know that Linux doesn't use PID1 which is always 0 */
  184. lis r3, 0
  185. mtspr SPRN_PID1, r3
  186. #endif
  187. /* Restore host IVPR before re-enabling interrupts. We cheat and know
  188. * that Linux IVPR is always 0xc0000000. */
  189. lis r3, 0xc000
  190. mtspr SPRN_IVPR, r3
  191. /* Switch to kernel stack and jump to handler. */
  192. LOAD_REG_ADDR(r3, kvmppc_handle_exit)
  193. mtctr r3
  194. lwz r3, HOST_RUN(r1)
  195. lwz r2, HOST_R2(r1)
  196. mr r14, r4 /* Save vcpu pointer. */
  197. bctrl /* kvmppc_handle_exit() */
  198. /* Restore vcpu pointer and the nonvolatiles we used. */
  199. mr r4, r14
  200. lwz r14, VCPU_GPR(R14)(r4)
  201. /* Sometimes instruction emulation must restore complete GPR state. */
  202. andi. r5, r3, RESUME_FLAG_NV
  203. beq ..skip_nv_load
  204. lwz r15, VCPU_GPR(R15)(r4)
  205. lwz r16, VCPU_GPR(R16)(r4)
  206. lwz r17, VCPU_GPR(R17)(r4)
  207. lwz r18, VCPU_GPR(R18)(r4)
  208. lwz r19, VCPU_GPR(R19)(r4)
  209. lwz r20, VCPU_GPR(R20)(r4)
  210. lwz r21, VCPU_GPR(R21)(r4)
  211. lwz r22, VCPU_GPR(R22)(r4)
  212. lwz r23, VCPU_GPR(R23)(r4)
  213. lwz r24, VCPU_GPR(R24)(r4)
  214. lwz r25, VCPU_GPR(R25)(r4)
  215. lwz r26, VCPU_GPR(R26)(r4)
  216. lwz r27, VCPU_GPR(R27)(r4)
  217. lwz r28, VCPU_GPR(R28)(r4)
  218. lwz r29, VCPU_GPR(R29)(r4)
  219. lwz r30, VCPU_GPR(R30)(r4)
  220. lwz r31, VCPU_GPR(R31)(r4)
  221. ..skip_nv_load:
  222. /* Should we return to the guest? */
  223. andi. r5, r3, RESUME_FLAG_HOST
  224. beq lightweight_exit
  225. srawi r3, r3, 2 /* Shift -ERR back down. */
  226. heavyweight_exit:
  227. /* Not returning to guest. */
  228. #ifdef CONFIG_SPE
  229. /* save guest SPEFSCR and load host SPEFSCR */
  230. mfspr r9, SPRN_SPEFSCR
  231. stw r9, VCPU_SPEFSCR(r4)
  232. lwz r9, VCPU_HOST_SPEFSCR(r4)
  233. mtspr SPRN_SPEFSCR, r9
  234. #endif
  235. /* We already saved guest volatile register state; now save the
  236. * non-volatiles. */
  237. stw r15, VCPU_GPR(R15)(r4)
  238. stw r16, VCPU_GPR(R16)(r4)
  239. stw r17, VCPU_GPR(R17)(r4)
  240. stw r18, VCPU_GPR(R18)(r4)
  241. stw r19, VCPU_GPR(R19)(r4)
  242. stw r20, VCPU_GPR(R20)(r4)
  243. stw r21, VCPU_GPR(R21)(r4)
  244. stw r22, VCPU_GPR(R22)(r4)
  245. stw r23, VCPU_GPR(R23)(r4)
  246. stw r24, VCPU_GPR(R24)(r4)
  247. stw r25, VCPU_GPR(R25)(r4)
  248. stw r26, VCPU_GPR(R26)(r4)
  249. stw r27, VCPU_GPR(R27)(r4)
  250. stw r28, VCPU_GPR(R28)(r4)
  251. stw r29, VCPU_GPR(R29)(r4)
  252. stw r30, VCPU_GPR(R30)(r4)
  253. stw r31, VCPU_GPR(R31)(r4)
  254. /* Load host non-volatile register state from host stack. */
  255. lwz r14, HOST_NV_GPR(R14)(r1)
  256. lwz r15, HOST_NV_GPR(R15)(r1)
  257. lwz r16, HOST_NV_GPR(R16)(r1)
  258. lwz r17, HOST_NV_GPR(R17)(r1)
  259. lwz r18, HOST_NV_GPR(R18)(r1)
  260. lwz r19, HOST_NV_GPR(R19)(r1)
  261. lwz r20, HOST_NV_GPR(R20)(r1)
  262. lwz r21, HOST_NV_GPR(R21)(r1)
  263. lwz r22, HOST_NV_GPR(R22)(r1)
  264. lwz r23, HOST_NV_GPR(R23)(r1)
  265. lwz r24, HOST_NV_GPR(R24)(r1)
  266. lwz r25, HOST_NV_GPR(R25)(r1)
  267. lwz r26, HOST_NV_GPR(R26)(r1)
  268. lwz r27, HOST_NV_GPR(R27)(r1)
  269. lwz r28, HOST_NV_GPR(R28)(r1)
  270. lwz r29, HOST_NV_GPR(R29)(r1)
  271. lwz r30, HOST_NV_GPR(R30)(r1)
  272. lwz r31, HOST_NV_GPR(R31)(r1)
  273. /* Return to kvm_vcpu_run(). */
  274. lwz r4, HOST_STACK_LR(r1)
  275. lwz r5, HOST_CR(r1)
  276. addi r1, r1, HOST_STACK_SIZE
  277. mtlr r4
  278. mtcr r5
  279. /* r3 still contains the return code from kvmppc_handle_exit(). */
  280. blr
  281. /* Registers:
  282. * r3: kvm_run pointer
  283. * r4: vcpu pointer
  284. */
  285. _GLOBAL(__kvmppc_vcpu_run)
  286. stwu r1, -HOST_STACK_SIZE(r1)
  287. stw r1, VCPU_HOST_STACK(r4) /* Save stack pointer to vcpu. */
  288. /* Save host state to stack. */
  289. stw r3, HOST_RUN(r1)
  290. mflr r3
  291. stw r3, HOST_STACK_LR(r1)
  292. mfcr r5
  293. stw r5, HOST_CR(r1)
  294. /* Save host non-volatile register state to stack. */
  295. stw r14, HOST_NV_GPR(R14)(r1)
  296. stw r15, HOST_NV_GPR(R15)(r1)
  297. stw r16, HOST_NV_GPR(R16)(r1)
  298. stw r17, HOST_NV_GPR(R17)(r1)
  299. stw r18, HOST_NV_GPR(R18)(r1)
  300. stw r19, HOST_NV_GPR(R19)(r1)
  301. stw r20, HOST_NV_GPR(R20)(r1)
  302. stw r21, HOST_NV_GPR(R21)(r1)
  303. stw r22, HOST_NV_GPR(R22)(r1)
  304. stw r23, HOST_NV_GPR(R23)(r1)
  305. stw r24, HOST_NV_GPR(R24)(r1)
  306. stw r25, HOST_NV_GPR(R25)(r1)
  307. stw r26, HOST_NV_GPR(R26)(r1)
  308. stw r27, HOST_NV_GPR(R27)(r1)
  309. stw r28, HOST_NV_GPR(R28)(r1)
  310. stw r29, HOST_NV_GPR(R29)(r1)
  311. stw r30, HOST_NV_GPR(R30)(r1)
  312. stw r31, HOST_NV_GPR(R31)(r1)
  313. /* Load guest non-volatiles. */
  314. lwz r14, VCPU_GPR(R14)(r4)
  315. lwz r15, VCPU_GPR(R15)(r4)
  316. lwz r16, VCPU_GPR(R16)(r4)
  317. lwz r17, VCPU_GPR(R17)(r4)
  318. lwz r18, VCPU_GPR(R18)(r4)
  319. lwz r19, VCPU_GPR(R19)(r4)
  320. lwz r20, VCPU_GPR(R20)(r4)
  321. lwz r21, VCPU_GPR(R21)(r4)
  322. lwz r22, VCPU_GPR(R22)(r4)
  323. lwz r23, VCPU_GPR(R23)(r4)
  324. lwz r24, VCPU_GPR(R24)(r4)
  325. lwz r25, VCPU_GPR(R25)(r4)
  326. lwz r26, VCPU_GPR(R26)(r4)
  327. lwz r27, VCPU_GPR(R27)(r4)
  328. lwz r28, VCPU_GPR(R28)(r4)
  329. lwz r29, VCPU_GPR(R29)(r4)
  330. lwz r30, VCPU_GPR(R30)(r4)
  331. lwz r31, VCPU_GPR(R31)(r4)
  332. #ifdef CONFIG_SPE
  333. /* save host SPEFSCR and load guest SPEFSCR */
  334. mfspr r3, SPRN_SPEFSCR
  335. stw r3, VCPU_HOST_SPEFSCR(r4)
  336. lwz r3, VCPU_SPEFSCR(r4)
  337. mtspr SPRN_SPEFSCR, r3
  338. #endif
  339. lightweight_exit:
  340. stw r2, HOST_R2(r1)
  341. mfspr r3, SPRN_PID
  342. stw r3, VCPU_HOST_PID(r4)
  343. lwz r3, VCPU_SHADOW_PID(r4)
  344. mtspr SPRN_PID, r3
  345. #ifdef CONFIG_FSL_BOOKE
  346. lwz r3, VCPU_SHADOW_PID1(r4)
  347. mtspr SPRN_PID1, r3
  348. #endif
  349. #ifdef CONFIG_44x
  350. iccci 0, 0 /* XXX hack */
  351. #endif
  352. /* Load some guest volatiles. */
  353. lwz r0, VCPU_GPR(R0)(r4)
  354. lwz r2, VCPU_GPR(R2)(r4)
  355. lwz r9, VCPU_GPR(R9)(r4)
  356. lwz r10, VCPU_GPR(R10)(r4)
  357. lwz r11, VCPU_GPR(R11)(r4)
  358. lwz r12, VCPU_GPR(R12)(r4)
  359. lwz r13, VCPU_GPR(R13)(r4)
  360. lwz r3, VCPU_LR(r4)
  361. mtlr r3
  362. lwz r3, VCPU_XER(r4)
  363. mtxer r3
  364. /* Switch the IVPR. XXX If we take a TLB miss after this we're screwed,
  365. * so how do we make sure vcpu won't fault? */
  366. lis r8, kvmppc_booke_handlers@ha
  367. lwz r8, kvmppc_booke_handlers@l(r8)
  368. mtspr SPRN_IVPR, r8
  369. lwz r5, VCPU_SHARED(r4)
  370. /* Can't switch the stack pointer until after IVPR is switched,
  371. * because host interrupt handlers would get confused. */
  372. lwz r1, VCPU_GPR(R1)(r4)
  373. /*
  374. * Host interrupt handlers may have clobbered these
  375. * guest-readable SPRGs, or the guest kernel may have
  376. * written directly to the shared area, so we
  377. * need to reload them here with the guest's values.
  378. */
  379. PPC_LD(r3, VCPU_SHARED_SPRG4, r5)
  380. mtspr SPRN_SPRG4W, r3
  381. PPC_LD(r3, VCPU_SHARED_SPRG5, r5)
  382. mtspr SPRN_SPRG5W, r3
  383. PPC_LD(r3, VCPU_SHARED_SPRG6, r5)
  384. mtspr SPRN_SPRG6W, r3
  385. PPC_LD(r3, VCPU_SHARED_SPRG7, r5)
  386. mtspr SPRN_SPRG7W, r3
  387. #ifdef CONFIG_KVM_EXIT_TIMING
  388. /* save enter time */
  389. 1:
  390. mfspr r6, SPRN_TBRU
  391. mfspr r7, SPRN_TBRL
  392. mfspr r8, SPRN_TBRU
  393. cmpw r8, r6
  394. bne 1b
  395. stw r7, VCPU_TIMING_LAST_ENTER_TBL(r4)
  396. stw r8, VCPU_TIMING_LAST_ENTER_TBU(r4)
  397. #endif
  398. /* Finish loading guest volatiles and jump to guest. */
  399. lwz r3, VCPU_CTR(r4)
  400. lwz r5, VCPU_CR(r4)
  401. lwz r6, VCPU_PC(r4)
  402. lwz r7, VCPU_SHADOW_MSR(r4)
  403. mtctr r3
  404. mtcr r5
  405. mtsrr0 r6
  406. mtsrr1 r7
  407. lwz r5, VCPU_GPR(R5)(r4)
  408. lwz r6, VCPU_GPR(R6)(r4)
  409. lwz r7, VCPU_GPR(R7)(r4)
  410. lwz r8, VCPU_GPR(R8)(r4)
  411. /* Clear any debug events which occurred since we disabled MSR[DE].
  412. * XXX This gives us a 3-instruction window in which a breakpoint
  413. * intended for guest context could fire in the host instead. */
  414. lis r3, 0xffff
  415. ori r3, r3, 0xffff
  416. mtspr SPRN_DBSR, r3
  417. lwz r3, VCPU_GPR(R3)(r4)
  418. lwz r4, VCPU_GPR(R4)(r4)
  419. rfi
  420. .data
  421. .align 4
  422. .globl kvmppc_booke_handler_addr
  423. kvmppc_booke_handler_addr:
  424. KVM_HANDLER_ADDR BOOKE_INTERRUPT_CRITICAL
  425. KVM_HANDLER_ADDR BOOKE_INTERRUPT_MACHINE_CHECK
  426. KVM_HANDLER_ADDR BOOKE_INTERRUPT_DATA_STORAGE
  427. KVM_HANDLER_ADDR BOOKE_INTERRUPT_INST_STORAGE
  428. KVM_HANDLER_ADDR BOOKE_INTERRUPT_EXTERNAL
  429. KVM_HANDLER_ADDR BOOKE_INTERRUPT_ALIGNMENT
  430. KVM_HANDLER_ADDR BOOKE_INTERRUPT_PROGRAM
  431. KVM_HANDLER_ADDR BOOKE_INTERRUPT_FP_UNAVAIL
  432. KVM_HANDLER_ADDR BOOKE_INTERRUPT_SYSCALL
  433. KVM_HANDLER_ADDR BOOKE_INTERRUPT_AP_UNAVAIL
  434. KVM_HANDLER_ADDR BOOKE_INTERRUPT_DECREMENTER
  435. KVM_HANDLER_ADDR BOOKE_INTERRUPT_FIT
  436. KVM_HANDLER_ADDR BOOKE_INTERRUPT_WATCHDOG
  437. KVM_HANDLER_ADDR BOOKE_INTERRUPT_DTLB_MISS
  438. KVM_HANDLER_ADDR BOOKE_INTERRUPT_ITLB_MISS
  439. KVM_HANDLER_ADDR BOOKE_INTERRUPT_DEBUG
  440. KVM_HANDLER_ADDR BOOKE_INTERRUPT_SPE_UNAVAIL
  441. KVM_HANDLER_ADDR BOOKE_INTERRUPT_SPE_FP_DATA
  442. KVM_HANDLER_ADDR BOOKE_INTERRUPT_SPE_FP_ROUND
  443. KVM_HANDLER_END /*Always keep this in end*/
  444. #ifdef CONFIG_SPE
  445. _GLOBAL(kvmppc_save_guest_spe)
  446. cmpi 0,r3,0
  447. beqlr-
  448. SAVE_32EVRS(0, r4, r3, VCPU_EVR)
  449. evxor evr6, evr6, evr6
  450. evmwumiaa evr6, evr6, evr6
  451. li r4,VCPU_ACC
  452. evstddx evr6, r4, r3 /* save acc */
  453. blr
  454. _GLOBAL(kvmppc_load_guest_spe)
  455. cmpi 0,r3,0
  456. beqlr-
  457. li r4,VCPU_ACC
  458. evlddx evr6,r4,r3
  459. evmra evr6,evr6 /* load acc */
  460. REST_32EVRS(0, r4, r3, VCPU_EVR)
  461. blr
  462. #endif