head64.S
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:8k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  *
  3.  * This file is subject to the terms and conditions of the GNU General Public
  4.  * License.  See the file "COPYING" in the main directory of this archive
  5.  * for more details.
  6.  *
  7.  * Copyright (C) 1999 by Helge Deller
  8.  * Copyright 1999 SuSE GmbH (Philipp Rumpf)
  9.  * Copyright 1999 Philipp Rumpf (prumpf@tux.org)
  10.  * Copyright 2000 Hewlett Packard (Paul Bame, bame@puffin.external.hp.com)
  11.  * Copyright (C) 2001 Grant Grundler (Hewlett Packard)
  12.  *
  13.  * Initial Version 04-23-1999 by Helge Deller <deller@gmx.de>
  14.  */
  15. #include <linux/autoconf.h> /* for CONFIG_SMP */
  16. #include <asm/offset.h>
  17. #include <asm/psw.h>
  18. #include <asm/assembly.h>
  19. #include <asm/pgtable.h>
  20. #include <asm/pdc.h> /* for PDC_PSW defines */
  21. .level 2.0
  22. .section .initcall.init
  23. .align 4
  24. .export __initcall_start
  25. __initcall_start:
  26. .export __initcall_end
  27. __initcall_end:
  28. .export __setup_start
  29. __setup_start:
  30. .export __setup_end
  31. __setup_end:
  32. .data
  33. .export boot_args
  34. boot_args:
  35. .word 0 /* arg0 */
  36. .word 0 /* arg1 */
  37. .word 0 /* arg2 */
  38. .word 0 /* arg3 */
  39. .text
  40. .align 4
  41. .export stext
  42. .export _stext,data /* Kernel want it this way! */
  43. _stext:
  44. stext:
  45. .proc
  46. .callinfo
  47. /* Make sure sr4-sr7 are set to zero for the kernel address space */
  48. mtsp %r0,%sr4
  49. mtsp %r0,%sr5
  50. mtsp %r0,%sr6
  51. mtsp %r0,%sr7
  52. /* Clear BSS (shouldn't the boot loader do this?) */
  53. .import _edata,data
  54. .import _end,data
  55. ldil            L%PA(_edata),%r3
  56. ldo             R%PA(_edata)(%r3),%r3
  57. ldil            L%PA(_end),%r4
  58. ldo             R%PA(_end)(%r4),%r4
  59. $bss_loop:
  60. cmpb,<<,n       %r3,%r4,$bss_loop
  61. stb,ma          %r0,1(%r3)
  62. /* Save away the arguments the boot loader passed in (32 bit args) */
  63. ldil            L%PA(boot_args),%r1
  64. ldo             R%PA(boot_args)(%r1),%r1
  65. stw,ma          %arg0,4(%r1)
  66. stw,ma          %arg1,4(%r1)
  67. stw,ma          %arg2,4(%r1)
  68. stw,ma          %arg3,4(%r1)
  69. /* Initialize startup VM. Just map first 8 MB of memory */
  70. ldil L%PA(pg0),%r1
  71. ldo R%PA(pg0)(%r1),%r1
  72. ldil L%PA(pmd0),%r5
  73. ldo R%PA(pmd0)(%r5),%r5
  74. ldo _PAGE_TABLE(%r5),%r3
  75. ldil L%PA(swapper_pg_dir),%r4
  76. ldo R%PA(swapper_pg_dir)(%r4),%r4
  77. mtctl %r4,%cr24 /* Initialize kernel root pointer */
  78. mtctl %r4,%cr25 /* Initialize user root pointer */
  79. #if (__PAGE_OFFSET != 0x10000000UL)
  80. Error! Code below (the next five std's) needs to be changed
  81. #endif
  82. std             %r3,0x00(%r4)   /* Hardwired 0x1... kernel Vaddr start*/
  83. ldo _PAGE_TABLE(%r1),%r3
  84. std             %r3,0x400(%r5)  /* Hardwired 0x1... kernel Vaddr start*/
  85. ldo 0x1000(%r3),%r3
  86. std             %r3,0x408(%r5)
  87. ldo 0x1000(%r3),%r3
  88. std             %r3,0x410(%r5)
  89. ldo 0x1000(%r3),%r3
  90. std             %r3,0x418(%r5)
  91. ldo _PAGE_KERNEL(%r0),%r3 /* Hardwired 0 phys addr start */
  92. $pgt_fill_loop:
  93. std,ma %r3,8(%r1)
  94. ldo 0x1000(%r3),%r3
  95. bb,>= %r3,8,$pgt_fill_loop
  96. nop
  97. /* And the RFI Target address too */
  98. load32          start_kernel, %r11
  99. /* And the stack pointer too */
  100. load32 PA(init_task_union+TASK_SZ_ALGN),%sp
  101. /* And the initial task pointer */
  102. load32          init_task_union,%r6
  103. mtctl           %r6,%cr30
  104. /* And the interrupt stack */
  105. load32          interrupt_stack,%r6
  106. mtctl           %r6,%cr31
  107. /* Act like PDC just called us - that's how slave CPUs enter */
  108. #define MEM_PDC_LO 0x388
  109. #define MEM_PDC_HI 0x35C
  110. ldw MEM_PDC_LO(%r0),%r3
  111. ldw MEM_PDC_HI(%r0),%r6
  112. depd %r6, 31, 32, %r3 /* move to upper word */
  113. #ifdef CONFIG_SMP
  114. /* Set the smp rendevous address into page zero.
  115. ** It would be safer to do this in init_smp_config() but
  116. ** it's just way easier to deal with here because
  117. ** of 64-bit function ptrs and the address is local to this file.
  118. */
  119. ldil L%PA(smp_slave_stext),%r10
  120. ldo R%PA(smp_slave_stext)(%r10),%r10
  121. stw %r10,0x10(%r0) /* MEM_RENDEZ */
  122. stw %r0,0x28(%r0) /* MEM_RENDEZ_HI - assume addr < 4GB */
  123. /* FALLTHROUGH */
  124. .procend
  125. /*
  126. ** Code Common to both Monarch and Slave processors.
  127. ** Entry:
  128. **    %r3 PDCE_PROC address
  129. **    %r11 RFI target address.
  130. **
  131. ** Caller must init: SR4-7, %sp, %r10, %cr24/25, 
  132. */
  133. common_stext:
  134. .proc
  135. .callinfo
  136. #else /* CONFIG_SMP */
  137. /* Clear PDC's CPU handoff address - we won't use it */
  138. stw %r0,0x10(%r0) /* MEM_RENDEZ */
  139. stw %r0,0x28(%r0) /* MEM_RENDEZ_HI */
  140. #endif /* CONFIG_SMP */
  141. /* Save the rfi target address */
  142. std %r11,  TASK_PT_GR11-TASK_SZ_ALGN(%sp)
  143. #ifndef CONFIG_PDC_NARROW
  144. /* Switch to wide mode; Superdome doesn't support narrow PDC
  145. ** calls.
  146. */
  147. 1: mfia %rp /* clear upper part of pcoq */
  148. ldo 2f-1b(%rp),%rp
  149. depdi 0,31,32,%rp
  150. bv (%rp)
  151. ssm PSW_SM_W,%r0
  152. 2:
  153. #endif /* CONFIG_PDC_NARROW */
  154. /* Set Wide mode as the "Default" (eg for traps)
  155. ** First trap occurs *right* after (or part of) rfi for slave CPUs.
  156. ** Someday, palo might not do this for the Monarch either.
  157. */
  158. ldo PDC_PSW(%r0),%arg0 /* 21 */
  159. ldo PDC_PSW_SET_DEFAULTS(%r0),%arg1 /* 2 */
  160. ldo PDC_PSW_WIDE_BIT(%r0),%arg2 /* 2 */
  161. load32 PA(stext_pdc_ret), %rp
  162. bv (%r3)
  163. copy %r0,%arg3
  164. stext_pdc_ret:
  165. /* restore rfi target address*/
  166. ldd TASK_PT_GR11-TASK_SZ_ALGN(%sp), %r11
  167. /* PARANOID: clear user scratch/user space SR's */
  168. mtsp %r0,%sr0
  169. mtsp %r0,%sr1
  170. mtsp %r0,%sr2
  171. mtsp %r0,%sr3
  172. /* Initialize Protection Registers */
  173. mtctl %r0,%cr8
  174. mtctl %r0,%cr9
  175. mtctl %r0,%cr12
  176. mtctl %r0,%cr13
  177. /* Prepare to RFI! Man all the cannons! */
  178. tovirt_r1       %sp
  179. /* Initialize the global data pointer */
  180. load32 __gp,%dp
  181. /* Set up our interrupt table.  HPMCs might not work after this! */
  182. ldil L%PA(fault_vector_20),%r10
  183. ldo R%PA(fault_vector_20)(%r10),%r10
  184. mtctl %r10,%cr14
  185. b aligned_rfi
  186. nop
  187. /* the magic spell */
  188. .align          256
  189. aligned_rfi:
  190. ssm 0,0
  191. nop /* 1 */
  192. nop /* 2 */
  193. nop /* 3 */
  194. nop /* 4 */
  195. nop /* 5 */
  196. nop /* 6 */
  197. nop /* 7 */
  198. nop /* 8 */
  199. /* turn off troublesome PSW bits */
  200. rsm PSW_Q+PSW_I+PSW_D+PSW_P+PSW_R, %r0
  201. /* kernel PSW:
  202.  *  - no interruptions except HPMC and TOC (which are handled by PDC)
  203.  *  - Q bit set (IODC / PDC interruptions)
  204.  *  - big-endian
  205.  *  - virtually mapped
  206.  */
  207. load32 KERNEL_PSW,%r10
  208. mtctl %r10,%ipsw
  209. /* Set the space pointers for the post-RFI world
  210. ** Clear the two-level IIA Space Queue, effectively setting
  211. ** Kernel space.
  212. */
  213. mtctl %r0,%cr17
  214. mtctl %r0,%cr17
  215. /* Load RFI target into PC queue */
  216. mtctl %r11,%cr18
  217. ldo 4(%r11),%r11
  218. mtctl %r11,%cr18
  219. /* Jump to hyperspace */
  220. rfi
  221. nop
  222. .procend
  223. #ifdef CONFIG_SMP
  224. .import smp_init_current_idle_task,data
  225. .import smp_callin,code
  226. /***************************************************************************
  227. *
  228. * smp_slave_stext is executed by all non-monarch Processors when the Monarch
  229. * pokes the slave CPUs in smp.c:smp_boot_cpus().
  230. *
  231. * Once here, registers values are initialized in order to branch to virtual
  232. * mode. Once all available/eligible CPUs are in virtual mode, all are
  233. * released and start out by executing their own idle task.
  234. *****************************************************************************/
  235. smp_slave_stext:
  236.         .proc
  237. .callinfo
  238. /*
  239. ** Initialize Space registers
  240. */
  241. mtsp    %r0,%sr4
  242. mtsp    %r0,%sr5
  243. mtsp    %r0,%sr6
  244. mtsp    %r0,%sr7
  245. /*  Initialize the SP - monarch sets up smp_init_current_idle_task */
  246. load32 PA(smp_init_current_idle_task),%sp
  247. ldd 0(%sp),%sp /* load task address */
  248. mtctl           %sp,%cr30       /* store in cr30 */
  249. ldo             TASK_SZ_ALGN(%sp),%sp
  250. tophys_r1       %sp
  251. /* point CPU to kernel page tables */
  252. load32 PA(swapper_pg_dir),%r4
  253. mtctl %r4,%cr24 /* Initialize kernel root pointer */
  254. mtctl %r4,%cr25 /* Initialize user root pointer */
  255. /* Setup PDCE_PROC entry */
  256. copy %arg0,%r3
  257. /* Load RFI target address.  */
  258. load32 smp_callin, %r11
  259. /* ok...common code can handle the rest */
  260. b common_stext
  261. nop
  262. .procend
  263. #endif /* CONFIG_SMP */