head64.S 6.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261
  1. /*
  2. * arch/s390/kernel/head64.S
  3. *
  4. * Copyright (C) IBM Corp. 1999,2006
  5. *
  6. * Author(s): Hartmut Penner <hp@de.ibm.com>
  7. * Martin Schwidefsky <schwidefsky@de.ibm.com>
  8. * Rob van der Heij <rvdhei@iae.nl>
  9. * Heiko Carstens <heiko.carstens@de.ibm.com>
  10. *
  11. */
  12. #
  13. # startup-code at 0x10000, running in absolute addressing mode
  14. # this is called either by the ipl loader or directly by PSW restart
  15. # or linload or SALIPL
  16. #
  17. .org 0x10000
  18. startup:basr %r13,0 # get base
  19. .LPG0: l %r13,0f-.LPG0(%r13)
  20. b 0(%r13)
  21. 0: .long startup_continue
  22. #
  23. # params at 10400 (setup.h)
  24. #
  25. .org PARMAREA
  26. .quad 0 # IPL_DEVICE
  27. .quad 0 # INITRD_START
  28. .quad 0 # INITRD_SIZE
  29. .org COMMAND_LINE
  30. .byte "root=/dev/ram0 ro"
  31. .byte 0
  32. .org 0x11000
  33. startup_continue:
  34. basr %r13,0 # get base
  35. .LPG1: sll %r13,1 # remove high order bit
  36. srl %r13,1
  37. #ifdef CONFIG_ZFCPDUMP
  38. # check if we have been ipled using zfcp dump:
  39. tm 0xb9,0x01 # test if subchannel is enabled
  40. jno .nodump # subchannel disabled
  41. l %r1,0xb8
  42. la %r5,.Lipl_schib-.LPG1(%r13)
  43. stsch 0(%r5) # get schib of subchannel
  44. jne .nodump # schib not available
  45. tm 5(%r5),0x01 # devno valid?
  46. jno .nodump
  47. tm 4(%r5),0x80 # qdio capable device?
  48. jno .nodump
  49. l %r2,20(%r0) # address of ipl parameter block
  50. lhi %r3,0
  51. ic %r3,0x148(%r2) # get opt field
  52. chi %r3,0x20 # load with dump?
  53. jne .nodump
  54. # store all prefix registers in case of load with dump:
  55. la %r7,0 # base register for 0 page
  56. la %r8,0 # first cpu
  57. l %r11,.Lpref_arr_ptr-.LPG1(%r13) # address of prefix array
  58. ahi %r11,4 # skip boot cpu
  59. lr %r12,%r11
  60. ahi %r12,(CONFIG_NR_CPUS*4) # end of prefix array
  61. stap .Lcurrent_cpu+2-.LPG1(%r13) # store current cpu addr
  62. 1:
  63. cl %r8,.Lcurrent_cpu-.LPG1(%r13) # is ipl cpu ?
  64. je 4f # if yes get next cpu
  65. 2:
  66. lr %r9,%r7
  67. sigp %r9,%r8,0x9 # stop & store status of cpu
  68. brc 8,3f # accepted
  69. brc 4,4f # status stored: next cpu
  70. brc 2,2b # busy: try again
  71. brc 1,4f # not op: next cpu
  72. 3:
  73. mvc 0(4,%r11),264(%r7) # copy prefix register to prefix array
  74. ahi %r11,4 # next element in prefix array
  75. clr %r11,%r12
  76. je 5f # no more space in prefix array
  77. 4:
  78. ahi %r8,1 # next cpu (r8 += 1)
  79. cl %r8,.Llast_cpu-.LPG1(%r13) # is last possible cpu ?
  80. jl 1b # jump if not last cpu
  81. 5:
  82. lhi %r1,2 # mode 2 = esame (dump)
  83. j 6f
  84. .align 4
  85. .Lipl_schib:
  86. .rept 13
  87. .long 0
  88. .endr
  89. .nodump:
  90. lhi %r1,1 # mode 1 = esame (normal ipl)
  91. 6:
  92. #else
  93. lhi %r1,1 # mode 1 = esame (normal ipl)
  94. #endif /* CONFIG_ZFCPDUMP */
  95. mvi __LC_AR_MODE_ID,1 # set esame flag
  96. slr %r0,%r0 # set cpuid to zero
  97. sigp %r1,%r0,0x12 # switch to esame mode
  98. sam64 # switch to 64 bit mode
  99. lctlg %c0,%c15,.Lctl-.LPG1(%r13) # load control registers
  100. lg %r12,.Lparmaddr-.LPG1(%r13) # pointer to parameter area
  101. # move IPL device to lowcore
  102. mvc __LC_IPLDEV(4),IPL_DEVICE+4-PARMAREA(%r12)
  103. #
  104. # Setup stack
  105. #
  106. larl %r15,init_thread_union
  107. lg %r14,__TI_task(%r15) # cache current in lowcore
  108. stg %r14,__LC_CURRENT
  109. aghi %r15,1<<(PAGE_SHIFT+THREAD_ORDER) # init_task_union + THREAD_SIZE
  110. stg %r15,__LC_KERNEL_STACK # set end of kernel stack
  111. aghi %r15,-160
  112. xc __SF_BACKCHAIN(4,%r15),__SF_BACKCHAIN(%r15) # clear backchain
  113. #
  114. # Save ipl parameters, clear bss memory, initialize storage key for kernel pages,
  115. # and create a kernel NSS if the SAVESYS= parm is defined
  116. #
  117. brasl %r14,startup_init
  118. # set program check new psw mask
  119. mvc __LC_PGM_NEW_PSW(8),.Lpcmsk-.LPG1(%r13)
  120. larl %r12,machine_flags
  121. #
  122. # find out if we have the MVPG instruction
  123. #
  124. la %r1,0f-.LPG1(%r13) # set program check address
  125. stg %r1,__LC_PGM_NEW_PSW+8
  126. sgr %r0,%r0
  127. lghi %r1,0
  128. lghi %r2,0
  129. mvpg %r1,%r2 # test MVPG instruction
  130. oi 7(%r12),16 # set MVPG flag
  131. 0:
  132. #
  133. # find out if the diag 0x44 works in 64 bit mode
  134. #
  135. la %r1,0f-.LPG1(%r13) # set program check address
  136. stg %r1,__LC_PGM_NEW_PSW+8
  137. diag 0,0,0x44 # test diag 0x44
  138. oi 7(%r12),32 # set diag44 flag
  139. 0:
  140. #
  141. # find out if we have the IDTE instruction
  142. #
  143. la %r1,0f-.LPG1(%r13) # set program check address
  144. stg %r1,__LC_PGM_NEW_PSW+8
  145. .long 0xb2b10000 # store facility list
  146. tm 0xc8,0x08 # check bit for clearing-by-ASCE
  147. bno 0f-.LPG1(%r13)
  148. lhi %r1,2094
  149. lhi %r2,0
  150. .long 0xb98e2001
  151. oi 7(%r12),0x80 # set IDTE flag
  152. 0:
  153. #
  154. # find out if the diag 0x9c is available
  155. #
  156. la %r1,0f-.LPG1(%r13) # set program check address
  157. stg %r1,__LC_PGM_NEW_PSW+8
  158. stap __LC_CPUID+4 # store cpu address
  159. lh %r1,__LC_CPUID+4
  160. diag %r1,0,0x9c # test diag 0x9c
  161. oi 6(%r12),1 # set diag9c flag
  162. 0:
  163. #
  164. # find out if we have the MVCOS instruction
  165. #
  166. la %r1,0f-.LPG1(%r13) # set program check address
  167. stg %r1,__LC_PGM_NEW_PSW+8
  168. .short 0xc800 # mvcos 0(%r0),0(%r0),%r0
  169. .short 0x0000
  170. .short 0x0000
  171. 0: tm 0x8f,0x13 # special-operation exception?
  172. bno 1f-.LPG1(%r13) # if yes, MVCOS is present
  173. oi 6(%r12),2 # set MVCOS flag
  174. 1:
  175. lpswe .Lentry-.LPG1(13) # jump to _stext in primary-space,
  176. # virtual and never return ...
  177. .align 16
  178. .Lentry:.quad 0x0000000180000000,_stext
  179. .Lctl: .quad 0x04b50002 # cr0: various things
  180. .quad 0 # cr1: primary space segment table
  181. .quad .Lduct # cr2: dispatchable unit control table
  182. .quad 0 # cr3: instruction authorization
  183. .quad 0 # cr4: instruction authorization
  184. .quad .Lduct # cr5: primary-aste origin
  185. .quad 0 # cr6: I/O interrupts
  186. .quad 0 # cr7: secondary space segment table
  187. .quad 0 # cr8: access registers translation
  188. .quad 0 # cr9: tracing off
  189. .quad 0 # cr10: tracing off
  190. .quad 0 # cr11: tracing off
  191. .quad 0 # cr12: tracing off
  192. .quad 0 # cr13: home space segment table
  193. .quad 0xc0000000 # cr14: machine check handling off
  194. .quad 0 # cr15: linkage stack operations
  195. .Lpcmsk:.quad 0x0000000180000000
  196. .L4malign:.quad 0xffffffffffc00000
  197. .Lscan2g:.quad 0x80000000 + 0x20000 - 8 # 2GB + 128K - 8
  198. .Lnop: .long 0x07000700
  199. #ifdef CONFIG_ZFCPDUMP
  200. .Lcurrent_cpu:
  201. .long 0x0
  202. .Llast_cpu:
  203. .long 0x0000ffff
  204. .Lpref_arr_ptr:
  205. .long zfcpdump_prefix_array
  206. #endif /* CONFIG_ZFCPDUMP */
  207. .Lparmaddr:
  208. .quad PARMAREA
  209. .align 64
  210. .Lduct: .long 0,0,0,0,.Lduald,0,0,0
  211. .long 0,0,0,0,0,0,0,0
  212. .align 128
  213. .Lduald:.rept 8
  214. .long 0x80000000,0,0,0 # invalid access-list entries
  215. .endr
  216. .org 0x12000
  217. .globl _ehead
  218. _ehead:
  219. #ifdef CONFIG_SHARED_KERNEL
  220. .org 0x100000
  221. #endif
  222. #
  223. # startup-code, running in absolute addressing mode
  224. #
  225. .globl _stext
  226. _stext: basr %r13,0 # get base
  227. .LPG3:
  228. # check control registers
  229. stctg %c0,%c15,0(%r15)
  230. oi 6(%r15),0x40 # enable sigp emergency signal
  231. oi 4(%r15),0x10 # switch on low address proctection
  232. lctlg %c0,%c15,0(%r15)
  233. lam 0,15,.Laregs-.LPG3(%r13) # load acrs needed by uaccess
  234. brasl %r14,start_kernel # go to C code
  235. #
  236. # We returned from start_kernel ?!? PANIK
  237. #
  238. basr %r13,0
  239. lpswe .Ldw-.(%r13) # load disabled wait psw
  240. .align 8
  241. .Ldw: .quad 0x0002000180000000,0x0000000000000000
  242. .Laregs:.long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0