exceptions-64s.S 37 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455
  1. /*
  2. * This file contains the 64-bit "server" PowerPC variant
  3. * of the low level exception handling including exception
  4. * vectors, exception return, part of the slb and stab
  5. * handling and other fixed offset specific things.
  6. *
  7. * This file is meant to be #included from head_64.S due to
  8. * position dependent assembly.
  9. *
  10. * Most of this originates from head_64.S and thus has the same
  11. * copyright history.
  12. *
  13. */
  14. #include <asm/hw_irq.h>
  15. #include <asm/exception-64s.h>
  16. #include <asm/ptrace.h>
  17. /*
  18. * We layout physical memory as follows:
  19. * 0x0000 - 0x00ff : Secondary processor spin code
  20. * 0x0100 - 0x17ff : pSeries Interrupt prologs
  21. * 0x1800 - 0x4000 : interrupt support common interrupt prologs
  22. * 0x4000 - 0x5fff : pSeries interrupts with IR=1,DR=1
  23. * 0x6000 - 0x6fff : more interrupt support including for IR=1,DR=1
  24. * 0x7000 - 0x7fff : FWNMI data area
  25. * 0x8000 - 0x8fff : Initial (CPU0) segment table
  26. * 0x9000 - : Early init and support code
  27. */
  28. /* Syscall routine is used twice, in reloc-off and reloc-on paths */
  29. #define SYSCALL_PSERIES_1 \
  30. BEGIN_FTR_SECTION \
  31. cmpdi r0,0x1ebe ; \
  32. beq- 1f ; \
  33. END_FTR_SECTION_IFSET(CPU_FTR_REAL_LE) \
  34. mr r9,r13 ; \
  35. GET_PACA(r13) ; \
  36. mfspr r11,SPRN_SRR0 ; \
  37. 0:
  38. #define SYSCALL_PSERIES_2_RFID \
  39. mfspr r12,SPRN_SRR1 ; \
  40. ld r10,PACAKBASE(r13) ; \
  41. LOAD_HANDLER(r10, system_call_entry) ; \
  42. mtspr SPRN_SRR0,r10 ; \
  43. ld r10,PACAKMSR(r13) ; \
  44. mtspr SPRN_SRR1,r10 ; \
  45. rfid ; \
  46. b . ; /* prevent speculative execution */
  47. #define SYSCALL_PSERIES_3 \
  48. /* Fast LE/BE switch system call */ \
  49. 1: mfspr r12,SPRN_SRR1 ; \
  50. xori r12,r12,MSR_LE ; \
  51. mtspr SPRN_SRR1,r12 ; \
  52. rfid ; /* return to userspace */ \
  53. b . ; \
  54. 2: mfspr r12,SPRN_SRR1 ; \
  55. andi. r12,r12,MSR_PR ; \
  56. bne 0b ; \
  57. mtspr SPRN_SRR0,r3 ; \
  58. mtspr SPRN_SRR1,r4 ; \
  59. mtspr SPRN_SDR1,r5 ; \
  60. rfid ; \
  61. b . ; /* prevent speculative execution */
  62. #if defined(CONFIG_RELOCATABLE)
  63. /*
  64. * We can't branch directly; in the direct case we use LR
  65. * and system_call_entry restores LR. (We thus need to move
  66. * LR to r10 in the RFID case too.)
  67. */
  68. #define SYSCALL_PSERIES_2_DIRECT \
  69. mflr r10 ; \
  70. ld r12,PACAKBASE(r13) ; \
  71. LOAD_HANDLER(r12, system_call_entry_direct) ; \
  72. mtlr r12 ; \
  73. mfspr r12,SPRN_SRR1 ; \
  74. /* Re-use of r13... No spare regs to do this */ \
  75. li r13,MSR_RI ; \
  76. mtmsrd r13,1 ; \
  77. GET_PACA(r13) ; /* get r13 back */ \
  78. blr ;
  79. #else
  80. /* We can branch directly */
  81. #define SYSCALL_PSERIES_2_DIRECT \
  82. mfspr r12,SPRN_SRR1 ; \
  83. li r10,MSR_RI ; \
  84. mtmsrd r10,1 ; /* Set RI (EE=0) */ \
  85. b system_call_entry_direct ;
  86. #endif
  87. /*
  88. * This is the start of the interrupt handlers for pSeries
  89. * This code runs with relocation off.
  90. * Code from here to __end_interrupts gets copied down to real
  91. * address 0x100 when we are running a relocatable kernel.
  92. * Therefore any relative branches in this section must only
  93. * branch to labels in this section.
  94. */
  95. . = 0x100
  96. .globl __start_interrupts
  97. __start_interrupts:
  98. .globl system_reset_pSeries;
  99. system_reset_pSeries:
  100. HMT_MEDIUM_PPR_DISCARD
  101. SET_SCRATCH0(r13)
  102. #ifdef CONFIG_PPC_P7_NAP
  103. BEGIN_FTR_SECTION
  104. /* Running native on arch 2.06 or later, check if we are
  105. * waking up from nap. We only handle no state loss and
  106. * supervisor state loss. We do -not- handle hypervisor
  107. * state loss at this time.
  108. */
  109. mfspr r13,SPRN_SRR1
  110. rlwinm. r13,r13,47-31,30,31
  111. beq 9f
  112. /* waking up from powersave (nap) state */
  113. cmpwi cr1,r13,2
  114. /* Total loss of HV state is fatal, we could try to use the
  115. * PIR to locate a PACA, then use an emergency stack etc...
  116. * but for now, let's just stay stuck here
  117. */
  118. bgt cr1,.
  119. GET_PACA(r13)
  120. #ifdef CONFIG_KVM_BOOK3S_64_HV
  121. li r0,KVM_HWTHREAD_IN_KERNEL
  122. stb r0,HSTATE_HWTHREAD_STATE(r13)
  123. /* Order setting hwthread_state vs. testing hwthread_req */
  124. sync
  125. lbz r0,HSTATE_HWTHREAD_REQ(r13)
  126. cmpwi r0,0
  127. beq 1f
  128. b kvm_start_guest
  129. 1:
  130. #endif
  131. beq cr1,2f
  132. b .power7_wakeup_noloss
  133. 2: b .power7_wakeup_loss
  134. 9:
  135. END_FTR_SECTION_IFSET(CPU_FTR_HVMODE | CPU_FTR_ARCH_206)
  136. #endif /* CONFIG_PPC_P7_NAP */
  137. EXCEPTION_PROLOG_PSERIES(PACA_EXGEN, system_reset_common, EXC_STD,
  138. NOTEST, 0x100)
  139. . = 0x200
  140. machine_check_pSeries_1:
  141. /* This is moved out of line as it can be patched by FW, but
  142. * some code path might still want to branch into the original
  143. * vector
  144. */
  145. HMT_MEDIUM_PPR_DISCARD
  146. SET_SCRATCH0(r13) /* save r13 */
  147. EXCEPTION_PROLOG_0(PACA_EXMC)
  148. b machine_check_pSeries_0
  149. . = 0x300
  150. .globl data_access_pSeries
  151. data_access_pSeries:
  152. HMT_MEDIUM_PPR_DISCARD
  153. SET_SCRATCH0(r13)
  154. BEGIN_FTR_SECTION
  155. b data_access_check_stab
  156. data_access_not_stab:
  157. END_MMU_FTR_SECTION_IFCLR(MMU_FTR_SLB)
  158. EXCEPTION_PROLOG_PSERIES(PACA_EXGEN, data_access_common, EXC_STD,
  159. KVMTEST, 0x300)
  160. . = 0x380
  161. .globl data_access_slb_pSeries
  162. data_access_slb_pSeries:
  163. HMT_MEDIUM_PPR_DISCARD
  164. SET_SCRATCH0(r13)
  165. EXCEPTION_PROLOG_0(PACA_EXSLB)
  166. EXCEPTION_PROLOG_1(PACA_EXSLB, KVMTEST, 0x380)
  167. std r3,PACA_EXSLB+EX_R3(r13)
  168. mfspr r3,SPRN_DAR
  169. #ifdef __DISABLED__
  170. /* Keep that around for when we re-implement dynamic VSIDs */
  171. cmpdi r3,0
  172. bge slb_miss_user_pseries
  173. #endif /* __DISABLED__ */
  174. mfspr r12,SPRN_SRR1
  175. #ifndef CONFIG_RELOCATABLE
  176. b .slb_miss_realmode
  177. #else
  178. /*
  179. * We can't just use a direct branch to .slb_miss_realmode
  180. * because the distance from here to there depends on where
  181. * the kernel ends up being put.
  182. */
  183. mfctr r11
  184. ld r10,PACAKBASE(r13)
  185. LOAD_HANDLER(r10, .slb_miss_realmode)
  186. mtctr r10
  187. bctr
  188. #endif
  189. STD_EXCEPTION_PSERIES(0x400, 0x400, instruction_access)
  190. . = 0x480
  191. .globl instruction_access_slb_pSeries
  192. instruction_access_slb_pSeries:
  193. HMT_MEDIUM_PPR_DISCARD
  194. SET_SCRATCH0(r13)
  195. EXCEPTION_PROLOG_0(PACA_EXSLB)
  196. EXCEPTION_PROLOG_1(PACA_EXSLB, KVMTEST_PR, 0x480)
  197. std r3,PACA_EXSLB+EX_R3(r13)
  198. mfspr r3,SPRN_SRR0 /* SRR0 is faulting address */
  199. #ifdef __DISABLED__
  200. /* Keep that around for when we re-implement dynamic VSIDs */
  201. cmpdi r3,0
  202. bge slb_miss_user_pseries
  203. #endif /* __DISABLED__ */
  204. mfspr r12,SPRN_SRR1
  205. #ifndef CONFIG_RELOCATABLE
  206. b .slb_miss_realmode
  207. #else
  208. mfctr r11
  209. ld r10,PACAKBASE(r13)
  210. LOAD_HANDLER(r10, .slb_miss_realmode)
  211. mtctr r10
  212. bctr
  213. #endif
  214. /* We open code these as we can't have a ". = x" (even with
  215. * x = "." within a feature section
  216. */
  217. . = 0x500;
  218. .globl hardware_interrupt_pSeries;
  219. .globl hardware_interrupt_hv;
  220. hardware_interrupt_pSeries:
  221. hardware_interrupt_hv:
  222. BEGIN_FTR_SECTION
  223. _MASKABLE_EXCEPTION_PSERIES(0x502, hardware_interrupt,
  224. EXC_HV, SOFTEN_TEST_HV)
  225. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0x502)
  226. FTR_SECTION_ELSE
  227. _MASKABLE_EXCEPTION_PSERIES(0x500, hardware_interrupt,
  228. EXC_STD, SOFTEN_TEST_HV_201)
  229. KVM_HANDLER(PACA_EXGEN, EXC_STD, 0x500)
  230. ALT_FTR_SECTION_END_IFSET(CPU_FTR_HVMODE | CPU_FTR_ARCH_206)
  231. STD_EXCEPTION_PSERIES(0x600, 0x600, alignment)
  232. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0x600)
  233. STD_EXCEPTION_PSERIES(0x700, 0x700, program_check)
  234. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0x700)
  235. STD_EXCEPTION_PSERIES(0x800, 0x800, fp_unavailable)
  236. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0x800)
  237. MASKABLE_EXCEPTION_PSERIES(0x900, 0x900, decrementer)
  238. STD_EXCEPTION_HV(0x980, 0x982, hdecrementer)
  239. MASKABLE_EXCEPTION_PSERIES(0xa00, 0xa00, doorbell_super)
  240. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0xa00)
  241. STD_EXCEPTION_PSERIES(0xb00, 0xb00, trap_0b)
  242. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0xb00)
  243. . = 0xc00
  244. .globl system_call_pSeries
  245. system_call_pSeries:
  246. HMT_MEDIUM
  247. #ifdef CONFIG_KVM_BOOK3S_64_HANDLER
  248. SET_SCRATCH0(r13)
  249. GET_PACA(r13)
  250. std r9,PACA_EXGEN+EX_R9(r13)
  251. std r10,PACA_EXGEN+EX_R10(r13)
  252. mfcr r9
  253. KVMTEST(0xc00)
  254. GET_SCRATCH0(r13)
  255. #endif
  256. SYSCALL_PSERIES_1
  257. SYSCALL_PSERIES_2_RFID
  258. SYSCALL_PSERIES_3
  259. KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xc00)
  260. STD_EXCEPTION_PSERIES(0xd00, 0xd00, single_step)
  261. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0xd00)
  262. /* At 0xe??? we have a bunch of hypervisor exceptions, we branch
  263. * out of line to handle them
  264. */
  265. . = 0xe00
  266. hv_exception_trampoline:
  267. SET_SCRATCH0(r13)
  268. EXCEPTION_PROLOG_0(PACA_EXGEN)
  269. b h_data_storage_hv
  270. . = 0xe20
  271. SET_SCRATCH0(r13)
  272. EXCEPTION_PROLOG_0(PACA_EXGEN)
  273. b h_instr_storage_hv
  274. . = 0xe40
  275. SET_SCRATCH0(r13)
  276. EXCEPTION_PROLOG_0(PACA_EXGEN)
  277. b emulation_assist_hv
  278. . = 0xe60
  279. SET_SCRATCH0(r13)
  280. EXCEPTION_PROLOG_0(PACA_EXGEN)
  281. b hmi_exception_hv
  282. . = 0xe80
  283. SET_SCRATCH0(r13)
  284. EXCEPTION_PROLOG_0(PACA_EXGEN)
  285. b h_doorbell_hv
  286. /* We need to deal with the Altivec unavailable exception
  287. * here which is at 0xf20, thus in the middle of the
  288. * prolog code of the PerformanceMonitor one. A little
  289. * trickery is thus necessary
  290. */
  291. performance_monitor_pSeries_1:
  292. . = 0xf00
  293. SET_SCRATCH0(r13)
  294. EXCEPTION_PROLOG_0(PACA_EXGEN)
  295. b performance_monitor_pSeries
  296. altivec_unavailable_pSeries_1:
  297. . = 0xf20
  298. SET_SCRATCH0(r13)
  299. EXCEPTION_PROLOG_0(PACA_EXGEN)
  300. b altivec_unavailable_pSeries
  301. vsx_unavailable_pSeries_1:
  302. . = 0xf40
  303. SET_SCRATCH0(r13)
  304. EXCEPTION_PROLOG_0(PACA_EXGEN)
  305. b vsx_unavailable_pSeries
  306. #ifdef CONFIG_CBE_RAS
  307. STD_EXCEPTION_HV(0x1200, 0x1202, cbe_system_error)
  308. KVM_HANDLER_SKIP(PACA_EXGEN, EXC_HV, 0x1202)
  309. #endif /* CONFIG_CBE_RAS */
  310. STD_EXCEPTION_PSERIES(0x1300, 0x1300, instruction_breakpoint)
  311. KVM_HANDLER_PR_SKIP(PACA_EXGEN, EXC_STD, 0x1300)
  312. . = 0x1500
  313. .global denorm_exception_hv
  314. denorm_exception_hv:
  315. HMT_MEDIUM_PPR_DISCARD
  316. mtspr SPRN_SPRG_HSCRATCH0,r13
  317. EXCEPTION_PROLOG_0(PACA_EXGEN)
  318. std r11,PACA_EXGEN+EX_R11(r13)
  319. std r12,PACA_EXGEN+EX_R12(r13)
  320. mfspr r9,SPRN_SPRG_HSCRATCH0
  321. std r9,PACA_EXGEN+EX_R13(r13)
  322. mfcr r9
  323. #ifdef CONFIG_PPC_DENORMALISATION
  324. mfspr r10,SPRN_HSRR1
  325. mfspr r11,SPRN_HSRR0 /* save HSRR0 */
  326. andis. r10,r10,(HSRR1_DENORM)@h /* denorm? */
  327. addi r11,r11,-4 /* HSRR0 is next instruction */
  328. bne+ denorm_assist
  329. #endif
  330. EXCEPTION_PROLOG_PSERIES_1(denorm_common, EXC_HV)
  331. KVM_HANDLER_SKIP(PACA_EXGEN, EXC_STD, 0x1500)
  332. #ifdef CONFIG_CBE_RAS
  333. STD_EXCEPTION_HV(0x1600, 0x1602, cbe_maintenance)
  334. KVM_HANDLER_SKIP(PACA_EXGEN, EXC_HV, 0x1602)
  335. #endif /* CONFIG_CBE_RAS */
  336. STD_EXCEPTION_PSERIES(0x1700, 0x1700, altivec_assist)
  337. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0x1700)
  338. #ifdef CONFIG_CBE_RAS
  339. STD_EXCEPTION_HV(0x1800, 0x1802, cbe_thermal)
  340. KVM_HANDLER_SKIP(PACA_EXGEN, EXC_HV, 0x1802)
  341. #else
  342. . = 0x1800
  343. #endif /* CONFIG_CBE_RAS */
  344. /*** Out of line interrupts support ***/
  345. .align 7
  346. /* moved from 0x200 */
  347. machine_check_pSeries:
  348. .globl machine_check_fwnmi
  349. machine_check_fwnmi:
  350. HMT_MEDIUM_PPR_DISCARD
  351. SET_SCRATCH0(r13) /* save r13 */
  352. EXCEPTION_PROLOG_0(PACA_EXMC)
  353. machine_check_pSeries_0:
  354. EXCEPTION_PROLOG_1(PACA_EXMC, KVMTEST, 0x200)
  355. EXCEPTION_PROLOG_PSERIES_1(machine_check_common, EXC_STD)
  356. KVM_HANDLER_SKIP(PACA_EXMC, EXC_STD, 0x200)
  357. /* moved from 0x300 */
  358. data_access_check_stab:
  359. GET_PACA(r13)
  360. std r9,PACA_EXSLB+EX_R9(r13)
  361. std r10,PACA_EXSLB+EX_R10(r13)
  362. mfspr r10,SPRN_DAR
  363. mfspr r9,SPRN_DSISR
  364. srdi r10,r10,60
  365. rlwimi r10,r9,16,0x20
  366. #ifdef CONFIG_KVM_BOOK3S_PR
  367. lbz r9,HSTATE_IN_GUEST(r13)
  368. rlwimi r10,r9,8,0x300
  369. #endif
  370. mfcr r9
  371. cmpwi r10,0x2c
  372. beq do_stab_bolted_pSeries
  373. mtcrf 0x80,r9
  374. ld r9,PACA_EXSLB+EX_R9(r13)
  375. ld r10,PACA_EXSLB+EX_R10(r13)
  376. b data_access_not_stab
  377. do_stab_bolted_pSeries:
  378. std r11,PACA_EXSLB+EX_R11(r13)
  379. std r12,PACA_EXSLB+EX_R12(r13)
  380. GET_SCRATCH0(r10)
  381. std r10,PACA_EXSLB+EX_R13(r13)
  382. EXCEPTION_PROLOG_PSERIES_1(.do_stab_bolted, EXC_STD)
  383. KVM_HANDLER_SKIP(PACA_EXGEN, EXC_STD, 0x300)
  384. KVM_HANDLER_SKIP(PACA_EXSLB, EXC_STD, 0x380)
  385. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0x400)
  386. KVM_HANDLER_PR(PACA_EXSLB, EXC_STD, 0x480)
  387. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0x900)
  388. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0x982)
  389. #ifdef CONFIG_PPC_DENORMALISATION
  390. denorm_assist:
  391. BEGIN_FTR_SECTION
  392. /*
  393. * To denormalise we need to move a copy of the register to itself.
  394. * For POWER6 do that here for all FP regs.
  395. */
  396. mfmsr r10
  397. ori r10,r10,(MSR_FP|MSR_FE0|MSR_FE1)
  398. xori r10,r10,(MSR_FE0|MSR_FE1)
  399. mtmsrd r10
  400. sync
  401. fmr 0,0
  402. fmr 1,1
  403. fmr 2,2
  404. fmr 3,3
  405. fmr 4,4
  406. fmr 5,5
  407. fmr 6,6
  408. fmr 7,7
  409. fmr 8,8
  410. fmr 9,9
  411. fmr 10,10
  412. fmr 11,11
  413. fmr 12,12
  414. fmr 13,13
  415. fmr 14,14
  416. fmr 15,15
  417. fmr 16,16
  418. fmr 17,17
  419. fmr 18,18
  420. fmr 19,19
  421. fmr 20,20
  422. fmr 21,21
  423. fmr 22,22
  424. fmr 23,23
  425. fmr 24,24
  426. fmr 25,25
  427. fmr 26,26
  428. fmr 27,27
  429. fmr 28,28
  430. fmr 29,29
  431. fmr 30,30
  432. fmr 31,31
  433. FTR_SECTION_ELSE
  434. /*
  435. * To denormalise we need to move a copy of the register to itself.
  436. * For POWER7 do that here for the first 32 VSX registers only.
  437. */
  438. mfmsr r10
  439. oris r10,r10,MSR_VSX@h
  440. mtmsrd r10
  441. sync
  442. XVCPSGNDP(0,0,0)
  443. XVCPSGNDP(1,1,1)
  444. XVCPSGNDP(2,2,2)
  445. XVCPSGNDP(3,3,3)
  446. XVCPSGNDP(4,4,4)
  447. XVCPSGNDP(5,5,5)
  448. XVCPSGNDP(6,6,6)
  449. XVCPSGNDP(7,7,7)
  450. XVCPSGNDP(8,8,8)
  451. XVCPSGNDP(9,9,9)
  452. XVCPSGNDP(10,10,10)
  453. XVCPSGNDP(11,11,11)
  454. XVCPSGNDP(12,12,12)
  455. XVCPSGNDP(13,13,13)
  456. XVCPSGNDP(14,14,14)
  457. XVCPSGNDP(15,15,15)
  458. XVCPSGNDP(16,16,16)
  459. XVCPSGNDP(17,17,17)
  460. XVCPSGNDP(18,18,18)
  461. XVCPSGNDP(19,19,19)
  462. XVCPSGNDP(20,20,20)
  463. XVCPSGNDP(21,21,21)
  464. XVCPSGNDP(22,22,22)
  465. XVCPSGNDP(23,23,23)
  466. XVCPSGNDP(24,24,24)
  467. XVCPSGNDP(25,25,25)
  468. XVCPSGNDP(26,26,26)
  469. XVCPSGNDP(27,27,27)
  470. XVCPSGNDP(28,28,28)
  471. XVCPSGNDP(29,29,29)
  472. XVCPSGNDP(30,30,30)
  473. XVCPSGNDP(31,31,31)
  474. ALT_FTR_SECTION_END_IFCLR(CPU_FTR_ARCH_206)
  475. mtspr SPRN_HSRR0,r11
  476. mtcrf 0x80,r9
  477. ld r9,PACA_EXGEN+EX_R9(r13)
  478. RESTORE_PPR_PACA(PACA_EXGEN, r10)
  479. ld r10,PACA_EXGEN+EX_R10(r13)
  480. ld r11,PACA_EXGEN+EX_R11(r13)
  481. ld r12,PACA_EXGEN+EX_R12(r13)
  482. ld r13,PACA_EXGEN+EX_R13(r13)
  483. HRFID
  484. b .
  485. #endif
  486. .align 7
  487. /* moved from 0xe00 */
  488. STD_EXCEPTION_HV_OOL(0xe02, h_data_storage)
  489. KVM_HANDLER_SKIP(PACA_EXGEN, EXC_HV, 0xe02)
  490. STD_EXCEPTION_HV_OOL(0xe22, h_instr_storage)
  491. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe22)
  492. STD_EXCEPTION_HV_OOL(0xe42, emulation_assist)
  493. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe42)
  494. STD_EXCEPTION_HV_OOL(0xe62, hmi_exception) /* need to flush cache ? */
  495. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe62)
  496. MASKABLE_EXCEPTION_HV_OOL(0xe82, h_doorbell)
  497. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe82)
  498. /* moved from 0xf00 */
  499. STD_EXCEPTION_PSERIES_OOL(0xf00, performance_monitor)
  500. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0xf00)
  501. STD_EXCEPTION_PSERIES_OOL(0xf20, altivec_unavailable)
  502. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0xf20)
  503. STD_EXCEPTION_PSERIES_OOL(0xf40, vsx_unavailable)
  504. KVM_HANDLER_PR(PACA_EXGEN, EXC_STD, 0xf40)
  505. /*
  506. * An interrupt came in while soft-disabled. We set paca->irq_happened, then:
  507. * - If it was a decrementer interrupt, we bump the dec to max and and return.
  508. * - If it was a doorbell we return immediately since doorbells are edge
  509. * triggered and won't automatically refire.
  510. * - else we hard disable and return.
  511. * This is called with r10 containing the value to OR to the paca field.
  512. */
  513. #define MASKED_INTERRUPT(_H) \
  514. masked_##_H##interrupt: \
  515. std r11,PACA_EXGEN+EX_R11(r13); \
  516. lbz r11,PACAIRQHAPPENED(r13); \
  517. or r11,r11,r10; \
  518. stb r11,PACAIRQHAPPENED(r13); \
  519. cmpwi r10,PACA_IRQ_DEC; \
  520. bne 1f; \
  521. lis r10,0x7fff; \
  522. ori r10,r10,0xffff; \
  523. mtspr SPRN_DEC,r10; \
  524. b 2f; \
  525. 1: cmpwi r10,PACA_IRQ_DBELL; \
  526. beq 2f; \
  527. mfspr r10,SPRN_##_H##SRR1; \
  528. rldicl r10,r10,48,1; /* clear MSR_EE */ \
  529. rotldi r10,r10,16; \
  530. mtspr SPRN_##_H##SRR1,r10; \
  531. 2: mtcrf 0x80,r9; \
  532. ld r9,PACA_EXGEN+EX_R9(r13); \
  533. ld r10,PACA_EXGEN+EX_R10(r13); \
  534. ld r11,PACA_EXGEN+EX_R11(r13); \
  535. GET_SCRATCH0(r13); \
  536. ##_H##rfid; \
  537. b .
  538. MASKED_INTERRUPT()
  539. MASKED_INTERRUPT(H)
  540. /*
  541. * Called from arch_local_irq_enable when an interrupt needs
  542. * to be resent. r3 contains 0x500, 0x900, 0xa00 or 0xe80 to indicate
  543. * which kind of interrupt. MSR:EE is already off. We generate a
  544. * stackframe like if a real interrupt had happened.
  545. *
  546. * Note: While MSR:EE is off, we need to make sure that _MSR
  547. * in the generated frame has EE set to 1 or the exception
  548. * handler will not properly re-enable them.
  549. */
  550. _GLOBAL(__replay_interrupt)
  551. /* We are going to jump to the exception common code which
  552. * will retrieve various register values from the PACA which
  553. * we don't give a damn about, so we don't bother storing them.
  554. */
  555. mfmsr r12
  556. mflr r11
  557. mfcr r9
  558. ori r12,r12,MSR_EE
  559. cmpwi r3,0x900
  560. beq decrementer_common
  561. cmpwi r3,0x500
  562. beq hardware_interrupt_common
  563. BEGIN_FTR_SECTION
  564. cmpwi r3,0xe80
  565. beq h_doorbell_common
  566. FTR_SECTION_ELSE
  567. cmpwi r3,0xa00
  568. beq doorbell_super_common
  569. ALT_FTR_SECTION_END_IFSET(CPU_FTR_HVMODE)
  570. blr
  571. #ifdef CONFIG_PPC_PSERIES
  572. /*
  573. * Vectors for the FWNMI option. Share common code.
  574. */
  575. .globl system_reset_fwnmi
  576. .align 7
  577. system_reset_fwnmi:
  578. HMT_MEDIUM_PPR_DISCARD
  579. SET_SCRATCH0(r13) /* save r13 */
  580. EXCEPTION_PROLOG_PSERIES(PACA_EXGEN, system_reset_common, EXC_STD,
  581. NOTEST, 0x100)
  582. #endif /* CONFIG_PPC_PSERIES */
  583. #ifdef __DISABLED__
  584. /*
  585. * This is used for when the SLB miss handler has to go virtual,
  586. * which doesn't happen for now anymore but will once we re-implement
  587. * dynamic VSIDs for shared page tables
  588. */
  589. slb_miss_user_pseries:
  590. std r10,PACA_EXGEN+EX_R10(r13)
  591. std r11,PACA_EXGEN+EX_R11(r13)
  592. std r12,PACA_EXGEN+EX_R12(r13)
  593. GET_SCRATCH0(r10)
  594. ld r11,PACA_EXSLB+EX_R9(r13)
  595. ld r12,PACA_EXSLB+EX_R3(r13)
  596. std r10,PACA_EXGEN+EX_R13(r13)
  597. std r11,PACA_EXGEN+EX_R9(r13)
  598. std r12,PACA_EXGEN+EX_R3(r13)
  599. clrrdi r12,r13,32
  600. mfmsr r10
  601. mfspr r11,SRR0 /* save SRR0 */
  602. ori r12,r12,slb_miss_user_common@l /* virt addr of handler */
  603. ori r10,r10,MSR_IR|MSR_DR|MSR_RI
  604. mtspr SRR0,r12
  605. mfspr r12,SRR1 /* and SRR1 */
  606. mtspr SRR1,r10
  607. rfid
  608. b . /* prevent spec. execution */
  609. #endif /* __DISABLED__ */
  610. /*
  611. * Code from here down to __end_handlers is invoked from the
  612. * exception prologs above. Because the prologs assemble the
  613. * addresses of these handlers using the LOAD_HANDLER macro,
  614. * which uses an ori instruction, these handlers must be in
  615. * the first 64k of the kernel image.
  616. */
  617. /*** Common interrupt handlers ***/
  618. STD_EXCEPTION_COMMON(0x100, system_reset, .system_reset_exception)
  619. /*
  620. * Machine check is different because we use a different
  621. * save area: PACA_EXMC instead of PACA_EXGEN.
  622. */
  623. .align 7
  624. .globl machine_check_common
  625. machine_check_common:
  626. EXCEPTION_PROLOG_COMMON(0x200, PACA_EXMC)
  627. FINISH_NAP
  628. DISABLE_INTS
  629. bl .save_nvgprs
  630. addi r3,r1,STACK_FRAME_OVERHEAD
  631. bl .machine_check_exception
  632. b .ret_from_except
  633. STD_EXCEPTION_COMMON_ASYNC(0x500, hardware_interrupt, do_IRQ)
  634. STD_EXCEPTION_COMMON_ASYNC(0x900, decrementer, .timer_interrupt)
  635. STD_EXCEPTION_COMMON(0x980, hdecrementer, .hdec_interrupt)
  636. #ifdef CONFIG_PPC_DOORBELL
  637. STD_EXCEPTION_COMMON_ASYNC(0xa00, doorbell_super, .doorbell_exception)
  638. #else
  639. STD_EXCEPTION_COMMON_ASYNC(0xa00, doorbell_super, .unknown_exception)
  640. #endif
  641. STD_EXCEPTION_COMMON(0xb00, trap_0b, .unknown_exception)
  642. STD_EXCEPTION_COMMON(0xd00, single_step, .single_step_exception)
  643. STD_EXCEPTION_COMMON(0xe00, trap_0e, .unknown_exception)
  644. STD_EXCEPTION_COMMON(0xe40, emulation_assist, .program_check_exception)
  645. STD_EXCEPTION_COMMON(0xe60, hmi_exception, .unknown_exception)
  646. #ifdef CONFIG_PPC_DOORBELL
  647. STD_EXCEPTION_COMMON_ASYNC(0xe80, h_doorbell, .doorbell_exception)
  648. #else
  649. STD_EXCEPTION_COMMON_ASYNC(0xe80, h_doorbell, .unknown_exception)
  650. #endif
  651. STD_EXCEPTION_COMMON_ASYNC(0xf00, performance_monitor, .performance_monitor_exception)
  652. STD_EXCEPTION_COMMON(0x1300, instruction_breakpoint, .instruction_breakpoint_exception)
  653. STD_EXCEPTION_COMMON(0x1502, denorm, .unknown_exception)
  654. #ifdef CONFIG_ALTIVEC
  655. STD_EXCEPTION_COMMON(0x1700, altivec_assist, .altivec_assist_exception)
  656. #else
  657. STD_EXCEPTION_COMMON(0x1700, altivec_assist, .unknown_exception)
  658. #endif
  659. #ifdef CONFIG_CBE_RAS
  660. STD_EXCEPTION_COMMON(0x1200, cbe_system_error, .cbe_system_error_exception)
  661. STD_EXCEPTION_COMMON(0x1600, cbe_maintenance, .cbe_maintenance_exception)
  662. STD_EXCEPTION_COMMON(0x1800, cbe_thermal, .cbe_thermal_exception)
  663. #endif /* CONFIG_CBE_RAS */
  664. /*
  665. * Relocation-on interrupts: A subset of the interrupts can be delivered
  666. * with IR=1/DR=1, if AIL==2 and MSR.HV won't be changed by delivering
  667. * it. Addresses are the same as the original interrupt addresses, but
  668. * offset by 0xc000000000004000.
  669. * It's impossible to receive interrupts below 0x300 via this mechanism.
  670. * KVM: None of these traps are from the guest ; anything that escalated
  671. * to HV=1 from HV=0 is delivered via real mode handlers.
  672. */
  673. /*
  674. * This uses the standard macro, since the original 0x300 vector
  675. * only has extra guff for STAB-based processors -- which never
  676. * come here.
  677. */
  678. STD_RELON_EXCEPTION_PSERIES(0x4300, 0x300, data_access)
  679. . = 0x4380
  680. .globl data_access_slb_relon_pSeries
  681. data_access_slb_relon_pSeries:
  682. SET_SCRATCH0(r13)
  683. EXCEPTION_PROLOG_0(PACA_EXSLB)
  684. EXCEPTION_PROLOG_1(PACA_EXSLB, NOTEST, 0x380)
  685. std r3,PACA_EXSLB+EX_R3(r13)
  686. mfspr r3,SPRN_DAR
  687. mfspr r12,SPRN_SRR1
  688. #ifndef CONFIG_RELOCATABLE
  689. b .slb_miss_realmode
  690. #else
  691. /*
  692. * We can't just use a direct branch to .slb_miss_realmode
  693. * because the distance from here to there depends on where
  694. * the kernel ends up being put.
  695. */
  696. mfctr r11
  697. ld r10,PACAKBASE(r13)
  698. LOAD_HANDLER(r10, .slb_miss_realmode)
  699. mtctr r10
  700. bctr
  701. #endif
  702. STD_RELON_EXCEPTION_PSERIES(0x4400, 0x400, instruction_access)
  703. . = 0x4480
  704. .globl instruction_access_slb_relon_pSeries
  705. instruction_access_slb_relon_pSeries:
  706. SET_SCRATCH0(r13)
  707. EXCEPTION_PROLOG_0(PACA_EXSLB)
  708. EXCEPTION_PROLOG_1(PACA_EXSLB, NOTEST, 0x480)
  709. std r3,PACA_EXSLB+EX_R3(r13)
  710. mfspr r3,SPRN_SRR0 /* SRR0 is faulting address */
  711. mfspr r12,SPRN_SRR1
  712. #ifndef CONFIG_RELOCATABLE
  713. b .slb_miss_realmode
  714. #else
  715. mfctr r11
  716. ld r10,PACAKBASE(r13)
  717. LOAD_HANDLER(r10, .slb_miss_realmode)
  718. mtctr r10
  719. bctr
  720. #endif
  721. . = 0x4500
  722. .globl hardware_interrupt_relon_pSeries;
  723. .globl hardware_interrupt_relon_hv;
  724. hardware_interrupt_relon_pSeries:
  725. hardware_interrupt_relon_hv:
  726. BEGIN_FTR_SECTION
  727. _MASKABLE_RELON_EXCEPTION_PSERIES(0x502, hardware_interrupt, EXC_HV, SOFTEN_TEST_HV)
  728. FTR_SECTION_ELSE
  729. _MASKABLE_RELON_EXCEPTION_PSERIES(0x500, hardware_interrupt, EXC_STD, SOFTEN_TEST_PR)
  730. ALT_FTR_SECTION_END_IFSET(CPU_FTR_ARCH_206)
  731. STD_RELON_EXCEPTION_PSERIES(0x4600, 0x600, alignment)
  732. STD_RELON_EXCEPTION_PSERIES(0x4700, 0x700, program_check)
  733. STD_RELON_EXCEPTION_PSERIES(0x4800, 0x800, fp_unavailable)
  734. MASKABLE_RELON_EXCEPTION_PSERIES(0x4900, 0x900, decrementer)
  735. STD_RELON_EXCEPTION_HV(0x4980, 0x982, hdecrementer)
  736. MASKABLE_RELON_EXCEPTION_PSERIES(0x4a00, 0xa00, doorbell_super)
  737. STD_RELON_EXCEPTION_PSERIES(0x4b00, 0xb00, trap_0b)
  738. . = 0x4c00
  739. .globl system_call_relon_pSeries
  740. system_call_relon_pSeries:
  741. HMT_MEDIUM
  742. SYSCALL_PSERIES_1
  743. SYSCALL_PSERIES_2_DIRECT
  744. SYSCALL_PSERIES_3
  745. STD_RELON_EXCEPTION_PSERIES(0x4d00, 0xd00, single_step)
  746. . = 0x4e00
  747. SET_SCRATCH0(r13)
  748. EXCEPTION_PROLOG_0(PACA_EXGEN)
  749. b h_data_storage_relon_hv
  750. . = 0x4e20
  751. SET_SCRATCH0(r13)
  752. EXCEPTION_PROLOG_0(PACA_EXGEN)
  753. b h_instr_storage_relon_hv
  754. . = 0x4e40
  755. SET_SCRATCH0(r13)
  756. EXCEPTION_PROLOG_0(PACA_EXGEN)
  757. b emulation_assist_relon_hv
  758. . = 0x4e60
  759. SET_SCRATCH0(r13)
  760. EXCEPTION_PROLOG_0(PACA_EXGEN)
  761. b hmi_exception_relon_hv
  762. . = 0x4e80
  763. SET_SCRATCH0(r13)
  764. EXCEPTION_PROLOG_0(PACA_EXGEN)
  765. b h_doorbell_relon_hv
  766. performance_monitor_relon_pSeries_1:
  767. . = 0x4f00
  768. SET_SCRATCH0(r13)
  769. EXCEPTION_PROLOG_0(PACA_EXGEN)
  770. b performance_monitor_relon_pSeries
  771. altivec_unavailable_relon_pSeries_1:
  772. . = 0x4f20
  773. SET_SCRATCH0(r13)
  774. EXCEPTION_PROLOG_0(PACA_EXGEN)
  775. b altivec_unavailable_relon_pSeries
  776. vsx_unavailable_relon_pSeries_1:
  777. . = 0x4f40
  778. SET_SCRATCH0(r13)
  779. EXCEPTION_PROLOG_0(PACA_EXGEN)
  780. b vsx_unavailable_relon_pSeries
  781. STD_RELON_EXCEPTION_PSERIES(0x5300, 0x1300, instruction_breakpoint)
  782. #ifdef CONFIG_PPC_DENORMALISATION
  783. . = 0x5500
  784. b denorm_exception_hv
  785. #endif
  786. #ifdef CONFIG_HVC_SCOM
  787. STD_RELON_EXCEPTION_HV(0x5600, 0x1600, maintence_interrupt)
  788. KVM_HANDLER_SKIP(PACA_EXGEN, EXC_HV, 0x1600)
  789. #endif /* CONFIG_HVC_SCOM */
  790. STD_RELON_EXCEPTION_PSERIES(0x5700, 0x1700, altivec_assist)
  791. /* Other future vectors */
  792. .align 7
  793. .globl __end_interrupts
  794. __end_interrupts:
  795. .align 7
  796. system_call_entry_direct:
  797. #if defined(CONFIG_RELOCATABLE)
  798. /* The first level prologue may have used LR to get here, saving
  799. * orig in r10. To save hacking/ifdeffing common code, restore here.
  800. */
  801. mtlr r10
  802. #endif
  803. system_call_entry:
  804. b system_call_common
  805. ppc64_runlatch_on_trampoline:
  806. b .__ppc64_runlatch_on
  807. /*
  808. * Here we have detected that the kernel stack pointer is bad.
  809. * R9 contains the saved CR, r13 points to the paca,
  810. * r10 contains the (bad) kernel stack pointer,
  811. * r11 and r12 contain the saved SRR0 and SRR1.
  812. * We switch to using an emergency stack, save the registers there,
  813. * and call kernel_bad_stack(), which panics.
  814. */
  815. bad_stack:
  816. ld r1,PACAEMERGSP(r13)
  817. subi r1,r1,64+INT_FRAME_SIZE
  818. std r9,_CCR(r1)
  819. std r10,GPR1(r1)
  820. std r11,_NIP(r1)
  821. std r12,_MSR(r1)
  822. mfspr r11,SPRN_DAR
  823. mfspr r12,SPRN_DSISR
  824. std r11,_DAR(r1)
  825. std r12,_DSISR(r1)
  826. mflr r10
  827. mfctr r11
  828. mfxer r12
  829. std r10,_LINK(r1)
  830. std r11,_CTR(r1)
  831. std r12,_XER(r1)
  832. SAVE_GPR(0,r1)
  833. SAVE_GPR(2,r1)
  834. ld r10,EX_R3(r3)
  835. std r10,GPR3(r1)
  836. SAVE_GPR(4,r1)
  837. SAVE_4GPRS(5,r1)
  838. ld r9,EX_R9(r3)
  839. ld r10,EX_R10(r3)
  840. SAVE_2GPRS(9,r1)
  841. ld r9,EX_R11(r3)
  842. ld r10,EX_R12(r3)
  843. ld r11,EX_R13(r3)
  844. std r9,GPR11(r1)
  845. std r10,GPR12(r1)
  846. std r11,GPR13(r1)
  847. BEGIN_FTR_SECTION
  848. ld r10,EX_CFAR(r3)
  849. std r10,ORIG_GPR3(r1)
  850. END_FTR_SECTION_IFSET(CPU_FTR_CFAR)
  851. SAVE_8GPRS(14,r1)
  852. SAVE_10GPRS(22,r1)
  853. lhz r12,PACA_TRAP_SAVE(r13)
  854. std r12,_TRAP(r1)
  855. addi r11,r1,INT_FRAME_SIZE
  856. std r11,0(r1)
  857. li r12,0
  858. std r12,0(r11)
  859. ld r2,PACATOC(r13)
  860. ld r11,exception_marker@toc(r2)
  861. std r12,RESULT(r1)
  862. std r11,STACK_FRAME_OVERHEAD-16(r1)
  863. 1: addi r3,r1,STACK_FRAME_OVERHEAD
  864. bl .kernel_bad_stack
  865. b 1b
  866. /*
  867. * Here r13 points to the paca, r9 contains the saved CR,
  868. * SRR0 and SRR1 are saved in r11 and r12,
  869. * r9 - r13 are saved in paca->exgen.
  870. */
  871. .align 7
  872. .globl data_access_common
  873. data_access_common:
  874. mfspr r10,SPRN_DAR
  875. std r10,PACA_EXGEN+EX_DAR(r13)
  876. mfspr r10,SPRN_DSISR
  877. stw r10,PACA_EXGEN+EX_DSISR(r13)
  878. EXCEPTION_PROLOG_COMMON(0x300, PACA_EXGEN)
  879. DISABLE_INTS
  880. ld r12,_MSR(r1)
  881. ld r3,PACA_EXGEN+EX_DAR(r13)
  882. lwz r4,PACA_EXGEN+EX_DSISR(r13)
  883. li r5,0x300
  884. b .do_hash_page /* Try to handle as hpte fault */
  885. .align 7
  886. .globl h_data_storage_common
  887. h_data_storage_common:
  888. mfspr r10,SPRN_HDAR
  889. std r10,PACA_EXGEN+EX_DAR(r13)
  890. mfspr r10,SPRN_HDSISR
  891. stw r10,PACA_EXGEN+EX_DSISR(r13)
  892. EXCEPTION_PROLOG_COMMON(0xe00, PACA_EXGEN)
  893. bl .save_nvgprs
  894. DISABLE_INTS
  895. addi r3,r1,STACK_FRAME_OVERHEAD
  896. bl .unknown_exception
  897. b .ret_from_except
  898. .align 7
  899. .globl instruction_access_common
  900. instruction_access_common:
  901. EXCEPTION_PROLOG_COMMON(0x400, PACA_EXGEN)
  902. DISABLE_INTS
  903. ld r12,_MSR(r1)
  904. ld r3,_NIP(r1)
  905. andis. r4,r12,0x5820
  906. li r5,0x400
  907. b .do_hash_page /* Try to handle as hpte fault */
  908. STD_EXCEPTION_COMMON(0xe20, h_instr_storage, .unknown_exception)
  909. /*
  910. * Here is the common SLB miss user that is used when going to virtual
  911. * mode for SLB misses, that is currently not used
  912. */
  913. #ifdef __DISABLED__
  914. .align 7
  915. .globl slb_miss_user_common
  916. slb_miss_user_common:
  917. mflr r10
  918. std r3,PACA_EXGEN+EX_DAR(r13)
  919. stw r9,PACA_EXGEN+EX_CCR(r13)
  920. std r10,PACA_EXGEN+EX_LR(r13)
  921. std r11,PACA_EXGEN+EX_SRR0(r13)
  922. bl .slb_allocate_user
  923. ld r10,PACA_EXGEN+EX_LR(r13)
  924. ld r3,PACA_EXGEN+EX_R3(r13)
  925. lwz r9,PACA_EXGEN+EX_CCR(r13)
  926. ld r11,PACA_EXGEN+EX_SRR0(r13)
  927. mtlr r10
  928. beq- slb_miss_fault
  929. andi. r10,r12,MSR_RI /* check for unrecoverable exception */
  930. beq- unrecov_user_slb
  931. mfmsr r10
  932. .machine push
  933. .machine "power4"
  934. mtcrf 0x80,r9
  935. .machine pop
  936. clrrdi r10,r10,2 /* clear RI before setting SRR0/1 */
  937. mtmsrd r10,1
  938. mtspr SRR0,r11
  939. mtspr SRR1,r12
  940. ld r9,PACA_EXGEN+EX_R9(r13)
  941. ld r10,PACA_EXGEN+EX_R10(r13)
  942. ld r11,PACA_EXGEN+EX_R11(r13)
  943. ld r12,PACA_EXGEN+EX_R12(r13)
  944. ld r13,PACA_EXGEN+EX_R13(r13)
  945. rfid
  946. b .
  947. slb_miss_fault:
  948. EXCEPTION_PROLOG_COMMON(0x380, PACA_EXGEN)
  949. ld r4,PACA_EXGEN+EX_DAR(r13)
  950. li r5,0
  951. std r4,_DAR(r1)
  952. std r5,_DSISR(r1)
  953. b handle_page_fault
  954. unrecov_user_slb:
  955. EXCEPTION_PROLOG_COMMON(0x4200, PACA_EXGEN)
  956. DISABLE_INTS
  957. bl .save_nvgprs
  958. 1: addi r3,r1,STACK_FRAME_OVERHEAD
  959. bl .unrecoverable_exception
  960. b 1b
  961. #endif /* __DISABLED__ */
  962. /*
  963. * r13 points to the PACA, r9 contains the saved CR,
  964. * r12 contain the saved SRR1, SRR0 is still ready for return
  965. * r3 has the faulting address
  966. * r9 - r13 are saved in paca->exslb.
  967. * r3 is saved in paca->slb_r3
  968. * We assume we aren't going to take any exceptions during this procedure.
  969. */
  970. _GLOBAL(slb_miss_realmode)
  971. mflr r10
  972. #ifdef CONFIG_RELOCATABLE
  973. mtctr r11
  974. #endif
  975. stw r9,PACA_EXSLB+EX_CCR(r13) /* save CR in exc. frame */
  976. std r10,PACA_EXSLB+EX_LR(r13) /* save LR */
  977. bl .slb_allocate_realmode
  978. /* All done -- return from exception. */
  979. ld r10,PACA_EXSLB+EX_LR(r13)
  980. ld r3,PACA_EXSLB+EX_R3(r13)
  981. lwz r9,PACA_EXSLB+EX_CCR(r13) /* get saved CR */
  982. mtlr r10
  983. andi. r10,r12,MSR_RI /* check for unrecoverable exception */
  984. beq- 2f
  985. .machine push
  986. .machine "power4"
  987. mtcrf 0x80,r9
  988. mtcrf 0x01,r9 /* slb_allocate uses cr0 and cr7 */
  989. .machine pop
  990. RESTORE_PPR_PACA(PACA_EXSLB, r9)
  991. ld r9,PACA_EXSLB+EX_R9(r13)
  992. ld r10,PACA_EXSLB+EX_R10(r13)
  993. ld r11,PACA_EXSLB+EX_R11(r13)
  994. ld r12,PACA_EXSLB+EX_R12(r13)
  995. ld r13,PACA_EXSLB+EX_R13(r13)
  996. rfid
  997. b . /* prevent speculative execution */
  998. 2: mfspr r11,SPRN_SRR0
  999. ld r10,PACAKBASE(r13)
  1000. LOAD_HANDLER(r10,unrecov_slb)
  1001. mtspr SPRN_SRR0,r10
  1002. ld r10,PACAKMSR(r13)
  1003. mtspr SPRN_SRR1,r10
  1004. rfid
  1005. b .
  1006. unrecov_slb:
  1007. EXCEPTION_PROLOG_COMMON(0x4100, PACA_EXSLB)
  1008. DISABLE_INTS
  1009. bl .save_nvgprs
  1010. 1: addi r3,r1,STACK_FRAME_OVERHEAD
  1011. bl .unrecoverable_exception
  1012. b 1b
  1013. #ifdef CONFIG_PPC_970_NAP
  1014. power4_fixup_nap:
  1015. andc r9,r9,r10
  1016. std r9,TI_LOCAL_FLAGS(r11)
  1017. ld r10,_LINK(r1) /* make idle task do the */
  1018. std r10,_NIP(r1) /* equivalent of a blr */
  1019. blr
  1020. #endif
  1021. .align 7
  1022. .globl alignment_common
  1023. alignment_common:
  1024. mfspr r10,SPRN_DAR
  1025. std r10,PACA_EXGEN+EX_DAR(r13)
  1026. mfspr r10,SPRN_DSISR
  1027. stw r10,PACA_EXGEN+EX_DSISR(r13)
  1028. EXCEPTION_PROLOG_COMMON(0x600, PACA_EXGEN)
  1029. ld r3,PACA_EXGEN+EX_DAR(r13)
  1030. lwz r4,PACA_EXGEN+EX_DSISR(r13)
  1031. std r3,_DAR(r1)
  1032. std r4,_DSISR(r1)
  1033. bl .save_nvgprs
  1034. DISABLE_INTS
  1035. addi r3,r1,STACK_FRAME_OVERHEAD
  1036. bl .alignment_exception
  1037. b .ret_from_except
  1038. .align 7
  1039. .globl program_check_common
  1040. program_check_common:
  1041. EXCEPTION_PROLOG_COMMON(0x700, PACA_EXGEN)
  1042. bl .save_nvgprs
  1043. DISABLE_INTS
  1044. addi r3,r1,STACK_FRAME_OVERHEAD
  1045. bl .program_check_exception
  1046. b .ret_from_except
  1047. .align 7
  1048. .globl fp_unavailable_common
  1049. fp_unavailable_common:
  1050. EXCEPTION_PROLOG_COMMON(0x800, PACA_EXGEN)
  1051. bne 1f /* if from user, just load it up */
  1052. bl .save_nvgprs
  1053. DISABLE_INTS
  1054. addi r3,r1,STACK_FRAME_OVERHEAD
  1055. bl .kernel_fp_unavailable_exception
  1056. BUG_OPCODE
  1057. 1: bl .load_up_fpu
  1058. b fast_exception_return
  1059. .align 7
  1060. .globl altivec_unavailable_common
  1061. altivec_unavailable_common:
  1062. EXCEPTION_PROLOG_COMMON(0xf20, PACA_EXGEN)
  1063. #ifdef CONFIG_ALTIVEC
  1064. BEGIN_FTR_SECTION
  1065. beq 1f
  1066. bl .load_up_altivec
  1067. b fast_exception_return
  1068. 1:
  1069. END_FTR_SECTION_IFSET(CPU_FTR_ALTIVEC)
  1070. #endif
  1071. bl .save_nvgprs
  1072. DISABLE_INTS
  1073. addi r3,r1,STACK_FRAME_OVERHEAD
  1074. bl .altivec_unavailable_exception
  1075. b .ret_from_except
  1076. .align 7
  1077. .globl vsx_unavailable_common
  1078. vsx_unavailable_common:
  1079. EXCEPTION_PROLOG_COMMON(0xf40, PACA_EXGEN)
  1080. #ifdef CONFIG_VSX
  1081. BEGIN_FTR_SECTION
  1082. beq 1f
  1083. b .load_up_vsx
  1084. 1:
  1085. END_FTR_SECTION_IFSET(CPU_FTR_VSX)
  1086. #endif
  1087. bl .save_nvgprs
  1088. DISABLE_INTS
  1089. addi r3,r1,STACK_FRAME_OVERHEAD
  1090. bl .vsx_unavailable_exception
  1091. b .ret_from_except
  1092. .align 7
  1093. .globl __end_handlers
  1094. __end_handlers:
  1095. /* Equivalents to the above handlers for relocation-on interrupt vectors */
  1096. STD_RELON_EXCEPTION_HV_OOL(0xe00, h_data_storage)
  1097. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe00)
  1098. STD_RELON_EXCEPTION_HV_OOL(0xe20, h_instr_storage)
  1099. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe20)
  1100. STD_RELON_EXCEPTION_HV_OOL(0xe40, emulation_assist)
  1101. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe40)
  1102. STD_RELON_EXCEPTION_HV_OOL(0xe60, hmi_exception)
  1103. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe60)
  1104. MASKABLE_RELON_EXCEPTION_HV_OOL(0xe80, h_doorbell)
  1105. KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe80)
  1106. STD_RELON_EXCEPTION_PSERIES_OOL(0xf00, performance_monitor)
  1107. STD_RELON_EXCEPTION_PSERIES_OOL(0xf20, altivec_unavailable)
  1108. STD_RELON_EXCEPTION_PSERIES_OOL(0xf40, vsx_unavailable)
  1109. #if defined(CONFIG_PPC_PSERIES) || defined(CONFIG_PPC_POWERNV)
  1110. /*
  1111. * Data area reserved for FWNMI option.
  1112. * This address (0x7000) is fixed by the RPA.
  1113. */
  1114. .= 0x7000
  1115. .globl fwnmi_data_area
  1116. fwnmi_data_area:
  1117. /* pseries and powernv need to keep the whole page from
  1118. * 0x7000 to 0x8000 free for use by the firmware
  1119. */
  1120. . = 0x8000
  1121. #endif /* defined(CONFIG_PPC_PSERIES) || defined(CONFIG_PPC_POWERNV) */
  1122. /* Space for CPU0's segment table */
  1123. .balign 4096
  1124. .globl initial_stab
  1125. initial_stab:
  1126. .space 4096
  1127. #ifdef CONFIG_PPC_POWERNV
  1128. _GLOBAL(opal_mc_secondary_handler)
  1129. HMT_MEDIUM_PPR_DISCARD
  1130. SET_SCRATCH0(r13)
  1131. GET_PACA(r13)
  1132. clrldi r3,r3,2
  1133. tovirt(r3,r3)
  1134. std r3,PACA_OPAL_MC_EVT(r13)
  1135. ld r13,OPAL_MC_SRR0(r3)
  1136. mtspr SPRN_SRR0,r13
  1137. ld r13,OPAL_MC_SRR1(r3)
  1138. mtspr SPRN_SRR1,r13
  1139. ld r3,OPAL_MC_GPR3(r3)
  1140. GET_SCRATCH0(r13)
  1141. b machine_check_pSeries
  1142. #endif /* CONFIG_PPC_POWERNV */
  1143. /*
  1144. * Hash table stuff
  1145. */
  1146. .align 7
  1147. _STATIC(do_hash_page)
  1148. std r3,_DAR(r1)
  1149. std r4,_DSISR(r1)
  1150. andis. r0,r4,0xa410 /* weird error? */
  1151. bne- handle_page_fault /* if not, try to insert a HPTE */
  1152. andis. r0,r4,DSISR_DABRMATCH@h
  1153. bne- handle_dabr_fault
  1154. BEGIN_FTR_SECTION
  1155. andis. r0,r4,0x0020 /* Is it a segment table fault? */
  1156. bne- do_ste_alloc /* If so handle it */
  1157. END_MMU_FTR_SECTION_IFCLR(MMU_FTR_SLB)
  1158. CURRENT_THREAD_INFO(r11, r1)
  1159. lwz r0,TI_PREEMPT(r11) /* If we're in an "NMI" */
  1160. andis. r0,r0,NMI_MASK@h /* (i.e. an irq when soft-disabled) */
  1161. bne 77f /* then don't call hash_page now */
  1162. /*
  1163. * We need to set the _PAGE_USER bit if MSR_PR is set or if we are
  1164. * accessing a userspace segment (even from the kernel). We assume
  1165. * kernel addresses always have the high bit set.
  1166. */
  1167. rlwinm r4,r4,32-25+9,31-9,31-9 /* DSISR_STORE -> _PAGE_RW */
  1168. rotldi r0,r3,15 /* Move high bit into MSR_PR posn */
  1169. orc r0,r12,r0 /* MSR_PR | ~high_bit */
  1170. rlwimi r4,r0,32-13,30,30 /* becomes _PAGE_USER access bit */
  1171. ori r4,r4,1 /* add _PAGE_PRESENT */
  1172. rlwimi r4,r5,22+2,31-2,31-2 /* Set _PAGE_EXEC if trap is 0x400 */
  1173. /*
  1174. * r3 contains the faulting address
  1175. * r4 contains the required access permissions
  1176. * r5 contains the trap number
  1177. *
  1178. * at return r3 = 0 for success, 1 for page fault, negative for error
  1179. */
  1180. bl .hash_page /* build HPTE if possible */
  1181. cmpdi r3,0 /* see if hash_page succeeded */
  1182. /* Success */
  1183. beq fast_exc_return_irq /* Return from exception on success */
  1184. /* Error */
  1185. blt- 13f
  1186. /* Here we have a page fault that hash_page can't handle. */
  1187. handle_page_fault:
  1188. 11: ld r4,_DAR(r1)
  1189. ld r5,_DSISR(r1)
  1190. addi r3,r1,STACK_FRAME_OVERHEAD
  1191. bl .do_page_fault
  1192. cmpdi r3,0
  1193. beq+ 12f
  1194. bl .save_nvgprs
  1195. mr r5,r3
  1196. addi r3,r1,STACK_FRAME_OVERHEAD
  1197. lwz r4,_DAR(r1)
  1198. bl .bad_page_fault
  1199. b .ret_from_except
  1200. /* We have a data breakpoint exception - handle it */
  1201. handle_dabr_fault:
  1202. bl .save_nvgprs
  1203. ld r4,_DAR(r1)
  1204. ld r5,_DSISR(r1)
  1205. addi r3,r1,STACK_FRAME_OVERHEAD
  1206. bl .do_break
  1207. 12: b .ret_from_except_lite
  1208. /* We have a page fault that hash_page could handle but HV refused
  1209. * the PTE insertion
  1210. */
  1211. 13: bl .save_nvgprs
  1212. mr r5,r3
  1213. addi r3,r1,STACK_FRAME_OVERHEAD
  1214. ld r4,_DAR(r1)
  1215. bl .low_hash_fault
  1216. b .ret_from_except
  1217. /*
  1218. * We come here as a result of a DSI at a point where we don't want
  1219. * to call hash_page, such as when we are accessing memory (possibly
  1220. * user memory) inside a PMU interrupt that occurred while interrupts
  1221. * were soft-disabled. We want to invoke the exception handler for
  1222. * the access, or panic if there isn't a handler.
  1223. */
  1224. 77: bl .save_nvgprs
  1225. mr r4,r3
  1226. addi r3,r1,STACK_FRAME_OVERHEAD
  1227. li r5,SIGSEGV
  1228. bl .bad_page_fault
  1229. b .ret_from_except
  1230. /* here we have a segment miss */
  1231. do_ste_alloc:
  1232. bl .ste_allocate /* try to insert stab entry */
  1233. cmpdi r3,0
  1234. bne- handle_page_fault
  1235. b fast_exception_return
  1236. /*
  1237. * r13 points to the PACA, r9 contains the saved CR,
  1238. * r11 and r12 contain the saved SRR0 and SRR1.
  1239. * r9 - r13 are saved in paca->exslb.
  1240. * We assume we aren't going to take any exceptions during this procedure.
  1241. * We assume (DAR >> 60) == 0xc.
  1242. */
  1243. .align 7
  1244. _GLOBAL(do_stab_bolted)
  1245. stw r9,PACA_EXSLB+EX_CCR(r13) /* save CR in exc. frame */
  1246. std r11,PACA_EXSLB+EX_SRR0(r13) /* save SRR0 in exc. frame */
  1247. /* Hash to the primary group */
  1248. ld r10,PACASTABVIRT(r13)
  1249. mfspr r11,SPRN_DAR
  1250. srdi r11,r11,28
  1251. rldimi r10,r11,7,52 /* r10 = first ste of the group */
  1252. /* Calculate VSID */
  1253. /* This is a kernel address, so protovsid = ESID | 1 << 37 */
  1254. li r9,0x1
  1255. rldimi r11,r9,(CONTEXT_BITS + USER_ESID_BITS),0
  1256. ASM_VSID_SCRAMBLE(r11, r9, 256M)
  1257. rldic r9,r11,12,16 /* r9 = vsid << 12 */
  1258. /* Search the primary group for a free entry */
  1259. 1: ld r11,0(r10) /* Test valid bit of the current ste */
  1260. andi. r11,r11,0x80
  1261. beq 2f
  1262. addi r10,r10,16
  1263. andi. r11,r10,0x70
  1264. bne 1b
  1265. /* Stick for only searching the primary group for now. */
  1266. /* At least for now, we use a very simple random castout scheme */
  1267. /* Use the TB as a random number ; OR in 1 to avoid entry 0 */
  1268. mftb r11
  1269. rldic r11,r11,4,57 /* r11 = (r11 << 4) & 0x70 */
  1270. ori r11,r11,0x10
  1271. /* r10 currently points to an ste one past the group of interest */
  1272. /* make it point to the randomly selected entry */
  1273. subi r10,r10,128
  1274. or r10,r10,r11 /* r10 is the entry to invalidate */
  1275. isync /* mark the entry invalid */
  1276. ld r11,0(r10)
  1277. rldicl r11,r11,56,1 /* clear the valid bit */
  1278. rotldi r11,r11,8
  1279. std r11,0(r10)
  1280. sync
  1281. clrrdi r11,r11,28 /* Get the esid part of the ste */
  1282. slbie r11
  1283. 2: std r9,8(r10) /* Store the vsid part of the ste */
  1284. eieio
  1285. mfspr r11,SPRN_DAR /* Get the new esid */
  1286. clrrdi r11,r11,28 /* Permits a full 32b of ESID */
  1287. ori r11,r11,0x90 /* Turn on valid and kp */
  1288. std r11,0(r10) /* Put new entry back into the stab */
  1289. sync
  1290. /* All done -- return from exception. */
  1291. lwz r9,PACA_EXSLB+EX_CCR(r13) /* get saved CR */
  1292. ld r11,PACA_EXSLB+EX_SRR0(r13) /* get saved SRR0 */
  1293. andi. r10,r12,MSR_RI
  1294. beq- unrecov_slb
  1295. mtcrf 0x80,r9 /* restore CR */
  1296. mfmsr r10
  1297. clrrdi r10,r10,2
  1298. mtmsrd r10,1
  1299. mtspr SPRN_SRR0,r11
  1300. mtspr SPRN_SRR1,r12
  1301. ld r9,PACA_EXSLB+EX_R9(r13)
  1302. ld r10,PACA_EXSLB+EX_R10(r13)
  1303. ld r11,PACA_EXSLB+EX_R11(r13)
  1304. ld r12,PACA_EXSLB+EX_R12(r13)
  1305. ld r13,PACA_EXSLB+EX_R13(r13)
  1306. rfid
  1307. b . /* prevent speculative execution */