1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <asm/asm-offsets.h>
16#include <asm/psw.h>
17#include <asm/pdc.h>
18
19#include <asm/assembly.h>
20#include <asm/pgtable.h>
21
22#include <linux/linkage.h>
23#include <linux/init.h>
24
25 .level LEVEL
26
27 __INITDATA
28ENTRY(boot_args)
29 .word 0
30 .word 0
31 .word 0
32 .word 0
33END(boot_args)
34
35 __HEAD
36
37 .align 4
38 .import init_thread_union,data
39 .import fault_vector_20,code
40#ifndef CONFIG_64BIT
41 .import fault_vector_11,code
42 .import $global$
43#endif
44 .export _stext,data
45_stext:
46ENTRY(stext)
47 .proc
48 .callinfo
49
50
51 mtsp %r0,%sr4
52 mtsp %r0,%sr5
53 mtsp %r0,%sr6
54 mtsp %r0,%sr7
55
56
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
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
75 load32 PA(swapper_pg_dir),%r4
76 mtctl %r4,%cr24
77 mtctl %r4,%cr25
78
79
80
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
88 ldo ASM_PGD_ENTRY*ASM_PGD_ENTRY_SIZE(%r4),%r4
89#endif
90
91
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
981:
99 stw %r3,0(%r4)
100 ldo (PAGE_SIZE >> PxD_VALUE_SHIFT)(%r3),%r3
101 addib,> -1,%r1,1b
102
103 ldo ASM_PMD_ENTRY_SIZE(%r4),%r4
104#else
105 ldo ASM_PGD_ENTRY_SIZE(%r4),%r4
106#endif
107
108
109
110
111 ldo 0+_PAGE_KERNEL_RWX(%r0),%r3
112 ldi (1<<(KERNEL_INITIAL_ORDER-PAGE_SHIFT)),%r11
113 load32 PA(pg0),%r1
114
115$pgt_fill_loop:
116 STREGM %r3,ASM_PTE_ENTRY_SIZE(%r1)
117 ldo (1<<PFN_PTE_SHIFT)(%r3),%r3
118 addib,> -1,%r11,$pgt_fill_loop
119 nop
120
121
122 copy %r0,%r2
123
124
125 load32 start_parisc,%r11
126
127
128 load32 init_thread_union,%r6
129 mtctl %r6,%cr30
130
131
132 ldo THREAD_SZ_ALGN(%r6),%sp
133
134#ifdef CONFIG_SMP
135
136
137
138
139
140 load32 PA(smp_slave_stext),%r10
141 stw %r10,0x10(%r0)
142 stw %r0,0x28(%r0)
143
144
145 .procend
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162common_stext:
163 .proc
164 .callinfo
165#else
166
167 stw %r0,0x10(%r0)
168 stw %r0,0x28(%r0)
169#endif
170
171#ifdef CONFIG_64BIT
172 tophys_r1 %sp
173
174
175 ldd TI_TASK-THREAD_SZ_ALGN(%sp), %r10
176 tophys_r1 %r10
177 std %r11, TASK_PT_GR11(%r10)
178
179
180
1811: mfia %rp
182 ldo 2f-1b(%rp),%rp
183 depdi 0,31,32,%rp
184 bv (%rp)
185 ssm PSW_SM_W,%r0
186
187
188
189
190
1912:
192#define MEM_PDC_LO 0x388
193#define MEM_PDC_HI 0x35C
194 ldw MEM_PDC_LO(%r0),%r3
195 ldw MEM_PDC_HI(%r0),%r6
196 depd %r6, 31, 32, %r3
197
198 mfctl %cr30,%r6
199
200 ldo PDC_PSW(%r0),%arg0
201 ldo PDC_PSW_SET_DEFAULTS(%r0),%arg1
202 ldo PDC_PSW_WIDE_BIT(%r0),%arg2
203 load32 PA(stext_pdc_ret), %rp
204 bv (%r3)
205 copy %r0,%arg3
206
207stext_pdc_ret:
208 mtctl %r6,%cr30
209
210
211 ldd TI_TASK-THREAD_SZ_ALGN(%sp), %r10
212 tophys_r1 %r10
213 ldd TASK_PT_GR11(%r10), %r11
214 tovirt_r1 %sp
215#endif
216
217
218 mtsp %r0,%sr0
219 mtsp %r0,%sr1
220 mtsp %r0,%sr2
221 mtsp %r0,%sr3
222
223
224 mtctl %r0,%cr8
225 mtctl %r0,%cr9
226 mtctl %r0,%cr12
227 mtctl %r0,%cr13
228
229
230 loadgp
231
232
233
234
235
236
237
238#ifndef CONFIG_64BIT
239 ldi 32,%r10
240 mtctl %r10,%cr11
241 .level 2.0
242 mfctl,w %cr11,%r10
243 .level 1.1
244 comib,<>,n 0,%r10,$is_pa20
245 ldil L%PA(fault_vector_11),%r10
246 b $install_iva
247 ldo R%PA(fault_vector_11)(%r10),%r10
248
249$is_pa20:
250 .level LEVEL
251#endif
252 load32 PA(fault_vector_20),%r10
253
254$install_iva:
255 mtctl %r10,%cr14
256
257 b aligned_rfi
258 nop
259
260 .align 128
261aligned_rfi:
262 pcxt_ssm_bug
263
264 rsm PSW_SM_QUIET,%r0
265
266
267 mtctl %r0,%cr17
268 mtctl %r0,%cr17
269
270
271 mtctl %r11,%cr18
272 ldo 4(%r11),%r11
273 mtctl %r11,%cr18
274
275 load32 KERNEL_PSW,%r10
276 mtctl %r10,%ipsw
277
278
279 rfi
280 nop
281
282 .procend
283
284#ifdef CONFIG_SMP
285
286 .import smp_init_current_idle_task,data
287 .import smp_callin,code
288
289#ifndef CONFIG_64BIT
290smp_callin_rtn:
291 .proc
292 .callinfo
293 break 1,1
294 nop
295 nop
296 .procend
297#endif
298
299
300
301
302
303
304
305
306
307smp_slave_stext:
308 .proc
309 .callinfo
310
311
312
313
314 mtsp %r0,%sr4
315 mtsp %r0,%sr5
316 mtsp %r0,%sr6
317 mtsp %r0,%sr7
318
319
320 load32 PA(smp_init_current_idle_task),%sp
321 LDREG 0(%sp),%sp
322 tophys_r1 %sp
323 LDREG TASK_THREAD_INFO(%sp),%sp
324 mtctl %sp,%cr30
325 ldo THREAD_SZ_ALGN(%sp),%sp
326
327
328 load32 PA(swapper_pg_dir),%r4
329 mtctl %r4,%cr24
330 mtctl %r4,%cr25
331
332#ifdef CONFIG_64BIT
333
334 copy %arg0,%r3
335#else
336
337 load32 smp_callin_rtn,%r2
338#endif
339
340
341 load32 smp_callin,%r11
342
343
344 b common_stext
345 nop
346
347 .procend
348#endif
349
350ENDPROC(stext)
351
352#ifndef CONFIG_64BIT
353 .section .data..read_mostly
354
355 .align 4
356 .export $global$,data
357
358 .type $global$,@object
359 .size $global$,4
360$global$:
361 .word 0
362#endif
363