head.S 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697
  1. /* $Id: head.S,v 1.87 2002/02/09 19:49:31 davem Exp $
  2. * head.S: Initial boot code for the Sparc64 port of Linux.
  3. *
  4. * Copyright (C) 1996,1997 David S. Miller (davem@caip.rutgers.edu)
  5. * Copyright (C) 1996 David Sitsky (David.Sitsky@anu.edu.au)
  6. * Copyright (C) 1997,1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
  7. * Copyright (C) 1997 Miguel de Icaza (miguel@nuclecu.unam.mx)
  8. */
  9. #include <linux/config.h>
  10. #include <linux/version.h>
  11. #include <linux/errno.h>
  12. #include <linux/threads.h>
  13. #include <asm/thread_info.h>
  14. #include <asm/asi.h>
  15. #include <asm/pstate.h>
  16. #include <asm/ptrace.h>
  17. #include <asm/spitfire.h>
  18. #include <asm/page.h>
  19. #include <asm/pgtable.h>
  20. #include <asm/errno.h>
  21. #include <asm/signal.h>
  22. #include <asm/processor.h>
  23. #include <asm/lsu.h>
  24. #include <asm/dcr.h>
  25. #include <asm/dcu.h>
  26. #include <asm/head.h>
  27. #include <asm/ttable.h>
  28. #include <asm/mmu.h>
  29. #include <asm/cpudata.h>
  30. /* This section from from _start to sparc64_boot_end should fit into
  31. * 0x0000000000404000 to 0x0000000000408000.
  32. */
  33. .text
  34. .globl start, _start, stext, _stext
  35. _start:
  36. start:
  37. _stext:
  38. stext:
  39. ! 0x0000000000404000
  40. b sparc64_boot
  41. flushw /* Flush register file. */
  42. /* This stuff has to be in sync with SILO and other potential boot loaders
  43. * Fields should be kept upward compatible and whenever any change is made,
  44. * HdrS version should be incremented.
  45. */
  46. .global root_flags, ram_flags, root_dev
  47. .global sparc_ramdisk_image, sparc_ramdisk_size
  48. .global sparc_ramdisk_image64
  49. .ascii "HdrS"
  50. .word LINUX_VERSION_CODE
  51. /* History:
  52. *
  53. * 0x0300 : Supports being located at other than 0x4000
  54. * 0x0202 : Supports kernel params string
  55. * 0x0201 : Supports reboot_command
  56. */
  57. .half 0x0301 /* HdrS version */
  58. root_flags:
  59. .half 1
  60. root_dev:
  61. .half 0
  62. ram_flags:
  63. .half 0
  64. sparc_ramdisk_image:
  65. .word 0
  66. sparc_ramdisk_size:
  67. .word 0
  68. .xword reboot_command
  69. .xword bootstr_info
  70. sparc_ramdisk_image64:
  71. .xword 0
  72. .word _end
  73. /* PROM cif handler code address is in %o4. */
  74. sparc64_boot:
  75. 1: rd %pc, %g7
  76. set 1b, %g1
  77. cmp %g1, %g7
  78. be,pn %xcc, sparc64_boot_after_remap
  79. mov %o4, %l7
  80. /* We need to remap the kernel. Use position independant
  81. * code to remap us to KERNBASE.
  82. *
  83. * SILO can invoke us with 32-bit address masking enabled,
  84. * so make sure that's clear.
  85. */
  86. rdpr %pstate, %g1
  87. andn %g1, PSTATE_AM, %g1
  88. wrpr %g1, 0x0, %pstate
  89. ba,a,pt %xcc, 1f
  90. .globl prom_finddev_name, prom_chosen_path, prom_root_node
  91. .globl prom_getprop_name, prom_mmu_name, prom_peer_name
  92. .globl prom_callmethod_name, prom_translate_name, prom_root_compatible
  93. .globl prom_map_name, prom_unmap_name, prom_mmu_ihandle_cache
  94. .globl prom_boot_mapped_pc, prom_boot_mapping_mode
  95. .globl prom_boot_mapping_phys_high, prom_boot_mapping_phys_low
  96. .globl is_sun4v
  97. prom_peer_name:
  98. .asciz "peer"
  99. prom_compatible_name:
  100. .asciz "compatible"
  101. prom_finddev_name:
  102. .asciz "finddevice"
  103. prom_chosen_path:
  104. .asciz "/chosen"
  105. prom_getprop_name:
  106. .asciz "getprop"
  107. prom_mmu_name:
  108. .asciz "mmu"
  109. prom_callmethod_name:
  110. .asciz "call-method"
  111. prom_translate_name:
  112. .asciz "translate"
  113. prom_map_name:
  114. .asciz "map"
  115. prom_unmap_name:
  116. .asciz "unmap"
  117. prom_sun4v_name:
  118. .asciz "sun4v"
  119. .align 4
  120. prom_root_compatible:
  121. .skip 64
  122. prom_root_node:
  123. .word 0
  124. prom_mmu_ihandle_cache:
  125. .word 0
  126. prom_boot_mapped_pc:
  127. .word 0
  128. prom_boot_mapping_mode:
  129. .word 0
  130. .align 8
  131. prom_boot_mapping_phys_high:
  132. .xword 0
  133. prom_boot_mapping_phys_low:
  134. .xword 0
  135. is_sun4v:
  136. .word 0
  137. 1:
  138. rd %pc, %l0
  139. mov (1b - prom_peer_name), %l1
  140. sub %l0, %l1, %l1
  141. mov 0, %l2
  142. /* prom_root_node = prom_peer(0) */
  143. stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "peer"
  144. mov 1, %l3
  145. stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 1
  146. stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1
  147. stx %l2, [%sp + 2047 + 128 + 0x18] ! arg1, 0
  148. stx %g0, [%sp + 2047 + 128 + 0x20] ! ret1
  149. call %l7
  150. add %sp, (2047 + 128), %o0 ! argument array
  151. ldx [%sp + 2047 + 128 + 0x20], %l4 ! prom root node
  152. mov (1b - prom_root_node), %l1
  153. sub %l0, %l1, %l1
  154. stw %l4, [%l1]
  155. mov (1b - prom_getprop_name), %l1
  156. mov (1b - prom_compatible_name), %l2
  157. mov (1b - prom_root_compatible), %l5
  158. sub %l0, %l1, %l1
  159. sub %l0, %l2, %l2
  160. sub %l0, %l5, %l5
  161. /* prom_getproperty(prom_root_node, "compatible",
  162. * &prom_root_compatible, 64)
  163. */
  164. stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "getprop"
  165. mov 4, %l3
  166. stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 4
  167. mov 1, %l3
  168. stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1
  169. stx %l4, [%sp + 2047 + 128 + 0x18] ! arg1, prom_root_node
  170. stx %l2, [%sp + 2047 + 128 + 0x20] ! arg2, "compatible"
  171. stx %l5, [%sp + 2047 + 128 + 0x28] ! arg3, &prom_root_compatible
  172. mov 64, %l3
  173. stx %l3, [%sp + 2047 + 128 + 0x30] ! arg4, size
  174. stx %g0, [%sp + 2047 + 128 + 0x38] ! ret1
  175. call %l7
  176. add %sp, (2047 + 128), %o0 ! argument array
  177. mov (1b - prom_finddev_name), %l1
  178. mov (1b - prom_chosen_path), %l2
  179. mov (1b - prom_boot_mapped_pc), %l3
  180. sub %l0, %l1, %l1
  181. sub %l0, %l2, %l2
  182. sub %l0, %l3, %l3
  183. stw %l0, [%l3]
  184. sub %sp, (192 + 128), %sp
  185. /* chosen_node = prom_finddevice("/chosen") */
  186. stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "finddevice"
  187. mov 1, %l3
  188. stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 1
  189. stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1
  190. stx %l2, [%sp + 2047 + 128 + 0x18] ! arg1, "/chosen"
  191. stx %g0, [%sp + 2047 + 128 + 0x20] ! ret1
  192. call %l7
  193. add %sp, (2047 + 128), %o0 ! argument array
  194. ldx [%sp + 2047 + 128 + 0x20], %l4 ! chosen device node
  195. mov (1b - prom_getprop_name), %l1
  196. mov (1b - prom_mmu_name), %l2
  197. mov (1b - prom_mmu_ihandle_cache), %l5
  198. sub %l0, %l1, %l1
  199. sub %l0, %l2, %l2
  200. sub %l0, %l5, %l5
  201. /* prom_mmu_ihandle_cache = prom_getint(chosen_node, "mmu") */
  202. stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "getprop"
  203. mov 4, %l3
  204. stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 4
  205. mov 1, %l3
  206. stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1
  207. stx %l4, [%sp + 2047 + 128 + 0x18] ! arg1, chosen_node
  208. stx %l2, [%sp + 2047 + 128 + 0x20] ! arg2, "mmu"
  209. stx %l5, [%sp + 2047 + 128 + 0x28] ! arg3, &prom_mmu_ihandle_cache
  210. mov 4, %l3
  211. stx %l3, [%sp + 2047 + 128 + 0x30] ! arg4, sizeof(arg3)
  212. stx %g0, [%sp + 2047 + 128 + 0x38] ! ret1
  213. call %l7
  214. add %sp, (2047 + 128), %o0 ! argument array
  215. mov (1b - prom_callmethod_name), %l1
  216. mov (1b - prom_translate_name), %l2
  217. sub %l0, %l1, %l1
  218. sub %l0, %l2, %l2
  219. lduw [%l5], %l5 ! prom_mmu_ihandle_cache
  220. stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "call-method"
  221. mov 3, %l3
  222. stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 3
  223. mov 5, %l3
  224. stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 5
  225. stx %l2, [%sp + 2047 + 128 + 0x18] ! arg1: "translate"
  226. stx %l5, [%sp + 2047 + 128 + 0x20] ! arg2: prom_mmu_ihandle_cache
  227. /* PAGE align */
  228. srlx %l0, 13, %l3
  229. sllx %l3, 13, %l3
  230. stx %l3, [%sp + 2047 + 128 + 0x28] ! arg3: vaddr, our PC
  231. stx %g0, [%sp + 2047 + 128 + 0x30] ! res1
  232. stx %g0, [%sp + 2047 + 128 + 0x38] ! res2
  233. stx %g0, [%sp + 2047 + 128 + 0x40] ! res3
  234. stx %g0, [%sp + 2047 + 128 + 0x48] ! res4
  235. stx %g0, [%sp + 2047 + 128 + 0x50] ! res5
  236. call %l7
  237. add %sp, (2047 + 128), %o0 ! argument array
  238. ldx [%sp + 2047 + 128 + 0x40], %l1 ! translation mode
  239. mov (1b - prom_boot_mapping_mode), %l4
  240. sub %l0, %l4, %l4
  241. stw %l1, [%l4]
  242. mov (1b - prom_boot_mapping_phys_high), %l4
  243. sub %l0, %l4, %l4
  244. ldx [%sp + 2047 + 128 + 0x48], %l2 ! physaddr high
  245. stx %l2, [%l4 + 0x0]
  246. ldx [%sp + 2047 + 128 + 0x50], %l3 ! physaddr low
  247. /* 4MB align */
  248. srlx %l3, 22, %l3
  249. sllx %l3, 22, %l3
  250. stx %l3, [%l4 + 0x8]
  251. /* Leave service as-is, "call-method" */
  252. mov 7, %l3
  253. stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 7
  254. mov 1, %l3
  255. stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1
  256. mov (1b - prom_map_name), %l3
  257. sub %l0, %l3, %l3
  258. stx %l3, [%sp + 2047 + 128 + 0x18] ! arg1: "map"
  259. /* Leave arg2 as-is, prom_mmu_ihandle_cache */
  260. mov -1, %l3
  261. stx %l3, [%sp + 2047 + 128 + 0x28] ! arg3: mode (-1 default)
  262. sethi %hi(8 * 1024 * 1024), %l3
  263. stx %l3, [%sp + 2047 + 128 + 0x30] ! arg4: size (8MB)
  264. sethi %hi(KERNBASE), %l3
  265. stx %l3, [%sp + 2047 + 128 + 0x38] ! arg5: vaddr (KERNBASE)
  266. stx %g0, [%sp + 2047 + 128 + 0x40] ! arg6: empty
  267. mov (1b - prom_boot_mapping_phys_low), %l3
  268. sub %l0, %l3, %l3
  269. ldx [%l3], %l3
  270. stx %l3, [%sp + 2047 + 128 + 0x48] ! arg7: phys addr
  271. call %l7
  272. add %sp, (2047 + 128), %o0 ! argument array
  273. add %sp, (192 + 128), %sp
  274. sparc64_boot_after_remap:
  275. sethi %hi(prom_root_compatible), %g1
  276. or %g1, %lo(prom_root_compatible), %g1
  277. sethi %hi(prom_sun4v_name), %g7
  278. or %g7, %lo(prom_sun4v_name), %g7
  279. mov 5, %g3
  280. 1: ldub [%g7], %g2
  281. ldub [%g1], %g4
  282. cmp %g2, %g4
  283. bne,pn %icc, 2f
  284. add %g7, 1, %g7
  285. subcc %g3, 1, %g3
  286. bne,pt %xcc, 1b
  287. add %g1, 1, %g1
  288. sethi %hi(is_sun4v), %g1
  289. or %g1, %lo(is_sun4v), %g1
  290. mov 1, %g7
  291. stw %g7, [%g1]
  292. 2:
  293. BRANCH_IF_SUN4V(g1, jump_to_sun4u_init)
  294. BRANCH_IF_CHEETAH_BASE(g1,g7,cheetah_boot)
  295. BRANCH_IF_CHEETAH_PLUS_OR_FOLLOWON(g1,g7,cheetah_plus_boot)
  296. ba,pt %xcc, spitfire_boot
  297. nop
  298. cheetah_plus_boot:
  299. /* Preserve OBP chosen DCU and DCR register settings. */
  300. ba,pt %xcc, cheetah_generic_boot
  301. nop
  302. cheetah_boot:
  303. mov DCR_BPE | DCR_RPE | DCR_SI | DCR_IFPOE | DCR_MS, %g1
  304. wr %g1, %asr18
  305. sethi %uhi(DCU_ME|DCU_RE|DCU_HPE|DCU_SPE|DCU_SL|DCU_WE), %g7
  306. or %g7, %ulo(DCU_ME|DCU_RE|DCU_HPE|DCU_SPE|DCU_SL|DCU_WE), %g7
  307. sllx %g7, 32, %g7
  308. or %g7, DCU_DM | DCU_IM | DCU_DC | DCU_IC, %g7
  309. stxa %g7, [%g0] ASI_DCU_CONTROL_REG
  310. membar #Sync
  311. cheetah_generic_boot:
  312. mov TSB_EXTENSION_P, %g3
  313. stxa %g0, [%g3] ASI_DMMU
  314. stxa %g0, [%g3] ASI_IMMU
  315. membar #Sync
  316. mov TSB_EXTENSION_S, %g3
  317. stxa %g0, [%g3] ASI_DMMU
  318. membar #Sync
  319. mov TSB_EXTENSION_N, %g3
  320. stxa %g0, [%g3] ASI_DMMU
  321. stxa %g0, [%g3] ASI_IMMU
  322. membar #Sync
  323. ba,a,pt %xcc, jump_to_sun4u_init
  324. spitfire_boot:
  325. /* Typically PROM has already enabled both MMU's and both on-chip
  326. * caches, but we do it here anyway just to be paranoid.
  327. */
  328. mov (LSU_CONTROL_IC|LSU_CONTROL_DC|LSU_CONTROL_IM|LSU_CONTROL_DM), %g1
  329. stxa %g1, [%g0] ASI_LSU_CONTROL
  330. membar #Sync
  331. jump_to_sun4u_init:
  332. /*
  333. * Make sure we are in privileged mode, have address masking,
  334. * using the ordinary globals and have enabled floating
  335. * point.
  336. *
  337. * Again, typically PROM has left %pil at 13 or similar, and
  338. * (PSTATE_PRIV | PSTATE_PEF | PSTATE_IE) in %pstate.
  339. */
  340. wrpr %g0, (PSTATE_PRIV|PSTATE_PEF|PSTATE_IE), %pstate
  341. wr %g0, 0, %fprs
  342. set sun4u_init, %g2
  343. jmpl %g2 + %g0, %g0
  344. nop
  345. sun4u_init:
  346. BRANCH_IF_SUN4V(g1, sun4v_init)
  347. /* Set ctx 0 */
  348. mov PRIMARY_CONTEXT, %g7
  349. stxa %g0, [%g7] ASI_DMMU
  350. membar #Sync
  351. mov SECONDARY_CONTEXT, %g7
  352. stxa %g0, [%g7] ASI_DMMU
  353. membar #Sync
  354. ba,pt %xcc, sun4u_continue
  355. nop
  356. sun4v_init:
  357. /* Set ctx 0 */
  358. mov PRIMARY_CONTEXT, %g7
  359. stxa %g0, [%g7] ASI_MMU
  360. membar #Sync
  361. mov SECONDARY_CONTEXT, %g7
  362. stxa %g0, [%g7] ASI_MMU
  363. membar #Sync
  364. ba,pt %xcc, niagara_tlb_fixup
  365. nop
  366. sun4u_continue:
  367. BRANCH_IF_ANY_CHEETAH(g1, g7, cheetah_tlb_fixup)
  368. ba,pt %xcc, spitfire_tlb_fixup
  369. nop
  370. niagara_tlb_fixup:
  371. mov 3, %g2 /* Set TLB type to hypervisor. */
  372. sethi %hi(tlb_type), %g1
  373. stw %g2, [%g1 + %lo(tlb_type)]
  374. /* Patch copy/clear ops. */
  375. call niagara_patch_copyops
  376. nop
  377. call niagara_patch_bzero
  378. nop
  379. call niagara_patch_pageops
  380. nop
  381. /* Patch TLB/cache ops. */
  382. call hypervisor_patch_cachetlbops
  383. nop
  384. ba,pt %xcc, tlb_fixup_done
  385. nop
  386. cheetah_tlb_fixup:
  387. mov 2, %g2 /* Set TLB type to cheetah+. */
  388. BRANCH_IF_CHEETAH_PLUS_OR_FOLLOWON(g1,g7,1f)
  389. mov 1, %g2 /* Set TLB type to cheetah. */
  390. 1: sethi %hi(tlb_type), %g1
  391. stw %g2, [%g1 + %lo(tlb_type)]
  392. /* Patch copy/page operations to cheetah optimized versions. */
  393. call cheetah_patch_copyops
  394. nop
  395. call cheetah_patch_copy_page
  396. nop
  397. call cheetah_patch_cachetlbops
  398. nop
  399. ba,pt %xcc, tlb_fixup_done
  400. nop
  401. spitfire_tlb_fixup:
  402. /* Set TLB type to spitfire. */
  403. mov 0, %g2
  404. sethi %hi(tlb_type), %g1
  405. stw %g2, [%g1 + %lo(tlb_type)]
  406. tlb_fixup_done:
  407. sethi %hi(init_thread_union), %g6
  408. or %g6, %lo(init_thread_union), %g6
  409. ldx [%g6 + TI_TASK], %g4
  410. mov %sp, %l6
  411. mov %o4, %l7
  412. wr %g0, ASI_P, %asi
  413. mov 1, %g1
  414. sllx %g1, THREAD_SHIFT, %g1
  415. sub %g1, (STACKFRAME_SZ + STACK_BIAS), %g1
  416. add %g6, %g1, %sp
  417. mov 0, %fp
  418. /* Set per-cpu pointer initially to zero, this makes
  419. * the boot-cpu use the in-kernel-image per-cpu areas
  420. * before setup_per_cpu_area() is invoked.
  421. */
  422. clr %g5
  423. wrpr %g0, 0, %wstate
  424. wrpr %g0, 0x0, %tl
  425. /* Clear the bss */
  426. sethi %hi(__bss_start), %o0
  427. or %o0, %lo(__bss_start), %o0
  428. sethi %hi(_end), %o1
  429. or %o1, %lo(_end), %o1
  430. call __bzero
  431. sub %o1, %o0, %o1
  432. mov %l6, %o1 ! OpenPROM stack
  433. call prom_init
  434. mov %l7, %o0 ! OpenPROM cif handler
  435. /* Initialize current_thread_info()->cpu as early as possible.
  436. * In order to do that accurately we have to patch up the get_cpuid()
  437. * assembler sequences. And that, in turn, requires that we know
  438. * if we are on a Starfire box or not. While we're here, patch up
  439. * the sun4v sequences as well.
  440. */
  441. call check_if_starfire
  442. nop
  443. call per_cpu_patch
  444. nop
  445. call sun4v_patch
  446. nop
  447. #ifdef CONFIG_SMP
  448. call hard_smp_processor_id
  449. nop
  450. cmp %o0, NR_CPUS
  451. blu,pt %xcc, 1f
  452. nop
  453. call boot_cpu_id_too_large
  454. nop
  455. /* Not reached... */
  456. 1:
  457. #else
  458. mov 0, %o0
  459. #endif
  460. stb %o0, [%g6 + TI_CPU]
  461. /* Off we go.... */
  462. call start_kernel
  463. nop
  464. /* Not reached... */
  465. /* This is meant to allow the sharing of this code between
  466. * boot processor invocation (via setup_tba() below) and
  467. * secondary processor startup (via trampoline.S). The
  468. * former does use this code, the latter does not yet due
  469. * to some complexities. That should be fixed up at some
  470. * point.
  471. *
  472. * There used to be enormous complexity wrt. transferring
  473. * over from the firwmare's trap table to the Linux kernel's.
  474. * For example, there was a chicken & egg problem wrt. building
  475. * the OBP page tables, yet needing to be on the Linux kernel
  476. * trap table (to translate PAGE_OFFSET addresses) in order to
  477. * do that.
  478. *
  479. * We now handle OBP tlb misses differently, via linear lookups
  480. * into the prom_trans[] array. So that specific problem no
  481. * longer exists. Yet, unfortunately there are still some issues
  482. * preventing trampoline.S from using this code... ho hum.
  483. */
  484. .globl setup_trap_table
  485. setup_trap_table:
  486. save %sp, -192, %sp
  487. /* Force interrupts to be disabled. */
  488. rdpr %pstate, %o1
  489. andn %o1, PSTATE_IE, %o1
  490. wrpr %o1, 0x0, %pstate
  491. wrpr %g0, 15, %pil
  492. /* Make the firmware call to jump over to the Linux trap table. */
  493. sethi %hi(is_sun4v), %o0
  494. lduw [%o0 + %lo(is_sun4v)], %o0
  495. brz,pt %o0, 1f
  496. nop
  497. TRAP_LOAD_TRAP_BLOCK(%g2, %g3)
  498. add %g2, TRAP_PER_CPU_FAULT_INFO, %g2
  499. stxa %g2, [%g0] ASI_SCRATCHPAD
  500. /* Compute physical address:
  501. *
  502. * paddr = kern_base + (mmfsa_vaddr - KERNBASE)
  503. */
  504. sethi %hi(KERNBASE), %g3
  505. sub %g2, %g3, %g2
  506. sethi %hi(kern_base), %g3
  507. ldx [%g3 + %lo(kern_base)], %g3
  508. add %g2, %g3, %o1
  509. call prom_set_trap_table_sun4v
  510. sethi %hi(sparc64_ttable_tl0), %o0
  511. ba,pt %xcc, 2f
  512. nop
  513. 1: call prom_set_trap_table
  514. sethi %hi(sparc64_ttable_tl0), %o0
  515. /* Start using proper page size encodings in ctx register. */
  516. 2: sethi %hi(sparc64_kern_pri_context), %g3
  517. ldx [%g3 + %lo(sparc64_kern_pri_context)], %g2
  518. mov PRIMARY_CONTEXT, %g1
  519. 661: stxa %g2, [%g1] ASI_DMMU
  520. .section .sun4v_1insn_patch, "ax"
  521. .word 661b
  522. stxa %g2, [%g1] ASI_MMU
  523. .previous
  524. membar #Sync
  525. /* Kill PROM timer */
  526. sethi %hi(0x80000000), %o2
  527. sllx %o2, 32, %o2
  528. wr %o2, 0, %tick_cmpr
  529. BRANCH_IF_SUN4V(o2, 1f)
  530. BRANCH_IF_ANY_CHEETAH(o2, o3, 1f)
  531. ba,pt %xcc, 2f
  532. nop
  533. /* Disable STICK_INT interrupts. */
  534. 1:
  535. sethi %hi(0x80000000), %o2
  536. sllx %o2, 32, %o2
  537. wr %o2, %asr25
  538. 2:
  539. wrpr %g0, %g0, %wstate
  540. call init_irqwork_curcpu
  541. nop
  542. /* Now we can turn interrupts back on. */
  543. rdpr %pstate, %o1
  544. or %o1, PSTATE_IE, %o1
  545. wrpr %o1, 0, %pstate
  546. wrpr %g0, 0x0, %pil
  547. ret
  548. restore
  549. .globl setup_tba
  550. setup_tba:
  551. save %sp, -192, %sp
  552. /* The boot processor is the only cpu which invokes this
  553. * routine, the other cpus set things up via trampoline.S.
  554. * So save the OBP trap table address here.
  555. */
  556. rdpr %tba, %g7
  557. sethi %hi(prom_tba), %o1
  558. or %o1, %lo(prom_tba), %o1
  559. stx %g7, [%o1]
  560. call setup_trap_table
  561. nop
  562. ret
  563. restore
  564. sparc64_boot_end:
  565. #include "ktlb.S"
  566. #include "tsb.S"
  567. #include "etrap.S"
  568. #include "rtrap.S"
  569. #include "winfixup.S"
  570. #include "entry.S"
  571. #include "sun4v_tlb_miss.S"
  572. #include "sun4v_ivec.S"
  573. /*
  574. * The following skip makes sure the trap table in ttable.S is aligned
  575. * on a 32K boundary as required by the v9 specs for TBA register.
  576. *
  577. * We align to a 32K boundary, then we have the 32K kernel TSB,
  578. * then the 32K aligned trap table.
  579. */
  580. 1:
  581. .skip 0x4000 + _start - 1b
  582. .globl swapper_tsb
  583. swapper_tsb:
  584. .skip (32 * 1024)
  585. ! 0x0000000000408000
  586. #include "ttable.S"
  587. #include "systbls.S"
  588. .data
  589. .align 8
  590. .globl prom_tba, tlb_type
  591. prom_tba: .xword 0
  592. tlb_type: .word 0 /* Must NOT end up in BSS */
  593. .section ".fixup",#alloc,#execinstr
  594. .globl __ret_efault, __retl_efault
  595. __ret_efault:
  596. ret
  597. restore %g0, -EFAULT, %o0
  598. __retl_efault:
  599. retl
  600. mov -EFAULT, %o0