bookehv_interrupts.S 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593
  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 (C) 2010-2011 Freescale Semiconductor, Inc.
  16. *
  17. * Author: Varun Sethi <varun.sethi@freescale.com>
  18. * Author: Scott Wood <scotwood@freescale.com>
  19. *
  20. * This file is derived from arch/powerpc/kvm/booke_interrupts.S
  21. */
  22. #include <asm/ppc_asm.h>
  23. #include <asm/kvm_asm.h>
  24. #include <asm/reg.h>
  25. #include <asm/mmu-44x.h>
  26. #include <asm/page.h>
  27. #include <asm/asm-compat.h>
  28. #include <asm/asm-offsets.h>
  29. #include <asm/bitsperlong.h>
  30. #include <asm/thread_info.h>
  31. #include "../kernel/head_booke.h" /* for THREAD_NORMSAVE() */
  32. #define GET_VCPU(vcpu, thread) \
  33. PPC_LL vcpu, THREAD_KVM_VCPU(thread)
  34. #define LONGBYTES (BITS_PER_LONG / 8)
  35. #define VCPU_GUEST_SPRG(n) (VCPU_GUEST_SPRGS + (n * LONGBYTES))
  36. /* The host stack layout: */
  37. #define HOST_R1 (0 * LONGBYTES) /* Implied by stwu. */
  38. #define HOST_CALLEE_LR (1 * LONGBYTES)
  39. #define HOST_RUN (2 * LONGBYTES) /* struct kvm_run */
  40. /*
  41. * r2 is special: it holds 'current', and it made nonvolatile in the
  42. * kernel with the -ffixed-r2 gcc option.
  43. */
  44. #define HOST_R2 (3 * LONGBYTES)
  45. #define HOST_CR (4 * LONGBYTES)
  46. #define HOST_NV_GPRS (5 * LONGBYTES)
  47. #define __HOST_NV_GPR(n) (HOST_NV_GPRS + ((n - 14) * LONGBYTES))
  48. #define HOST_NV_GPR(n) __HOST_NV_GPR(__REG_##n)
  49. #define HOST_MIN_STACK_SIZE (HOST_NV_GPR(R31) + LONGBYTES)
  50. #define HOST_STACK_SIZE ((HOST_MIN_STACK_SIZE + 15) & ~15) /* Align. */
  51. #define HOST_STACK_LR (HOST_STACK_SIZE + LONGBYTES) /* In caller stack frame. */
  52. #define NEED_EMU 0x00000001 /* emulation -- save nv regs */
  53. #define NEED_DEAR 0x00000002 /* save faulting DEAR */
  54. #define NEED_ESR 0x00000004 /* save faulting ESR */
  55. /*
  56. * On entry:
  57. * r4 = vcpu, r5 = srr0, r6 = srr1
  58. * saved in vcpu: cr, ctr, r3-r13
  59. */
  60. .macro kvm_handler_common intno, srr0, flags
  61. /* Restore host stack pointer */
  62. PPC_STL r1, VCPU_GPR(R1)(r4)
  63. PPC_STL r2, VCPU_GPR(R2)(r4)
  64. PPC_LL r1, VCPU_HOST_STACK(r4)
  65. PPC_LL r2, HOST_R2(r1)
  66. mfspr r10, SPRN_PID
  67. lwz r8, VCPU_HOST_PID(r4)
  68. PPC_LL r11, VCPU_SHARED(r4)
  69. PPC_STL r14, VCPU_GPR(R14)(r4) /* We need a non-volatile GPR. */
  70. li r14, \intno
  71. stw r10, VCPU_GUEST_PID(r4)
  72. mtspr SPRN_PID, r8
  73. #ifdef CONFIG_KVM_EXIT_TIMING
  74. /* save exit time */
  75. 1: mfspr r7, SPRN_TBRU
  76. mfspr r8, SPRN_TBRL
  77. mfspr r9, SPRN_TBRU
  78. cmpw r9, r7
  79. stw r8, VCPU_TIMING_EXIT_TBL(r4)
  80. bne- 1b
  81. stw r9, VCPU_TIMING_EXIT_TBU(r4)
  82. #endif
  83. oris r8, r6, MSR_CE@h
  84. PPC_STD(r6, VCPU_SHARED_MSR, r11)
  85. ori r8, r8, MSR_ME | MSR_RI
  86. PPC_STL r5, VCPU_PC(r4)
  87. /*
  88. * Make sure CE/ME/RI are set (if appropriate for exception type)
  89. * whether or not the guest had it set. Since mfmsr/mtmsr are
  90. * somewhat expensive, skip in the common case where the guest
  91. * had all these bits set (and thus they're still set if
  92. * appropriate for the exception type).
  93. */
  94. cmpw r6, r8
  95. beq 1f
  96. mfmsr r7
  97. .if \srr0 != SPRN_MCSRR0 && \srr0 != SPRN_CSRR0
  98. oris r7, r7, MSR_CE@h
  99. .endif
  100. .if \srr0 != SPRN_MCSRR0
  101. ori r7, r7, MSR_ME | MSR_RI
  102. .endif
  103. mtmsr r7
  104. 1:
  105. .if \flags & NEED_EMU
  106. /*
  107. * This assumes you have external PID support.
  108. * To support a bookehv CPU without external PID, you'll
  109. * need to look up the TLB entry and create a temporary mapping.
  110. *
  111. * FIXME: we don't currently handle if the lwepx faults. PR-mode
  112. * booke doesn't handle it either. Since Linux doesn't use
  113. * broadcast tlbivax anymore, the only way this should happen is
  114. * if the guest maps its memory execute-but-not-read, or if we
  115. * somehow take a TLB miss in the middle of this entry code and
  116. * evict the relevant entry. On e500mc, all kernel lowmem is
  117. * bolted into TLB1 large page mappings, and we don't use
  118. * broadcast invalidates, so we should not take a TLB miss here.
  119. *
  120. * Later we'll need to deal with faults here. Disallowing guest
  121. * mappings that are execute-but-not-read could be an option on
  122. * e500mc, but not on chips with an LRAT if it is used.
  123. */
  124. mfspr r3, SPRN_EPLC /* will already have correct ELPID and EGS */
  125. PPC_STL r15, VCPU_GPR(R15)(r4)
  126. PPC_STL r16, VCPU_GPR(R16)(r4)
  127. PPC_STL r17, VCPU_GPR(R17)(r4)
  128. PPC_STL r18, VCPU_GPR(R18)(r4)
  129. PPC_STL r19, VCPU_GPR(R19)(r4)
  130. mr r8, r3
  131. PPC_STL r20, VCPU_GPR(R20)(r4)
  132. rlwimi r8, r6, EPC_EAS_SHIFT - MSR_IR_LG, EPC_EAS
  133. PPC_STL r21, VCPU_GPR(R21)(r4)
  134. rlwimi r8, r6, EPC_EPR_SHIFT - MSR_PR_LG, EPC_EPR
  135. PPC_STL r22, VCPU_GPR(R22)(r4)
  136. rlwimi r8, r10, EPC_EPID_SHIFT, EPC_EPID
  137. PPC_STL r23, VCPU_GPR(R23)(r4)
  138. PPC_STL r24, VCPU_GPR(R24)(r4)
  139. PPC_STL r25, VCPU_GPR(R25)(r4)
  140. PPC_STL r26, VCPU_GPR(R26)(r4)
  141. PPC_STL r27, VCPU_GPR(R27)(r4)
  142. PPC_STL r28, VCPU_GPR(R28)(r4)
  143. PPC_STL r29, VCPU_GPR(R29)(r4)
  144. PPC_STL r30, VCPU_GPR(R30)(r4)
  145. PPC_STL r31, VCPU_GPR(R31)(r4)
  146. mtspr SPRN_EPLC, r8
  147. /* disable preemption, so we are sure we hit the fixup handler */
  148. CURRENT_THREAD_INFO(r8, r1)
  149. li r7, 1
  150. stw r7, TI_PREEMPT(r8)
  151. isync
  152. /*
  153. * In case the read goes wrong, we catch it and write an invalid value
  154. * in LAST_INST instead.
  155. */
  156. 1: lwepx r9, 0, r5
  157. 2:
  158. .section .fixup, "ax"
  159. 3: li r9, KVM_INST_FETCH_FAILED
  160. b 2b
  161. .previous
  162. .section __ex_table,"a"
  163. PPC_LONG_ALIGN
  164. PPC_LONG 1b,3b
  165. .previous
  166. mtspr SPRN_EPLC, r3
  167. li r7, 0
  168. stw r7, TI_PREEMPT(r8)
  169. stw r9, VCPU_LAST_INST(r4)
  170. .endif
  171. .if \flags & NEED_ESR
  172. mfspr r8, SPRN_ESR
  173. PPC_STL r8, VCPU_FAULT_ESR(r4)
  174. .endif
  175. .if \flags & NEED_DEAR
  176. mfspr r9, SPRN_DEAR
  177. PPC_STL r9, VCPU_FAULT_DEAR(r4)
  178. .endif
  179. b kvmppc_resume_host
  180. .endm
  181. /*
  182. * For input register values, see arch/powerpc/include/asm/kvm_booke_hv_asm.h
  183. */
  184. .macro kvm_handler intno srr0, srr1, flags
  185. _GLOBAL(kvmppc_handler_\intno\()_\srr1)
  186. GET_VCPU(r11, r10)
  187. PPC_STL r3, VCPU_GPR(R3)(r11)
  188. mfspr r3, SPRN_SPRG_RSCRATCH0
  189. PPC_STL r4, VCPU_GPR(R4)(r11)
  190. PPC_LL r4, THREAD_NORMSAVE(0)(r10)
  191. PPC_STL r5, VCPU_GPR(R5)(r11)
  192. stw r13, VCPU_CR(r11)
  193. mfspr r5, \srr0
  194. PPC_STL r3, VCPU_GPR(R10)(r11)
  195. PPC_LL r3, THREAD_NORMSAVE(2)(r10)
  196. PPC_STL r6, VCPU_GPR(R6)(r11)
  197. PPC_STL r4, VCPU_GPR(R11)(r11)
  198. mfspr r6, \srr1
  199. PPC_STL r7, VCPU_GPR(R7)(r11)
  200. PPC_STL r8, VCPU_GPR(R8)(r11)
  201. PPC_STL r9, VCPU_GPR(R9)(r11)
  202. PPC_STL r3, VCPU_GPR(R13)(r11)
  203. mfctr r7
  204. PPC_STL r12, VCPU_GPR(R12)(r11)
  205. PPC_STL r7, VCPU_CTR(r11)
  206. mr r4, r11
  207. kvm_handler_common \intno, \srr0, \flags
  208. .endm
  209. .macro kvm_lvl_handler intno scratch srr0, srr1, flags
  210. _GLOBAL(kvmppc_handler_\intno\()_\srr1)
  211. mfspr r10, SPRN_SPRG_THREAD
  212. GET_VCPU(r11, r10)
  213. PPC_STL r3, VCPU_GPR(R3)(r11)
  214. mfspr r3, \scratch
  215. PPC_STL r4, VCPU_GPR(R4)(r11)
  216. PPC_LL r4, GPR9(r8)
  217. PPC_STL r5, VCPU_GPR(R5)(r11)
  218. stw r9, VCPU_CR(r11)
  219. mfspr r5, \srr0
  220. PPC_STL r3, VCPU_GPR(R8)(r11)
  221. PPC_LL r3, GPR10(r8)
  222. PPC_STL r6, VCPU_GPR(R6)(r11)
  223. PPC_STL r4, VCPU_GPR(R9)(r11)
  224. mfspr r6, \srr1
  225. PPC_LL r4, GPR11(r8)
  226. PPC_STL r7, VCPU_GPR(R7)(r11)
  227. PPC_STL r3, VCPU_GPR(R10)(r11)
  228. mfctr r7
  229. PPC_STL r12, VCPU_GPR(R12)(r11)
  230. PPC_STL r13, VCPU_GPR(R13)(r11)
  231. PPC_STL r4, VCPU_GPR(R11)(r11)
  232. PPC_STL r7, VCPU_CTR(r11)
  233. mr r4, r11
  234. kvm_handler_common \intno, \srr0, \flags
  235. .endm
  236. kvm_lvl_handler BOOKE_INTERRUPT_CRITICAL, \
  237. SPRN_SPRG_RSCRATCH_CRIT, SPRN_CSRR0, SPRN_CSRR1, 0
  238. kvm_lvl_handler BOOKE_INTERRUPT_MACHINE_CHECK, \
  239. SPRN_SPRG_RSCRATCH_MC, SPRN_MCSRR0, SPRN_MCSRR1, 0
  240. kvm_handler BOOKE_INTERRUPT_DATA_STORAGE, \
  241. SPRN_SRR0, SPRN_SRR1, (NEED_EMU | NEED_DEAR | NEED_ESR)
  242. kvm_handler BOOKE_INTERRUPT_INST_STORAGE, SPRN_SRR0, SPRN_SRR1, NEED_ESR
  243. kvm_handler BOOKE_INTERRUPT_EXTERNAL, SPRN_SRR0, SPRN_SRR1, 0
  244. kvm_handler BOOKE_INTERRUPT_ALIGNMENT, \
  245. SPRN_SRR0, SPRN_SRR1, (NEED_DEAR | NEED_ESR)
  246. kvm_handler BOOKE_INTERRUPT_PROGRAM, SPRN_SRR0, SPRN_SRR1, NEED_ESR
  247. kvm_handler BOOKE_INTERRUPT_FP_UNAVAIL, SPRN_SRR0, SPRN_SRR1, 0
  248. kvm_handler BOOKE_INTERRUPT_SYSCALL, SPRN_SRR0, SPRN_SRR1, 0
  249. kvm_handler BOOKE_INTERRUPT_AP_UNAVAIL, SPRN_SRR0, SPRN_SRR1, 0
  250. kvm_handler BOOKE_INTERRUPT_DECREMENTER, SPRN_SRR0, SPRN_SRR1, 0
  251. kvm_handler BOOKE_INTERRUPT_FIT, SPRN_SRR0, SPRN_SRR1, 0
  252. kvm_lvl_handler BOOKE_INTERRUPT_WATCHDOG, \
  253. SPRN_SPRG_RSCRATCH_CRIT, SPRN_CSRR0, SPRN_CSRR1, 0
  254. kvm_handler BOOKE_INTERRUPT_DTLB_MISS, \
  255. SPRN_SRR0, SPRN_SRR1, (NEED_EMU | NEED_DEAR | NEED_ESR)
  256. kvm_handler BOOKE_INTERRUPT_ITLB_MISS, SPRN_SRR0, SPRN_SRR1, 0
  257. kvm_handler BOOKE_INTERRUPT_SPE_UNAVAIL, SPRN_SRR0, SPRN_SRR1, 0
  258. kvm_handler BOOKE_INTERRUPT_SPE_FP_DATA, SPRN_SRR0, SPRN_SRR1, 0
  259. kvm_handler BOOKE_INTERRUPT_SPE_FP_ROUND, SPRN_SRR0, SPRN_SRR1, 0
  260. kvm_handler BOOKE_INTERRUPT_PERFORMANCE_MONITOR, SPRN_SRR0, SPRN_SRR1, 0
  261. kvm_handler BOOKE_INTERRUPT_DOORBELL, SPRN_SRR0, SPRN_SRR1, 0
  262. kvm_lvl_handler BOOKE_INTERRUPT_DOORBELL_CRITICAL, \
  263. SPRN_SPRG_RSCRATCH_CRIT, SPRN_CSRR0, SPRN_CSRR1, 0
  264. kvm_handler BOOKE_INTERRUPT_HV_PRIV, SPRN_SRR0, SPRN_SRR1, NEED_EMU
  265. kvm_handler BOOKE_INTERRUPT_HV_SYSCALL, SPRN_SRR0, SPRN_SRR1, 0
  266. kvm_handler BOOKE_INTERRUPT_GUEST_DBELL, SPRN_GSRR0, SPRN_GSRR1, 0
  267. kvm_lvl_handler BOOKE_INTERRUPT_GUEST_DBELL_CRIT, \
  268. SPRN_SPRG_RSCRATCH_CRIT, SPRN_CSRR0, SPRN_CSRR1, 0
  269. kvm_lvl_handler BOOKE_INTERRUPT_DEBUG, \
  270. SPRN_SPRG_RSCRATCH_CRIT, SPRN_CSRR0, SPRN_CSRR1, 0
  271. kvm_lvl_handler BOOKE_INTERRUPT_DEBUG, \
  272. SPRN_SPRG_RSCRATCH_DBG, SPRN_DSRR0, SPRN_DSRR1, 0
  273. /* Registers:
  274. * SPRG_SCRATCH0: guest r10
  275. * r4: vcpu pointer
  276. * r11: vcpu->arch.shared
  277. * r14: KVM exit number
  278. */
  279. _GLOBAL(kvmppc_resume_host)
  280. /* Save remaining volatile guest register state to vcpu. */
  281. mfspr r3, SPRN_VRSAVE
  282. PPC_STL r0, VCPU_GPR(R0)(r4)
  283. mflr r5
  284. mfspr r6, SPRN_SPRG4
  285. PPC_STL r5, VCPU_LR(r4)
  286. mfspr r7, SPRN_SPRG5
  287. stw r3, VCPU_VRSAVE(r4)
  288. PPC_STD(r6, VCPU_SHARED_SPRG4, r11)
  289. mfspr r8, SPRN_SPRG6
  290. PPC_STD(r7, VCPU_SHARED_SPRG5, r11)
  291. mfspr r9, SPRN_SPRG7
  292. PPC_STD(r8, VCPU_SHARED_SPRG6, r11)
  293. mfxer r3
  294. PPC_STD(r9, VCPU_SHARED_SPRG7, r11)
  295. /* save guest MAS registers and restore host mas4 & mas6 */
  296. mfspr r5, SPRN_MAS0
  297. PPC_STL r3, VCPU_XER(r4)
  298. mfspr r6, SPRN_MAS1
  299. stw r5, VCPU_SHARED_MAS0(r11)
  300. mfspr r7, SPRN_MAS2
  301. stw r6, VCPU_SHARED_MAS1(r11)
  302. PPC_STD(r7, VCPU_SHARED_MAS2, r11)
  303. mfspr r5, SPRN_MAS3
  304. mfspr r6, SPRN_MAS4
  305. stw r5, VCPU_SHARED_MAS7_3+4(r11)
  306. mfspr r7, SPRN_MAS6
  307. stw r6, VCPU_SHARED_MAS4(r11)
  308. mfspr r5, SPRN_MAS7
  309. lwz r6, VCPU_HOST_MAS4(r4)
  310. stw r7, VCPU_SHARED_MAS6(r11)
  311. lwz r8, VCPU_HOST_MAS6(r4)
  312. mtspr SPRN_MAS4, r6
  313. stw r5, VCPU_SHARED_MAS7_3+0(r11)
  314. mtspr SPRN_MAS6, r8
  315. /* Enable MAS register updates via exception */
  316. mfspr r3, SPRN_EPCR
  317. rlwinm r3, r3, 0, ~SPRN_EPCR_DMIUH
  318. mtspr SPRN_EPCR, r3
  319. isync
  320. /* Switch to kernel stack and jump to handler. */
  321. PPC_LL r3, HOST_RUN(r1)
  322. mr r5, r14 /* intno */
  323. mr r14, r4 /* Save vcpu pointer. */
  324. bl kvmppc_handle_exit
  325. /* Restore vcpu pointer and the nonvolatiles we used. */
  326. mr r4, r14
  327. PPC_LL r14, VCPU_GPR(R14)(r4)
  328. andi. r5, r3, RESUME_FLAG_NV
  329. beq skip_nv_load
  330. PPC_LL r15, VCPU_GPR(R15)(r4)
  331. PPC_LL r16, VCPU_GPR(R16)(r4)
  332. PPC_LL r17, VCPU_GPR(R17)(r4)
  333. PPC_LL r18, VCPU_GPR(R18)(r4)
  334. PPC_LL r19, VCPU_GPR(R19)(r4)
  335. PPC_LL r20, VCPU_GPR(R20)(r4)
  336. PPC_LL r21, VCPU_GPR(R21)(r4)
  337. PPC_LL r22, VCPU_GPR(R22)(r4)
  338. PPC_LL r23, VCPU_GPR(R23)(r4)
  339. PPC_LL r24, VCPU_GPR(R24)(r4)
  340. PPC_LL r25, VCPU_GPR(R25)(r4)
  341. PPC_LL r26, VCPU_GPR(R26)(r4)
  342. PPC_LL r27, VCPU_GPR(R27)(r4)
  343. PPC_LL r28, VCPU_GPR(R28)(r4)
  344. PPC_LL r29, VCPU_GPR(R29)(r4)
  345. PPC_LL r30, VCPU_GPR(R30)(r4)
  346. PPC_LL r31, VCPU_GPR(R31)(r4)
  347. skip_nv_load:
  348. /* Should we return to the guest? */
  349. andi. r5, r3, RESUME_FLAG_HOST
  350. beq lightweight_exit
  351. srawi r3, r3, 2 /* Shift -ERR back down. */
  352. heavyweight_exit:
  353. /* Not returning to guest. */
  354. PPC_LL r5, HOST_STACK_LR(r1)
  355. lwz r6, HOST_CR(r1)
  356. /*
  357. * We already saved guest volatile register state; now save the
  358. * non-volatiles.
  359. */
  360. PPC_STL r15, VCPU_GPR(R15)(r4)
  361. PPC_STL r16, VCPU_GPR(R16)(r4)
  362. PPC_STL r17, VCPU_GPR(R17)(r4)
  363. PPC_STL r18, VCPU_GPR(R18)(r4)
  364. PPC_STL r19, VCPU_GPR(R19)(r4)
  365. PPC_STL r20, VCPU_GPR(R20)(r4)
  366. PPC_STL r21, VCPU_GPR(R21)(r4)
  367. PPC_STL r22, VCPU_GPR(R22)(r4)
  368. PPC_STL r23, VCPU_GPR(R23)(r4)
  369. PPC_STL r24, VCPU_GPR(R24)(r4)
  370. PPC_STL r25, VCPU_GPR(R25)(r4)
  371. PPC_STL r26, VCPU_GPR(R26)(r4)
  372. PPC_STL r27, VCPU_GPR(R27)(r4)
  373. PPC_STL r28, VCPU_GPR(R28)(r4)
  374. PPC_STL r29, VCPU_GPR(R29)(r4)
  375. PPC_STL r30, VCPU_GPR(R30)(r4)
  376. PPC_STL r31, VCPU_GPR(R31)(r4)
  377. /* Load host non-volatile register state from host stack. */
  378. PPC_LL r14, HOST_NV_GPR(R14)(r1)
  379. PPC_LL r15, HOST_NV_GPR(R15)(r1)
  380. PPC_LL r16, HOST_NV_GPR(R16)(r1)
  381. PPC_LL r17, HOST_NV_GPR(R17)(r1)
  382. PPC_LL r18, HOST_NV_GPR(R18)(r1)
  383. PPC_LL r19, HOST_NV_GPR(R19)(r1)
  384. PPC_LL r20, HOST_NV_GPR(R20)(r1)
  385. PPC_LL r21, HOST_NV_GPR(R21)(r1)
  386. PPC_LL r22, HOST_NV_GPR(R22)(r1)
  387. PPC_LL r23, HOST_NV_GPR(R23)(r1)
  388. PPC_LL r24, HOST_NV_GPR(R24)(r1)
  389. PPC_LL r25, HOST_NV_GPR(R25)(r1)
  390. PPC_LL r26, HOST_NV_GPR(R26)(r1)
  391. PPC_LL r27, HOST_NV_GPR(R27)(r1)
  392. PPC_LL r28, HOST_NV_GPR(R28)(r1)
  393. PPC_LL r29, HOST_NV_GPR(R29)(r1)
  394. PPC_LL r30, HOST_NV_GPR(R30)(r1)
  395. PPC_LL r31, HOST_NV_GPR(R31)(r1)
  396. /* Return to kvm_vcpu_run(). */
  397. mtlr r5
  398. mtcr r6
  399. addi r1, r1, HOST_STACK_SIZE
  400. /* r3 still contains the return code from kvmppc_handle_exit(). */
  401. blr
  402. /* Registers:
  403. * r3: kvm_run pointer
  404. * r4: vcpu pointer
  405. */
  406. _GLOBAL(__kvmppc_vcpu_run)
  407. stwu r1, -HOST_STACK_SIZE(r1)
  408. PPC_STL r1, VCPU_HOST_STACK(r4) /* Save stack pointer to vcpu. */
  409. /* Save host state to stack. */
  410. PPC_STL r3, HOST_RUN(r1)
  411. mflr r3
  412. mfcr r5
  413. PPC_STL r3, HOST_STACK_LR(r1)
  414. stw r5, HOST_CR(r1)
  415. /* Save host non-volatile register state to stack. */
  416. PPC_STL r14, HOST_NV_GPR(R14)(r1)
  417. PPC_STL r15, HOST_NV_GPR(R15)(r1)
  418. PPC_STL r16, HOST_NV_GPR(R16)(r1)
  419. PPC_STL r17, HOST_NV_GPR(R17)(r1)
  420. PPC_STL r18, HOST_NV_GPR(R18)(r1)
  421. PPC_STL r19, HOST_NV_GPR(R19)(r1)
  422. PPC_STL r20, HOST_NV_GPR(R20)(r1)
  423. PPC_STL r21, HOST_NV_GPR(R21)(r1)
  424. PPC_STL r22, HOST_NV_GPR(R22)(r1)
  425. PPC_STL r23, HOST_NV_GPR(R23)(r1)
  426. PPC_STL r24, HOST_NV_GPR(R24)(r1)
  427. PPC_STL r25, HOST_NV_GPR(R25)(r1)
  428. PPC_STL r26, HOST_NV_GPR(R26)(r1)
  429. PPC_STL r27, HOST_NV_GPR(R27)(r1)
  430. PPC_STL r28, HOST_NV_GPR(R28)(r1)
  431. PPC_STL r29, HOST_NV_GPR(R29)(r1)
  432. PPC_STL r30, HOST_NV_GPR(R30)(r1)
  433. PPC_STL r31, HOST_NV_GPR(R31)(r1)
  434. /* Load guest non-volatiles. */
  435. PPC_LL r14, VCPU_GPR(R14)(r4)
  436. PPC_LL r15, VCPU_GPR(R15)(r4)
  437. PPC_LL r16, VCPU_GPR(R16)(r4)
  438. PPC_LL r17, VCPU_GPR(R17)(r4)
  439. PPC_LL r18, VCPU_GPR(R18)(r4)
  440. PPC_LL r19, VCPU_GPR(R19)(r4)
  441. PPC_LL r20, VCPU_GPR(R20)(r4)
  442. PPC_LL r21, VCPU_GPR(R21)(r4)
  443. PPC_LL r22, VCPU_GPR(R22)(r4)
  444. PPC_LL r23, VCPU_GPR(R23)(r4)
  445. PPC_LL r24, VCPU_GPR(R24)(r4)
  446. PPC_LL r25, VCPU_GPR(R25)(r4)
  447. PPC_LL r26, VCPU_GPR(R26)(r4)
  448. PPC_LL r27, VCPU_GPR(R27)(r4)
  449. PPC_LL r28, VCPU_GPR(R28)(r4)
  450. PPC_LL r29, VCPU_GPR(R29)(r4)
  451. PPC_LL r30, VCPU_GPR(R30)(r4)
  452. PPC_LL r31, VCPU_GPR(R31)(r4)
  453. lightweight_exit:
  454. PPC_STL r2, HOST_R2(r1)
  455. mfspr r3, SPRN_PID
  456. stw r3, VCPU_HOST_PID(r4)
  457. lwz r3, VCPU_GUEST_PID(r4)
  458. mtspr SPRN_PID, r3
  459. PPC_LL r11, VCPU_SHARED(r4)
  460. /* Disable MAS register updates via exception */
  461. mfspr r3, SPRN_EPCR
  462. oris r3, r3, SPRN_EPCR_DMIUH@h
  463. mtspr SPRN_EPCR, r3
  464. isync
  465. /* Save host mas4 and mas6 and load guest MAS registers */
  466. mfspr r3, SPRN_MAS4
  467. stw r3, VCPU_HOST_MAS4(r4)
  468. mfspr r3, SPRN_MAS6
  469. stw r3, VCPU_HOST_MAS6(r4)
  470. lwz r3, VCPU_SHARED_MAS0(r11)
  471. lwz r5, VCPU_SHARED_MAS1(r11)
  472. PPC_LD(r6, VCPU_SHARED_MAS2, r11)
  473. lwz r7, VCPU_SHARED_MAS7_3+4(r11)
  474. lwz r8, VCPU_SHARED_MAS4(r11)
  475. mtspr SPRN_MAS0, r3
  476. mtspr SPRN_MAS1, r5
  477. mtspr SPRN_MAS2, r6
  478. mtspr SPRN_MAS3, r7
  479. mtspr SPRN_MAS4, r8
  480. lwz r3, VCPU_SHARED_MAS6(r11)
  481. lwz r5, VCPU_SHARED_MAS7_3+0(r11)
  482. mtspr SPRN_MAS6, r3
  483. mtspr SPRN_MAS7, r5
  484. /*
  485. * Host interrupt handlers may have clobbered these guest-readable
  486. * SPRGs, so we need to reload them here with the guest's values.
  487. */
  488. lwz r3, VCPU_VRSAVE(r4)
  489. PPC_LD(r5, VCPU_SHARED_SPRG4, r11)
  490. mtspr SPRN_VRSAVE, r3
  491. PPC_LD(r6, VCPU_SHARED_SPRG5, r11)
  492. mtspr SPRN_SPRG4W, r5
  493. PPC_LD(r7, VCPU_SHARED_SPRG6, r11)
  494. mtspr SPRN_SPRG5W, r6
  495. PPC_LD(r8, VCPU_SHARED_SPRG7, r11)
  496. mtspr SPRN_SPRG6W, r7
  497. mtspr SPRN_SPRG7W, r8
  498. /* Load some guest volatiles. */
  499. PPC_LL r3, VCPU_LR(r4)
  500. PPC_LL r5, VCPU_XER(r4)
  501. PPC_LL r6, VCPU_CTR(r4)
  502. lwz r7, VCPU_CR(r4)
  503. PPC_LL r8, VCPU_PC(r4)
  504. PPC_LD(r9, VCPU_SHARED_MSR, r11)
  505. PPC_LL r0, VCPU_GPR(R0)(r4)
  506. PPC_LL r1, VCPU_GPR(R1)(r4)
  507. PPC_LL r2, VCPU_GPR(R2)(r4)
  508. PPC_LL r10, VCPU_GPR(R10)(r4)
  509. PPC_LL r11, VCPU_GPR(R11)(r4)
  510. PPC_LL r12, VCPU_GPR(R12)(r4)
  511. PPC_LL r13, VCPU_GPR(R13)(r4)
  512. mtlr r3
  513. mtxer r5
  514. mtctr r6
  515. mtsrr0 r8
  516. mtsrr1 r9
  517. #ifdef CONFIG_KVM_EXIT_TIMING
  518. /* save enter time */
  519. 1:
  520. mfspr r6, SPRN_TBRU
  521. mfspr r9, SPRN_TBRL
  522. mfspr r8, SPRN_TBRU
  523. cmpw r8, r6
  524. stw r9, VCPU_TIMING_LAST_ENTER_TBL(r4)
  525. bne 1b
  526. stw r8, VCPU_TIMING_LAST_ENTER_TBU(r4)
  527. #endif
  528. /*
  529. * Don't execute any instruction which can change CR after
  530. * below instruction.
  531. */
  532. mtcr r7
  533. /* Finish loading guest volatiles and jump to guest. */
  534. PPC_LL r5, VCPU_GPR(R5)(r4)
  535. PPC_LL r6, VCPU_GPR(R6)(r4)
  536. PPC_LL r7, VCPU_GPR(R7)(r4)
  537. PPC_LL r8, VCPU_GPR(R8)(r4)
  538. PPC_LL r9, VCPU_GPR(R9)(r4)
  539. PPC_LL r3, VCPU_GPR(R3)(r4)
  540. PPC_LL r4, VCPU_GPR(R4)(r4)
  541. rfi