1 /* SPDX-License-Identifier: GPL-2.0-only */ !! 1 /* SPDX-License-Identifier: GPL-2.0-or-later
2 /* !! 2 * -*- mode: asm -*-
3 * Low-level exception handling code !! 3 *
>> 4 * linux/arch/m68k/kernel/entry.S
>> 5 *
>> 6 * Copyright (C) 1991, 1992 Linus Torvalds
>> 7 *
>> 8 * Linux/m68k support by Hamish Macdonald
>> 9 *
>> 10 * 68060 fixes by Jesper Skov
4 * 11 *
5 * Copyright (C) 2012 ARM Ltd. <<
6 * Authors: Catalin Marinas <catalin.marina <<
7 * Will Deacon <will.deacon@arm.co <<
8 */ 12 */
9 13
10 #include <linux/arm-smccc.h> <<
11 #include <linux/init.h> <<
12 #include <linux/linkage.h> <<
13 <<
14 #include <asm/alternative.h> <<
15 #include <asm/assembler.h> <<
16 #include <asm/asm-offsets.h> <<
17 #include <asm/asm_pointer_auth.h> <<
18 #include <asm/bug.h> <<
19 #include <asm/cpufeature.h> <<
20 #include <asm/errno.h> <<
21 #include <asm/esr.h> <<
22 #include <asm/irq.h> <<
23 #include <asm/memory.h> <<
24 #include <asm/mmu.h> <<
25 #include <asm/processor.h> <<
26 #include <asm/ptrace.h> <<
27 #include <asm/scs.h> <<
28 #include <asm/thread_info.h> <<
29 #include <asm/asm-uaccess.h> <<
30 #include <asm/unistd.h> <<
31 <<
32 .macro clear_gp_regs <<
33 .irp n,0,1,2,3,4,5,6,7,8,9,10,11,12 <<
34 mov x\n, xzr <<
35 .endr <<
36 .endm <<
37 <<
38 .macro kernel_ventry, el:req, ht:req, <<
39 .align 7 <<
40 .Lventry_start\@: <<
41 .if \el == 0 <<
42 /* <<
43 * This must be the first instruction <<
44 * skipped by the trampoline vectors, <<
45 */ <<
46 b .Lskip_tramp_vectors_cleanup\@ <<
47 .if \regsize == 64 <<
48 mrs x30, tpidrro_el0 <<
49 msr tpidrro_el0, xzr <<
50 .else <<
51 mov x30, xzr <<
52 .endif <<
53 .Lskip_tramp_vectors_cleanup\@: <<
54 .endif <<
55 <<
56 sub sp, sp, #PT_REGS_SIZE <<
57 #ifdef CONFIG_VMAP_STACK <<
58 /* <<
59 * Test whether the SP has overflowed, <<
60 * Task and IRQ stacks are aligned so <<
61 * should always be zero. <<
62 */ <<
63 add sp, sp, x0 <<
64 sub x0, sp, x0 <<
65 tbnz x0, #THREAD_SHIFT, 0f <<
66 sub x0, sp, x0 <<
67 sub sp, sp, x0 <<
68 b el\el\ht\()_\regsize\()_\label <<
69 <<
70 0: <<
71 /* <<
72 * Either we've just detected an overf <<
73 * while on the overflow stack. Either <<
74 * userspace, and can clobber EL0 regi <<
75 */ <<
76 <<
77 /* Stash the original SP (minus PT_REG <<
78 msr tpidr_el0, x0 <<
79 <<
80 /* Recover the original x0 value and s <<
81 sub x0, sp, x0 <<
82 msr tpidrro_el0, x0 <<
83 <<
84 /* Switch to the overflow stack */ <<
85 adr_this_cpu sp, overflow_stack + OVER <<
86 <<
87 /* <<
88 * Check whether we were already on th <<
89 * after panic() re-enables interrupts <<
90 */ <<
91 mrs x0, tpidr_el0 <<
92 sub x0, sp, x0 <<
93 tst x0, #~(OVERFLOW_STACK_SIZE - 1 <<
94 b.ne __bad_stack <<
95 <<
96 /* We were already on the overflow sta <<
97 sub sp, sp, x0 <<
98 mrs x0, tpidrro_el0 <<
99 #endif <<
100 b el\el\ht\()_\regsize\()_\label <<
101 .org .Lventry_start\@ + 128 // Did we over <<
102 .endm <<
103 <<
104 .macro tramp_alias, dst, sym <<
105 .set .Lalias\@, TRAMP_VALIAS + \sym <<
106 movz \dst, :abs_g2_s:.Lalias\@ <<
107 movk \dst, :abs_g1_nc:.Lalias\@ <<
108 movk \dst, :abs_g0_nc:.Lalias\@ <<
109 .endm <<
110 <<
111 /* <<
112 * This macro corrupts x0-x3. It is th <<
113 * them if required. <<
114 */ <<
115 .macro apply_ssbd, state, tmp1, tmp2 <<
116 alternative_cb ARM64_ALWAYS_SYSTEM, spectre_v <<
117 b .L__asm_ssbd_skip\@ <<
118 alternative_cb_end <<
119 ldr_this_cpu \tmp2, arm64_ssbd_call <<
120 cbz \tmp2, .L__asm_ssbd_skip\@ <<
121 ldr \tmp2, [tsk, #TSK_TI_FLAGS] <<
122 tbnz \tmp2, #TIF_SSBD, .L__asm_ssbd <<
123 mov w0, #ARM_SMCCC_ARCH_WORKAROUND <<
124 mov w1, #\state <<
125 alternative_cb ARM64_ALWAYS_SYSTEM, smccc_pat <<
126 nop <<
127 alternative_cb_end <<
128 .L__asm_ssbd_skip\@: <<
129 .endm <<
130 <<
131 /* Check for MTE asynchronous tag chec <<
132 .macro check_mte_async_tcf, tmp, ti_fl <<
133 #ifdef CONFIG_ARM64_MTE <<
134 .arch_extension lse <<
135 alternative_if_not ARM64_MTE <<
136 b 1f <<
137 alternative_else_nop_endif <<
138 /* <<
139 * Asynchronous tag check faults are o <<
140 * ASYM (3) modes. In each of these mo <<
141 * set, so skip the check if it is uns <<
142 */ <<
143 tbz \thread_sctlr, #(SCTLR_EL1_TCF <<
144 mrs_s \tmp, SYS_TFSRE0_EL1 <<
145 tbz \tmp, #SYS_TFSR_EL1_TF0_SHIFT, <<
146 /* Asynchronous TCF occurred for TTBR0 <<
147 mov \tmp, #_TIF_MTE_ASYNC_FAULT <<
148 add \ti_flags, tsk, #TSK_TI_FLAGS <<
149 stset \tmp, [\ti_flags] <<
150 1: <<
151 #endif <<
152 .endm <<
153 <<
154 /* Clear the MTE asynchronous tag chec <<
155 .macro clear_mte_async_tcf thread_sctl <<
156 #ifdef CONFIG_ARM64_MTE <<
157 alternative_if ARM64_MTE <<
158 /* See comment in check_mte_async_tcf <<
159 tbz \thread_sctlr, #(SCTLR_EL1_TCF <<
160 dsb ish <<
161 msr_s SYS_TFSRE0_EL1, xzr <<
162 1: <<
163 alternative_else_nop_endif <<
164 #endif <<
165 .endm <<
166 <<
167 .macro mte_set_gcr, mte_ctrl, tmp <<
168 #ifdef CONFIG_ARM64_MTE <<
169 ubfx \tmp, \mte_ctrl, #MTE_CTRL_GCR <<
170 orr \tmp, \tmp, #SYS_GCR_EL1_RRND <<
171 msr_s SYS_GCR_EL1, \tmp <<
172 #endif <<
173 .endm <<
174 <<
175 .macro mte_set_kernel_gcr, tmp, tmp2 <<
176 #ifdef CONFIG_KASAN_HW_TAGS <<
177 alternative_cb ARM64_ALWAYS_SYSTEM, kasan_hw_ <<
178 b 1f <<
179 alternative_cb_end <<
180 mov \tmp, KERNEL_GCR_EL1 <<
181 msr_s SYS_GCR_EL1, \tmp <<
182 1: <<
183 #endif <<
184 .endm <<
185 <<
186 .macro mte_set_user_gcr, tsk, tmp, tmp <<
187 #ifdef CONFIG_KASAN_HW_TAGS <<
188 alternative_cb ARM64_ALWAYS_SYSTEM, kasan_hw_ <<
189 b 1f <<
190 alternative_cb_end <<
191 ldr \tmp, [\tsk, #THREAD_MTE_CTRL] <<
192 <<
193 mte_set_gcr \tmp, \tmp2 <<
194 1: <<
195 #endif <<
196 .endm <<
197 <<
198 .macro kernel_entry, el, regsize = 64 <<
199 .if \el == 0 <<
200 alternative_insn nop, SET_PSTATE_DIT(1 <<
201 .endif <<
202 .if \regsize == 32 <<
203 mov w0, w0 <<
204 .endif <<
205 stp x0, x1, [sp, #16 * 0] <<
206 stp x2, x3, [sp, #16 * 1] <<
207 stp x4, x5, [sp, #16 * 2] <<
208 stp x6, x7, [sp, #16 * 3] <<
209 stp x8, x9, [sp, #16 * 4] <<
210 stp x10, x11, [sp, #16 * 5] <<
211 stp x12, x13, [sp, #16 * 6] <<
212 stp x14, x15, [sp, #16 * 7] <<
213 stp x16, x17, [sp, #16 * 8] <<
214 stp x18, x19, [sp, #16 * 9] <<
215 stp x20, x21, [sp, #16 * 10] <<
216 stp x22, x23, [sp, #16 * 11] <<
217 stp x24, x25, [sp, #16 * 12] <<
218 stp x26, x27, [sp, #16 * 13] <<
219 stp x28, x29, [sp, #16 * 14] <<
220 <<
221 .if \el == 0 <<
222 clear_gp_regs <<
223 mrs x21, sp_el0 <<
224 ldr_this_cpu tsk, __entry_task, x20 <<
225 msr sp_el0, tsk <<
226 <<
227 /* <<
228 * Ensure MDSCR_EL1.SS is clear, since <<
229 * when scheduling. <<
230 */ <<
231 ldr x19, [tsk, #TSK_TI_FLAGS] <<
232 disable_step_tsk x19, x20 <<
233 <<
234 /* Check for asynchronous tag check fa <<
235 ldr x0, [tsk, THREAD_SCTLR_USER] <<
236 check_mte_async_tcf x22, x23, x0 <<
237 <<
238 #ifdef CONFIG_ARM64_PTR_AUTH <<
239 alternative_if ARM64_HAS_ADDRESS_AUTH <<
240 /* <<
241 * Enable IA for in-kernel PAC if the <<
242 * this could be implemented with an u <<
243 * a load, this was measured to be slo <<
244 * <<
245 * Install the kernel IA key only if I <<
246 * was disabled on kernel exit then we <<
247 * installed so there is no need to in <<
248 */ <<
249 tbz x0, SCTLR_ELx_ENIA_SHIFT, 1f <<
250 __ptrauth_keys_install_kernel_nosync t <<
251 b 2f <<
252 1: <<
253 mrs x0, sctlr_el1 <<
254 orr x0, x0, SCTLR_ELx_ENIA <<
255 msr sctlr_el1, x0 <<
256 2: <<
257 alternative_else_nop_endif <<
258 #endif <<
259 <<
260 apply_ssbd 1, x22, x23 <<
261 <<
262 mte_set_kernel_gcr x22, x23 <<
263 <<
264 /* <<
265 * Any non-self-synchronizing system r <<
266 * kernel entry should be placed befor <<
267 */ <<
268 alternative_if ARM64_MTE <<
269 isb <<
270 b 1f <<
271 alternative_else_nop_endif <<
272 alternative_if ARM64_HAS_ADDRESS_AUTH <<
273 isb <<
274 alternative_else_nop_endif <<
275 1: <<
276 <<
277 scs_load_current <<
278 .else <<
279 add x21, sp, #PT_REGS_SIZE <<
280 get_current_task tsk <<
281 .endif /* \el == 0 */ <<
282 mrs x22, elr_el1 <<
283 mrs x23, spsr_el1 <<
284 stp lr, x21, [sp, #S_LR] <<
285 <<
286 /* <<
287 * For exceptions from EL0, create a f <<
288 * For exceptions from EL1, create a s <<
289 * interrupted code shows up in the ba <<
290 */ <<
291 .if \el == 0 <<
292 stp xzr, xzr, [sp, #S_STACKFRAME] <<
293 .else <<
294 stp x29, x22, [sp, #S_STACKFRAME] <<
295 .endif <<
296 add x29, sp, #S_STACKFRAME <<
297 <<
298 #ifdef CONFIG_ARM64_SW_TTBR0_PAN <<
299 alternative_if_not ARM64_HAS_PAN <<
300 bl __swpan_entry_el\el <<
301 alternative_else_nop_endif <<
302 #endif <<
303 <<
304 stp x22, x23, [sp, #S_PC] <<
305 <<
306 /* Not in a syscall by default (el0_sv <<
307 .if \el == 0 <<
308 mov w21, #NO_SYSCALL <<
309 str w21, [sp, #S_SYSCALLNO] <<
310 .endif <<
311 <<
312 #ifdef CONFIG_ARM64_PSEUDO_NMI <<
313 alternative_if_not ARM64_HAS_GIC_PRIO_MASKING <<
314 b .Lskip_pmr_save\@ <<
315 alternative_else_nop_endif <<
316 <<
317 mrs_s x20, SYS_ICC_PMR_EL1 <<
318 str x20, [sp, #S_PMR_SAVE] <<
319 mov x20, #GIC_PRIO_IRQON | GIC_PRI <<
320 msr_s SYS_ICC_PMR_EL1, x20 <<
321 <<
322 .Lskip_pmr_save\@: <<
323 #endif <<
324 <<
325 /* <<
326 * Registers that may be useful after <<
327 * <<
328 * x20 - ICC_PMR_EL1 <<
329 * x21 - aborted SP <<
330 * x22 - aborted PC <<
331 * x23 - aborted PSTATE <<
332 */ <<
333 .endm <<
334 <<
335 .macro kernel_exit, el <<
336 .if \el != 0 <<
337 disable_daif <<
338 .endif <<
339 <<
340 #ifdef CONFIG_ARM64_PSEUDO_NMI <<
341 alternative_if_not ARM64_HAS_GIC_PRIO_MASKING <<
342 b .Lskip_pmr_restore\@ <<
343 alternative_else_nop_endif <<
344 <<
345 ldr x20, [sp, #S_PMR_SAVE] <<
346 msr_s SYS_ICC_PMR_EL1, x20 <<
347 <<
348 /* Ensure priority change is seen by r <<
349 alternative_if_not ARM64_HAS_GIC_PRIO_RELAXED_ <<
350 dsb sy <<
351 alternative_else_nop_endif <<
352 <<
353 .Lskip_pmr_restore\@: <<
354 #endif <<
355 <<
356 ldp x21, x22, [sp, #S_PC] <<
357 <<
358 #ifdef CONFIG_ARM64_SW_TTBR0_PAN <<
359 alternative_if_not ARM64_HAS_PAN <<
360 bl __swpan_exit_el\el <<
361 alternative_else_nop_endif <<
362 #endif <<
363 <<
364 .if \el == 0 <<
365 ldr x23, [sp, #S_SP] <<
366 msr sp_el0, x23 <<
367 tst x22, #PSR_MODE32_BIT <<
368 b.eq 3f <<
369 <<
370 #ifdef CONFIG_ARM64_ERRATUM_845719 <<
371 alternative_if ARM64_WORKAROUND_845719 <<
372 #ifdef CONFIG_PID_IN_CONTEXTIDR <<
373 mrs x29, contextidr_el1 <<
374 msr contextidr_el1, x29 <<
375 #else <<
376 msr contextidr_el1, xzr <<
377 #endif <<
378 alternative_else_nop_endif <<
379 #endif <<
380 3: <<
381 scs_save tsk <<
382 <<
383 /* Ignore asynchronous tag check fault <<
384 ldr x0, [tsk, THREAD_SCTLR_USER] <<
385 clear_mte_async_tcf x0 <<
386 <<
387 #ifdef CONFIG_ARM64_PTR_AUTH <<
388 alternative_if ARM64_HAS_ADDRESS_AUTH <<
389 /* <<
390 * IA was enabled for in-kernel PAC. D <<
391 * alternatively install the user's IA <<
392 * SCTLR bits were updated on task swi <<
393 * <<
394 * No kernel C function calls after th <<
395 */ <<
396 tbz x0, SCTLR_ELx_ENIA_SHIFT, 1f <<
397 __ptrauth_keys_install_user tsk, x0, x <<
398 b 2f <<
399 1: <<
400 mrs x0, sctlr_el1 <<
401 bic x0, x0, SCTLR_ELx_ENIA <<
402 msr sctlr_el1, x0 <<
403 2: <<
404 alternative_else_nop_endif <<
405 #endif <<
406 <<
407 mte_set_user_gcr tsk, x0, x1 <<
408 <<
409 apply_ssbd 0, x0, x1 <<
410 .endif <<
411 <<
412 msr elr_el1, x21 <<
413 msr spsr_el1, x22 <<
414 ldp x0, x1, [sp, #16 * 0] <<
415 ldp x2, x3, [sp, #16 * 1] <<
416 ldp x4, x5, [sp, #16 * 2] <<
417 ldp x6, x7, [sp, #16 * 3] <<
418 ldp x8, x9, [sp, #16 * 4] <<
419 ldp x10, x11, [sp, #16 * 5] <<
420 ldp x12, x13, [sp, #16 * 6] <<
421 ldp x14, x15, [sp, #16 * 7] <<
422 ldp x16, x17, [sp, #16 * 8] <<
423 ldp x18, x19, [sp, #16 * 9] <<
424 ldp x20, x21, [sp, #16 * 10] <<
425 ldp x22, x23, [sp, #16 * 11] <<
426 ldp x24, x25, [sp, #16 * 12] <<
427 ldp x26, x27, [sp, #16 * 13] <<
428 ldp x28, x29, [sp, #16 * 14] <<
429 <<
430 .if \el == 0 <<
431 #ifdef CONFIG_UNMAP_KERNEL_AT_EL0 <<
432 alternative_insn "b .L_skip_tramp_exit <<
433 <<
434 msr far_el1, x29 <<
435 <<
436 ldr_this_cpu x30, this_cpu_vector, <<
437 tramp_alias x29, tramp_exit <<
438 msr vbar_el1, x30 <<
439 ldr lr, [sp, #S_LR] <<
440 add sp, sp, #PT_REGS_SIZE <<
441 br x29 <<
442 <<
443 .L_skip_tramp_exit_\@: <<
444 #endif <<
445 .endif <<
446 <<
447 ldr lr, [sp, #S_LR] <<
448 add sp, sp, #PT_REGS_SIZE <<
449 <<
450 .if \el == 0 <<
451 /* This must be after the last explici <<
452 alternative_if ARM64_WORKAROUND_SPECULATIVE_UN <<
453 tlbi vale1, xzr <<
454 dsb nsh <<
455 alternative_else_nop_endif <<
456 .else <<
457 /* Ensure any device/NC reads complete <<
458 alternative_insn nop, "dmb sy", ARM64_ <<
459 .endif <<
460 <<
461 eret <<
462 sb <<
463 .endm <<
464 <<
465 #ifdef CONFIG_ARM64_SW_TTBR0_PAN <<
466 /* <<
467 * Set the TTBR0 PAN bit in SPSR. When <<
468 * EL0, there is no need to check the <<
469 * accesses are always enabled. <<
470 * Note that the meaning of this bit d <<
471 * feature as all TTBR0_EL1 accesses a <<
472 * user mappings. <<
473 */ <<
474 SYM_CODE_START_LOCAL(__swpan_entry_el1) <<
475 mrs x21, ttbr0_el1 <<
476 tst x21, #TTBR_ASID_MASK <<
477 orr x23, x23, #PSR_PAN_BIT <<
478 b.eq 1f <<
479 and x23, x23, #~PSR_PAN_BIT <<
480 SYM_INNER_LABEL(__swpan_entry_el0, SYM_L_LOCAL <<
481 __uaccess_ttbr0_disable x21 <<
482 1: ret <<
483 SYM_CODE_END(__swpan_entry_el1) <<
484 <<
485 /* <<
486 * Restore access to TTBR0_EL1. If ret <<
487 * PAN bit checking. <<
488 */ <<
489 SYM_CODE_START_LOCAL(__swpan_exit_el1) <<
490 tbnz x22, #22, 1f <<
491 __uaccess_ttbr0_enable x0, x1 <<
492 1: and x22, x22, #~PSR_PAN_BIT <<
493 ret <<
494 SYM_CODE_END(__swpan_exit_el1) <<
495 <<
496 SYM_CODE_START_LOCAL(__swpan_exit_el0) <<
497 __uaccess_ttbr0_enable x0, x1 <<
498 /* <<
499 * Enable errata workarounds only if r <<
500 * workaround currently required for T <<
501 * Cavium erratum 27456 (broadcast TLB <<
502 * corruption). <<
503 */ <<
504 b post_ttbr_update_workaround <<
505 SYM_CODE_END(__swpan_exit_el0) <<
506 #endif <<
507 <<
508 /* GPRs used by entry code */ <<
509 tsk .req x28 // current thr <<
510 <<
511 .text <<
512 <<
513 /* 14 /*
514 * Exception vectors. !! 15 * entry.S contains the system-call and fault low-level handling routines.
>> 16 * This also contains the timer-interrupt handler, as well as all interrupts
>> 17 * and faults that can result in a task-switch.
>> 18 *
>> 19 * NOTE: This code handles signal-recognition, which happens every time
>> 20 * after a timer-interrupt and after each system call.
>> 21 *
515 */ 22 */
516 .pushsection ".entry.text", "ax" <<
517 <<
518 .align 11 <<
519 SYM_CODE_START(vectors) <<
520 kernel_ventry 1, t, 64, sync <<
521 kernel_ventry 1, t, 64, irq <<
522 kernel_ventry 1, t, 64, fiq <<
523 kernel_ventry 1, t, 64, error <<
524 <<
525 kernel_ventry 1, h, 64, sync <<
526 kernel_ventry 1, h, 64, irq <<
527 kernel_ventry 1, h, 64, fiq <<
528 kernel_ventry 1, h, 64, error <<
529 <<
530 kernel_ventry 0, t, 64, sync <<
531 kernel_ventry 0, t, 64, irq <<
532 kernel_ventry 0, t, 64, fiq <<
533 kernel_ventry 0, t, 64, error <<
534 <<
535 kernel_ventry 0, t, 32, sync <<
536 kernel_ventry 0, t, 32, irq <<
537 kernel_ventry 0, t, 32, fiq <<
538 kernel_ventry 0, t, 32, error <<
539 SYM_CODE_END(vectors) <<
540 <<
541 #ifdef CONFIG_VMAP_STACK <<
542 SYM_CODE_START_LOCAL(__bad_stack) <<
543 /* <<
544 * We detected an overflow in kernel_v <<
545 * overflow stack. Stash the exception <<
546 * handler. <<
547 */ <<
548 <<
549 /* Restore the original x0 value */ <<
550 mrs x0, tpidrro_el0 <<
551 <<
552 /* <<
553 * Store the original GPRs to the new <<
554 * PT_REGS_SIZE) was stashed in tpidr_ <<
555 */ <<
556 sub sp, sp, #PT_REGS_SIZE <<
557 kernel_entry 1 <<
558 mrs x0, tpidr_el0 <<
559 add x0, x0, #PT_REGS_SIZE <<
560 str x0, [sp, #S_SP] <<
561 <<
562 /* Stash the regs for handle_bad_stack <<
563 mov x0, sp <<
564 <<
565 /* Time to die */ <<
566 bl handle_bad_stack <<
567 ASM_BUG() <<
568 SYM_CODE_END(__bad_stack) <<
569 #endif /* CONFIG_VMAP_STACK */ <<
570 <<
571 <<
572 .macro entry_handler el:req, ht:req, r <<
573 SYM_CODE_START_LOCAL(el\el\ht\()_\regsize\()_\ <<
574 kernel_entry \el, \regsize <<
575 mov x0, sp <<
576 bl el\el\ht\()_\regsize\()_\label <<
577 .if \el == 0 <<
578 b ret_to_user <<
579 .else <<
580 b ret_to_kernel <<
581 .endif <<
582 SYM_CODE_END(el\el\ht\()_\regsize\()_\label) <<
583 .endm <<
584 23
585 /* 24 /*
586 * Early exception handlers !! 25 * 12/03/96 Jes: Currently we only support m68k single-cpu systems, so
>> 26 * all pointers that used to be 'current' are now entry
>> 27 * number 0 in the 'current_set' list.
>> 28 *
>> 29 * 6/05/00 RZ: addedd writeback completion after return from sighandler
>> 30 * for 68040
587 */ 31 */
588 entry_handler 1, t, 64, sync <<
589 entry_handler 1, t, 64, irq <<
590 entry_handler 1, t, 64, fiq <<
591 entry_handler 1, t, 64, error <<
592 <<
593 entry_handler 1, h, 64, sync <<
594 entry_handler 1, h, 64, irq <<
595 entry_handler 1, h, 64, fiq <<
596 entry_handler 1, h, 64, error <<
597 <<
598 entry_handler 0, t, 64, sync <<
599 entry_handler 0, t, 64, irq <<
600 entry_handler 0, t, 64, fiq <<
601 entry_handler 0, t, 64, error <<
602 <<
603 entry_handler 0, t, 32, sync <<
604 entry_handler 0, t, 32, irq <<
605 entry_handler 0, t, 32, fiq <<
606 entry_handler 0, t, 32, error <<
607 <<
608 SYM_CODE_START_LOCAL(ret_to_kernel) <<
609 kernel_exit 1 <<
610 SYM_CODE_END(ret_to_kernel) <<
611 <<
612 SYM_CODE_START_LOCAL(ret_to_user) <<
613 ldr x19, [tsk, #TSK_TI_FLAGS] <<
614 enable_step_tsk x19, x2 <<
615 #ifdef CONFIG_GCC_PLUGIN_STACKLEAK <<
616 bl stackleak_erase_on_task_stack <<
617 #endif <<
618 kernel_exit 0 <<
619 SYM_CODE_END(ret_to_user) <<
620 <<
621 .popsection <<
622 <<
623 // Move from tramp_pg_dir to swapper_p <<
624 .macro tramp_map_kernel, tmp <<
625 mrs \tmp, ttbr1_el1 <<
626 add \tmp, \tmp, #TRAMP_SWAPPER_OFF <<
627 bic \tmp, \tmp, #USER_ASID_FLAG <<
628 msr ttbr1_el1, \tmp <<
629 #ifdef CONFIG_QCOM_FALKOR_ERRATUM_1003 <<
630 alternative_if ARM64_WORKAROUND_QCOM_FALKOR_E1 <<
631 /* ASID already in \tmp[63:48] */ <<
632 movk \tmp, #:abs_g2_nc:(TRAMP_VALIA <<
633 movk \tmp, #:abs_g1_nc:(TRAMP_VALIA <<
634 /* 2MB boundary containing the vectors <<
635 movk \tmp, #:abs_g0_nc:((TRAMP_VALI <<
636 isb <<
637 tlbi vae1, \tmp <<
638 dsb nsh <<
639 alternative_else_nop_endif <<
640 #endif /* CONFIG_QCOM_FALKOR_ERRATUM_1003 */ <<
641 .endm <<
642 <<
643 // Move from swapper_pg_dir to tramp_p <<
644 .macro tramp_unmap_kernel, tmp <<
645 mrs \tmp, ttbr1_el1 <<
646 sub \tmp, \tmp, #TRAMP_SWAPPER_OFF <<
647 orr \tmp, \tmp, #USER_ASID_FLAG <<
648 msr ttbr1_el1, \tmp <<
649 /* <<
650 * We avoid running the post_ttbr_upda <<
651 * it's only needed by Cavium ThunderX <<
652 * disabled. <<
653 */ <<
654 .endm <<
655 32
656 .macro tramp_data_read_var !! 33 #include <linux/linkage.h>
657 #ifdef CONFIG_RELOCATABLE !! 34 #include <asm/errno.h>
658 ldr \dst, .L__tramp_data_\ !! 35 #include <asm/setup.h>
659 .ifndef .L__tramp_data_\var !! 36 #include <asm/traps.h>
660 .pushsection ".entry.tramp.rodata", !! 37 #include <asm/unistd.h>
661 .align 3 !! 38 #include <asm/asm-offsets.h>
662 .L__tramp_data_\var: !! 39 #include <asm/entry.h>
663 .quad \var <<
664 .popsection <<
665 .endif <<
666 #else <<
667 /* <<
668 * As !RELOCATABLE implies !RANDOMIZE_ <<
669 * compile time constant (and hence no <<
670 * <<
671 * As statically allocated kernel code <<
672 * 47 bits of the address space we can <<
673 * instruction to load the upper 16 bi <<
674 */ <<
675 movz \dst, :abs_g2_s:\var <<
676 movk \dst, :abs_g1_nc:\var <<
677 movk \dst, :abs_g0_nc:\var <<
678 #endif <<
679 .endm <<
680 40
681 #define BHB_MITIGATION_NONE 0 !! 41 .globl system_call, buserr, trap, resume
682 #define BHB_MITIGATION_LOOP 1 !! 42 .globl sys_call_table
683 #define BHB_MITIGATION_FW 2 !! 43 .globl __sys_fork, __sys_clone, __sys_vfork
684 #define BHB_MITIGATION_INSN 3 !! 44 .globl bad_interrupt
>> 45 .globl auto_irqhandler_fixup
>> 46 .globl user_irqvec_fixup
>> 47
>> 48 .text
>> 49 ENTRY(__sys_fork)
>> 50 SAVE_SWITCH_STACK
>> 51 jbsr sys_fork
>> 52 lea %sp@(24),%sp
>> 53 rts
>> 54
>> 55 ENTRY(__sys_clone)
>> 56 SAVE_SWITCH_STACK
>> 57 pea %sp@(SWITCH_STACK_SIZE)
>> 58 jbsr m68k_clone
>> 59 lea %sp@(28),%sp
>> 60 rts
>> 61
>> 62 ENTRY(__sys_vfork)
>> 63 SAVE_SWITCH_STACK
>> 64 jbsr sys_vfork
>> 65 lea %sp@(24),%sp
>> 66 rts
>> 67
>> 68 ENTRY(__sys_clone3)
>> 69 SAVE_SWITCH_STACK
>> 70 pea %sp@(SWITCH_STACK_SIZE)
>> 71 jbsr m68k_clone3
>> 72 lea %sp@(28),%sp
>> 73 rts
>> 74
>> 75 ENTRY(sys_sigreturn)
>> 76 SAVE_SWITCH_STACK
>> 77 movel %sp,%a1 | switch_stack pointer
>> 78 lea %sp@(SWITCH_STACK_SIZE),%a0 | pt_regs pointer
>> 79 lea %sp@(-84),%sp | leave a gap
>> 80 movel %a1,%sp@-
>> 81 movel %a0,%sp@-
>> 82 jbsr do_sigreturn
>> 83 jra 1f | shared with rt_sigreturn()
>> 84
>> 85 ENTRY(sys_rt_sigreturn)
>> 86 SAVE_SWITCH_STACK
>> 87 movel %sp,%a1 | switch_stack pointer
>> 88 lea %sp@(SWITCH_STACK_SIZE),%a0 | pt_regs pointer
>> 89 lea %sp@(-84),%sp | leave a gap
>> 90 movel %a1,%sp@-
>> 91 movel %a0,%sp@-
>> 92 | stack contents:
>> 93 | [original pt_regs address] [original switch_stack address]
>> 94 | [gap] [switch_stack] [pt_regs] [exception frame]
>> 95 jbsr do_rt_sigreturn
685 96
686 .macro tramp_ventry, vector_start, reg <<
687 .align 7 <<
688 1: 97 1:
689 .if \regsize == 64 !! 98 | stack contents now:
690 msr tpidrro_el0, x30 // Res !! 99 | [original pt_regs address] [original switch_stack address]
691 .endif !! 100 | [unused part of the gap] [moved switch_stack] [moved pt_regs]
692 !! 101 | [replacement exception frame]
693 .if \bhb == BHB_MITIGATION_LOOP !! 102 | return value of do_{rt_,}sigreturn() points to moved switch_stack.
694 /* !! 103
695 * This sequence must appear before th !! 104 movel %d0,%sp | discard the leftover junk
696 * ret out of tramp_ventry. It appears !! 105 RESTORE_SWITCH_STACK
697 */ !! 106 | stack contents now is just [syscall return address] [pt_regs] [frame]
698 __mitigate_spectre_bhb_loop x30 !! 107 | return pt_regs.d0
699 .endif // \bhb == BHB_MITIGATION_LOOP !! 108 movel %sp@(PT_OFF_D0+4),%d0
700 !! 109 rts
701 .if \bhb == BHB_MITIGATION_INSN !! 110
702 clearbhb !! 111 ENTRY(buserr)
703 isb !! 112 SAVE_ALL_INT
704 .endif // \bhb == BHB_MITIGATION_INSN !! 113 GET_CURRENT(%d0)
705 !! 114 movel %sp,%sp@- | stack frame pointer argument
706 .if \kpti == 1 !! 115 jbsr buserr_c
707 /* !! 116 addql #4,%sp
708 * Defend against branch aliasing atta !! 117 jra ret_from_exception
709 * entry onto the return stack and usi !! 118
710 * enter the full-fat kernel vectors. !! 119 ENTRY(trap)
711 */ !! 120 SAVE_ALL_INT
712 bl 2f !! 121 GET_CURRENT(%d0)
713 b . !! 122 movel %sp,%sp@- | stack frame pointer argument
714 2: !! 123 jbsr trap_c
715 tramp_map_kernel x30 !! 124 addql #4,%sp
716 alternative_insn isb, nop, ARM64_WORKAROUND_QC !! 125 jra ret_from_exception
717 tramp_data_read_var x30, vectors !! 126
718 alternative_if_not ARM64_WORKAROUND_CAVIUM_TX2 !! 127 | After a fork we jump here directly from resume,
719 prfm plil1strm, [x30, #(1b - \vecto !! 128 | so that %d1 contains the previous task
720 alternative_else_nop_endif !! 129 | schedule_tail now used regardless of CONFIG_SMP
721 !! 130 ENTRY(ret_from_fork)
722 msr vbar_el1, x30 !! 131 movel %d1,%sp@-
723 isb !! 132 jsr schedule_tail
724 .else !! 133 addql #4,%sp
725 adr_l x30, vectors !! 134 jra ret_from_exception
726 .endif // \kpti == 1 !! 135
727 !! 136 ENTRY(ret_from_kernel_thread)
728 .if \bhb == BHB_MITIGATION_FW !! 137 | a3 contains the kernel thread payload, d7 - its argument
729 /* !! 138 movel %d1,%sp@-
730 * The firmware sequence must appear b !! 139 jsr schedule_tail
731 * i.e. the ret out of tramp_ventry. B !! 140 movel %d7,(%sp)
732 * mapped to save/restore the register !! 141 jsr %a3@
733 */ !! 142 addql #4,%sp
734 __mitigate_spectre_bhb_fw !! 143 jra ret_from_exception
735 .endif // \bhb == BHB_MITIGATION_FW !! 144
736 !! 145 #if defined(CONFIG_COLDFIRE) || !defined(CONFIG_MMU)
737 add x30, x30, #(1b - \vector_start !! 146
738 ret !! 147 #ifdef TRAP_DBG_INTERRUPT
739 .org 1b + 128 // Did we overflow the ventry !! 148
740 .endm !! 149 .globl dbginterrupt
741 !! 150 ENTRY(dbginterrupt)
742 .macro generate_tramp_vector, kpti, !! 151 SAVE_ALL_INT
743 .Lvector_start\@: !! 152 GET_CURRENT(%d0)
744 .space 0x400 !! 153 movel %sp,%sp@- /* stack frame pointer argument */
745 !! 154 jsr dbginterrupt_c
746 .rept 4 !! 155 addql #4,%sp
747 tramp_ventry .Lvector_start\@, 64, !! 156 jra ret_from_exception
748 .endr !! 157 #endif
749 .rept 4 !! 158
750 tramp_ventry .Lvector_start\@, 32, !! 159 ENTRY(reschedule)
751 .endr !! 160 /* save top of frame */
752 .endm !! 161 pea %sp@
753 !! 162 jbsr set_esp0
754 #ifdef CONFIG_UNMAP_KERNEL_AT_EL0 !! 163 addql #4,%sp
755 /* !! 164 pea ret_from_exception
756 * Exception vectors trampoline. !! 165 jmp schedule
757 * The order must match __bp_harden_el1_vector !! 166
758 * arm64_bp_harden_el1_vectors enum. !! 167 ENTRY(ret_from_user_signal)
759 */ !! 168 moveq #__NR_sigreturn,%d0
760 .pushsection ".entry.tramp.text", "ax" !! 169 trap #0
761 .align 11 !! 170
762 SYM_CODE_START_LOCAL_NOALIGN(tramp_vectors) !! 171 ENTRY(ret_from_user_rt_signal)
763 #ifdef CONFIG_MITIGATE_SPECTRE_BRANCH_HISTORY !! 172 movel #__NR_rt_sigreturn,%d0
764 generate_tramp_vector kpti=1, bhb=BH !! 173 trap #0
765 generate_tramp_vector kpti=1, bhb=BH <<
766 generate_tramp_vector kpti=1, bhb=BH <<
767 #endif /* CONFIG_MITIGATE_SPECTRE_BRANCH_HISTO <<
768 generate_tramp_vector kpti=1, bhb=BH <<
769 SYM_CODE_END(tramp_vectors) <<
770 <<
771 SYM_CODE_START_LOCAL(tramp_exit) <<
772 tramp_unmap_kernel x29 <<
773 mrs x29, far_el1 <<
774 eret <<
775 sb <<
776 SYM_CODE_END(tramp_exit) <<
777 .popsection <<
778 #endif /* CONFIG_UNMAP_KERNEL_AT_EL0 */ <<
779 <<
780 /* <<
781 * Exception vectors for spectre mitigations o <<
782 * kpti is not in use. <<
783 */ <<
784 .macro generate_el1_vector, bhb <<
785 .Lvector_start\@: <<
786 kernel_ventry 1, t, 64, sync <<
787 kernel_ventry 1, t, 64, irq <<
788 kernel_ventry 1, t, 64, fiq <<
789 kernel_ventry 1, t, 64, error <<
790 <<
791 kernel_ventry 1, h, 64, sync <<
792 kernel_ventry 1, h, 64, irq <<
793 kernel_ventry 1, h, 64, fiq <<
794 kernel_ventry 1, h, 64, error <<
795 <<
796 .rept 4 <<
797 tramp_ventry .Lvector_start\@, 64, <<
798 .endr <<
799 .rept 4 <<
800 tramp_ventry .Lvector_start\@, 32, <<
801 .endr <<
802 .endm <<
803 <<
804 /* The order must match tramp_vecs and the arm <<
805 .pushsection ".entry.text", "ax" <<
806 .align 11 <<
807 SYM_CODE_START(__bp_harden_el1_vectors) <<
808 #ifdef CONFIG_MITIGATE_SPECTRE_BRANCH_HISTORY <<
809 generate_el1_vector bhb=BHB_MITIGA <<
810 generate_el1_vector bhb=BHB_MITIGA <<
811 generate_el1_vector bhb=BHB_MITIGA <<
812 #endif /* CONFIG_MITIGATE_SPECTRE_BRANCH_HISTO <<
813 SYM_CODE_END(__bp_harden_el1_vectors) <<
814 .popsection <<
815 <<
816 <<
817 /* <<
818 * Register switch for AArch64. The callee-sav <<
819 * and restored. On entry: <<
820 * x0 = previous task_struct (must be preser <<
821 * x1 = next task_struct <<
822 * Previous and next are guaranteed not to be <<
823 * <<
824 */ <<
825 SYM_FUNC_START(cpu_switch_to) <<
826 mov x10, #THREAD_CPU_CONTEXT <<
827 add x8, x0, x10 <<
828 mov x9, sp <<
829 stp x19, x20, [x8], #16 <<
830 stp x21, x22, [x8], #16 <<
831 stp x23, x24, [x8], #16 <<
832 stp x25, x26, [x8], #16 <<
833 stp x27, x28, [x8], #16 <<
834 stp x29, x9, [x8], #16 <<
835 str lr, [x8] <<
836 add x8, x1, x10 <<
837 ldp x19, x20, [x8], #16 <<
838 ldp x21, x22, [x8], #16 <<
839 ldp x23, x24, [x8], #16 <<
840 ldp x25, x26, [x8], #16 <<
841 ldp x27, x28, [x8], #16 <<
842 ldp x29, x9, [x8], #16 <<
843 ldr lr, [x8] <<
844 mov sp, x9 <<
845 msr sp_el0, x1 <<
846 ptrauth_keys_install_kernel x1, x8, x9 <<
847 scs_save x0 <<
848 scs_load_current <<
849 ret <<
850 SYM_FUNC_END(cpu_switch_to) <<
851 NOKPROBE(cpu_switch_to) <<
852 174
853 /* !! 175 #else
854 * This is how we return from a fork. <<
855 */ <<
856 SYM_CODE_START(ret_from_fork) <<
857 bl schedule_tail <<
858 cbz x19, 1f <<
859 mov x0, x20 <<
860 blr x19 <<
861 1: get_current_task tsk <<
862 mov x0, sp <<
863 bl asm_exit_to_user_mode <<
864 b ret_to_user <<
865 SYM_CODE_END(ret_from_fork) <<
866 NOKPROBE(ret_from_fork) <<
867 176
868 /* !! 177 do_trace_entry:
869 * void call_on_irq_stack(struct pt_regs *regs !! 178 movel #-ENOSYS,%sp@(PT_OFF_D0)| needed for strace
870 * void (*func)(struct !! 179 subql #4,%sp
871 * !! 180 SAVE_SWITCH_STACK
872 * Calls func(regs) using this CPU's irq stack !! 181 jbsr syscall_trace_enter
873 */ !! 182 RESTORE_SWITCH_STACK
874 SYM_FUNC_START(call_on_irq_stack) !! 183 addql #4,%sp
875 #ifdef CONFIG_SHADOW_CALL_STACK !! 184 addql #1,%d0 | optimization for cmpil #-1,%d0
876 get_current_task x16 !! 185 jeq ret_from_syscall
877 scs_save x16 !! 186 movel %sp@(PT_OFF_ORIG_D0),%d0
878 ldr_this_cpu scs_sp, irq_shadow_call_s !! 187 cmpl #NR_syscalls,%d0
>> 188 jcs syscall
>> 189 jra ret_from_syscall
>> 190 badsys:
>> 191 movel #-ENOSYS,%sp@(PT_OFF_D0)
>> 192 jra ret_from_syscall
>> 193
>> 194 do_trace_exit:
>> 195 subql #4,%sp
>> 196 SAVE_SWITCH_STACK
>> 197 jbsr syscall_trace_leave
>> 198 RESTORE_SWITCH_STACK
>> 199 addql #4,%sp
>> 200 jra .Lret_from_exception
>> 201
>> 202 ENTRY(system_call)
>> 203 SAVE_ALL_SYS
>> 204
>> 205 GET_CURRENT(%d1)
>> 206 movel %d1,%a1
>> 207
>> 208 | save top of frame
>> 209 movel %sp,%curptr@(TASK_THREAD+THREAD_ESP0)
>> 210
>> 211 | syscall trace?
>> 212 tstb %a1@(TINFO_FLAGS+2)
>> 213 jmi do_trace_entry
>> 214 | seccomp filter active?
>> 215 btst #5,%a1@(TINFO_FLAGS+2)
>> 216 bnes do_trace_entry
>> 217 cmpl #NR_syscalls,%d0
>> 218 jcc badsys
>> 219 syscall:
>> 220 jbsr @(sys_call_table,%d0:l:4)@(0)
>> 221 movel %d0,%sp@(PT_OFF_D0) | save the return value
>> 222 ret_from_syscall:
>> 223 |oriw #0x0700,%sr
>> 224 movel %curptr@(TASK_STACK),%a1
>> 225 movew %a1@(TINFO_FLAGS+2),%d0
>> 226 jne syscall_exit_work
>> 227 1: RESTORE_ALL
>> 228
>> 229 syscall_exit_work:
>> 230 btst #5,%sp@(PT_OFF_SR) | check if returning to kernel
>> 231 bnes 1b | if so, skip resched, signals
>> 232 lslw #1,%d0
>> 233 jcs do_trace_exit
>> 234 jmi do_delayed_trace
>> 235 lslw #8,%d0
>> 236 jne do_signal_return
>> 237 pea resume_userspace
>> 238 jra schedule
>> 239
>> 240
>> 241 ENTRY(ret_from_exception)
>> 242 .Lret_from_exception:
>> 243 btst #5,%sp@(PT_OFF_SR) | check if returning to kernel
>> 244 bnes 1f | if so, skip resched, signals
>> 245 | only allow interrupts when we are really the last one on the
>> 246 | kernel stack, otherwise stack overflow can occur during
>> 247 | heavy interrupt load
>> 248 andw #ALLOWINT,%sr
>> 249
>> 250 resume_userspace:
>> 251 movel %curptr@(TASK_STACK),%a1
>> 252 moveb %a1@(TINFO_FLAGS+3),%d0
>> 253 jne exit_work
>> 254 1: RESTORE_ALL
>> 255
>> 256 exit_work:
>> 257 | save top of frame
>> 258 movel %sp,%curptr@(TASK_THREAD+THREAD_ESP0)
>> 259 lslb #1,%d0
>> 260 jne do_signal_return
>> 261 pea resume_userspace
>> 262 jra schedule
>> 263
>> 264
>> 265 do_signal_return:
>> 266 |andw #ALLOWINT,%sr
>> 267 subql #4,%sp | dummy return address
>> 268 SAVE_SWITCH_STACK
>> 269 pea %sp@(SWITCH_STACK_SIZE)
>> 270 bsrl do_notify_resume
>> 271 addql #4,%sp
>> 272 RESTORE_SWITCH_STACK
>> 273 addql #4,%sp
>> 274 jbra resume_userspace
>> 275
>> 276 do_delayed_trace:
>> 277 bclr #7,%sp@(PT_OFF_SR) | clear trace bit in SR
>> 278 pea 1 | send SIGTRAP
>> 279 movel %curptr,%sp@-
>> 280 pea LSIGTRAP
>> 281 jbsr send_sig
>> 282 addql #8,%sp
>> 283 addql #4,%sp
>> 284 jbra resume_userspace
>> 285
>> 286
>> 287 /* This is the main interrupt handler for autovector interrupts */
>> 288
>> 289 ENTRY(auto_inthandler)
>> 290 SAVE_ALL_INT
>> 291 GET_CURRENT(%d0)
>> 292 | put exception # in d0
>> 293 bfextu %sp@(PT_OFF_FORMATVEC){#4,#10},%d0
>> 294 subw #VEC_SPUR,%d0
>> 295
>> 296 movel %sp,%sp@-
>> 297 movel %d0,%sp@- | put vector # on stack
>> 298 auto_irqhandler_fixup = . + 2
>> 299 jsr do_IRQ | process the IRQ
>> 300 addql #8,%sp | pop parameters off stack
>> 301 jra ret_from_exception
>> 302
>> 303 /* Handler for user defined interrupt vectors */
>> 304
>> 305 ENTRY(user_inthandler)
>> 306 SAVE_ALL_INT
>> 307 GET_CURRENT(%d0)
>> 308 | put exception # in d0
>> 309 bfextu %sp@(PT_OFF_FORMATVEC){#4,#10},%d0
>> 310 user_irqvec_fixup = . + 2
>> 311 subw #VEC_USER,%d0
>> 312
>> 313 movel %sp,%sp@-
>> 314 movel %d0,%sp@- | put vector # on stack
>> 315 jsr do_IRQ | process the IRQ
>> 316 addql #8,%sp | pop parameters off stack
>> 317 jra ret_from_exception
>> 318
>> 319 /* Handler for uninitialized and spurious interrupts */
>> 320
>> 321 ENTRY(bad_inthandler)
>> 322 SAVE_ALL_INT
>> 323 GET_CURRENT(%d0)
>> 324
>> 325 movel %sp,%sp@-
>> 326 jsr handle_badint
>> 327 addql #4,%sp
>> 328 jra ret_from_exception
>> 329
>> 330 resume:
>> 331 /*
>> 332 * Beware - when entering resume, prev (the current task) is
>> 333 * in a0, next (the new task) is in a1,so don't change these
>> 334 * registers until their contents are no longer needed.
>> 335 */
>> 336
>> 337 /* save sr */
>> 338 movew %sr,%a0@(TASK_THREAD+THREAD_SR)
>> 339
>> 340 /* save fs (sfc,%dfc) (may be pointing to kernel memory) */
>> 341 movec %sfc,%d0
>> 342 movew %d0,%a0@(TASK_THREAD+THREAD_FC)
>> 343
>> 344 /* save usp */
>> 345 /* it is better to use a movel here instead of a movew 8*) */
>> 346 movec %usp,%d0
>> 347 movel %d0,%a0@(TASK_THREAD+THREAD_USP)
>> 348
>> 349 /* save non-scratch registers on stack */
>> 350 SAVE_SWITCH_STACK
>> 351
>> 352 /* save current kernel stack pointer */
>> 353 movel %sp,%a0@(TASK_THREAD+THREAD_KSP)
>> 354
>> 355 /* save floating point context */
>> 356 #ifndef CONFIG_M68KFPU_EMU_ONLY
>> 357 #ifdef CONFIG_M68KFPU_EMU
>> 358 tstl m68k_fputype
>> 359 jeq 3f
>> 360 #endif
>> 361 fsave %a0@(TASK_THREAD+THREAD_FPSTATE)
>> 362
>> 363 #if defined(CONFIG_M68060)
>> 364 #if !defined(CPU_M68060_ONLY)
>> 365 btst #3,m68k_cputype+3
>> 366 beqs 1f
>> 367 #endif
>> 368 /* The 060 FPU keeps status in bits 15-8 of the first longword */
>> 369 tstb %a0@(TASK_THREAD+THREAD_FPSTATE+2)
>> 370 jeq 3f
>> 371 #if !defined(CPU_M68060_ONLY)
>> 372 jra 2f
>> 373 #endif
>> 374 #endif /* CONFIG_M68060 */
>> 375 #if !defined(CPU_M68060_ONLY)
>> 376 1: tstb %a0@(TASK_THREAD+THREAD_FPSTATE)
>> 377 jeq 3f
879 #endif 378 #endif
>> 379 2: fmovemx %fp0-%fp7,%a0@(TASK_THREAD+THREAD_FPREG)
>> 380 fmoveml %fpcr/%fpsr/%fpiar,%a0@(TASK_THREAD+THREAD_FPCNTL)
>> 381 3:
>> 382 #endif /* CONFIG_M68KFPU_EMU_ONLY */
>> 383 /* Return previous task in %d1 */
>> 384 movel %curptr,%d1
>> 385
>> 386 /* switch to new task (a1 contains new task) */
>> 387 movel %a1,%curptr
>> 388
>> 389 /* restore floating point context */
>> 390 #ifndef CONFIG_M68KFPU_EMU_ONLY
>> 391 #ifdef CONFIG_M68KFPU_EMU
>> 392 tstl m68k_fputype
>> 393 jeq 4f
>> 394 #endif
>> 395 #if defined(CONFIG_M68060)
>> 396 #if !defined(CPU_M68060_ONLY)
>> 397 btst #3,m68k_cputype+3
>> 398 beqs 1f
>> 399 #endif
>> 400 /* The 060 FPU keeps status in bits 15-8 of the first longword */
>> 401 tstb %a1@(TASK_THREAD+THREAD_FPSTATE+2)
>> 402 jeq 3f
>> 403 #if !defined(CPU_M68060_ONLY)
>> 404 jra 2f
>> 405 #endif
>> 406 #endif /* CONFIG_M68060 */
>> 407 #if !defined(CPU_M68060_ONLY)
>> 408 1: tstb %a1@(TASK_THREAD+THREAD_FPSTATE)
>> 409 jeq 3f
>> 410 #endif
>> 411 2: fmovemx %a1@(TASK_THREAD+THREAD_FPREG),%fp0-%fp7
>> 412 fmoveml %a1@(TASK_THREAD+THREAD_FPCNTL),%fpcr/%fpsr/%fpiar
>> 413 3: frestore %a1@(TASK_THREAD+THREAD_FPSTATE)
>> 414 4:
>> 415 #endif /* CONFIG_M68KFPU_EMU_ONLY */
880 416
881 /* Create a frame record to save our L !! 417 /* restore the kernel stack pointer */
882 stp x29, x30, [sp, #-16]! !! 418 movel %a1@(TASK_THREAD+THREAD_KSP),%sp
883 mov x29, sp <<
884 <<
885 ldr_this_cpu x16, irq_stack_ptr, x17 <<
886 <<
887 /* Move to the new stack and call the <<
888 add sp, x16, #IRQ_STACK_SIZE <<
889 blr x1 <<
890 <<
891 /* <<
892 * Restore the SP from the FP, and res <<
893 * record. <<
894 */ <<
895 mov sp, x29 <<
896 ldp x29, x30, [sp], #16 <<
897 scs_load_current <<
898 ret <<
899 SYM_FUNC_END(call_on_irq_stack) <<
900 NOKPROBE(call_on_irq_stack) <<
901 <<
902 #ifdef CONFIG_ARM_SDE_INTERFACE <<
903 <<
904 #include <asm/sdei.h> <<
905 #include <uapi/linux/arm_sdei.h> <<
906 <<
907 .macro sdei_handler_exit exit_mode <<
908 /* On success, this call never returns <<
909 cmp \exit_mode, #SDEI_EXIT_SMC <<
910 b.ne 99f <<
911 smc #0 <<
912 b . <<
913 99: hvc #0 <<
914 b . <<
915 .endm <<
916 <<
917 #ifdef CONFIG_UNMAP_KERNEL_AT_EL0 <<
918 /* <<
919 * The regular SDEI entry point may have been <<
920 * the kernel. This trampoline restores the ke <<
921 * argument accessible. <<
922 * <<
923 * This clobbers x4, __sdei_handler() will res <<
924 * copy. <<
925 */ <<
926 .pushsection ".entry.tramp.text", "ax" <<
927 SYM_CODE_START(__sdei_asm_entry_trampoline) <<
928 mrs x4, ttbr1_el1 <<
929 tbz x4, #USER_ASID_BIT, 1f <<
930 <<
931 tramp_map_kernel tmp=x4 <<
932 isb <<
933 mov x4, xzr <<
934 <<
935 /* <<
936 * Remember whether to unmap the kerne <<
937 */ <<
938 1: str x4, [x1, #(SDEI_EVENT_INTREGS <<
939 tramp_data_read_var x4, __sdei_asm <<
940 br x4 <<
941 SYM_CODE_END(__sdei_asm_entry_trampoline) <<
942 NOKPROBE(__sdei_asm_entry_trampoline) <<
943 419
944 /* !! 420 /* restore non-scratch registers */
945 * Make the exit call and restore the original !! 421 RESTORE_SWITCH_STACK
946 * <<
947 * x0 & x1: setup for the exit API call <<
948 * x2: exit_mode <<
949 * x4: struct sdei_registered_event argument f <<
950 */ <<
951 SYM_CODE_START(__sdei_asm_exit_trampoline) <<
952 ldr x4, [x4, #(SDEI_EVENT_INTREGS <<
953 cbnz x4, 1f <<
954 <<
955 tramp_unmap_kernel tmp=x4 <<
956 <<
957 1: sdei_handler_exit exit_mode=x2 <<
958 SYM_CODE_END(__sdei_asm_exit_trampoline) <<
959 NOKPROBE(__sdei_asm_exit_trampoline) <<
960 .popsection // .entry.tramp.text <<
961 #endif /* CONFIG_UNMAP_KERNEL_AT_EL0 */ <<
962 422
963 /* !! 423 /* restore user stack pointer */
964 * Software Delegated Exception entry point. !! 424 movel %a1@(TASK_THREAD+THREAD_USP),%a0
965 * !! 425 movel %a0,%usp
966 * x0: Event number <<
967 * x1: struct sdei_registered_event argument f <<
968 * x2: interrupted PC <<
969 * x3: interrupted PSTATE <<
970 * x4: maybe clobbered by the trampoline <<
971 * <<
972 * Firmware has preserved x0->x17 for us, we m <<
973 * follow SMC-CC. We save (or retrieve) all th <<
974 * want them. <<
975 */ <<
976 SYM_CODE_START(__sdei_asm_handler) <<
977 stp x2, x3, [x1, #SDEI_EVENT_INTRE <<
978 stp x4, x5, [x1, #SDEI_EVENT_INTRE <<
979 stp x6, x7, [x1, #SDEI_EVENT_INTRE <<
980 stp x8, x9, [x1, #SDEI_EVENT_INTRE <<
981 stp x10, x11, [x1, #SDEI_EVENT_INT <<
982 stp x12, x13, [x1, #SDEI_EVENT_INT <<
983 stp x14, x15, [x1, #SDEI_EVENT_INT <<
984 stp x16, x17, [x1, #SDEI_EVENT_INT <<
985 stp x18, x19, [x1, #SDEI_EVENT_INT <<
986 stp x20, x21, [x1, #SDEI_EVENT_INT <<
987 stp x22, x23, [x1, #SDEI_EVENT_INT <<
988 stp x24, x25, [x1, #SDEI_EVENT_INT <<
989 stp x26, x27, [x1, #SDEI_EVENT_INT <<
990 stp x28, x29, [x1, #SDEI_EVENT_INT <<
991 mov x4, sp <<
992 stp lr, x4, [x1, #SDEI_EVENT_INTRE <<
993 <<
994 mov x19, x1 <<
995 <<
996 /* Store the registered-event for cras <<
997 ldrb w4, [x19, #SDEI_EVENT_PRIORITY <<
998 cbnz w4, 1f <<
999 adr_this_cpu dst=x5, sym=sdei_active_n <<
1000 b 2f <<
1001 1: adr_this_cpu dst=x5, sym=sdei_active_ <<
1002 2: str x19, [x5] <<
1003 426
1004 #ifdef CONFIG_VMAP_STACK !! 427 /* restore fs (sfc,%dfc) */
1005 /* !! 428 movew %a1@(TASK_THREAD+THREAD_FC),%a0
1006 * entry.S may have been using sp as !! 429 movec %a0,%sfc
1007 * this is a normal or critical event !! 430 movec %a0,%dfc
1008 * stack for this CPU. <<
1009 */ <<
1010 cbnz w4, 1f <<
1011 ldr_this_cpu dst=x5, sym=sdei_stack_n <<
1012 b 2f <<
1013 1: ldr_this_cpu dst=x5, sym=sdei_stack_c <<
1014 2: mov x6, #SDEI_STACK_SIZE <<
1015 add x5, x5, x6 <<
1016 mov sp, x5 <<
1017 #endif <<
1018 431
1019 #ifdef CONFIG_SHADOW_CALL_STACK !! 432 /* restore status register */
1020 /* Use a separate shadow call stack f !! 433 movew %a1@(TASK_THREAD+THREAD_SR),%sr
1021 cbnz w4, 3f <<
1022 ldr_this_cpu dst=scs_sp, sym=sdei_sha <<
1023 b 4f <<
1024 3: ldr_this_cpu dst=scs_sp, sym=sdei_sha <<
1025 4: <<
1026 #endif <<
1027 434
1028 /* !! 435 rts
1029 * We may have interrupted userspace, <<
1030 * return-to either of these. We can' <<
1031 */ <<
1032 mrs x28, sp_el0 <<
1033 ldr_this_cpu dst=x0, sym=__entry_t <<
1034 msr sp_el0, x0 <<
1035 <<
1036 /* If we interrupted the kernel point <<
1037 and x0, x3, #0xc <<
1038 mrs x1, CurrentEL <<
1039 cmp x0, x1 <<
1040 csel x29, x29, xzr, eq // fp <<
1041 csel x4, x2, xzr, eq // el <<
1042 <<
1043 stp x29, x4, [sp, #-16]! <<
1044 mov x29, sp <<
1045 <<
1046 add x0, x19, #SDEI_EVENT_INTREGS <<
1047 mov x1, x19 <<
1048 bl __sdei_handler <<
1049 <<
1050 msr sp_el0, x28 <<
1051 /* restore regs >x17 that we clobbere <<
1052 mov x4, x19 // keep x4 fo <<
1053 ldp x28, x29, [x4, #SDEI_EVENT_IN <<
1054 ldp x18, x19, [x4, #SDEI_EVENT_IN <<
1055 ldp lr, x1, [x4, #SDEI_EVENT_INTR <<
1056 mov sp, x1 <<
1057 <<
1058 mov x1, x0 // ad <<
1059 /* x0 = (x0 <= SDEI_EV_FAILED) ? <<
1060 * EVENT_COMPLETE:EVENT_COMPLETE_AND_ <<
1061 */ <<
1062 cmp x0, #SDEI_EV_FAILED <<
1063 mov_q x2, SDEI_1_0_FN_SDEI_EVENT_CO <<
1064 mov_q x3, SDEI_1_0_FN_SDEI_EVENT_CO <<
1065 csel x0, x2, x3, ls <<
1066 <<
1067 ldr_l x2, sdei_exit_mode <<
1068 <<
1069 /* Clear the registered-event seen by <<
1070 ldrb w3, [x4, #SDEI_EVENT_PRIORITY <<
1071 cbnz w3, 1f <<
1072 adr_this_cpu dst=x5, sym=sdei_active_ <<
1073 b 2f <<
1074 1: adr_this_cpu dst=x5, sym=sdei_active_ <<
1075 2: str xzr, [x5] <<
1076 <<
1077 alternative_if_not ARM64_UNMAP_KERNEL_AT_EL0 <<
1078 sdei_handler_exit exit_mode=x2 <<
1079 alternative_else_nop_endif <<
1080 <<
1081 #ifdef CONFIG_UNMAP_KERNEL_AT_EL0 <<
1082 tramp_alias dst=x5, sym=__sdei_as <<
1083 br x5 <<
1084 #endif <<
1085 SYM_CODE_END(__sdei_asm_handler) <<
1086 NOKPROBE(__sdei_asm_handler) <<
1087 436
1088 SYM_CODE_START(__sdei_handler_abort) !! 437 #endif /* CONFIG_MMU && !CONFIG_COLDFIRE */
1089 mov_q x0, SDEI_1_0_FN_SDEI_EVENT_CO <<
1090 adr x1, 1f <<
1091 ldr_l x2, sdei_exit_mode <<
1092 sdei_handler_exit exit_mode=x2 <<
1093 // exit the handler and jump to the n <<
1094 // Exit will stomp x0-x17, PSTATE, EL <<
1095 1: ret <<
1096 SYM_CODE_END(__sdei_handler_abort) <<
1097 NOKPROBE(__sdei_handler_abort) <<
1098 #endif /* CONFIG_ARM_SDE_INTERFACE */ <<
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.