]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* This file is subject to the terms and conditions of the GNU General Public |
2 | * License. See the file "COPYING" in the main directory of this archive | |
3 | * for more details. | |
4 | * | |
5 | * Copyright (C) 1999 by Helge Deller | |
6 | * Copyright 1999 SuSE GmbH (Philipp Rumpf) | |
7 | * Copyright 1999 Philipp Rumpf ([email protected]) | |
8 | * Copyright 2000 Hewlett Packard (Paul Bame, [email protected]) | |
9 | * Copyright (C) 2001 Grant Grundler (Hewlett Packard) | |
10 | * Copyright (C) 2004 Kyle McMartin <[email protected]> | |
11 | * | |
12 | * Initial Version 04-23-1999 by Helge Deller <[email protected]> | |
13 | */ | |
14 | ||
413059f2 | 15 | #include <linux/config.h> /* for CONFIG_SMP */ |
1da177e4 | 16 | |
0013a854 | 17 | #include <asm/asm-offsets.h> |
1da177e4 LT |
18 | #include <asm/psw.h> |
19 | #include <asm/pdc.h> | |
20 | ||
21 | #include <asm/assembly.h> | |
22 | #include <asm/pgtable.h> | |
23 | ||
24 | .level LEVEL | |
25 | ||
26 | .data | |
27 | ||
28 | .export boot_args | |
29 | boot_args: | |
30 | .word 0 /* arg0 */ | |
31 | .word 0 /* arg1 */ | |
32 | .word 0 /* arg2 */ | |
33 | .word 0 /* arg3 */ | |
34 | ||
35 | .text | |
36 | .align 4 | |
37 | .import init_thread_union,data | |
38 | .import fault_vector_20,code /* IVA parisc 2.0 32 bit */ | |
413059f2 | 39 | #ifndef CONFIG_64BIT |
1da177e4 LT |
40 | .import fault_vector_11,code /* IVA parisc 1.1 32 bit */ |
41 | .import $global$ /* forward declaration */ | |
413059f2 | 42 | #endif /*!CONFIG_64BIT*/ |
1da177e4 LT |
43 | .export stext |
44 | .export _stext,data /* Kernel want it this way! */ | |
45 | _stext: | |
46 | stext: | |
47 | .proc | |
48 | .callinfo | |
49 | ||
50 | /* Make sure sr4-sr7 are set to zero for the kernel address space */ | |
51 | mtsp %r0,%sr4 | |
52 | mtsp %r0,%sr5 | |
53 | mtsp %r0,%sr6 | |
54 | mtsp %r0,%sr7 | |
55 | ||
56 | /* Clear BSS (shouldn't the boot loader do this?) */ | |
57 | ||
58 | .import __bss_start,data | |
59 | .import __bss_stop,data | |
60 | ||
61 | load32 PA(__bss_start),%r3 | |
62 | load32 PA(__bss_stop),%r4 | |
63 | $bss_loop: | |
64 | cmpb,<<,n %r3,%r4,$bss_loop | |
65 | stw,ma %r0,4(%r3) | |
66 | ||
67 | /* Save away the arguments the boot loader passed in (32 bit args) */ | |
68 | load32 PA(boot_args),%r1 | |
69 | stw,ma %arg0,4(%r1) | |
70 | stw,ma %arg1,4(%r1) | |
71 | stw,ma %arg2,4(%r1) | |
72 | stw,ma %arg3,4(%r1) | |
73 | ||
74 | /* Initialize startup VM. Just map first 8/16 MB of memory */ | |
75 | load32 PA(swapper_pg_dir),%r4 | |
76 | mtctl %r4,%cr24 /* Initialize kernel root pointer */ | |
77 | mtctl %r4,%cr25 /* Initialize user root pointer */ | |
78 | ||
413059f2 | 79 | #ifdef CONFIG_64BIT |
1da177e4 LT |
80 | /* Set pmd in pgd */ |
81 | load32 PA(pmd0),%r5 | |
82 | shrd %r5,PxD_VALUE_SHIFT,%r3 | |
83 | ldo (PxD_FLAG_PRESENT+PxD_FLAG_VALID)(%r3),%r3 | |
84 | stw %r3,ASM_PGD_ENTRY*ASM_PGD_ENTRY_SIZE(%r4) | |
85 | ldo ASM_PMD_ENTRY*ASM_PMD_ENTRY_SIZE(%r5),%r4 | |
86 | #else | |
87 | /* 2-level page table, so pmd == pgd */ | |
88 | ldo ASM_PGD_ENTRY*ASM_PGD_ENTRY_SIZE(%r4),%r4 | |
89 | #endif | |
90 | ||
91 | /* Fill in pmd with enough pte directories */ | |
92 | load32 PA(pg0),%r1 | |
93 | SHRREG %r1,PxD_VALUE_SHIFT,%r3 | |
94 | ldo (PxD_FLAG_PRESENT+PxD_FLAG_VALID)(%r3),%r3 | |
95 | ||
96 | ldi ASM_PT_INITIAL,%r1 | |
97 | ||
98 | 1: | |
99 | stw %r3,0(%r4) | |
100 | ldo (ASM_PAGE_SIZE >> PxD_VALUE_SHIFT)(%r3),%r3 | |
101 | addib,> -1,%r1,1b | |
413059f2 | 102 | #ifdef CONFIG_64BIT |
1da177e4 LT |
103 | ldo ASM_PMD_ENTRY_SIZE(%r4),%r4 |
104 | #else | |
105 | ldo ASM_PGD_ENTRY_SIZE(%r4),%r4 | |
106 | #endif | |
107 | ||
108 | ||
109 | /* Now initialize the PTEs themselves */ | |
110 | ldo _PAGE_KERNEL(%r0),%r3 /* Hardwired 0 phys addr start */ | |
111 | load32 PA(pg0),%r1 | |
112 | ||
113 | $pgt_fill_loop: | |
114 | STREGM %r3,ASM_PTE_ENTRY_SIZE(%r1) | |
115 | ldo ASM_PAGE_SIZE(%r3),%r3 | |
116 | bb,>= %r3,31-KERNEL_INITIAL_ORDER,$pgt_fill_loop | |
117 | nop | |
118 | ||
119 | /* Load the return address...er...crash 'n burn */ | |
120 | copy %r0,%r2 | |
121 | ||
122 | /* And the RFI Target address too */ | |
123 | load32 start_kernel,%r11 | |
124 | ||
125 | /* And the initial task pointer */ | |
126 | load32 init_thread_union,%r6 | |
127 | mtctl %r6,%cr30 | |
128 | ||
129 | /* And the stack pointer too */ | |
130 | ldo THREAD_SZ_ALGN(%r6),%sp | |
131 | ||
132 | /* And the interrupt stack */ | |
133 | load32 interrupt_stack,%r6 | |
134 | mtctl %r6,%cr31 | |
135 | ||
136 | #ifdef CONFIG_SMP | |
137 | /* Set the smp rendevous address into page zero. | |
138 | ** It would be safer to do this in init_smp_config() but | |
139 | ** it's just way easier to deal with here because | |
140 | ** of 64-bit function ptrs and the address is local to this file. | |
141 | */ | |
142 | load32 PA(smp_slave_stext),%r10 | |
143 | stw %r10,0x10(%r0) /* MEM_RENDEZ */ | |
144 | stw %r0,0x28(%r0) /* MEM_RENDEZ_HI - assume addr < 4GB */ | |
145 | ||
146 | /* FALLTHROUGH */ | |
147 | .procend | |
148 | ||
149 | /* | |
150 | ** Code Common to both Monarch and Slave processors. | |
151 | ** Entry: | |
152 | ** | |
153 | ** 1.1: | |
154 | ** %r11 must contain RFI target address. | |
155 | ** %r25/%r26 args to pass to target function | |
156 | ** %r2 in case rfi target decides it didn't like something | |
157 | ** | |
158 | ** 2.0w: | |
159 | ** %r3 PDCE_PROC address | |
160 | ** %r11 RFI target address | |
161 | ** | |
162 | ** Caller must init: SR4-7, %sp, %r10, %cr24/25, | |
163 | */ | |
164 | common_stext: | |
165 | .proc | |
166 | .callinfo | |
167 | #else | |
168 | /* Clear PDC entry point - we won't use it */ | |
169 | stw %r0,0x10(%r0) /* MEM_RENDEZ */ | |
170 | stw %r0,0x28(%r0) /* MEM_RENDEZ_HI */ | |
171 | #endif /*CONFIG_SMP*/ | |
172 | ||
413059f2 | 173 | #ifdef CONFIG_64BIT |
1da177e4 LT |
174 | tophys_r1 %sp |
175 | ||
176 | /* Save the rfi target address */ | |
177 | ldd TI_TASK-THREAD_SZ_ALGN(%sp), %r10 | |
178 | tophys_r1 %r10 | |
179 | std %r11, TASK_PT_GR11(%r10) | |
180 | /* Switch to wide mode Superdome doesn't support narrow PDC | |
181 | ** calls. | |
182 | */ | |
183 | 1: mfia %rp /* clear upper part of pcoq */ | |
184 | ldo 2f-1b(%rp),%rp | |
185 | depdi 0,31,32,%rp | |
186 | bv (%rp) | |
187 | ssm PSW_SM_W,%r0 | |
188 | ||
189 | /* Set Wide mode as the "Default" (eg for traps) | |
190 | ** First trap occurs *right* after (or part of) rfi for slave CPUs. | |
191 | ** Someday, palo might not do this for the Monarch either. | |
192 | */ | |
193 | 2: | |
194 | #define MEM_PDC_LO 0x388 | |
195 | #define MEM_PDC_HI 0x35C | |
196 | ldw MEM_PDC_LO(%r0),%r3 | |
197 | ldw MEM_PDC_HI(%r0),%r6 | |
198 | depd %r6, 31, 32, %r3 /* move to upper word */ | |
199 | ||
200 | ldo PDC_PSW(%r0),%arg0 /* 21 */ | |
201 | ldo PDC_PSW_SET_DEFAULTS(%r0),%arg1 /* 2 */ | |
202 | ldo PDC_PSW_WIDE_BIT(%r0),%arg2 /* 2 */ | |
203 | load32 PA(stext_pdc_ret), %rp | |
204 | bv (%r3) | |
205 | copy %r0,%arg3 | |
206 | ||
207 | stext_pdc_ret: | |
208 | /* restore rfi target address*/ | |
209 | ldd TI_TASK-THREAD_SZ_ALGN(%sp), %r10 | |
210 | tophys_r1 %r10 | |
211 | ldd TASK_PT_GR11(%r10), %r11 | |
212 | tovirt_r1 %sp | |
213 | #endif | |
214 | ||
215 | /* PARANOID: clear user scratch/user space SR's */ | |
216 | mtsp %r0,%sr0 | |
217 | mtsp %r0,%sr1 | |
218 | mtsp %r0,%sr2 | |
219 | mtsp %r0,%sr3 | |
220 | ||
221 | /* Initialize Protection Registers */ | |
222 | mtctl %r0,%cr8 | |
223 | mtctl %r0,%cr9 | |
224 | mtctl %r0,%cr12 | |
225 | mtctl %r0,%cr13 | |
226 | ||
1da177e4 LT |
227 | /* Initialize the global data pointer */ |
228 | loadgp | |
229 | ||
230 | /* Set up our interrupt table. HPMCs might not work after this! | |
231 | * | |
232 | * We need to install the correct iva for PA1.1 or PA2.0. The | |
233 | * following short sequence of instructions can determine this | |
234 | * (without being illegal on a PA1.1 machine). | |
235 | */ | |
413059f2 | 236 | #ifndef CONFIG_64BIT |
1da177e4 LT |
237 | ldi 32,%r10 |
238 | mtctl %r10,%cr11 | |
239 | .level 2.0 | |
240 | mfctl,w %cr11,%r10 | |
241 | .level 1.1 | |
242 | comib,<>,n 0,%r10,$is_pa20 | |
243 | ldil L%PA(fault_vector_11),%r10 | |
244 | b $install_iva | |
245 | ldo R%PA(fault_vector_11)(%r10),%r10 | |
246 | ||
247 | $is_pa20: | |
248 | .level LEVEL /* restore 1.1 || 2.0w */ | |
413059f2 | 249 | #endif /*!CONFIG_64BIT*/ |
1da177e4 LT |
250 | load32 PA(fault_vector_20),%r10 |
251 | ||
252 | $install_iva: | |
253 | mtctl %r10,%cr14 | |
254 | ||
896a3756 | 255 | b aligned_rfi /* Prepare to RFI! Man all the cannons! */ |
1da177e4 LT |
256 | nop |
257 | ||
896a3756 | 258 | .align 128 |
1da177e4 | 259 | aligned_rfi: |
896a3756 | 260 | pcxt_ssm_bug |
1da177e4 | 261 | |
896a3756 GG |
262 | rsm PSW_SM_QUIET,%r0 /* off troublesome PSW bits */ |
263 | /* Don't need NOPs, have 8 compliant insn before rfi */ | |
1da177e4 | 264 | |
1da177e4 LT |
265 | mtctl %r0,%cr17 /* Clear IIASQ tail */ |
266 | mtctl %r0,%cr17 /* Clear IIASQ head */ | |
267 | ||
268 | /* Load RFI target into PC queue */ | |
269 | mtctl %r11,%cr18 /* IIAOQ head */ | |
270 | ldo 4(%r11),%r11 | |
271 | mtctl %r11,%cr18 /* IIAOQ tail */ | |
896a3756 GG |
272 | |
273 | load32 KERNEL_PSW,%r10 | |
274 | mtctl %r10,%ipsw | |
1da177e4 | 275 | |
896a3756 | 276 | /* Jump through hyperspace to Virt Mode */ |
1da177e4 LT |
277 | rfi |
278 | nop | |
279 | ||
280 | .procend | |
281 | ||
282 | #ifdef CONFIG_SMP | |
283 | ||
284 | .import smp_init_current_idle_task,data | |
285 | .import smp_callin,code | |
286 | ||
413059f2 | 287 | #ifndef CONFIG_64BIT |
1da177e4 LT |
288 | smp_callin_rtn: |
289 | .proc | |
290 | .callinfo | |
291 | break 1,1 /* Break if returned from start_secondary */ | |
292 | nop | |
293 | nop | |
294 | .procend | |
413059f2 | 295 | #endif /*!CONFIG_64BIT*/ |
1da177e4 LT |
296 | |
297 | /*************************************************************************** | |
298 | * smp_slave_stext is executed by all non-monarch Processors when the Monarch | |
299 | * pokes the slave CPUs in smp.c:smp_boot_cpus(). | |
300 | * | |
301 | * Once here, registers values are initialized in order to branch to virtual | |
302 | * mode. Once all available/eligible CPUs are in virtual mode, all are | |
303 | * released and start out by executing their own idle task. | |
304 | *****************************************************************************/ | |
305 | smp_slave_stext: | |
306 | .proc | |
307 | .callinfo | |
308 | ||
309 | /* | |
310 | ** Initialize Space registers | |
311 | */ | |
312 | mtsp %r0,%sr4 | |
313 | mtsp %r0,%sr5 | |
314 | mtsp %r0,%sr6 | |
315 | mtsp %r0,%sr7 | |
316 | ||
317 | /* Initialize the SP - monarch sets up smp_init_current_idle_task */ | |
318 | load32 PA(smp_init_current_idle_task),%sp | |
319 | LDREG 0(%sp),%sp /* load task address */ | |
320 | tophys_r1 %sp | |
321 | LDREG TASK_THREAD_INFO(%sp),%sp | |
322 | mtctl %sp,%cr30 /* store in cr30 */ | |
323 | ldo THREAD_SZ_ALGN(%sp),%sp | |
324 | ||
325 | /* point CPU to kernel page tables */ | |
326 | load32 PA(swapper_pg_dir),%r4 | |
327 | mtctl %r4,%cr24 /* Initialize kernel root pointer */ | |
328 | mtctl %r4,%cr25 /* Initialize user root pointer */ | |
329 | ||
413059f2 | 330 | #ifdef CONFIG_64BIT |
1da177e4 LT |
331 | /* Setup PDCE_PROC entry */ |
332 | copy %arg0,%r3 | |
333 | #else | |
334 | /* Load RFI *return* address in case smp_callin bails */ | |
335 | load32 smp_callin_rtn,%r2 | |
336 | #endif | |
337 | ||
338 | /* Load RFI target address. */ | |
339 | load32 smp_callin,%r11 | |
340 | ||
341 | /* ok...common code can handle the rest */ | |
342 | b common_stext | |
343 | nop | |
344 | ||
345 | .procend | |
346 | #endif /* CONFIG_SMP */ | |
413059f2 | 347 | #ifndef CONFIG_64BIT |
1da177e4 LT |
348 | .data |
349 | ||
350 | .align 4 | |
351 | .export $global$,data | |
352 | ||
353 | .type $global$,@object | |
354 | .size $global$,4 | |
355 | $global$: | |
356 | .word 0 | |
413059f2 | 357 | #endif /*!CONFIG_64BIT*/ |