]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Linux/PA-RISC Project (http://www.parisc-linux.org/) | |
3 | * | |
4 | * kernel entry points (interruptions, system call wrappers) | |
5 | * Copyright (C) 1999,2000 Philipp Rumpf | |
6 | * Copyright (C) 1999 SuSE GmbH Nuernberg | |
7 | * Copyright (C) 2000 Hewlett-Packard (John Marvin) | |
8 | * Copyright (C) 1999 Hewlett-Packard (Frank Rowand) | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License as published by | |
12 | * the Free Software Foundation; either version 2, or (at your option) | |
13 | * any later version. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, write to the Free Software | |
22 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
23 | */ | |
24 | ||
0013a854 | 25 | #include <asm/asm-offsets.h> |
1da177e4 LT |
26 | |
27 | /* we have the following possibilities to act on an interruption: | |
28 | * - handle in assembly and use shadowed registers only | |
29 | * - save registers to kernel stack and handle in assembly or C */ | |
30 | ||
31 | ||
896a3756 | 32 | #include <asm/psw.h> |
3d73cf5e | 33 | #include <asm/cache.h> /* for L1_CACHE_SHIFT */ |
1da177e4 LT |
34 | #include <asm/assembly.h> /* for LDREG/STREG defines */ |
35 | #include <asm/pgtable.h> | |
1da177e4 LT |
36 | #include <asm/signal.h> |
37 | #include <asm/unistd.h> | |
38 | #include <asm/thread_info.h> | |
39 | ||
c5e76552 HD |
40 | #include <linux/linkage.h> |
41 | ||
413059f2 | 42 | #ifdef CONFIG_64BIT |
1da177e4 LT |
43 | .level 2.0w |
44 | #else | |
1da177e4 LT |
45 | .level 2.0 |
46 | #endif | |
47 | ||
01ab6057 | 48 | .import pa_tlb_lock,data |
1da177e4 LT |
49 | |
50 | /* space_to_prot macro creates a prot id from a space id */ | |
51 | ||
52 | #if (SPACEID_SHIFT) == 0 | |
53 | .macro space_to_prot spc prot | |
54 | depd,z \spc,62,31,\prot | |
55 | .endm | |
56 | #else | |
57 | .macro space_to_prot spc prot | |
58 | extrd,u \spc,(64 - (SPACEID_SHIFT)),32,\prot | |
59 | .endm | |
60 | #endif | |
61 | ||
62 | /* Switch to virtual mapping, trashing only %r1 */ | |
63 | .macro virt_map | |
896a3756 GG |
64 | /* pcxt_ssm_bug */ |
65 | rsm PSW_SM_I, %r0 /* barrier for "Relied upon Translation */ | |
1da177e4 LT |
66 | mtsp %r0, %sr4 |
67 | mtsp %r0, %sr5 | |
b63a2bbc | 68 | mtsp %r0, %sr6 |
896a3756 GG |
69 | tovirt_r1 %r29 |
70 | load32 KERNEL_PSW, %r1 | |
71 | ||
72 | rsm PSW_SM_QUIET,%r0 /* second "heavy weight" ctl op */ | |
1da177e4 LT |
73 | mtctl %r0, %cr17 /* Clear IIASQ tail */ |
74 | mtctl %r0, %cr17 /* Clear IIASQ head */ | |
896a3756 | 75 | mtctl %r1, %ipsw |
1da177e4 LT |
76 | load32 4f, %r1 |
77 | mtctl %r1, %cr18 /* Set IIAOQ tail */ | |
78 | ldo 4(%r1), %r1 | |
79 | mtctl %r1, %cr18 /* Set IIAOQ head */ | |
80 | rfir | |
81 | nop | |
82 | 4: | |
83 | .endm | |
84 | ||
85 | /* | |
86 | * The "get_stack" macros are responsible for determining the | |
87 | * kernel stack value. | |
88 | * | |
1da177e4 LT |
89 | * If sr7 == 0 |
90 | * Already using a kernel stack, so call the | |
91 | * get_stack_use_r30 macro to push a pt_regs structure | |
92 | * on the stack, and store registers there. | |
93 | * else | |
94 | * Need to set up a kernel stack, so call the | |
95 | * get_stack_use_cr30 macro to set up a pointer | |
96 | * to the pt_regs structure contained within the | |
97 | * task pointer pointed to by cr30. Set the stack | |
98 | * pointer to point to the end of the task structure. | |
99 | * | |
1da177e4 LT |
100 | * Note that we use shadowed registers for temps until |
101 | * we can save %r26 and %r29. %r26 is used to preserve | |
102 | * %r8 (a shadowed register) which temporarily contained | |
103 | * either the fault type ("code") or the eirr. We need | |
104 | * to use a non-shadowed register to carry the value over | |
105 | * the rfir in virt_map. We use %r26 since this value winds | |
106 | * up being passed as the argument to either do_cpu_irq_mask | |
107 | * or handle_interruption. %r29 is used to hold a pointer | |
108 | * the register save area, and once again, it needs to | |
109 | * be a non-shadowed register so that it survives the rfir. | |
110 | * | |
111 | * N.B. TASK_SZ_ALGN and PT_SZ_ALGN include space for a stack frame. | |
112 | */ | |
113 | ||
114 | .macro get_stack_use_cr30 | |
115 | ||
116 | /* we save the registers in the task struct */ | |
117 | ||
b63a2bbc | 118 | copy %r30, %r17 |
1da177e4 | 119 | mfctl %cr30, %r1 |
b63a2bbc JDA |
120 | ldo THREAD_SZ_ALGN(%r1), %r30 |
121 | mtsp %r0,%sr7 | |
122 | mtsp %r16,%sr3 | |
1da177e4 LT |
123 | tophys %r1,%r9 |
124 | LDREG TI_TASK(%r9), %r1 /* thread_info -> task_struct */ | |
125 | tophys %r1,%r9 | |
126 | ldo TASK_REGS(%r9),%r9 | |
b63a2bbc | 127 | STREG %r17,PT_GR30(%r9) |
1da177e4 LT |
128 | STREG %r29,PT_GR29(%r9) |
129 | STREG %r26,PT_GR26(%r9) | |
b63a2bbc | 130 | STREG %r16,PT_SR7(%r9) |
1da177e4 | 131 | copy %r9,%r29 |
1da177e4 LT |
132 | .endm |
133 | ||
134 | .macro get_stack_use_r30 | |
135 | ||
136 | /* we put a struct pt_regs on the stack and save the registers there */ | |
137 | ||
138 | tophys %r30,%r9 | |
b63a2bbc | 139 | copy %r30,%r1 |
1da177e4 | 140 | ldo PT_SZ_ALGN(%r30),%r30 |
b63a2bbc | 141 | STREG %r1,PT_GR30(%r9) |
1da177e4 LT |
142 | STREG %r29,PT_GR29(%r9) |
143 | STREG %r26,PT_GR26(%r9) | |
b63a2bbc | 144 | STREG %r16,PT_SR7(%r9) |
1da177e4 LT |
145 | copy %r9,%r29 |
146 | .endm | |
147 | ||
148 | .macro rest_stack | |
149 | LDREG PT_GR1(%r29), %r1 | |
150 | LDREG PT_GR30(%r29),%r30 | |
151 | LDREG PT_GR29(%r29),%r29 | |
152 | .endm | |
153 | ||
154 | /* default interruption handler | |
155 | * (calls traps.c:handle_interruption) */ | |
156 | .macro def code | |
157 | b intr_save | |
158 | ldi \code, %r8 | |
159 | .align 32 | |
160 | .endm | |
161 | ||
162 | /* Interrupt interruption handler | |
163 | * (calls irq.c:do_cpu_irq_mask) */ | |
164 | .macro extint code | |
165 | b intr_extint | |
166 | mfsp %sr7,%r16 | |
167 | .align 32 | |
168 | .endm | |
169 | ||
170 | .import os_hpmc, code | |
171 | ||
172 | /* HPMC handler */ | |
173 | .macro hpmc code | |
174 | nop /* must be a NOP, will be patched later */ | |
175 | load32 PA(os_hpmc), %r3 | |
176 | bv,n 0(%r3) | |
177 | nop | |
178 | .word 0 /* checksum (will be patched) */ | |
179 | .word PA(os_hpmc) /* address of handler */ | |
180 | .word 0 /* length of handler */ | |
181 | .endm | |
182 | ||
183 | /* | |
184 | * Performance Note: Instructions will be moved up into | |
185 | * this part of the code later on, once we are sure | |
186 | * that the tlb miss handlers are close to final form. | |
187 | */ | |
188 | ||
189 | /* Register definitions for tlb miss handler macros */ | |
190 | ||
25985edc LDM |
191 | va = r8 /* virtual address for which the trap occurred */ |
192 | spc = r24 /* space for which the trap occurred */ | |
1da177e4 | 193 | |
413059f2 | 194 | #ifndef CONFIG_64BIT |
1da177e4 LT |
195 | |
196 | /* | |
197 | * itlb miss interruption handler (parisc 1.1 - 32 bit) | |
198 | */ | |
199 | ||
200 | .macro itlb_11 code | |
201 | ||
202 | mfctl %pcsq, spc | |
203 | b itlb_miss_11 | |
204 | mfctl %pcoq, va | |
205 | ||
206 | .align 32 | |
207 | .endm | |
208 | #endif | |
209 | ||
210 | /* | |
211 | * itlb miss interruption handler (parisc 2.0) | |
212 | */ | |
213 | ||
214 | .macro itlb_20 code | |
215 | mfctl %pcsq, spc | |
413059f2 | 216 | #ifdef CONFIG_64BIT |
1da177e4 LT |
217 | b itlb_miss_20w |
218 | #else | |
219 | b itlb_miss_20 | |
220 | #endif | |
221 | mfctl %pcoq, va | |
222 | ||
223 | .align 32 | |
224 | .endm | |
225 | ||
413059f2 | 226 | #ifndef CONFIG_64BIT |
1da177e4 LT |
227 | /* |
228 | * naitlb miss interruption handler (parisc 1.1 - 32 bit) | |
1da177e4 LT |
229 | */ |
230 | ||
231 | .macro naitlb_11 code | |
232 | ||
233 | mfctl %isr,spc | |
f311847c | 234 | b naitlb_miss_11 |
1da177e4 | 235 | mfctl %ior,va |
1da177e4 LT |
236 | |
237 | .align 32 | |
238 | .endm | |
239 | #endif | |
240 | ||
241 | /* | |
242 | * naitlb miss interruption handler (parisc 2.0) | |
1da177e4 LT |
243 | */ |
244 | ||
245 | .macro naitlb_20 code | |
246 | ||
247 | mfctl %isr,spc | |
413059f2 | 248 | #ifdef CONFIG_64BIT |
f311847c | 249 | b naitlb_miss_20w |
1da177e4 | 250 | #else |
f311847c | 251 | b naitlb_miss_20 |
1da177e4 LT |
252 | #endif |
253 | mfctl %ior,va | |
1da177e4 LT |
254 | |
255 | .align 32 | |
256 | .endm | |
257 | ||
413059f2 | 258 | #ifndef CONFIG_64BIT |
1da177e4 LT |
259 | /* |
260 | * dtlb miss interruption handler (parisc 1.1 - 32 bit) | |
261 | */ | |
262 | ||
263 | .macro dtlb_11 code | |
264 | ||
265 | mfctl %isr, spc | |
266 | b dtlb_miss_11 | |
267 | mfctl %ior, va | |
268 | ||
269 | .align 32 | |
270 | .endm | |
271 | #endif | |
272 | ||
273 | /* | |
274 | * dtlb miss interruption handler (parisc 2.0) | |
275 | */ | |
276 | ||
277 | .macro dtlb_20 code | |
278 | ||
279 | mfctl %isr, spc | |
413059f2 | 280 | #ifdef CONFIG_64BIT |
1da177e4 LT |
281 | b dtlb_miss_20w |
282 | #else | |
283 | b dtlb_miss_20 | |
284 | #endif | |
285 | mfctl %ior, va | |
286 | ||
287 | .align 32 | |
288 | .endm | |
289 | ||
413059f2 | 290 | #ifndef CONFIG_64BIT |
1da177e4 LT |
291 | /* nadtlb miss interruption handler (parisc 1.1 - 32 bit) */ |
292 | ||
293 | .macro nadtlb_11 code | |
294 | ||
295 | mfctl %isr,spc | |
296 | b nadtlb_miss_11 | |
297 | mfctl %ior,va | |
298 | ||
299 | .align 32 | |
300 | .endm | |
301 | #endif | |
302 | ||
303 | /* nadtlb miss interruption handler (parisc 2.0) */ | |
304 | ||
305 | .macro nadtlb_20 code | |
306 | ||
307 | mfctl %isr,spc | |
413059f2 | 308 | #ifdef CONFIG_64BIT |
1da177e4 LT |
309 | b nadtlb_miss_20w |
310 | #else | |
311 | b nadtlb_miss_20 | |
312 | #endif | |
313 | mfctl %ior,va | |
314 | ||
315 | .align 32 | |
316 | .endm | |
317 | ||
413059f2 | 318 | #ifndef CONFIG_64BIT |
1da177e4 LT |
319 | /* |
320 | * dirty bit trap interruption handler (parisc 1.1 - 32 bit) | |
321 | */ | |
322 | ||
323 | .macro dbit_11 code | |
324 | ||
325 | mfctl %isr,spc | |
326 | b dbit_trap_11 | |
327 | mfctl %ior,va | |
328 | ||
329 | .align 32 | |
330 | .endm | |
331 | #endif | |
332 | ||
333 | /* | |
334 | * dirty bit trap interruption handler (parisc 2.0) | |
335 | */ | |
336 | ||
337 | .macro dbit_20 code | |
338 | ||
339 | mfctl %isr,spc | |
413059f2 | 340 | #ifdef CONFIG_64BIT |
1da177e4 LT |
341 | b dbit_trap_20w |
342 | #else | |
343 | b dbit_trap_20 | |
344 | #endif | |
345 | mfctl %ior,va | |
346 | ||
347 | .align 32 | |
348 | .endm | |
349 | ||
1da177e4 LT |
350 | /* In LP64, the space contains part of the upper 32 bits of the |
351 | * fault. We have to extract this and place it in the va, | |
352 | * zeroing the corresponding bits in the space register */ | |
353 | .macro space_adjust spc,va,tmp | |
413059f2 | 354 | #ifdef CONFIG_64BIT |
1da177e4 LT |
355 | extrd,u \spc,63,SPACEID_SHIFT,\tmp |
356 | depd %r0,63,SPACEID_SHIFT,\spc | |
357 | depd \tmp,31,SPACEID_SHIFT,\va | |
358 | #endif | |
359 | .endm | |
360 | ||
361 | .import swapper_pg_dir,code | |
362 | ||
363 | /* Get the pgd. For faults on space zero (kernel space), this | |
364 | * is simply swapper_pg_dir. For user space faults, the | |
365 | * pgd is stored in %cr25 */ | |
366 | .macro get_pgd spc,reg | |
367 | ldil L%PA(swapper_pg_dir),\reg | |
368 | ldo R%PA(swapper_pg_dir)(\reg),\reg | |
369 | or,COND(=) %r0,\spc,%r0 | |
370 | mfctl %cr25,\reg | |
371 | .endm | |
372 | ||
373 | /* | |
374 | space_check(spc,tmp,fault) | |
375 | ||
376 | spc - The space we saw the fault with. | |
377 | tmp - The place to store the current space. | |
378 | fault - Function to call on failure. | |
379 | ||
380 | Only allow faults on different spaces from the | |
381 | currently active one if we're the kernel | |
382 | ||
383 | */ | |
384 | .macro space_check spc,tmp,fault | |
385 | mfsp %sr7,\tmp | |
386 | or,COND(<>) %r0,\spc,%r0 /* user may execute gateway page | |
387 | * as kernel, so defeat the space | |
388 | * check if it is */ | |
389 | copy \spc,\tmp | |
390 | or,COND(=) %r0,\tmp,%r0 /* nullify if executing as kernel */ | |
391 | cmpb,COND(<>),n \tmp,\spc,\fault | |
392 | .endm | |
393 | ||
394 | /* Look up a PTE in a 2-Level scheme (faulting at each | |
395 | * level if the entry isn't present | |
396 | * | |
397 | * NOTE: we use ldw even for LP64, since the short pointers | |
398 | * can address up to 1TB | |
399 | */ | |
400 | .macro L2_ptep pmd,pte,index,va,fault | |
f24ffde4 | 401 | #if CONFIG_PGTABLE_LEVELS == 3 |
9b437bca | 402 | extru \va,31-ASM_PMD_SHIFT,ASM_BITS_PER_PMD,\index |
1da177e4 | 403 | #else |
6a45716a HD |
404 | # if defined(CONFIG_64BIT) |
405 | extrd,u \va,63-ASM_PGDIR_SHIFT,ASM_BITS_PER_PGD,\index | |
406 | #else | |
407 | # if PAGE_SIZE > 4096 | |
408 | extru \va,31-ASM_PGDIR_SHIFT,32-ASM_PGDIR_SHIFT,\index | |
409 | # else | |
9b437bca | 410 | extru \va,31-ASM_PGDIR_SHIFT,ASM_BITS_PER_PGD,\index |
6a45716a HD |
411 | # endif |
412 | # endif | |
1da177e4 | 413 | #endif |
9b437bca | 414 | dep %r0,31,PAGE_SHIFT,\pmd /* clear offset */ |
1da177e4 LT |
415 | copy %r0,\pte |
416 | ldw,s \index(\pmd),\pmd | |
417 | bb,>=,n \pmd,_PxD_PRESENT_BIT,\fault | |
9b437bca | 418 | dep %r0,31,PxD_FLAG_SHIFT,\pmd /* clear flags */ |
1da177e4 | 419 | copy \pmd,%r9 |
3d73cf5e | 420 | SHLREG %r9,PxD_VALUE_SHIFT,\pmd |
9b437bca JDA |
421 | extru \va,31-PAGE_SHIFT,ASM_BITS_PER_PTE,\index |
422 | dep %r0,31,PAGE_SHIFT,\pmd /* clear offset */ | |
01ab6057 JDA |
423 | shladd \index,BITS_PER_PTE_ENTRY,\pmd,\pmd /* pmd is now pte */ |
424 | LDREG %r0(\pmd),\pte | |
1da177e4 LT |
425 | bb,>=,n \pte,_PAGE_PRESENT_BIT,\fault |
426 | .endm | |
427 | ||
428 | /* Look up PTE in a 3-Level scheme. | |
429 | * | |
430 | * Here we implement a Hybrid L2/L3 scheme: we allocate the | |
431 | * first pmd adjacent to the pgd. This means that we can | |
432 | * subtract a constant offset to get to it. The pmd and pgd | |
433 | * sizes are arranged so that a single pmd covers 4GB (giving | |
434 | * a full LP64 process access to 8TB) so our lookups are | |
435 | * effectively L2 for the first 4GB of the kernel (i.e. for | |
436 | * all ILP32 processes and all the kernel for machines with | |
437 | * under 4GB of memory) */ | |
438 | .macro L3_ptep pgd,pte,index,va,fault | |
f24ffde4 | 439 | #if CONFIG_PGTABLE_LEVELS == 3 /* we might have a 2-Level scheme, e.g. with 16kb page size */ |
1da177e4 LT |
440 | extrd,u \va,63-ASM_PGDIR_SHIFT,ASM_BITS_PER_PGD,\index |
441 | copy %r0,\pte | |
2fd83038 | 442 | extrd,u,*= \va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0 |
1da177e4 | 443 | ldw,s \index(\pgd),\pgd |
2fd83038 | 444 | extrd,u,*= \va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0 |
1da177e4 | 445 | bb,>=,n \pgd,_PxD_PRESENT_BIT,\fault |
2fd83038 | 446 | extrd,u,*= \va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0 |
1da177e4 | 447 | shld \pgd,PxD_VALUE_SHIFT,\index |
2fd83038 | 448 | extrd,u,*= \va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0 |
1da177e4 | 449 | copy \index,\pgd |
2fd83038 | 450 | extrd,u,*<> \va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0 |
1da177e4 | 451 | ldo ASM_PGD_PMD_OFFSET(\pgd),\pgd |
2fd83038 | 452 | #endif |
1da177e4 LT |
453 | L2_ptep \pgd,\pte,\index,\va,\fault |
454 | .endm | |
455 | ||
01ab6057 JDA |
456 | /* Acquire pa_tlb_lock lock and recheck page is still present. */ |
457 | .macro tlb_lock spc,ptp,pte,tmp,tmp1,fault | |
f0a18819 JDA |
458 | #ifdef CONFIG_SMP |
459 | cmpib,COND(=),n 0,\spc,2f | |
01ab6057 | 460 | load32 PA(pa_tlb_lock),\tmp |
f0a18819 JDA |
461 | 1: LDCW 0(\tmp),\tmp1 |
462 | cmpib,COND(=) 0,\tmp1,1b | |
463 | nop | |
01ab6057 JDA |
464 | LDREG 0(\ptp),\pte |
465 | bb,<,n \pte,_PAGE_PRESENT_BIT,2f | |
466 | b \fault | |
467 | stw \spc,0(\tmp) | |
f0a18819 JDA |
468 | 2: |
469 | #endif | |
470 | .endm | |
471 | ||
01ab6057 JDA |
472 | /* Release pa_tlb_lock lock without reloading lock address. */ |
473 | .macro tlb_unlock0 spc,tmp | |
f0a18819 JDA |
474 | #ifdef CONFIG_SMP |
475 | or,COND(=) %r0,\spc,%r0 | |
476 | stw \spc,0(\tmp) | |
477 | #endif | |
478 | .endm | |
479 | ||
01ab6057 JDA |
480 | /* Release pa_tlb_lock lock. */ |
481 | .macro tlb_unlock1 spc,tmp | |
f0a18819 | 482 | #ifdef CONFIG_SMP |
01ab6057 JDA |
483 | load32 PA(pa_tlb_lock),\tmp |
484 | tlb_unlock0 \spc,\tmp | |
f0a18819 JDA |
485 | #endif |
486 | .endm | |
487 | ||
1da177e4 LT |
488 | /* Set the _PAGE_ACCESSED bit of the PTE. Be clever and |
489 | * don't needlessly dirty the cache line if it was already set */ | |
01ab6057 | 490 | .macro update_accessed ptp,pte,tmp,tmp1 |
1da177e4 LT |
491 | ldi _PAGE_ACCESSED,\tmp1 |
492 | or \tmp1,\pte,\tmp | |
493 | and,COND(<>) \tmp1,\pte,%r0 | |
01ab6057 | 494 | STREG \tmp,0(\ptp) |
1da177e4 LT |
495 | .endm |
496 | ||
497 | /* Set the dirty bit (and accessed bit). No need to be | |
498 | * clever, this is only used from the dirty fault */ | |
01ab6057 | 499 | .macro update_dirty ptp,pte,tmp |
1da177e4 LT |
500 | ldi _PAGE_ACCESSED|_PAGE_DIRTY,\tmp |
501 | or \tmp,\pte,\pte | |
01ab6057 | 502 | STREG \pte,0(\ptp) |
1da177e4 LT |
503 | .endm |
504 | ||
736d2169 HD |
505 | /* We have (depending on the page size): |
506 | * - 38 to 52-bit Physical Page Number | |
507 | * - 12 to 26-bit page offset | |
508 | */ | |
afca2523 HD |
509 | /* bitshift difference between a PFN (based on kernel's PAGE_SIZE) |
510 | * to a CPU TLB 4k PFN (4k => 12 bits to shift) */ | |
736d2169 HD |
511 | #define PAGE_ADD_SHIFT (PAGE_SHIFT-12) |
512 | #define PAGE_ADD_HUGE_SHIFT (REAL_HPAGE_SHIFT-12) | |
afca2523 HD |
513 | |
514 | /* Drop prot bits and convert to page addr for iitlbt and idtlbt */ | |
736d2169 HD |
515 | .macro convert_for_tlb_insert20 pte,tmp |
516 | #ifdef CONFIG_HUGETLB_PAGE | |
517 | copy \pte,\tmp | |
518 | extrd,u \tmp,(63-ASM_PFN_PTE_SHIFT)+(63-58)+PAGE_ADD_SHIFT,\ | |
519 | 64-PAGE_SHIFT-PAGE_ADD_SHIFT,\pte | |
520 | ||
521 | depdi _PAGE_SIZE_ENCODING_DEFAULT,63,\ | |
522 | (63-58)+PAGE_ADD_SHIFT,\pte | |
523 | extrd,u,*= \tmp,_PAGE_HPAGE_BIT+32,1,%r0 | |
524 | depdi _HUGE_PAGE_SIZE_ENCODING_DEFAULT,63,\ | |
525 | (63-58)+PAGE_ADD_HUGE_SHIFT,\pte | |
526 | #else /* Huge pages disabled */ | |
afca2523 HD |
527 | extrd,u \pte,(63-ASM_PFN_PTE_SHIFT)+(63-58)+PAGE_ADD_SHIFT,\ |
528 | 64-PAGE_SHIFT-PAGE_ADD_SHIFT,\pte | |
529 | depdi _PAGE_SIZE_ENCODING_DEFAULT,63,\ | |
530 | (63-58)+PAGE_ADD_SHIFT,\pte | |
736d2169 | 531 | #endif |
afca2523 HD |
532 | .endm |
533 | ||
1da177e4 LT |
534 | /* Convert the pte and prot to tlb insertion values. How |
535 | * this happens is quite subtle, read below */ | |
736d2169 | 536 | .macro make_insert_tlb spc,pte,prot,tmp |
1da177e4 LT |
537 | space_to_prot \spc \prot /* create prot id from space */ |
538 | /* The following is the real subtlety. This is depositing | |
539 | * T <-> _PAGE_REFTRAP | |
540 | * D <-> _PAGE_DIRTY | |
541 | * B <-> _PAGE_DMB (memory break) | |
542 | * | |
543 | * Then incredible subtlety: The access rights are | |
1c4c6597 | 544 | * _PAGE_GATEWAY, _PAGE_EXEC and _PAGE_WRITE |
1da177e4 LT |
545 | * See 3-14 of the parisc 2.0 manual |
546 | * | |
547 | * Finally, _PAGE_READ goes in the top bit of PL1 (so we | |
548 | * trigger an access rights trap in user space if the user | |
549 | * tries to read an unreadable page */ | |
550 | depd \pte,8,7,\prot | |
551 | ||
552 | /* PAGE_USER indicates the page can be read with user privileges, | |
553 | * so deposit X1|11 to PL1|PL2 (remember the upper bit of PL1 | |
1c4c6597 | 554 | * contains _PAGE_READ) */ |
1da177e4 LT |
555 | extrd,u,*= \pte,_PAGE_USER_BIT+32,1,%r0 |
556 | depdi 7,11,3,\prot | |
557 | /* If we're a gateway page, drop PL2 back to zero for promotion | |
558 | * to kernel privilege (so we can execute the page as kernel). | |
559 | * Any privilege promotion page always denys read and write */ | |
560 | extrd,u,*= \pte,_PAGE_GATEWAY_BIT+32,1,%r0 | |
561 | depd %r0,11,2,\prot /* If Gateway, Set PL2 to 0 */ | |
562 | ||
2fd83038 HD |
563 | /* Enforce uncacheable pages. |
564 | * This should ONLY be use for MMIO on PA 2.0 machines. | |
565 | * Memory/DMA is cache coherent on all PA2.0 machines we support | |
566 | * (that means T-class is NOT supported) and the memory controllers | |
567 | * on most of those machines only handles cache transactions. | |
568 | */ | |
569 | extrd,u,*= \pte,_PAGE_NO_CACHE_BIT+32,1,%r0 | |
2678251b | 570 | depdi 1,12,1,\prot |
1da177e4 | 571 | |
2fd83038 | 572 | /* Drop prot bits and convert to page addr for iitlbt and idtlbt */ |
736d2169 | 573 | convert_for_tlb_insert20 \pte \tmp |
1da177e4 LT |
574 | .endm |
575 | ||
576 | /* Identical macro to make_insert_tlb above, except it | |
577 | * makes the tlb entry for the differently formatted pa11 | |
578 | * insertion instructions */ | |
579 | .macro make_insert_tlb_11 spc,pte,prot | |
580 | zdep \spc,30,15,\prot | |
581 | dep \pte,8,7,\prot | |
582 | extru,= \pte,_PAGE_NO_CACHE_BIT,1,%r0 | |
583 | depi 1,12,1,\prot | |
584 | extru,= \pte,_PAGE_USER_BIT,1,%r0 | |
585 | depi 7,11,3,\prot /* Set for user space (1 rsvd for read) */ | |
586 | extru,= \pte,_PAGE_GATEWAY_BIT,1,%r0 | |
587 | depi 0,11,2,\prot /* If Gateway, Set PL2 to 0 */ | |
588 | ||
589 | /* Get rid of prot bits and convert to page addr for iitlba */ | |
590 | ||
1152a68c HD |
591 | depi 0,31,ASM_PFN_PTE_SHIFT,\pte |
592 | SHRREG \pte,(ASM_PFN_PTE_SHIFT-(31-26)),\pte | |
1da177e4 LT |
593 | .endm |
594 | ||
595 | /* This is for ILP32 PA2.0 only. The TLB insertion needs | |
596 | * to extend into I/O space if the address is 0xfXXXXXXX | |
597 | * so we extend the f's into the top word of the pte in | |
598 | * this case */ | |
599 | .macro f_extend pte,tmp | |
600 | extrd,s \pte,42,4,\tmp | |
601 | addi,<> 1,\tmp,%r0 | |
602 | extrd,s \pte,63,25,\pte | |
603 | .endm | |
604 | ||
605 | /* The alias region is an 8MB aligned 16MB to do clear and | |
606 | * copy user pages at addresses congruent with the user | |
607 | * virtual address. | |
608 | * | |
609 | * To use the alias page, you set %r26 up with the to TLB | |
610 | * entry (identifying the physical page) and %r23 up with | |
611 | * the from tlb entry (or nothing if only a to entry---for | |
612 | * clear_user_page_asm) */ | |
2f649c1f | 613 | .macro do_alias spc,tmp,tmp1,va,pte,prot,fault,patype |
1da177e4 LT |
614 | cmpib,COND(<>),n 0,\spc,\fault |
615 | ldil L%(TMPALIAS_MAP_START),\tmp | |
413059f2 | 616 | #if defined(CONFIG_64BIT) && (TMPALIAS_MAP_START >= 0x80000000) |
1da177e4 LT |
617 | /* on LP64, ldi will sign extend into the upper 32 bits, |
618 | * which is behaviour we don't want */ | |
619 | depdi 0,31,32,\tmp | |
620 | #endif | |
621 | copy \va,\tmp1 | |
9b437bca | 622 | depi 0,31,23,\tmp1 |
1da177e4 | 623 | cmpb,COND(<>),n \tmp,\tmp1,\fault |
f311847c JB |
624 | mfctl %cr19,\tmp /* iir */ |
625 | /* get the opcode (first six bits) into \tmp */ | |
626 | extrw,u \tmp,5,6,\tmp | |
627 | /* | |
628 | * Only setting the T bit prevents data cache movein | |
629 | * Setting access rights to zero prevents instruction cache movein | |
630 | * | |
631 | * Note subtlety here: _PAGE_GATEWAY, _PAGE_EXEC and _PAGE_WRITE go | |
632 | * to type field and _PAGE_READ goes to top bit of PL1 | |
633 | */ | |
634 | ldi (_PAGE_REFTRAP|_PAGE_READ|_PAGE_WRITE),\prot | |
635 | /* | |
636 | * so if the opcode is one (i.e. this is a memory management | |
637 | * instruction) nullify the next load so \prot is only T. | |
638 | * Otherwise this is a normal data operation | |
639 | */ | |
640 | cmpiclr,= 0x01,\tmp,%r0 | |
641 | ldi (_PAGE_DIRTY|_PAGE_READ|_PAGE_WRITE),\prot | |
2f649c1f | 642 | .ifc \patype,20 |
1da177e4 | 643 | depd,z \prot,8,7,\prot |
2f649c1f JB |
644 | .else |
645 | .ifc \patype,11 | |
5e185581 | 646 | depw,z \prot,8,7,\prot |
2f649c1f JB |
647 | .else |
648 | .error "undefined PA type to do_alias" | |
649 | .endif | |
650 | .endif | |
1da177e4 LT |
651 | /* |
652 | * OK, it is in the temp alias region, check whether "from" or "to". | |
653 | * Check "subtle" note in pacache.S re: r23/r26. | |
654 | */ | |
413059f2 | 655 | #ifdef CONFIG_64BIT |
1da177e4 LT |
656 | extrd,u,*= \va,41,1,%r0 |
657 | #else | |
658 | extrw,u,= \va,9,1,%r0 | |
659 | #endif | |
660 | or,COND(tr) %r23,%r0,\pte | |
661 | or %r26,%r0,\pte | |
662 | .endm | |
663 | ||
664 | ||
665 | /* | |
4182d0cd HD |
666 | * Fault_vectors are architecturally required to be aligned on a 2K |
667 | * boundary | |
1da177e4 LT |
668 | */ |
669 | ||
4df3c9ec | 670 | .section .text.hot |
4182d0cd | 671 | .align 2048 |
1da177e4 | 672 | |
c5e76552 | 673 | ENTRY(fault_vector_20) |
1da177e4 LT |
674 | /* First vector is invalid (0) */ |
675 | .ascii "cows can fly" | |
676 | .byte 0 | |
677 | .align 32 | |
678 | ||
679 | hpmc 1 | |
680 | def 2 | |
681 | def 3 | |
682 | extint 4 | |
683 | def 5 | |
684 | itlb_20 6 | |
685 | def 7 | |
686 | def 8 | |
687 | def 9 | |
688 | def 10 | |
689 | def 11 | |
690 | def 12 | |
691 | def 13 | |
692 | def 14 | |
693 | dtlb_20 15 | |
1da177e4 | 694 | naitlb_20 16 |
1da177e4 LT |
695 | nadtlb_20 17 |
696 | def 18 | |
697 | def 19 | |
698 | dbit_20 20 | |
699 | def 21 | |
700 | def 22 | |
701 | def 23 | |
702 | def 24 | |
703 | def 25 | |
704 | def 26 | |
705 | def 27 | |
706 | def 28 | |
707 | def 29 | |
708 | def 30 | |
709 | def 31 | |
c5e76552 | 710 | END(fault_vector_20) |
1da177e4 | 711 | |
413059f2 | 712 | #ifndef CONFIG_64BIT |
1da177e4 | 713 | |
1da177e4 LT |
714 | .align 2048 |
715 | ||
c5e76552 | 716 | ENTRY(fault_vector_11) |
1da177e4 LT |
717 | /* First vector is invalid (0) */ |
718 | .ascii "cows can fly" | |
719 | .byte 0 | |
720 | .align 32 | |
721 | ||
722 | hpmc 1 | |
723 | def 2 | |
724 | def 3 | |
725 | extint 4 | |
726 | def 5 | |
727 | itlb_11 6 | |
728 | def 7 | |
729 | def 8 | |
730 | def 9 | |
731 | def 10 | |
732 | def 11 | |
733 | def 12 | |
734 | def 13 | |
735 | def 14 | |
736 | dtlb_11 15 | |
1da177e4 | 737 | naitlb_11 16 |
1da177e4 LT |
738 | nadtlb_11 17 |
739 | def 18 | |
740 | def 19 | |
741 | dbit_11 20 | |
742 | def 21 | |
743 | def 22 | |
744 | def 23 | |
745 | def 24 | |
746 | def 25 | |
747 | def 26 | |
748 | def 27 | |
749 | def 28 | |
750 | def 29 | |
751 | def 30 | |
752 | def 31 | |
c5e76552 | 753 | END(fault_vector_11) |
1da177e4 LT |
754 | |
755 | #endif | |
d7dd2ff1 JB |
756 | /* Fault vector is separately protected and *must* be on its own page */ |
757 | .align PAGE_SIZE | |
758 | ENTRY(end_fault_vector) | |
1da177e4 LT |
759 | |
760 | .import handle_interruption,code | |
761 | .import do_cpu_irq_mask,code | |
762 | ||
1da177e4 LT |
763 | /* |
764 | * Child Returns here | |
765 | * | |
a44e060f | 766 | * copy_thread moved args into task save area. |
1da177e4 LT |
767 | */ |
768 | ||
f39cce65 | 769 | ENTRY_CFI(ret_from_kernel_thread) |
1da177e4 LT |
770 | |
771 | /* Call schedule_tail first though */ | |
772 | BL schedule_tail, %r2 | |
773 | nop | |
774 | ||
ff0ab8af | 775 | LDREG TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30), %r1 |
1da177e4 | 776 | LDREG TASK_PT_GR25(%r1), %r26 |
413059f2 | 777 | #ifdef CONFIG_64BIT |
1da177e4 | 778 | LDREG TASK_PT_GR27(%r1), %r27 |
1da177e4 LT |
779 | #endif |
780 | LDREG TASK_PT_GR26(%r1), %r1 | |
781 | ble 0(%sr7, %r1) | |
782 | copy %r31, %r2 | |
363806dd AV |
783 | b finish_child_return |
784 | nop | |
f39cce65 | 785 | ENDPROC_CFI(ret_from_kernel_thread) |
1da177e4 | 786 | |
1da177e4 LT |
787 | |
788 | /* | |
789 | * struct task_struct *_switch_to(struct task_struct *prev, | |
790 | * struct task_struct *next) | |
791 | * | |
792 | * switch kernel stacks and return prev */ | |
f39cce65 | 793 | ENTRY_CFI(_switch_to) |
1da177e4 LT |
794 | STREG %r2, -RP_OFFSET(%r30) |
795 | ||
618febd6 | 796 | callee_save_float |
1da177e4 LT |
797 | callee_save |
798 | ||
799 | load32 _switch_to_ret, %r2 | |
800 | ||
801 | STREG %r2, TASK_PT_KPC(%r26) | |
802 | LDREG TASK_PT_KPC(%r25), %r2 | |
803 | ||
804 | STREG %r30, TASK_PT_KSP(%r26) | |
805 | LDREG TASK_PT_KSP(%r25), %r30 | |
806 | LDREG TASK_THREAD_INFO(%r25), %r25 | |
807 | bv %r0(%r2) | |
808 | mtctl %r25,%cr30 | |
809 | ||
810 | _switch_to_ret: | |
811 | mtctl %r0, %cr0 /* Needed for single stepping */ | |
812 | callee_rest | |
618febd6 | 813 | callee_rest_float |
1da177e4 LT |
814 | |
815 | LDREG -RP_OFFSET(%r30), %r2 | |
816 | bv %r0(%r2) | |
817 | copy %r26, %r28 | |
f39cce65 | 818 | ENDPROC_CFI(_switch_to) |
1da177e4 LT |
819 | |
820 | /* | |
821 | * Common rfi return path for interruptions, kernel execve, and | |
822 | * sys_rt_sigreturn (sometimes). The sys_rt_sigreturn syscall will | |
823 | * return via this path if the signal was received when the process | |
824 | * was running; if the process was blocked on a syscall then the | |
825 | * normal syscall_exit path is used. All syscalls for traced | |
826 | * proceses exit via intr_restore. | |
827 | * | |
828 | * XXX If any syscalls that change a processes space id ever exit | |
829 | * this way, then we will need to copy %sr3 in to PT_SR[3..7], and | |
830 | * adjust IASQ[0..1]. | |
831 | * | |
1da177e4 LT |
832 | */ |
833 | ||
873d50e2 | 834 | .align PAGE_SIZE |
1da177e4 | 835 | |
f39cce65 | 836 | ENTRY_CFI(syscall_exit_rfi) |
1da177e4 LT |
837 | mfctl %cr30,%r16 |
838 | LDREG TI_TASK(%r16), %r16 /* thread_info -> task_struct */ | |
839 | ldo TASK_REGS(%r16),%r16 | |
840 | /* Force iaoq to userspace, as the user has had access to our current | |
841 | * context via sigcontext. Also Filter the PSW for the same reason. | |
842 | */ | |
843 | LDREG PT_IAOQ0(%r16),%r19 | |
844 | depi 3,31,2,%r19 | |
845 | STREG %r19,PT_IAOQ0(%r16) | |
846 | LDREG PT_IAOQ1(%r16),%r19 | |
847 | depi 3,31,2,%r19 | |
848 | STREG %r19,PT_IAOQ1(%r16) | |
849 | LDREG PT_PSW(%r16),%r19 | |
850 | load32 USER_PSW_MASK,%r1 | |
413059f2 | 851 | #ifdef CONFIG_64BIT |
1da177e4 LT |
852 | load32 USER_PSW_HI_MASK,%r20 |
853 | depd %r20,31,32,%r1 | |
854 | #endif | |
855 | and %r19,%r1,%r19 /* Mask out bits that user shouldn't play with */ | |
856 | load32 USER_PSW,%r1 | |
857 | or %r19,%r1,%r19 /* Make sure default USER_PSW bits are set */ | |
858 | STREG %r19,PT_PSW(%r16) | |
859 | ||
860 | /* | |
861 | * If we aren't being traced, we never saved space registers | |
862 | * (we don't store them in the sigcontext), so set them | |
863 | * to "proper" values now (otherwise we'll wind up restoring | |
864 | * whatever was last stored in the task structure, which might | |
25985edc | 865 | * be inconsistent if an interrupt occurred while on the gateway |
4b3f686d ML |
866 | * page). Note that we may be "trashing" values the user put in |
867 | * them, but we don't support the user changing them. | |
1da177e4 LT |
868 | */ |
869 | ||
870 | STREG %r0,PT_SR2(%r16) | |
871 | mfsp %sr3,%r19 | |
872 | STREG %r19,PT_SR0(%r16) | |
873 | STREG %r19,PT_SR1(%r16) | |
874 | STREG %r19,PT_SR3(%r16) | |
875 | STREG %r19,PT_SR4(%r16) | |
876 | STREG %r19,PT_SR5(%r16) | |
877 | STREG %r19,PT_SR6(%r16) | |
878 | STREG %r19,PT_SR7(%r16) | |
879 | ||
880 | intr_return: | |
5c38602d HD |
881 | /* NOTE: Need to enable interrupts incase we schedule. */ |
882 | ssm PSW_SM_I, %r0 | |
883 | ||
1da177e4 LT |
884 | /* check for reschedule */ |
885 | mfctl %cr30,%r1 | |
886 | LDREG TI_FLAGS(%r1),%r19 /* sched.h: TIF_NEED_RESCHED */ | |
887 | bb,<,n %r19,31-TIF_NEED_RESCHED,intr_do_resched /* forward */ | |
888 | ||
4650f0a5 | 889 | .import do_notify_resume,code |
1da177e4 LT |
890 | intr_check_sig: |
891 | /* As above */ | |
892 | mfctl %cr30,%r1 | |
4650f0a5 | 893 | LDREG TI_FLAGS(%r1),%r19 |
6fd84c08 | 894 | ldi (_TIF_SIGPENDING|_TIF_NOTIFY_RESUME), %r20 |
4650f0a5 KM |
895 | and,COND(<>) %r19, %r20, %r0 |
896 | b,n intr_restore /* skip past if we've nothing to do */ | |
897 | ||
898 | /* This check is critical to having LWS | |
899 | * working. The IASQ is zero on the gateway | |
900 | * page and we cannot deliver any signals until | |
901 | * we get off the gateway page. | |
902 | * | |
903 | * Only do signals if we are returning to user space | |
904 | */ | |
905 | LDREG PT_IASQ0(%r16), %r20 | |
872f6deb | 906 | cmpib,COND(=),n 0,%r20,intr_restore /* backward */ |
4650f0a5 | 907 | LDREG PT_IASQ1(%r16), %r20 |
872f6deb | 908 | cmpib,COND(=),n 0,%r20,intr_restore /* backward */ |
4650f0a5 KM |
909 | |
910 | copy %r0, %r25 /* long in_syscall = 0 */ | |
911 | #ifdef CONFIG_64BIT | |
912 | ldo -16(%r30),%r29 /* Reference param save area */ | |
913 | #endif | |
914 | ||
915 | BL do_notify_resume,%r2 | |
916 | copy %r16, %r26 /* struct pt_regs *regs */ | |
917 | ||
3fe4c55e | 918 | b,n intr_check_sig |
1da177e4 LT |
919 | |
920 | intr_restore: | |
921 | copy %r16,%r29 | |
922 | ldo PT_FR31(%r29),%r1 | |
923 | rest_fp %r1 | |
924 | rest_general %r29 | |
925 | ||
896a3756 GG |
926 | /* inverse of virt_map */ |
927 | pcxt_ssm_bug | |
928 | rsm PSW_SM_QUIET,%r0 /* prepare for rfi */ | |
1da177e4 | 929 | tophys_r1 %r29 |
1da177e4 LT |
930 | |
931 | /* Restore space id's and special cr's from PT_REGS | |
896a3756 GG |
932 | * structure pointed to by r29 |
933 | */ | |
1da177e4 LT |
934 | rest_specials %r29 |
935 | ||
896a3756 GG |
936 | /* IMPORTANT: rest_stack restores r29 last (we are using it)! |
937 | * It also restores r1 and r30. | |
938 | */ | |
1da177e4 LT |
939 | rest_stack |
940 | ||
941 | rfi | |
942 | nop | |
1da177e4 | 943 | |
50a34dbd KM |
944 | #ifndef CONFIG_PREEMPT |
945 | # define intr_do_preempt intr_restore | |
946 | #endif /* !CONFIG_PREEMPT */ | |
947 | ||
1da177e4 LT |
948 | .import schedule,code |
949 | intr_do_resched: | |
50a34dbd KM |
950 | /* Only call schedule on return to userspace. If we're returning |
951 | * to kernel space, we may schedule if CONFIG_PREEMPT, otherwise | |
952 | * we jump back to intr_restore. | |
953 | */ | |
1da177e4 | 954 | LDREG PT_IASQ0(%r16), %r20 |
872f6deb | 955 | cmpib,COND(=) 0, %r20, intr_do_preempt |
1da177e4 LT |
956 | nop |
957 | LDREG PT_IASQ1(%r16), %r20 | |
872f6deb | 958 | cmpib,COND(=) 0, %r20, intr_do_preempt |
1da177e4 LT |
959 | nop |
960 | ||
413059f2 | 961 | #ifdef CONFIG_64BIT |
1da177e4 LT |
962 | ldo -16(%r30),%r29 /* Reference param save area */ |
963 | #endif | |
964 | ||
965 | ldil L%intr_check_sig, %r2 | |
99ac7947 | 966 | #ifndef CONFIG_64BIT |
1da177e4 | 967 | b schedule |
99ac7947 RC |
968 | #else |
969 | load32 schedule, %r20 | |
970 | bv %r0(%r20) | |
971 | #endif | |
1da177e4 LT |
972 | ldo R%intr_check_sig(%r2), %r2 |
973 | ||
50a34dbd KM |
974 | /* preempt the current task on returning to kernel |
975 | * mode from an interrupt, iff need_resched is set, | |
976 | * and preempt_count is 0. otherwise, we continue on | |
977 | * our merry way back to the current running task. | |
978 | */ | |
979 | #ifdef CONFIG_PREEMPT | |
980 | .import preempt_schedule_irq,code | |
981 | intr_do_preempt: | |
982 | rsm PSW_SM_I, %r0 /* disable interrupts */ | |
983 | ||
984 | /* current_thread_info()->preempt_count */ | |
985 | mfctl %cr30, %r1 | |
986 | LDREG TI_PRE_COUNT(%r1), %r19 | |
872f6deb | 987 | cmpib,COND(<>) 0, %r19, intr_restore /* if preempt_count > 0 */ |
50a34dbd KM |
988 | nop /* prev insn branched backwards */ |
989 | ||
990 | /* check if we interrupted a critical path */ | |
991 | LDREG PT_PSW(%r16), %r20 | |
992 | bb,<,n %r20, 31 - PSW_SM_I, intr_restore | |
993 | nop | |
994 | ||
995 | BL preempt_schedule_irq, %r2 | |
996 | nop | |
997 | ||
9c2c5457 | 998 | b,n intr_restore /* ssm PSW_SM_I done by intr_restore */ |
50a34dbd | 999 | #endif /* CONFIG_PREEMPT */ |
1da177e4 | 1000 | |
1da177e4 LT |
1001 | /* |
1002 | * External interrupts. | |
1003 | */ | |
1004 | ||
1005 | intr_extint: | |
872f6deb | 1006 | cmpib,COND(=),n 0,%r16,1f |
6cc4525d | 1007 | |
1da177e4 | 1008 | get_stack_use_cr30 |
6cc4525d | 1009 | b,n 2f |
1da177e4 LT |
1010 | |
1011 | 1: | |
1da177e4 | 1012 | get_stack_use_r30 |
6cc4525d | 1013 | 2: |
1da177e4 LT |
1014 | save_specials %r29 |
1015 | virt_map | |
1016 | save_general %r29 | |
1017 | ||
1018 | ldo PT_FR0(%r29), %r24 | |
1019 | save_fp %r24 | |
1020 | ||
1021 | loadgp | |
1022 | ||
1023 | copy %r29, %r26 /* arg0 is pt_regs */ | |
1024 | copy %r29, %r16 /* save pt_regs */ | |
1025 | ||
1026 | ldil L%intr_return, %r2 | |
1027 | ||
413059f2 | 1028 | #ifdef CONFIG_64BIT |
1da177e4 LT |
1029 | ldo -16(%r30),%r29 /* Reference param save area */ |
1030 | #endif | |
1031 | ||
1032 | b do_cpu_irq_mask | |
1033 | ldo R%intr_return(%r2), %r2 /* return to intr_return, not here */ | |
f39cce65 | 1034 | ENDPROC_CFI(syscall_exit_rfi) |
1da177e4 LT |
1035 | |
1036 | ||
1037 | /* Generic interruptions (illegal insn, unaligned, page fault, etc) */ | |
1038 | ||
f39cce65 | 1039 | ENTRY_CFI(intr_save) /* for os_hpmc */ |
1da177e4 | 1040 | mfsp %sr7,%r16 |
872f6deb | 1041 | cmpib,COND(=),n 0,%r16,1f |
1da177e4 LT |
1042 | get_stack_use_cr30 |
1043 | b 2f | |
1044 | copy %r8,%r26 | |
1045 | ||
1046 | 1: | |
1047 | get_stack_use_r30 | |
1048 | copy %r8,%r26 | |
1049 | ||
1050 | 2: | |
1051 | save_specials %r29 | |
1052 | ||
1053 | /* If this trap is a itlb miss, skip saving/adjusting isr/ior */ | |
1054 | ||
1055 | /* | |
1056 | * FIXME: 1) Use a #define for the hardwired "6" below (and in | |
1057 | * traps.c. | |
1058 | * 2) Once we start executing code above 4 Gb, we need | |
1059 | * to adjust iasq/iaoq here in the same way we | |
1060 | * adjust isr/ior below. | |
1061 | */ | |
1062 | ||
872f6deb | 1063 | cmpib,COND(=),n 6,%r26,skip_save_ior |
1da177e4 | 1064 | |
1da177e4 LT |
1065 | |
1066 | mfctl %cr20, %r16 /* isr */ | |
896a3756 | 1067 | nop /* serialize mfctl on PA 2.0 to avoid 4 cycle penalty */ |
1da177e4 LT |
1068 | mfctl %cr21, %r17 /* ior */ |
1069 | ||
896a3756 | 1070 | |
413059f2 | 1071 | #ifdef CONFIG_64BIT |
1da177e4 LT |
1072 | /* |
1073 | * If the interrupted code was running with W bit off (32 bit), | |
1074 | * clear the b bits (bits 0 & 1) in the ior. | |
896a3756 | 1075 | * save_specials left ipsw value in r8 for us to test. |
1da177e4 LT |
1076 | */ |
1077 | extrd,u,*<> %r8,PSW_W_BIT,1,%r0 | |
1078 | depdi 0,1,2,%r17 | |
1079 | ||
1080 | /* | |
1081 | * FIXME: This code has hardwired assumptions about the split | |
1082 | * between space bits and offset bits. This will change | |
1083 | * when we allow alternate page sizes. | |
1084 | */ | |
1085 | ||
1086 | /* adjust isr/ior. */ | |
2fd83038 HD |
1087 | extrd,u %r16,63,SPACEID_SHIFT,%r1 /* get high bits from isr for ior */ |
1088 | depd %r1,31,SPACEID_SHIFT,%r17 /* deposit them into ior */ | |
1089 | depdi 0,63,SPACEID_SHIFT,%r16 /* clear them from isr */ | |
1da177e4 LT |
1090 | #endif |
1091 | STREG %r16, PT_ISR(%r29) | |
1092 | STREG %r17, PT_IOR(%r29) | |
1093 | ||
1094 | ||
1095 | skip_save_ior: | |
1096 | virt_map | |
1097 | save_general %r29 | |
1098 | ||
1099 | ldo PT_FR0(%r29), %r25 | |
1100 | save_fp %r25 | |
1101 | ||
1102 | loadgp | |
1103 | ||
1104 | copy %r29, %r25 /* arg1 is pt_regs */ | |
413059f2 | 1105 | #ifdef CONFIG_64BIT |
1da177e4 LT |
1106 | ldo -16(%r30),%r29 /* Reference param save area */ |
1107 | #endif | |
1108 | ||
1109 | ldil L%intr_check_sig, %r2 | |
1110 | copy %r25, %r16 /* save pt_regs */ | |
1111 | ||
1112 | b handle_interruption | |
1113 | ldo R%intr_check_sig(%r2), %r2 | |
f39cce65 | 1114 | ENDPROC_CFI(intr_save) |
1da177e4 LT |
1115 | |
1116 | ||
1117 | /* | |
1118 | * Note for all tlb miss handlers: | |
1119 | * | |
1120 | * cr24 contains a pointer to the kernel address space | |
1121 | * page directory. | |
1122 | * | |
1123 | * cr25 contains a pointer to the current user address | |
1124 | * space page directory. | |
1125 | * | |
1126 | * sr3 will contain the space id of the user address space | |
1127 | * of the current running thread while that thread is | |
1128 | * running in the kernel. | |
1129 | */ | |
1130 | ||
1131 | /* | |
1132 | * register number allocations. Note that these are all | |
1133 | * in the shadowed registers | |
1134 | */ | |
1135 | ||
1136 | t0 = r1 /* temporary register 0 */ | |
25985edc | 1137 | va = r8 /* virtual address for which the trap occurred */ |
1da177e4 LT |
1138 | t1 = r9 /* temporary register 1 */ |
1139 | pte = r16 /* pte/phys page # */ | |
1140 | prot = r17 /* prot bits */ | |
25985edc | 1141 | spc = r24 /* space for which the trap occurred */ |
1da177e4 LT |
1142 | ptp = r25 /* page directory/page table pointer */ |
1143 | ||
413059f2 | 1144 | #ifdef CONFIG_64BIT |
1da177e4 LT |
1145 | |
1146 | dtlb_miss_20w: | |
1147 | space_adjust spc,va,t0 | |
1148 | get_pgd spc,ptp | |
1149 | space_check spc,t0,dtlb_fault | |
1150 | ||
1151 | L3_ptep ptp,pte,t0,va,dtlb_check_alias_20w | |
1152 | ||
01ab6057 JDA |
1153 | tlb_lock spc,ptp,pte,t0,t1,dtlb_check_alias_20w |
1154 | update_accessed ptp,pte,t0,t1 | |
1da177e4 | 1155 | |
736d2169 | 1156 | make_insert_tlb spc,pte,prot,t1 |
1da177e4 LT |
1157 | |
1158 | idtlbt pte,prot | |
1159 | ||
01ab6057 | 1160 | tlb_unlock1 spc,t0 |
1da177e4 LT |
1161 | rfir |
1162 | nop | |
1163 | ||
1164 | dtlb_check_alias_20w: | |
2f649c1f | 1165 | do_alias spc,t0,t1,va,pte,prot,dtlb_fault,20 |
1da177e4 LT |
1166 | |
1167 | idtlbt pte,prot | |
1168 | ||
1169 | rfir | |
1170 | nop | |
1171 | ||
1172 | nadtlb_miss_20w: | |
1173 | space_adjust spc,va,t0 | |
1174 | get_pgd spc,ptp | |
1175 | space_check spc,t0,nadtlb_fault | |
1176 | ||
f311847c | 1177 | L3_ptep ptp,pte,t0,va,nadtlb_check_alias_20w |
1da177e4 | 1178 | |
01ab6057 JDA |
1179 | tlb_lock spc,ptp,pte,t0,t1,nadtlb_check_alias_20w |
1180 | update_accessed ptp,pte,t0,t1 | |
1da177e4 | 1181 | |
736d2169 | 1182 | make_insert_tlb spc,pte,prot,t1 |
1da177e4 LT |
1183 | |
1184 | idtlbt pte,prot | |
1185 | ||
01ab6057 | 1186 | tlb_unlock1 spc,t0 |
1da177e4 LT |
1187 | rfir |
1188 | nop | |
1189 | ||
f311847c | 1190 | nadtlb_check_alias_20w: |
2f649c1f | 1191 | do_alias spc,t0,t1,va,pte,prot,nadtlb_emulate,20 |
1da177e4 | 1192 | |
1da177e4 LT |
1193 | idtlbt pte,prot |
1194 | ||
1195 | rfir | |
1196 | nop | |
1197 | ||
1198 | #else | |
1199 | ||
1200 | dtlb_miss_11: | |
1201 | get_pgd spc,ptp | |
1202 | ||
1203 | space_check spc,t0,dtlb_fault | |
1204 | ||
1205 | L2_ptep ptp,pte,t0,va,dtlb_check_alias_11 | |
1206 | ||
01ab6057 JDA |
1207 | tlb_lock spc,ptp,pte,t0,t1,dtlb_check_alias_11 |
1208 | update_accessed ptp,pte,t0,t1 | |
1da177e4 LT |
1209 | |
1210 | make_insert_tlb_11 spc,pte,prot | |
1211 | ||
01ab6057 | 1212 | mfsp %sr1,t1 /* Save sr1 so we can use it in tlb inserts */ |
1da177e4 LT |
1213 | mtsp spc,%sr1 |
1214 | ||
1215 | idtlba pte,(%sr1,va) | |
1216 | idtlbp prot,(%sr1,va) | |
1217 | ||
01ab6057 | 1218 | mtsp t1, %sr1 /* Restore sr1 */ |
1da177e4 | 1219 | |
01ab6057 | 1220 | tlb_unlock1 spc,t0 |
1da177e4 LT |
1221 | rfir |
1222 | nop | |
1223 | ||
1224 | dtlb_check_alias_11: | |
2f649c1f | 1225 | do_alias spc,t0,t1,va,pte,prot,dtlb_fault,11 |
1da177e4 LT |
1226 | |
1227 | idtlba pte,(va) | |
1228 | idtlbp prot,(va) | |
1229 | ||
1230 | rfir | |
1231 | nop | |
1232 | ||
1233 | nadtlb_miss_11: | |
1234 | get_pgd spc,ptp | |
1235 | ||
1236 | space_check spc,t0,nadtlb_fault | |
1237 | ||
f311847c | 1238 | L2_ptep ptp,pte,t0,va,nadtlb_check_alias_11 |
1da177e4 | 1239 | |
01ab6057 JDA |
1240 | tlb_lock spc,ptp,pte,t0,t1,nadtlb_check_alias_11 |
1241 | update_accessed ptp,pte,t0,t1 | |
1da177e4 LT |
1242 | |
1243 | make_insert_tlb_11 spc,pte,prot | |
1244 | ||
01ab6057 | 1245 | mfsp %sr1,t1 /* Save sr1 so we can use it in tlb inserts */ |
1da177e4 LT |
1246 | mtsp spc,%sr1 |
1247 | ||
1248 | idtlba pte,(%sr1,va) | |
1249 | idtlbp prot,(%sr1,va) | |
1250 | ||
01ab6057 | 1251 | mtsp t1, %sr1 /* Restore sr1 */ |
1da177e4 | 1252 | |
01ab6057 | 1253 | tlb_unlock1 spc,t0 |
1da177e4 LT |
1254 | rfir |
1255 | nop | |
1256 | ||
f311847c | 1257 | nadtlb_check_alias_11: |
2f649c1f | 1258 | do_alias spc,t0,t1,va,pte,prot,nadtlb_emulate,11 |
f311847c JB |
1259 | |
1260 | idtlba pte,(va) | |
1261 | idtlbp prot,(va) | |
1262 | ||
1263 | rfir | |
1264 | nop | |
1265 | ||
1da177e4 LT |
1266 | dtlb_miss_20: |
1267 | space_adjust spc,va,t0 | |
1268 | get_pgd spc,ptp | |
1269 | space_check spc,t0,dtlb_fault | |
1270 | ||
1271 | L2_ptep ptp,pte,t0,va,dtlb_check_alias_20 | |
1272 | ||
01ab6057 JDA |
1273 | tlb_lock spc,ptp,pte,t0,t1,dtlb_check_alias_20 |
1274 | update_accessed ptp,pte,t0,t1 | |
1da177e4 | 1275 | |
736d2169 | 1276 | make_insert_tlb spc,pte,prot,t1 |
1da177e4 | 1277 | |
01ab6057 | 1278 | f_extend pte,t1 |
1da177e4 LT |
1279 | |
1280 | idtlbt pte,prot | |
1281 | ||
01ab6057 | 1282 | tlb_unlock1 spc,t0 |
1da177e4 LT |
1283 | rfir |
1284 | nop | |
1285 | ||
1286 | dtlb_check_alias_20: | |
2f649c1f | 1287 | do_alias spc,t0,t1,va,pte,prot,dtlb_fault,20 |
1da177e4 LT |
1288 | |
1289 | idtlbt pte,prot | |
1290 | ||
1291 | rfir | |
1292 | nop | |
1293 | ||
1294 | nadtlb_miss_20: | |
1295 | get_pgd spc,ptp | |
1296 | ||
1297 | space_check spc,t0,nadtlb_fault | |
1298 | ||
f311847c | 1299 | L2_ptep ptp,pte,t0,va,nadtlb_check_alias_20 |
1da177e4 | 1300 | |
01ab6057 JDA |
1301 | tlb_lock spc,ptp,pte,t0,t1,nadtlb_check_alias_20 |
1302 | update_accessed ptp,pte,t0,t1 | |
1da177e4 | 1303 | |
736d2169 | 1304 | make_insert_tlb spc,pte,prot,t1 |
1da177e4 | 1305 | |
01ab6057 | 1306 | f_extend pte,t1 |
1da177e4 | 1307 | |
01ab6057 | 1308 | idtlbt pte,prot |
1da177e4 | 1309 | |
01ab6057 | 1310 | tlb_unlock1 spc,t0 |
1da177e4 LT |
1311 | rfir |
1312 | nop | |
1313 | ||
f311847c | 1314 | nadtlb_check_alias_20: |
2f649c1f | 1315 | do_alias spc,t0,t1,va,pte,prot,nadtlb_emulate,20 |
f311847c JB |
1316 | |
1317 | idtlbt pte,prot | |
1318 | ||
1319 | rfir | |
1320 | nop | |
1321 | ||
1da177e4 LT |
1322 | #endif |
1323 | ||
1324 | nadtlb_emulate: | |
1325 | ||
1326 | /* | |
1327 | * Non access misses can be caused by fdc,fic,pdc,lpa,probe and | |
1328 | * probei instructions. We don't want to fault for these | |
1329 | * instructions (not only does it not make sense, it can cause | |
1330 | * deadlocks, since some flushes are done with the mmap | |
1331 | * semaphore held). If the translation doesn't exist, we can't | |
1332 | * insert a translation, so have to emulate the side effects | |
1333 | * of the instruction. Since we don't insert a translation | |
1334 | * we can get a lot of faults during a flush loop, so it makes | |
1335 | * sense to try to do it here with minimum overhead. We only | |
1336 | * emulate fdc,fic,pdc,probew,prober instructions whose base | |
1337 | * and index registers are not shadowed. We defer everything | |
1338 | * else to the "slow" path. | |
1339 | */ | |
1340 | ||
1341 | mfctl %cr19,%r9 /* Get iir */ | |
1342 | ||
1343 | /* PA 2.0 Arch Ref. Book pg 382 has a good description of the insn bits. | |
1344 | Checks for fdc,fdce,pdc,"fic,4f",prober,probeir,probew, probeiw */ | |
1345 | ||
1346 | /* Checks for fdc,fdce,pdc,"fic,4f" only */ | |
1347 | ldi 0x280,%r16 | |
1348 | and %r9,%r16,%r17 | |
1349 | cmpb,<>,n %r16,%r17,nadtlb_probe_check | |
1350 | bb,>=,n %r9,26,nadtlb_nullify /* m bit not set, just nullify */ | |
1351 | BL get_register,%r25 | |
1352 | extrw,u %r9,15,5,%r8 /* Get index register # */ | |
872f6deb | 1353 | cmpib,COND(=),n -1,%r1,nadtlb_fault /* have to use slow path */ |
1da177e4 LT |
1354 | copy %r1,%r24 |
1355 | BL get_register,%r25 | |
1356 | extrw,u %r9,10,5,%r8 /* Get base register # */ | |
872f6deb | 1357 | cmpib,COND(=),n -1,%r1,nadtlb_fault /* have to use slow path */ |
1da177e4 LT |
1358 | BL set_register,%r25 |
1359 | add,l %r1,%r24,%r1 /* doesn't affect c/b bits */ | |
1360 | ||
1361 | nadtlb_nullify: | |
896a3756 | 1362 | mfctl %ipsw,%r8 |
1da177e4 LT |
1363 | ldil L%PSW_N,%r9 |
1364 | or %r8,%r9,%r8 /* Set PSW_N */ | |
896a3756 | 1365 | mtctl %r8,%ipsw |
1da177e4 LT |
1366 | |
1367 | rfir | |
1368 | nop | |
1369 | ||
1370 | /* | |
1371 | When there is no translation for the probe address then we | |
1372 | must nullify the insn and return zero in the target regsiter. | |
1373 | This will indicate to the calling code that it does not have | |
1374 | write/read privileges to this address. | |
1375 | ||
1376 | This should technically work for prober and probew in PA 1.1, | |
1377 | and also probe,r and probe,w in PA 2.0 | |
1378 | ||
1379 | WARNING: USE ONLY NON-SHADOW REGISTERS WITH PROBE INSN! | |
1380 | THE SLOW-PATH EMULATION HAS NOT BEEN WRITTEN YET. | |
1381 | ||
1382 | */ | |
1383 | nadtlb_probe_check: | |
1384 | ldi 0x80,%r16 | |
1385 | and %r9,%r16,%r17 | |
1386 | cmpb,<>,n %r16,%r17,nadtlb_fault /* Must be probe,[rw]*/ | |
1387 | BL get_register,%r25 /* Find the target register */ | |
1388 | extrw,u %r9,31,5,%r8 /* Get target register */ | |
872f6deb | 1389 | cmpib,COND(=),n -1,%r1,nadtlb_fault /* have to use slow path */ |
1da177e4 LT |
1390 | BL set_register,%r25 |
1391 | copy %r0,%r1 /* Write zero to target register */ | |
1392 | b nadtlb_nullify /* Nullify return insn */ | |
1393 | nop | |
1394 | ||
1395 | ||
413059f2 | 1396 | #ifdef CONFIG_64BIT |
1da177e4 LT |
1397 | itlb_miss_20w: |
1398 | ||
1399 | /* | |
1400 | * I miss is a little different, since we allow users to fault | |
1401 | * on the gateway page which is in the kernel address space. | |
1402 | */ | |
1403 | ||
1404 | space_adjust spc,va,t0 | |
1405 | get_pgd spc,ptp | |
1406 | space_check spc,t0,itlb_fault | |
1407 | ||
1408 | L3_ptep ptp,pte,t0,va,itlb_fault | |
1409 | ||
01ab6057 JDA |
1410 | tlb_lock spc,ptp,pte,t0,t1,itlb_fault |
1411 | update_accessed ptp,pte,t0,t1 | |
1da177e4 | 1412 | |
736d2169 | 1413 | make_insert_tlb spc,pte,prot,t1 |
1da177e4 LT |
1414 | |
1415 | iitlbt pte,prot | |
1416 | ||
01ab6057 | 1417 | tlb_unlock1 spc,t0 |
1da177e4 LT |
1418 | rfir |
1419 | nop | |
1420 | ||
f311847c JB |
1421 | naitlb_miss_20w: |
1422 | ||
1423 | /* | |
1424 | * I miss is a little different, since we allow users to fault | |
1425 | * on the gateway page which is in the kernel address space. | |
1426 | */ | |
1427 | ||
1428 | space_adjust spc,va,t0 | |
1429 | get_pgd spc,ptp | |
1430 | space_check spc,t0,naitlb_fault | |
1431 | ||
1432 | L3_ptep ptp,pte,t0,va,naitlb_check_alias_20w | |
1433 | ||
01ab6057 JDA |
1434 | tlb_lock spc,ptp,pte,t0,t1,naitlb_check_alias_20w |
1435 | update_accessed ptp,pte,t0,t1 | |
f311847c | 1436 | |
736d2169 | 1437 | make_insert_tlb spc,pte,prot,t1 |
f311847c JB |
1438 | |
1439 | iitlbt pte,prot | |
1440 | ||
01ab6057 | 1441 | tlb_unlock1 spc,t0 |
f311847c JB |
1442 | rfir |
1443 | nop | |
1444 | ||
1445 | naitlb_check_alias_20w: | |
2f649c1f | 1446 | do_alias spc,t0,t1,va,pte,prot,naitlb_fault,20 |
f311847c JB |
1447 | |
1448 | iitlbt pte,prot | |
1449 | ||
1450 | rfir | |
1451 | nop | |
1452 | ||
1da177e4 LT |
1453 | #else |
1454 | ||
1455 | itlb_miss_11: | |
1456 | get_pgd spc,ptp | |
1457 | ||
1458 | space_check spc,t0,itlb_fault | |
1459 | ||
1460 | L2_ptep ptp,pte,t0,va,itlb_fault | |
1461 | ||
01ab6057 JDA |
1462 | tlb_lock spc,ptp,pte,t0,t1,itlb_fault |
1463 | update_accessed ptp,pte,t0,t1 | |
1da177e4 LT |
1464 | |
1465 | make_insert_tlb_11 spc,pte,prot | |
1466 | ||
01ab6057 | 1467 | mfsp %sr1,t1 /* Save sr1 so we can use it in tlb inserts */ |
1da177e4 LT |
1468 | mtsp spc,%sr1 |
1469 | ||
1470 | iitlba pte,(%sr1,va) | |
1471 | iitlbp prot,(%sr1,va) | |
1472 | ||
01ab6057 | 1473 | mtsp t1, %sr1 /* Restore sr1 */ |
1da177e4 | 1474 | |
01ab6057 | 1475 | tlb_unlock1 spc,t0 |
1da177e4 LT |
1476 | rfir |
1477 | nop | |
1478 | ||
f311847c JB |
1479 | naitlb_miss_11: |
1480 | get_pgd spc,ptp | |
1481 | ||
1482 | space_check spc,t0,naitlb_fault | |
1483 | ||
1484 | L2_ptep ptp,pte,t0,va,naitlb_check_alias_11 | |
1485 | ||
01ab6057 JDA |
1486 | tlb_lock spc,ptp,pte,t0,t1,naitlb_check_alias_11 |
1487 | update_accessed ptp,pte,t0,t1 | |
f311847c JB |
1488 | |
1489 | make_insert_tlb_11 spc,pte,prot | |
1490 | ||
01ab6057 | 1491 | mfsp %sr1,t1 /* Save sr1 so we can use it in tlb inserts */ |
f311847c JB |
1492 | mtsp spc,%sr1 |
1493 | ||
1494 | iitlba pte,(%sr1,va) | |
1495 | iitlbp prot,(%sr1,va) | |
1496 | ||
01ab6057 | 1497 | mtsp t1, %sr1 /* Restore sr1 */ |
f311847c | 1498 | |
01ab6057 | 1499 | tlb_unlock1 spc,t0 |
f311847c JB |
1500 | rfir |
1501 | nop | |
1502 | ||
1503 | naitlb_check_alias_11: | |
2f649c1f | 1504 | do_alias spc,t0,t1,va,pte,prot,itlb_fault,11 |
f311847c JB |
1505 | |
1506 | iitlba pte,(%sr0, va) | |
1507 | iitlbp prot,(%sr0, va) | |
1508 | ||
1509 | rfir | |
1510 | nop | |
1511 | ||
1512 | ||
1da177e4 LT |
1513 | itlb_miss_20: |
1514 | get_pgd spc,ptp | |
1515 | ||
1516 | space_check spc,t0,itlb_fault | |
1517 | ||
1518 | L2_ptep ptp,pte,t0,va,itlb_fault | |
1519 | ||
01ab6057 JDA |
1520 | tlb_lock spc,ptp,pte,t0,t1,itlb_fault |
1521 | update_accessed ptp,pte,t0,t1 | |
1da177e4 | 1522 | |
736d2169 | 1523 | make_insert_tlb spc,pte,prot,t1 |
1da177e4 | 1524 | |
01ab6057 | 1525 | f_extend pte,t1 |
1da177e4 LT |
1526 | |
1527 | iitlbt pte,prot | |
1528 | ||
01ab6057 | 1529 | tlb_unlock1 spc,t0 |
1da177e4 LT |
1530 | rfir |
1531 | nop | |
1532 | ||
f311847c JB |
1533 | naitlb_miss_20: |
1534 | get_pgd spc,ptp | |
1535 | ||
1536 | space_check spc,t0,naitlb_fault | |
1537 | ||
1538 | L2_ptep ptp,pte,t0,va,naitlb_check_alias_20 | |
1539 | ||
01ab6057 JDA |
1540 | tlb_lock spc,ptp,pte,t0,t1,naitlb_check_alias_20 |
1541 | update_accessed ptp,pte,t0,t1 | |
f311847c | 1542 | |
736d2169 | 1543 | make_insert_tlb spc,pte,prot,t1 |
f311847c | 1544 | |
01ab6057 | 1545 | f_extend pte,t1 |
f311847c JB |
1546 | |
1547 | iitlbt pte,prot | |
1548 | ||
01ab6057 | 1549 | tlb_unlock1 spc,t0 |
f311847c JB |
1550 | rfir |
1551 | nop | |
1552 | ||
1553 | naitlb_check_alias_20: | |
2f649c1f | 1554 | do_alias spc,t0,t1,va,pte,prot,naitlb_fault,20 |
f311847c JB |
1555 | |
1556 | iitlbt pte,prot | |
1557 | ||
1558 | rfir | |
1559 | nop | |
1560 | ||
1da177e4 LT |
1561 | #endif |
1562 | ||
413059f2 | 1563 | #ifdef CONFIG_64BIT |
1da177e4 LT |
1564 | |
1565 | dbit_trap_20w: | |
1566 | space_adjust spc,va,t0 | |
1567 | get_pgd spc,ptp | |
1568 | space_check spc,t0,dbit_fault | |
1569 | ||
1570 | L3_ptep ptp,pte,t0,va,dbit_fault | |
1571 | ||
01ab6057 JDA |
1572 | tlb_lock spc,ptp,pte,t0,t1,dbit_fault |
1573 | update_dirty ptp,pte,t1 | |
1da177e4 | 1574 | |
736d2169 | 1575 | make_insert_tlb spc,pte,prot,t1 |
1da177e4 LT |
1576 | |
1577 | idtlbt pte,prot | |
1da177e4 | 1578 | |
01ab6057 | 1579 | tlb_unlock0 spc,t0 |
1da177e4 LT |
1580 | rfir |
1581 | nop | |
1582 | #else | |
1583 | ||
1584 | dbit_trap_11: | |
1585 | ||
1586 | get_pgd spc,ptp | |
1587 | ||
1588 | space_check spc,t0,dbit_fault | |
1589 | ||
1590 | L2_ptep ptp,pte,t0,va,dbit_fault | |
1591 | ||
01ab6057 JDA |
1592 | tlb_lock spc,ptp,pte,t0,t1,dbit_fault |
1593 | update_dirty ptp,pte,t1 | |
1da177e4 LT |
1594 | |
1595 | make_insert_tlb_11 spc,pte,prot | |
1596 | ||
1597 | mfsp %sr1,t1 /* Save sr1 so we can use it in tlb inserts */ | |
1598 | mtsp spc,%sr1 | |
1599 | ||
1600 | idtlba pte,(%sr1,va) | |
1601 | idtlbp prot,(%sr1,va) | |
1602 | ||
1603 | mtsp t1, %sr1 /* Restore sr1 */ | |
1da177e4 | 1604 | |
01ab6057 | 1605 | tlb_unlock0 spc,t0 |
1da177e4 LT |
1606 | rfir |
1607 | nop | |
1608 | ||
1609 | dbit_trap_20: | |
1610 | get_pgd spc,ptp | |
1611 | ||
1612 | space_check spc,t0,dbit_fault | |
1613 | ||
1614 | L2_ptep ptp,pte,t0,va,dbit_fault | |
1615 | ||
01ab6057 JDA |
1616 | tlb_lock spc,ptp,pte,t0,t1,dbit_fault |
1617 | update_dirty ptp,pte,t1 | |
1da177e4 | 1618 | |
736d2169 | 1619 | make_insert_tlb spc,pte,prot,t1 |
1da177e4 LT |
1620 | |
1621 | f_extend pte,t1 | |
1622 | ||
01ab6057 | 1623 | idtlbt pte,prot |
1da177e4 | 1624 | |
01ab6057 | 1625 | tlb_unlock0 spc,t0 |
1da177e4 LT |
1626 | rfir |
1627 | nop | |
1628 | #endif | |
1629 | ||
1630 | .import handle_interruption,code | |
1631 | ||
1632 | kernel_bad_space: | |
1633 | b intr_save | |
1634 | ldi 31,%r8 /* Use an unused code */ | |
1635 | ||
1636 | dbit_fault: | |
1637 | b intr_save | |
1638 | ldi 20,%r8 | |
1639 | ||
1640 | itlb_fault: | |
1641 | b intr_save | |
1642 | ldi 6,%r8 | |
1643 | ||
1644 | nadtlb_fault: | |
1645 | b intr_save | |
1646 | ldi 17,%r8 | |
1647 | ||
f311847c JB |
1648 | naitlb_fault: |
1649 | b intr_save | |
1650 | ldi 16,%r8 | |
1651 | ||
1da177e4 LT |
1652 | dtlb_fault: |
1653 | b intr_save | |
1654 | ldi 15,%r8 | |
1655 | ||
1656 | /* Register saving semantics for system calls: | |
1657 | ||
1658 | %r1 clobbered by system call macro in userspace | |
1659 | %r2 saved in PT_REGS by gateway page | |
1660 | %r3 - %r18 preserved by C code (saved by signal code) | |
1661 | %r19 - %r20 saved in PT_REGS by gateway page | |
1662 | %r21 - %r22 non-standard syscall args | |
1663 | stored in kernel stack by gateway page | |
1664 | %r23 - %r26 arg3-arg0, saved in PT_REGS by gateway page | |
1665 | %r27 - %r30 saved in PT_REGS by gateway page | |
1666 | %r31 syscall return pointer | |
1667 | */ | |
1668 | ||
1669 | /* Floating point registers (FIXME: what do we do with these?) | |
1670 | ||
1671 | %fr0 - %fr3 status/exception, not preserved | |
1672 | %fr4 - %fr7 arguments | |
1673 | %fr8 - %fr11 not preserved by C code | |
1674 | %fr12 - %fr21 preserved by C code | |
1675 | %fr22 - %fr31 not preserved by C code | |
1676 | */ | |
1677 | ||
1678 | .macro reg_save regs | |
1679 | STREG %r3, PT_GR3(\regs) | |
1680 | STREG %r4, PT_GR4(\regs) | |
1681 | STREG %r5, PT_GR5(\regs) | |
1682 | STREG %r6, PT_GR6(\regs) | |
1683 | STREG %r7, PT_GR7(\regs) | |
1684 | STREG %r8, PT_GR8(\regs) | |
1685 | STREG %r9, PT_GR9(\regs) | |
1686 | STREG %r10,PT_GR10(\regs) | |
1687 | STREG %r11,PT_GR11(\regs) | |
1688 | STREG %r12,PT_GR12(\regs) | |
1689 | STREG %r13,PT_GR13(\regs) | |
1690 | STREG %r14,PT_GR14(\regs) | |
1691 | STREG %r15,PT_GR15(\regs) | |
1692 | STREG %r16,PT_GR16(\regs) | |
1693 | STREG %r17,PT_GR17(\regs) | |
1694 | STREG %r18,PT_GR18(\regs) | |
1695 | .endm | |
1696 | ||
1697 | .macro reg_restore regs | |
1698 | LDREG PT_GR3(\regs), %r3 | |
1699 | LDREG PT_GR4(\regs), %r4 | |
1700 | LDREG PT_GR5(\regs), %r5 | |
1701 | LDREG PT_GR6(\regs), %r6 | |
1702 | LDREG PT_GR7(\regs), %r7 | |
1703 | LDREG PT_GR8(\regs), %r8 | |
1704 | LDREG PT_GR9(\regs), %r9 | |
1705 | LDREG PT_GR10(\regs),%r10 | |
1706 | LDREG PT_GR11(\regs),%r11 | |
1707 | LDREG PT_GR12(\regs),%r12 | |
1708 | LDREG PT_GR13(\regs),%r13 | |
1709 | LDREG PT_GR14(\regs),%r14 | |
1710 | LDREG PT_GR15(\regs),%r15 | |
1711 | LDREG PT_GR16(\regs),%r16 | |
1712 | LDREG PT_GR17(\regs),%r17 | |
1713 | LDREG PT_GR18(\regs),%r18 | |
1714 | .endm | |
1715 | ||
415bfae9 | 1716 | .macro fork_like name |
f39cce65 | 1717 | ENTRY_CFI(sys_\name\()_wrapper) |
1da177e4 LT |
1718 | LDREG TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30), %r1 |
1719 | ldo TASK_REGS(%r1),%r1 | |
1720 | reg_save %r1 | |
ff0ab8af | 1721 | mfctl %cr27, %r28 |
bbbfde78 JDA |
1722 | ldil L%sys_\name, %r31 |
1723 | be R%sys_\name(%sr4,%r31) | |
ff0ab8af | 1724 | STREG %r28, PT_CR27(%r1) |
f39cce65 | 1725 | ENDPROC_CFI(sys_\name\()_wrapper) |
415bfae9 | 1726 | .endm |
1da177e4 | 1727 | |
415bfae9 AV |
1728 | fork_like clone |
1729 | fork_like fork | |
1730 | fork_like vfork | |
1da177e4 LT |
1731 | |
1732 | /* Set the return value for the child */ | |
f39cce65 | 1733 | ENTRY_CFI(child_return) |
1da177e4 LT |
1734 | BL schedule_tail, %r2 |
1735 | nop | |
363806dd | 1736 | finish_child_return: |
ff0ab8af AV |
1737 | LDREG TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30), %r1 |
1738 | ldo TASK_REGS(%r1),%r1 /* get pt regs */ | |
1739 | ||
1740 | LDREG PT_CR27(%r1), %r3 | |
1741 | mtctl %r3, %cr27 | |
1742 | reg_restore %r1 | |
1743 | b syscall_exit | |
1da177e4 | 1744 | copy %r0,%r28 |
f39cce65 | 1745 | ENDPROC_CFI(child_return) |
1da177e4 | 1746 | |
f39cce65 | 1747 | ENTRY_CFI(sys_rt_sigreturn_wrapper) |
1da177e4 LT |
1748 | LDREG TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r26 |
1749 | ldo TASK_REGS(%r26),%r26 /* get pt regs */ | |
1750 | /* Don't save regs, we are going to restore them from sigcontext. */ | |
1751 | STREG %r2, -RP_OFFSET(%r30) | |
413059f2 | 1752 | #ifdef CONFIG_64BIT |
1da177e4 LT |
1753 | ldo FRAME_SIZE(%r30), %r30 |
1754 | BL sys_rt_sigreturn,%r2 | |
1755 | ldo -16(%r30),%r29 /* Reference param save area */ | |
1756 | #else | |
1757 | BL sys_rt_sigreturn,%r2 | |
1758 | ldo FRAME_SIZE(%r30), %r30 | |
1759 | #endif | |
1760 | ||
1761 | ldo -FRAME_SIZE(%r30), %r30 | |
1762 | LDREG -RP_OFFSET(%r30), %r2 | |
1763 | ||
1764 | /* FIXME: I think we need to restore a few more things here. */ | |
1765 | LDREG TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1 | |
1766 | ldo TASK_REGS(%r1),%r1 /* get pt regs */ | |
1767 | reg_restore %r1 | |
1768 | ||
1769 | /* If the signal was received while the process was blocked on a | |
1770 | * syscall, then r2 will take us to syscall_exit; otherwise r2 will | |
1771 | * take us to syscall_exit_rfi and on to intr_return. | |
1772 | */ | |
1773 | bv %r0(%r2) | |
1774 | LDREG PT_GR28(%r1),%r28 /* reload original r28 for syscall_exit */ | |
f39cce65 | 1775 | ENDPROC_CFI(sys_rt_sigreturn_wrapper) |
1da177e4 | 1776 | |
f39cce65 | 1777 | ENTRY_CFI(syscall_exit) |
1da177e4 LT |
1778 | /* NOTE: Not all syscalls exit this way. rt_sigreturn will exit |
1779 | * via syscall_exit_rfi if the signal was received while the process | |
1780 | * was running. | |
1781 | */ | |
1782 | ||
1783 | /* save return value now */ | |
1784 | ||
1785 | mfctl %cr30, %r1 | |
1786 | LDREG TI_TASK(%r1),%r1 | |
1787 | STREG %r28,TASK_PT_GR28(%r1) | |
1788 | ||
1da177e4 LT |
1789 | /* Seems to me that dp could be wrong here, if the syscall involved |
1790 | * calling a module, and nothing got round to restoring dp on return. | |
1791 | */ | |
1792 | loadgp | |
1793 | ||
1da177e4 LT |
1794 | syscall_check_resched: |
1795 | ||
1796 | /* check for reschedule */ | |
1797 | ||
1798 | LDREG TI_FLAGS-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r19 /* long */ | |
1799 | bb,<,n %r19, 31-TIF_NEED_RESCHED, syscall_do_resched /* forward */ | |
1800 | ||
4650f0a5 | 1801 | .import do_signal,code |
1da177e4 | 1802 | syscall_check_sig: |
4650f0a5 | 1803 | LDREG TI_FLAGS-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r19 |
6fd84c08 | 1804 | ldi (_TIF_SIGPENDING|_TIF_NOTIFY_RESUME), %r26 |
4650f0a5 KM |
1805 | and,COND(<>) %r19, %r26, %r0 |
1806 | b,n syscall_restore /* skip past if we've nothing to do */ | |
1807 | ||
1808 | syscall_do_signal: | |
1809 | /* Save callee-save registers (for sigcontext). | |
1810 | * FIXME: After this point the process structure should be | |
1811 | * consistent with all the relevant state of the process | |
1812 | * before the syscall. We need to verify this. | |
1813 | */ | |
1814 | LDREG TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1 | |
1815 | ldo TASK_REGS(%r1), %r26 /* struct pt_regs *regs */ | |
1816 | reg_save %r26 | |
1817 | ||
1818 | #ifdef CONFIG_64BIT | |
1819 | ldo -16(%r30),%r29 /* Reference param save area */ | |
1820 | #endif | |
1821 | ||
1822 | BL do_notify_resume,%r2 | |
1823 | ldi 1, %r25 /* long in_syscall = 1 */ | |
1824 | ||
1825 | LDREG TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1 | |
1826 | ldo TASK_REGS(%r1), %r20 /* reload pt_regs */ | |
1827 | reg_restore %r20 | |
1828 | ||
1829 | b,n syscall_check_sig | |
1da177e4 LT |
1830 | |
1831 | syscall_restore: | |
1da177e4 LT |
1832 | LDREG TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1 |
1833 | ||
ecd3d4bc KM |
1834 | /* Are we being ptraced? */ |
1835 | ldw TASK_FLAGS(%r1),%r19 | |
34360f08 | 1836 | ldi _TIF_SYSCALL_TRACE_MASK,%r2 |
ecd3d4bc KM |
1837 | and,COND(=) %r19,%r2,%r0 |
1838 | b,n syscall_restore_rfi | |
1da177e4 LT |
1839 | |
1840 | ldo TASK_PT_FR31(%r1),%r19 /* reload fpregs */ | |
1841 | rest_fp %r19 | |
1842 | ||
1843 | LDREG TASK_PT_SAR(%r1),%r19 /* restore SAR */ | |
1844 | mtsar %r19 | |
1845 | ||
1846 | LDREG TASK_PT_GR2(%r1),%r2 /* restore user rp */ | |
1847 | LDREG TASK_PT_GR19(%r1),%r19 | |
1848 | LDREG TASK_PT_GR20(%r1),%r20 | |
1849 | LDREG TASK_PT_GR21(%r1),%r21 | |
1850 | LDREG TASK_PT_GR22(%r1),%r22 | |
1851 | LDREG TASK_PT_GR23(%r1),%r23 | |
1852 | LDREG TASK_PT_GR24(%r1),%r24 | |
1853 | LDREG TASK_PT_GR25(%r1),%r25 | |
1854 | LDREG TASK_PT_GR26(%r1),%r26 | |
1855 | LDREG TASK_PT_GR27(%r1),%r27 /* restore user dp */ | |
1856 | LDREG TASK_PT_GR28(%r1),%r28 /* syscall return value */ | |
1857 | LDREG TASK_PT_GR29(%r1),%r29 | |
1858 | LDREG TASK_PT_GR31(%r1),%r31 /* restore syscall rp */ | |
1859 | ||
1860 | /* NOTE: We use rsm/ssm pair to make this operation atomic */ | |
8f6c0c2b | 1861 | LDREG TASK_PT_GR30(%r1),%r1 /* Get user sp */ |
1da177e4 | 1862 | rsm PSW_SM_I, %r0 |
8f6c0c2b JDA |
1863 | copy %r1,%r30 /* Restore user sp */ |
1864 | mfsp %sr3,%r1 /* Get user space id */ | |
1da177e4 LT |
1865 | mtsp %r1,%sr7 /* Restore sr7 */ |
1866 | ssm PSW_SM_I, %r0 | |
1867 | ||
1868 | /* Set sr2 to zero for userspace syscalls to work. */ | |
1869 | mtsp %r0,%sr2 | |
1870 | mtsp %r1,%sr4 /* Restore sr4 */ | |
1871 | mtsp %r1,%sr5 /* Restore sr5 */ | |
1872 | mtsp %r1,%sr6 /* Restore sr6 */ | |
1873 | ||
1874 | depi 3,31,2,%r31 /* ensure return to user mode. */ | |
1875 | ||
413059f2 | 1876 | #ifdef CONFIG_64BIT |
1da177e4 LT |
1877 | /* decide whether to reset the wide mode bit |
1878 | * | |
1879 | * For a syscall, the W bit is stored in the lowest bit | |
1880 | * of sp. Extract it and reset W if it is zero */ | |
1881 | extrd,u,*<> %r30,63,1,%r1 | |
1882 | rsm PSW_SM_W, %r0 | |
1883 | /* now reset the lowest bit of sp if it was set */ | |
1884 | xor %r30,%r1,%r30 | |
1885 | #endif | |
1886 | be,n 0(%sr3,%r31) /* return to user space */ | |
1887 | ||
1888 | /* We have to return via an RFI, so that PSW T and R bits can be set | |
1889 | * appropriately. | |
1890 | * This sets up pt_regs so we can return via intr_restore, which is not | |
1891 | * the most efficient way of doing things, but it works. | |
1892 | */ | |
1893 | syscall_restore_rfi: | |
1894 | ldo -1(%r0),%r2 /* Set recovery cntr to -1 */ | |
1895 | mtctl %r2,%cr0 /* for immediate trap */ | |
1896 | LDREG TASK_PT_PSW(%r1),%r2 /* Get old PSW */ | |
1897 | ldi 0x0b,%r20 /* Create new PSW */ | |
1898 | depi -1,13,1,%r20 /* C, Q, D, and I bits */ | |
1899 | ||
ecd3d4bc KM |
1900 | /* The values of SINGLESTEP_BIT and BLOCKSTEP_BIT are |
1901 | * set in thread_info.h and converted to PA bitmap | |
1da177e4 LT |
1902 | * numbers in asm-offsets.c */ |
1903 | ||
ecd3d4bc KM |
1904 | /* if ((%r19.SINGLESTEP_BIT)) { %r20.27=1} */ |
1905 | extru,= %r19,TIF_SINGLESTEP_PA_BIT,1,%r0 | |
1da177e4 LT |
1906 | depi -1,27,1,%r20 /* R bit */ |
1907 | ||
ecd3d4bc KM |
1908 | /* if ((%r19.BLOCKSTEP_BIT)) { %r20.7=1} */ |
1909 | extru,= %r19,TIF_BLOCKSTEP_PA_BIT,1,%r0 | |
1da177e4 LT |
1910 | depi -1,7,1,%r20 /* T bit */ |
1911 | ||
1912 | STREG %r20,TASK_PT_PSW(%r1) | |
1913 | ||
1914 | /* Always store space registers, since sr3 can be changed (e.g. fork) */ | |
1915 | ||
1916 | mfsp %sr3,%r25 | |
1917 | STREG %r25,TASK_PT_SR3(%r1) | |
1918 | STREG %r25,TASK_PT_SR4(%r1) | |
1919 | STREG %r25,TASK_PT_SR5(%r1) | |
1920 | STREG %r25,TASK_PT_SR6(%r1) | |
1921 | STREG %r25,TASK_PT_SR7(%r1) | |
1922 | STREG %r25,TASK_PT_IASQ0(%r1) | |
1923 | STREG %r25,TASK_PT_IASQ1(%r1) | |
1924 | ||
1925 | /* XXX W bit??? */ | |
1926 | /* Now if old D bit is clear, it means we didn't save all registers | |
1927 | * on syscall entry, so do that now. This only happens on TRACEME | |
1928 | * calls, or if someone attached to us while we were on a syscall. | |
1929 | * We could make this more efficient by not saving r3-r18, but | |
1930 | * then we wouldn't be able to use the common intr_restore path. | |
1931 | * It is only for traced processes anyway, so performance is not | |
1932 | * an issue. | |
1933 | */ | |
1934 | bb,< %r2,30,pt_regs_ok /* Branch if D set */ | |
1935 | ldo TASK_REGS(%r1),%r25 | |
1936 | reg_save %r25 /* Save r3 to r18 */ | |
1937 | ||
1938 | /* Save the current sr */ | |
1939 | mfsp %sr0,%r2 | |
1940 | STREG %r2,TASK_PT_SR0(%r1) | |
1941 | ||
1942 | /* Save the scratch sr */ | |
1943 | mfsp %sr1,%r2 | |
1944 | STREG %r2,TASK_PT_SR1(%r1) | |
1945 | ||
1946 | /* sr2 should be set to zero for userspace syscalls */ | |
1947 | STREG %r0,TASK_PT_SR2(%r1) | |
1948 | ||
1da177e4 | 1949 | LDREG TASK_PT_GR31(%r1),%r2 |
34360f08 JDA |
1950 | depi 3,31,2,%r2 /* ensure return to user mode. */ |
1951 | STREG %r2,TASK_PT_IAOQ0(%r1) | |
1da177e4 LT |
1952 | ldo 4(%r2),%r2 |
1953 | STREG %r2,TASK_PT_IAOQ1(%r1) | |
34360f08 | 1954 | b intr_restore |
1da177e4 | 1955 | copy %r25,%r16 |
34360f08 JDA |
1956 | |
1957 | pt_regs_ok: | |
1958 | LDREG TASK_PT_IAOQ0(%r1),%r2 | |
1959 | depi 3,31,2,%r2 /* ensure return to user mode. */ | |
1960 | STREG %r2,TASK_PT_IAOQ0(%r1) | |
1961 | LDREG TASK_PT_IAOQ1(%r1),%r2 | |
1962 | depi 3,31,2,%r2 | |
1963 | STREG %r2,TASK_PT_IAOQ1(%r1) | |
1da177e4 | 1964 | b intr_restore |
34360f08 | 1965 | copy %r25,%r16 |
1da177e4 | 1966 | |
1da177e4 | 1967 | syscall_do_resched: |
366dd4ea HD |
1968 | load32 syscall_check_resched,%r2 /* if resched, we start over again */ |
1969 | load32 schedule,%r19 | |
1970 | bv %r0(%r19) /* jumps to schedule() */ | |
413059f2 | 1971 | #ifdef CONFIG_64BIT |
1da177e4 LT |
1972 | ldo -16(%r30),%r29 /* Reference param save area */ |
1973 | #else | |
1974 | nop | |
1975 | #endif | |
f39cce65 | 1976 | ENDPROC_CFI(syscall_exit) |
1da177e4 | 1977 | |
c5e76552 | 1978 | |
d75f054a | 1979 | #ifdef CONFIG_FUNCTION_TRACER |
366dd4ea | 1980 | |
d75f054a | 1981 | .import ftrace_function_trampoline,code |
366dd4ea HD |
1982 | .align L1_CACHE_BYTES |
1983 | .globl mcount | |
1984 | .type mcount, @function | |
1985 | ENTRY(mcount) | |
1986 | _mcount: | |
1987 | .export _mcount,data | |
1988 | .proc | |
1989 | .callinfo caller,frame=0 | |
1990 | .entry | |
1991 | /* | |
1992 | * The 64bit mcount() function pointer needs 4 dwords, of which the | |
1993 | * first two are free. We optimize it here and put 2 instructions for | |
1994 | * calling mcount(), and 2 instructions for ftrace_stub(). That way we | |
1995 | * have all on one L1 cacheline. | |
1996 | */ | |
d75f054a | 1997 | b ftrace_function_trampoline |
366dd4ea HD |
1998 | copy %r3, %arg2 /* caller original %sp */ |
1999 | ftrace_stub: | |
2000 | .globl ftrace_stub | |
2001 | .type ftrace_stub, @function | |
2002 | #ifdef CONFIG_64BIT | |
2003 | bve (%rp) | |
2004 | #else | |
2005 | bv %r0(%rp) | |
2006 | #endif | |
d75f054a | 2007 | nop |
366dd4ea HD |
2008 | #ifdef CONFIG_64BIT |
2009 | .dword mcount | |
2010 | .dword 0 /* code in head.S puts value of global gp here */ | |
2011 | #endif | |
2012 | .exit | |
2013 | .procend | |
2014 | ENDPROC(mcount) | |
d75f054a | 2015 | |
5fece5ad | 2016 | #ifdef CONFIG_FUNCTION_GRAPH_TRACER |
366dd4ea HD |
2017 | .align 8 |
2018 | .globl return_to_handler | |
2019 | .type return_to_handler, @function | |
f39cce65 | 2020 | ENTRY_CFI(return_to_handler) |
366dd4ea HD |
2021 | .proc |
2022 | .callinfo caller,frame=FRAME_SIZE | |
2023 | .entry | |
2024 | .export parisc_return_to_handler,data | |
2025 | parisc_return_to_handler: | |
2026 | copy %r3,%r1 | |
2027 | STREG %r0,-RP_OFFSET(%sp) /* store 0 as %rp */ | |
2028 | copy %sp,%r3 | |
2029 | STREGM %r1,FRAME_SIZE(%sp) | |
2030 | STREG %ret0,8(%r3) | |
2031 | STREG %ret1,16(%r3) | |
d75f054a | 2032 | |
366dd4ea HD |
2033 | #ifdef CONFIG_64BIT |
2034 | loadgp | |
2035 | #endif | |
2036 | ||
2037 | /* call ftrace_return_to_handler(0) */ | |
5fece5ad HD |
2038 | .import ftrace_return_to_handler,code |
2039 | load32 ftrace_return_to_handler,%ret0 | |
2040 | load32 .Lftrace_ret,%r2 | |
366dd4ea HD |
2041 | #ifdef CONFIG_64BIT |
2042 | ldo -16(%sp),%ret1 /* Reference param save area */ | |
5fece5ad HD |
2043 | bve (%ret0) |
2044 | #else | |
2045 | bv %r0(%ret0) | |
366dd4ea | 2046 | #endif |
366dd4ea | 2047 | ldi 0,%r26 |
5fece5ad | 2048 | .Lftrace_ret: |
366dd4ea HD |
2049 | copy %ret0,%rp |
2050 | ||
2051 | /* restore original return values */ | |
2052 | LDREG 8(%r3),%ret0 | |
2053 | LDREG 16(%r3),%ret1 | |
2054 | ||
2055 | /* return from function */ | |
2056 | #ifdef CONFIG_64BIT | |
2057 | bve (%rp) | |
2058 | #else | |
d75f054a | 2059 | bv %r0(%rp) |
366dd4ea HD |
2060 | #endif |
2061 | LDREGM -FRAME_SIZE(%sp),%r3 | |
2062 | .exit | |
2063 | .procend | |
f39cce65 | 2064 | ENDPROC_CFI(return_to_handler) |
366dd4ea | 2065 | |
5fece5ad HD |
2066 | #endif /* CONFIG_FUNCTION_GRAPH_TRACER */ |
2067 | ||
d75f054a HD |
2068 | #endif /* CONFIG_FUNCTION_TRACER */ |
2069 | ||
200c8804 HD |
2070 | #ifdef CONFIG_IRQSTACKS |
2071 | /* void call_on_stack(unsigned long param1, void *func, | |
2072 | unsigned long new_stack) */ | |
f39cce65 | 2073 | ENTRY_CFI(call_on_stack) |
200c8804 HD |
2074 | copy %sp, %r1 |
2075 | ||
2076 | /* Regarding the HPPA calling conventions for function pointers, | |
2077 | we assume the PIC register is not changed across call. For | |
2078 | CONFIG_64BIT, the argument pointer is left to point at the | |
2079 | argument region allocated for the call to call_on_stack. */ | |
2080 | # ifdef CONFIG_64BIT | |
2081 | /* Switch to new stack. We allocate two 128 byte frames. */ | |
2082 | ldo 256(%arg2), %sp | |
2083 | /* Save previous stack pointer and return pointer in frame marker */ | |
2084 | STREG %rp, -144(%sp) | |
2085 | /* Calls always use function descriptor */ | |
2086 | LDREG 16(%arg1), %arg1 | |
2087 | bve,l (%arg1), %rp | |
2088 | STREG %r1, -136(%sp) | |
2089 | LDREG -144(%sp), %rp | |
2090 | bve (%rp) | |
2091 | LDREG -136(%sp), %sp | |
2092 | # else | |
2093 | /* Switch to new stack. We allocate two 64 byte frames. */ | |
2094 | ldo 128(%arg2), %sp | |
2095 | /* Save previous stack pointer and return pointer in frame marker */ | |
2096 | STREG %r1, -68(%sp) | |
2097 | STREG %rp, -84(%sp) | |
2098 | /* Calls use function descriptor if PLABEL bit is set */ | |
2099 | bb,>=,n %arg1, 30, 1f | |
2100 | depwi 0,31,2, %arg1 | |
2101 | LDREG 0(%arg1), %arg1 | |
2102 | 1: | |
2103 | be,l 0(%sr4,%arg1), %sr0, %r31 | |
2104 | copy %r31, %rp | |
2105 | LDREG -84(%sp), %rp | |
2106 | bv (%rp) | |
2107 | LDREG -68(%sp), %sp | |
2108 | # endif /* CONFIG_64BIT */ | |
f39cce65 | 2109 | ENDPROC_CFI(call_on_stack) |
200c8804 | 2110 | #endif /* CONFIG_IRQSTACKS */ |
d75f054a | 2111 | |
f39cce65 | 2112 | ENTRY_CFI(get_register) |
1da177e4 LT |
2113 | /* |
2114 | * get_register is used by the non access tlb miss handlers to | |
2115 | * copy the value of the general register specified in r8 into | |
2116 | * r1. This routine can't be used for shadowed registers, since | |
2117 | * the rfir will restore the original value. So, for the shadowed | |
2118 | * registers we put a -1 into r1 to indicate that the register | |
2119 | * should not be used (the register being copied could also have | |
2120 | * a -1 in it, but that is OK, it just means that we will have | |
2121 | * to use the slow path instead). | |
2122 | */ | |
1da177e4 LT |
2123 | blr %r8,%r0 |
2124 | nop | |
2125 | bv %r0(%r25) /* r0 */ | |
2126 | copy %r0,%r1 | |
2127 | bv %r0(%r25) /* r1 - shadowed */ | |
2128 | ldi -1,%r1 | |
2129 | bv %r0(%r25) /* r2 */ | |
2130 | copy %r2,%r1 | |
2131 | bv %r0(%r25) /* r3 */ | |
2132 | copy %r3,%r1 | |
2133 | bv %r0(%r25) /* r4 */ | |
2134 | copy %r4,%r1 | |
2135 | bv %r0(%r25) /* r5 */ | |
2136 | copy %r5,%r1 | |
2137 | bv %r0(%r25) /* r6 */ | |
2138 | copy %r6,%r1 | |
2139 | bv %r0(%r25) /* r7 */ | |
2140 | copy %r7,%r1 | |
2141 | bv %r0(%r25) /* r8 - shadowed */ | |
2142 | ldi -1,%r1 | |
2143 | bv %r0(%r25) /* r9 - shadowed */ | |
2144 | ldi -1,%r1 | |
2145 | bv %r0(%r25) /* r10 */ | |
2146 | copy %r10,%r1 | |
2147 | bv %r0(%r25) /* r11 */ | |
2148 | copy %r11,%r1 | |
2149 | bv %r0(%r25) /* r12 */ | |
2150 | copy %r12,%r1 | |
2151 | bv %r0(%r25) /* r13 */ | |
2152 | copy %r13,%r1 | |
2153 | bv %r0(%r25) /* r14 */ | |
2154 | copy %r14,%r1 | |
2155 | bv %r0(%r25) /* r15 */ | |
2156 | copy %r15,%r1 | |
2157 | bv %r0(%r25) /* r16 - shadowed */ | |
2158 | ldi -1,%r1 | |
2159 | bv %r0(%r25) /* r17 - shadowed */ | |
2160 | ldi -1,%r1 | |
2161 | bv %r0(%r25) /* r18 */ | |
2162 | copy %r18,%r1 | |
2163 | bv %r0(%r25) /* r19 */ | |
2164 | copy %r19,%r1 | |
2165 | bv %r0(%r25) /* r20 */ | |
2166 | copy %r20,%r1 | |
2167 | bv %r0(%r25) /* r21 */ | |
2168 | copy %r21,%r1 | |
2169 | bv %r0(%r25) /* r22 */ | |
2170 | copy %r22,%r1 | |
2171 | bv %r0(%r25) /* r23 */ | |
2172 | copy %r23,%r1 | |
2173 | bv %r0(%r25) /* r24 - shadowed */ | |
2174 | ldi -1,%r1 | |
2175 | bv %r0(%r25) /* r25 - shadowed */ | |
2176 | ldi -1,%r1 | |
2177 | bv %r0(%r25) /* r26 */ | |
2178 | copy %r26,%r1 | |
2179 | bv %r0(%r25) /* r27 */ | |
2180 | copy %r27,%r1 | |
2181 | bv %r0(%r25) /* r28 */ | |
2182 | copy %r28,%r1 | |
2183 | bv %r0(%r25) /* r29 */ | |
2184 | copy %r29,%r1 | |
2185 | bv %r0(%r25) /* r30 */ | |
2186 | copy %r30,%r1 | |
2187 | bv %r0(%r25) /* r31 */ | |
2188 | copy %r31,%r1 | |
f39cce65 | 2189 | ENDPROC_CFI(get_register) |
1da177e4 | 2190 | |
c5e76552 | 2191 | |
f39cce65 | 2192 | ENTRY_CFI(set_register) |
1da177e4 LT |
2193 | /* |
2194 | * set_register is used by the non access tlb miss handlers to | |
2195 | * copy the value of r1 into the general register specified in | |
2196 | * r8. | |
2197 | */ | |
1da177e4 LT |
2198 | blr %r8,%r0 |
2199 | nop | |
2200 | bv %r0(%r25) /* r0 (silly, but it is a place holder) */ | |
2201 | copy %r1,%r0 | |
2202 | bv %r0(%r25) /* r1 */ | |
2203 | copy %r1,%r1 | |
2204 | bv %r0(%r25) /* r2 */ | |
2205 | copy %r1,%r2 | |
2206 | bv %r0(%r25) /* r3 */ | |
2207 | copy %r1,%r3 | |
2208 | bv %r0(%r25) /* r4 */ | |
2209 | copy %r1,%r4 | |
2210 | bv %r0(%r25) /* r5 */ | |
2211 | copy %r1,%r5 | |
2212 | bv %r0(%r25) /* r6 */ | |
2213 | copy %r1,%r6 | |
2214 | bv %r0(%r25) /* r7 */ | |
2215 | copy %r1,%r7 | |
2216 | bv %r0(%r25) /* r8 */ | |
2217 | copy %r1,%r8 | |
2218 | bv %r0(%r25) /* r9 */ | |
2219 | copy %r1,%r9 | |
2220 | bv %r0(%r25) /* r10 */ | |
2221 | copy %r1,%r10 | |
2222 | bv %r0(%r25) /* r11 */ | |
2223 | copy %r1,%r11 | |
2224 | bv %r0(%r25) /* r12 */ | |
2225 | copy %r1,%r12 | |
2226 | bv %r0(%r25) /* r13 */ | |
2227 | copy %r1,%r13 | |
2228 | bv %r0(%r25) /* r14 */ | |
2229 | copy %r1,%r14 | |
2230 | bv %r0(%r25) /* r15 */ | |
2231 | copy %r1,%r15 | |
2232 | bv %r0(%r25) /* r16 */ | |
2233 | copy %r1,%r16 | |
2234 | bv %r0(%r25) /* r17 */ | |
2235 | copy %r1,%r17 | |
2236 | bv %r0(%r25) /* r18 */ | |
2237 | copy %r1,%r18 | |
2238 | bv %r0(%r25) /* r19 */ | |
2239 | copy %r1,%r19 | |
2240 | bv %r0(%r25) /* r20 */ | |
2241 | copy %r1,%r20 | |
2242 | bv %r0(%r25) /* r21 */ | |
2243 | copy %r1,%r21 | |
2244 | bv %r0(%r25) /* r22 */ | |
2245 | copy %r1,%r22 | |
2246 | bv %r0(%r25) /* r23 */ | |
2247 | copy %r1,%r23 | |
2248 | bv %r0(%r25) /* r24 */ | |
2249 | copy %r1,%r24 | |
2250 | bv %r0(%r25) /* r25 */ | |
2251 | copy %r1,%r25 | |
2252 | bv %r0(%r25) /* r26 */ | |
2253 | copy %r1,%r26 | |
2254 | bv %r0(%r25) /* r27 */ | |
2255 | copy %r1,%r27 | |
2256 | bv %r0(%r25) /* r28 */ | |
2257 | copy %r1,%r28 | |
2258 | bv %r0(%r25) /* r29 */ | |
2259 | copy %r1,%r29 | |
2260 | bv %r0(%r25) /* r30 */ | |
2261 | copy %r1,%r30 | |
2262 | bv %r0(%r25) /* r31 */ | |
2263 | copy %r1,%r31 | |
f39cce65 | 2264 | ENDPROC_CFI(set_register) |
c5e76552 | 2265 |