1
2
3
4
5
6
7
8
9
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/cpufeature.h>
18 #include <asm/errno.h>
19 #include <asm/esr.h>
20 #include <asm/irq.h>
21 #include <asm/memory.h>
22 #include <asm/mmu.h>
23 #include <asm/processor.h>
24 #include <asm/ptrace.h>
25 #include <asm/thread_info.h>
26 #include <asm/asm-uaccess.h>
27 #include <asm/unistd.h>
28
29
30
31
32
33 .macro ct_user_exit_irqoff
34 #ifdef CONFIG_CONTEXT_TRACKING
35 bl enter_from_user_mode
36 #endif
37 .endm
38
39 .macro ct_user_enter
40 #ifdef CONFIG_CONTEXT_TRACKING
41 bl context_tracking_user_enter
42 #endif
43 .endm
44
45 .macro clear_gp_regs
46 .irp n,0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29
47 mov x\n, xzr
48 .endr
49 .endm
50
51
52
53
54
55 #define BAD_SYNC 0
56 #define BAD_IRQ 1
57 #define BAD_FIQ 2
58 #define BAD_ERROR 3
59
60 .macro kernel_ventry, el, label, regsize = 64
61 .align 7
62 #ifdef CONFIG_UNMAP_KERNEL_AT_EL0
63 alternative_if ARM64_UNMAP_KERNEL_AT_EL0
64 .if \el == 0
65 .if \regsize == 64
66 mrs x30, tpidrro_el0
67 msr tpidrro_el0, xzr
68 .else
69 mov x30, xzr
70 .endif
71 .endif
72 alternative_else_nop_endif
73 #endif
74
75 sub sp, sp, #S_FRAME_SIZE
76 #ifdef CONFIG_VMAP_STACK
77
78
79
80
81 add sp, sp, x0
82 sub x0, sp, x0
83 tbnz x0, #THREAD_SHIFT, 0f
84 sub x0, sp, x0
85 sub sp, sp, x0
86 b el\()\el\()_\label
87
88 0:
89
90
91
92
93
94
95
96 msr tpidr_el0, x0
97
98
99 sub x0, sp, x0
100 msr tpidrro_el0, x0
101
102
103 adr_this_cpu sp, overflow_stack + OVERFLOW_STACK_SIZE, x0
104
105
106
107
108
109 mrs x0, tpidr_el0
110 sub x0, sp, x0
111 tst x0, #~(OVERFLOW_STACK_SIZE - 1)
112 b.ne __bad_stack
113
114
115 sub sp, sp, x0
116 mrs x0, tpidrro_el0
117 #endif
118 b el\()\el\()_\label
119 .endm
120
121 .macro tramp_alias, dst, sym
122 mov_q \dst, TRAMP_VALIAS
123 add \dst, \dst, #(\sym - .entry.tramp.text)
124 .endm
125
126
127
128 .macro apply_ssbd, state, tmp1, tmp2
129 #ifdef CONFIG_ARM64_SSBD
130 alternative_cb arm64_enable_wa2_handling
131 b .L__asm_ssbd_skip\@
132 alternative_cb_end
133 ldr_this_cpu \tmp2, arm64_ssbd_callback_required, \tmp1
134 cbz \tmp2, .L__asm_ssbd_skip\@
135 ldr \tmp2, [tsk, #TSK_TI_FLAGS]
136 tbnz \tmp2, #TIF_SSBD, .L__asm_ssbd_skip\@
137 mov w0, #ARM_SMCCC_ARCH_WORKAROUND_2
138 mov w1, #\state
139 alternative_cb arm64_update_smccc_conduit
140 nop
141 alternative_cb_end
142 .L__asm_ssbd_skip\@:
143 #endif
144 .endm
145
146 .macro kernel_entry, el, regsize = 64
147 .if \regsize == 32
148 mov w0, w0
149 .endif
150 stp x0, x1, [sp, #16 * 0]
151 stp x2, x3, [sp, #16 * 1]
152 stp x4, x5, [sp, #16 * 2]
153 stp x6, x7, [sp, #16 * 3]
154 stp x8, x9, [sp, #16 * 4]
155 stp x10, x11, [sp, #16 * 5]
156 stp x12, x13, [sp, #16 * 6]
157 stp x14, x15, [sp, #16 * 7]
158 stp x16, x17, [sp, #16 * 8]
159 stp x18, x19, [sp, #16 * 9]
160 stp x20, x21, [sp, #16 * 10]
161 stp x22, x23, [sp, #16 * 11]
162 stp x24, x25, [sp, #16 * 12]
163 stp x26, x27, [sp, #16 * 13]
164 stp x28, x29, [sp, #16 * 14]
165
166 .if \el == 0
167 clear_gp_regs
168 mrs x21, sp_el0
169 ldr_this_cpu tsk, __entry_task, x20
170 ldr x19, [tsk, #TSK_TI_FLAGS]
171 disable_step_tsk x19, x20
172
173 apply_ssbd 1, x22, x23
174
175 .else
176 add x21, sp, #S_FRAME_SIZE
177 get_current_task tsk
178
179 ldr x20, [tsk, #TSK_TI_ADDR_LIMIT]
180 str x20, [sp, #S_ORIG_ADDR_LIMIT]
181 mov x20, #USER_DS
182 str x20, [tsk, #TSK_TI_ADDR_LIMIT]
183
184 .endif
185 mrs x22, elr_el1
186 mrs x23, spsr_el1
187 stp lr, x21, [sp, #S_LR]
188
189
190
191
192
193
194 .if \el == 0
195 stp xzr, xzr, [sp, #S_STACKFRAME]
196 .else
197 stp x29, x22, [sp, #S_STACKFRAME]
198 .endif
199 add x29, sp, #S_STACKFRAME
200
201 #ifdef CONFIG_ARM64_SW_TTBR0_PAN
202
203
204
205
206
207
208
209
210 alternative_if ARM64_HAS_PAN
211 b 1f
212 alternative_else_nop_endif
213
214 .if \el != 0
215 mrs x21, ttbr0_el1
216 tst x21, #TTBR_ASID_MASK
217 orr x23, x23, #PSR_PAN_BIT
218 b.eq 1f
219 and x23, x23, #~PSR_PAN_BIT
220 .endif
221
222 __uaccess_ttbr0_disable x21
223 1:
224 #endif
225
226 stp x22, x23, [sp, #S_PC]
227
228
229 .if \el == 0
230 mov w21, #NO_SYSCALL
231 str w21, [sp, #S_SYSCALLNO]
232 .endif
233
234
235
236
237 .if \el == 0
238 msr sp_el0, tsk
239 .endif
240
241
242 alternative_if ARM64_HAS_IRQ_PRIO_MASKING
243 mrs_s x20, SYS_ICC_PMR_EL1
244 str x20, [sp, #S_PMR_SAVE]
245 alternative_else_nop_endif
246
247
248
249
250
251
252
253
254
255 .endm
256
257 .macro kernel_exit, el
258 .if \el != 0
259 disable_daif
260
261
262 ldr x20, [sp, #S_ORIG_ADDR_LIMIT]
263 str x20, [tsk, #TSK_TI_ADDR_LIMIT]
264
265
266 .endif
267
268
269 alternative_if ARM64_HAS_IRQ_PRIO_MASKING
270 ldr x20, [sp, #S_PMR_SAVE]
271 msr_s SYS_ICC_PMR_EL1, x20
272
273 dsb sy
274 alternative_else_nop_endif
275
276 ldp x21, x22, [sp, #S_PC]
277 .if \el == 0
278 ct_user_enter
279 .endif
280
281 #ifdef CONFIG_ARM64_SW_TTBR0_PAN
282
283
284
285
286 alternative_if ARM64_HAS_PAN
287 b 2f
288 alternative_else_nop_endif
289
290 .if \el != 0
291 tbnz x22, #22, 1f
292 .endif
293
294 __uaccess_ttbr0_enable x0, x1
295
296 .if \el == 0
297
298
299
300
301
302
303 bl post_ttbr_update_workaround
304 .endif
305 1:
306 .if \el != 0
307 and x22, x22, #~PSR_PAN_BIT
308 .endif
309 2:
310 #endif
311
312 .if \el == 0
313 ldr x23, [sp, #S_SP]
314 msr sp_el0, x23
315 tst x22, #PSR_MODE32_BIT
316 b.eq 3f
317
318 #ifdef CONFIG_ARM64_ERRATUM_845719
319 alternative_if ARM64_WORKAROUND_845719
320 #ifdef CONFIG_PID_IN_CONTEXTIDR
321 mrs x29, contextidr_el1
322 msr contextidr_el1, x29
323 #else
324 msr contextidr_el1, xzr
325 #endif
326 alternative_else_nop_endif
327 #endif
328 3:
329 #ifdef CONFIG_ARM64_ERRATUM_1418040
330 alternative_if_not ARM64_WORKAROUND_1418040
331 b 4f
332 alternative_else_nop_endif
333
334
335
336
337 mrs x1, cntkctl_el1
338 eon x0, x1, x22, lsr #3
339 tbz x0, #1, 4f
340 eor x1, x1, #2
341 msr cntkctl_el1, x1
342 4:
343 #endif
344 apply_ssbd 0, x0, x1
345 .endif
346
347 msr elr_el1, x21
348 msr spsr_el1, x22
349 ldp x0, x1, [sp, #16 * 0]
350 ldp x2, x3, [sp, #16 * 1]
351 ldp x4, x5, [sp, #16 * 2]
352 ldp x6, x7, [sp, #16 * 3]
353 ldp x8, x9, [sp, #16 * 4]
354 ldp x10, x11, [sp, #16 * 5]
355 ldp x12, x13, [sp, #16 * 6]
356 ldp x14, x15, [sp, #16 * 7]
357 ldp x16, x17, [sp, #16 * 8]
358 ldp x18, x19, [sp, #16 * 9]
359 ldp x20, x21, [sp, #16 * 10]
360 ldp x22, x23, [sp, #16 * 11]
361 ldp x24, x25, [sp, #16 * 12]
362 ldp x26, x27, [sp, #16 * 13]
363 ldp x28, x29, [sp, #16 * 14]
364 ldr lr, [sp, #S_LR]
365 add sp, sp, #S_FRAME_SIZE
366
367 .if \el == 0
368 alternative_insn eret, nop, ARM64_UNMAP_KERNEL_AT_EL0
369 #ifdef CONFIG_UNMAP_KERNEL_AT_EL0
370 bne 5f
371 msr far_el1, x30
372 tramp_alias x30, tramp_exit_native
373 br x30
374 5:
375 tramp_alias x30, tramp_exit_compat
376 br x30
377 #endif
378 .else
379 eret
380 .endif
381 sb
382 .endm
383
384 .macro irq_stack_entry
385 mov x19, sp
386
387
388
389
390
391
392 ldr x25, [tsk, TSK_STACK]
393 eor x25, x25, x19
394 and x25, x25, #~(THREAD_SIZE - 1)
395 cbnz x25, 9998f
396
397 ldr_this_cpu x25, irq_stack_ptr, x26
398 mov x26, #IRQ_STACK_SIZE
399 add x26, x25, x26
400
401
402 mov sp, x26
403 9998:
404 .endm
405
406
407
408
409
410 .macro irq_stack_exit
411 mov sp, x19
412 .endm
413
414
415 tsk .req x28
416
417
418
419
420 .macro irq_handler
421 ldr_l x1, handle_arch_irq
422 mov x0, sp
423 irq_stack_entry
424 blr x1
425 irq_stack_exit
426 .endm
427
428 #ifdef CONFIG_ARM64_PSEUDO_NMI
429
430
431
432
433 .macro test_irqs_unmasked res:req, pmr:req
434 alternative_if ARM64_HAS_IRQ_PRIO_MASKING
435 sub \res, \pmr, #GIC_PRIO_IRQON
436 alternative_else
437 mov \res, xzr
438 alternative_endif
439 .endm
440 #endif
441
442 .macro gic_prio_kentry_setup, tmp:req
443 #ifdef CONFIG_ARM64_PSEUDO_NMI
444 alternative_if ARM64_HAS_IRQ_PRIO_MASKING
445 mov \tmp, #(GIC_PRIO_PSR_I_SET | GIC_PRIO_IRQON)
446 msr_s SYS_ICC_PMR_EL1, \tmp
447 alternative_else_nop_endif
448 #endif
449 .endm
450
451 .macro gic_prio_irq_setup, pmr:req, tmp:req
452 #ifdef CONFIG_ARM64_PSEUDO_NMI
453 alternative_if ARM64_HAS_IRQ_PRIO_MASKING
454 orr \tmp, \pmr, #GIC_PRIO_PSR_I_SET
455 msr_s SYS_ICC_PMR_EL1, \tmp
456 alternative_else_nop_endif
457 #endif
458 .endm
459
460 .text
461
462
463
464
465 .pushsection ".entry.text", "ax"
466
467 .align 11
468 ENTRY(vectors)
469 kernel_ventry 1, sync_invalid
470 kernel_ventry 1, irq_invalid
471 kernel_ventry 1, fiq_invalid
472 kernel_ventry 1, error_invalid
473
474 kernel_ventry 1, sync
475 kernel_ventry 1, irq
476 kernel_ventry 1, fiq_invalid
477 kernel_ventry 1, error
478
479 kernel_ventry 0, sync
480 kernel_ventry 0, irq
481 kernel_ventry 0, fiq_invalid
482 kernel_ventry 0, error
483
484 #ifdef CONFIG_COMPAT
485 kernel_ventry 0, sync_compat, 32
486 kernel_ventry 0, irq_compat, 32
487 kernel_ventry 0, fiq_invalid_compat, 32
488 kernel_ventry 0, error_compat, 32
489 #else
490 kernel_ventry 0, sync_invalid, 32
491 kernel_ventry 0, irq_invalid, 32
492 kernel_ventry 0, fiq_invalid, 32
493 kernel_ventry 0, error_invalid, 32
494 #endif
495 END(vectors)
496
497 #ifdef CONFIG_VMAP_STACK
498
499
500
501
502
503 __bad_stack:
504
505 mrs x0, tpidrro_el0
506
507
508
509
510
511 sub sp, sp, #S_FRAME_SIZE
512 kernel_entry 1
513 mrs x0, tpidr_el0
514 add x0, x0, #S_FRAME_SIZE
515 str x0, [sp, #S_SP]
516
517
518 mov x0, sp
519
520
521 bl handle_bad_stack
522 ASM_BUG()
523 #endif
524
525
526
527
528 .macro inv_entry, el, reason, regsize = 64
529 kernel_entry \el, \regsize
530 mov x0, sp
531 mov x1, #\reason
532 mrs x2, esr_el1
533 bl bad_mode
534 ASM_BUG()
535 .endm
536
537 el0_sync_invalid:
538 inv_entry 0, BAD_SYNC
539 ENDPROC(el0_sync_invalid)
540
541 el0_irq_invalid:
542 inv_entry 0, BAD_IRQ
543 ENDPROC(el0_irq_invalid)
544
545 el0_fiq_invalid:
546 inv_entry 0, BAD_FIQ
547 ENDPROC(el0_fiq_invalid)
548
549 el0_error_invalid:
550 inv_entry 0, BAD_ERROR
551 ENDPROC(el0_error_invalid)
552
553 #ifdef CONFIG_COMPAT
554 el0_fiq_invalid_compat:
555 inv_entry 0, BAD_FIQ, 32
556 ENDPROC(el0_fiq_invalid_compat)
557 #endif
558
559 el1_sync_invalid:
560 inv_entry 1, BAD_SYNC
561 ENDPROC(el1_sync_invalid)
562
563 el1_irq_invalid:
564 inv_entry 1, BAD_IRQ
565 ENDPROC(el1_irq_invalid)
566
567 el1_fiq_invalid:
568 inv_entry 1, BAD_FIQ
569 ENDPROC(el1_fiq_invalid)
570
571 el1_error_invalid:
572 inv_entry 1, BAD_ERROR
573 ENDPROC(el1_error_invalid)
574
575
576
577
578 .align 6
579 el1_sync:
580 kernel_entry 1
581 mrs x1, esr_el1
582 lsr x24, x1, #ESR_ELx_EC_SHIFT
583 cmp x24, #ESR_ELx_EC_DABT_CUR
584 b.eq el1_da
585 cmp x24, #ESR_ELx_EC_IABT_CUR
586 b.eq el1_ia
587 cmp x24, #ESR_ELx_EC_SYS64
588 b.eq el1_undef
589 cmp x24, #ESR_ELx_EC_PC_ALIGN
590 b.eq el1_pc
591 cmp x24, #ESR_ELx_EC_UNKNOWN
592 b.eq el1_undef
593 cmp x24, #ESR_ELx_EC_BREAKPT_CUR
594 b.ge el1_dbg
595 b el1_inv
596
597 el1_ia:
598
599
600
601 el1_da:
602
603
604
605 mrs x3, far_el1
606 inherit_daif pstate=x23, tmp=x2
607 untagged_addr x0, x3
608 mov x2, sp
609 bl do_mem_abort
610
611 kernel_exit 1
612 el1_pc:
613
614
615
616
617
618 mrs x0, far_el1
619 inherit_daif pstate=x23, tmp=x2
620 mov x2, sp
621 bl do_sp_pc_abort
622 ASM_BUG()
623 el1_undef:
624
625
626
627 inherit_daif pstate=x23, tmp=x2
628 mov x0, sp
629 bl do_undefinstr
630 kernel_exit 1
631 el1_dbg:
632
633
634
635 cmp x24, #ESR_ELx_EC_BRK64
636 cinc x24, x24, eq
637 tbz x24, #0, el1_inv
638 gic_prio_kentry_setup tmp=x3
639 mrs x0, far_el1
640 mov x2, sp
641 bl do_debug_exception
642 kernel_exit 1
643 el1_inv:
644
645 inherit_daif pstate=x23, tmp=x2
646 mov x0, sp
647 mov x2, x1
648 mov x1, #BAD_SYNC
649 bl bad_mode
650 ASM_BUG()
651 ENDPROC(el1_sync)
652
653 .align 6
654 el1_irq:
655 kernel_entry 1
656 gic_prio_irq_setup pmr=x20, tmp=x1
657 enable_da_f
658
659 #ifdef CONFIG_ARM64_PSEUDO_NMI
660 test_irqs_unmasked res=x0, pmr=x20
661 cbz x0, 1f
662 bl asm_nmi_enter
663 1:
664 #endif
665
666 #ifdef CONFIG_TRACE_IRQFLAGS
667 bl trace_hardirqs_off
668 #endif
669
670 irq_handler
671
672 #ifdef CONFIG_PREEMPT
673 ldr x24, [tsk, #TSK_TI_PREEMPT]
674 alternative_if ARM64_HAS_IRQ_PRIO_MASKING
675
676
677
678
679 mrs x0, daif
680 orr x24, x24, x0
681 alternative_else_nop_endif
682 cbnz x24, 1f
683 bl arm64_preempt_schedule_irq
684 1:
685 #endif
686
687 #ifdef CONFIG_ARM64_PSEUDO_NMI
688
689
690
691
692
693 test_irqs_unmasked res=x0, pmr=x20
694 cbz x0, 1f
695 bl asm_nmi_exit
696 1:
697 #endif
698
699 #ifdef CONFIG_TRACE_IRQFLAGS
700 #ifdef CONFIG_ARM64_PSEUDO_NMI
701 test_irqs_unmasked res=x0, pmr=x20
702 cbnz x0, 1f
703 #endif
704 bl trace_hardirqs_on
705 1:
706 #endif
707
708 kernel_exit 1
709 ENDPROC(el1_irq)
710
711
712
713
714 .align 6
715 el0_sync:
716 kernel_entry 0
717 mrs x25, esr_el1
718 lsr x24, x25, #ESR_ELx_EC_SHIFT
719 cmp x24, #ESR_ELx_EC_SVC64
720 b.eq el0_svc
721 cmp x24, #ESR_ELx_EC_DABT_LOW
722 b.eq el0_da
723 cmp x24, #ESR_ELx_EC_IABT_LOW
724 b.eq el0_ia
725 cmp x24, #ESR_ELx_EC_FP_ASIMD
726 b.eq el0_fpsimd_acc
727 cmp x24, #ESR_ELx_EC_SVE
728 b.eq el0_sve_acc
729 cmp x24, #ESR_ELx_EC_FP_EXC64
730 b.eq el0_fpsimd_exc
731 cmp x24, #ESR_ELx_EC_SYS64
732 ccmp x24, #ESR_ELx_EC_WFx, #4, ne
733 b.eq el0_sys
734 cmp x24, #ESR_ELx_EC_SP_ALIGN
735 b.eq el0_sp
736 cmp x24, #ESR_ELx_EC_PC_ALIGN
737 b.eq el0_pc
738 cmp x24, #ESR_ELx_EC_UNKNOWN
739 b.eq el0_undef
740 cmp x24, #ESR_ELx_EC_BREAKPT_LOW
741 b.ge el0_dbg
742 b el0_inv
743
744 #ifdef CONFIG_COMPAT
745 .align 6
746 el0_sync_compat:
747 kernel_entry 0, 32
748 mrs x25, esr_el1
749 lsr x24, x25, #ESR_ELx_EC_SHIFT
750 cmp x24, #ESR_ELx_EC_SVC32
751 b.eq el0_svc_compat
752 cmp x24, #ESR_ELx_EC_DABT_LOW
753 b.eq el0_da
754 cmp x24, #ESR_ELx_EC_IABT_LOW
755 b.eq el0_ia
756 cmp x24, #ESR_ELx_EC_FP_ASIMD
757 b.eq el0_fpsimd_acc
758 cmp x24, #ESR_ELx_EC_FP_EXC32
759 b.eq el0_fpsimd_exc
760 cmp x24, #ESR_ELx_EC_PC_ALIGN
761 b.eq el0_pc
762 cmp x24, #ESR_ELx_EC_UNKNOWN
763 b.eq el0_undef
764 cmp x24, #ESR_ELx_EC_CP15_32
765 b.eq el0_cp15
766 cmp x24, #ESR_ELx_EC_CP15_64
767 b.eq el0_cp15
768 cmp x24, #ESR_ELx_EC_CP14_MR
769 b.eq el0_undef
770 cmp x24, #ESR_ELx_EC_CP14_LS
771 b.eq el0_undef
772 cmp x24, #ESR_ELx_EC_CP14_64
773 b.eq el0_undef
774 cmp x24, #ESR_ELx_EC_BREAKPT_LOW
775 b.ge el0_dbg
776 b el0_inv
777 el0_svc_compat:
778 gic_prio_kentry_setup tmp=x1
779 mov x0, sp
780 bl el0_svc_compat_handler
781 b ret_to_user
782
783 .align 6
784 el0_irq_compat:
785 kernel_entry 0, 32
786 b el0_irq_naked
787
788 el0_error_compat:
789 kernel_entry 0, 32
790 b el0_error_naked
791
792 el0_cp15:
793
794
795
796 ct_user_exit_irqoff
797 enable_daif
798 mov x0, x25
799 mov x1, sp
800 bl do_cp15instr
801 b ret_to_user
802 #endif
803
804 el0_da:
805
806
807
808 mrs x26, far_el1
809 ct_user_exit_irqoff
810 enable_daif
811 untagged_addr x0, x26
812 mov x1, x25
813 mov x2, sp
814 bl do_mem_abort
815 b ret_to_user
816 el0_ia:
817
818
819
820 mrs x26, far_el1
821 gic_prio_kentry_setup tmp=x0
822 ct_user_exit_irqoff
823 enable_da_f
824 #ifdef CONFIG_TRACE_IRQFLAGS
825 bl trace_hardirqs_off
826 #endif
827 mov x0, x26
828 mov x1, x25
829 mov x2, sp
830 bl do_el0_ia_bp_hardening
831 b ret_to_user
832 el0_fpsimd_acc:
833
834
835
836 ct_user_exit_irqoff
837 enable_daif
838 mov x0, x25
839 mov x1, sp
840 bl do_fpsimd_acc
841 b ret_to_user
842 el0_sve_acc:
843
844
845
846 ct_user_exit_irqoff
847 enable_daif
848 mov x0, x25
849 mov x1, sp
850 bl do_sve_acc
851 b ret_to_user
852 el0_fpsimd_exc:
853
854
855
856 ct_user_exit_irqoff
857 enable_daif
858 mov x0, x25
859 mov x1, sp
860 bl do_fpsimd_exc
861 b ret_to_user
862 el0_sp:
863 ldr x26, [sp, #S_SP]
864 b el0_sp_pc
865 el0_pc:
866 mrs x26, far_el1
867 el0_sp_pc:
868
869
870
871 gic_prio_kentry_setup tmp=x0
872 ct_user_exit_irqoff
873 enable_da_f
874 #ifdef CONFIG_TRACE_IRQFLAGS
875 bl trace_hardirqs_off
876 #endif
877 mov x0, x26
878 mov x1, x25
879 mov x2, sp
880 bl do_sp_pc_abort
881 b ret_to_user
882 el0_undef:
883
884
885
886 ct_user_exit_irqoff
887 enable_daif
888 mov x0, sp
889 bl do_undefinstr
890 b ret_to_user
891 el0_sys:
892
893
894
895 ct_user_exit_irqoff
896 enable_daif
897 mov x0, x25
898 mov x1, sp
899 bl do_sysinstr
900 b ret_to_user
901 el0_dbg:
902
903
904
905 tbnz x24, #0, el0_inv
906 mrs x24, far_el1
907 gic_prio_kentry_setup tmp=x3
908 ct_user_exit_irqoff
909 mov x0, x24
910 mov x1, x25
911 mov x2, sp
912 bl do_debug_exception
913 enable_da_f
914 b ret_to_user
915 el0_inv:
916 ct_user_exit_irqoff
917 enable_daif
918 mov x0, sp
919 mov x1, #BAD_SYNC
920 mov x2, x25
921 bl bad_el0_sync
922 b ret_to_user
923 ENDPROC(el0_sync)
924
925 .align 6
926 el0_irq:
927 kernel_entry 0
928 el0_irq_naked:
929 gic_prio_irq_setup pmr=x20, tmp=x0
930 ct_user_exit_irqoff
931 enable_da_f
932
933 #ifdef CONFIG_TRACE_IRQFLAGS
934 bl trace_hardirqs_off
935 #endif
936
937 #ifdef CONFIG_HARDEN_BRANCH_PREDICTOR
938 tbz x22, #55, 1f
939 bl do_el0_irq_bp_hardening
940 1:
941 #endif
942 irq_handler
943
944 #ifdef CONFIG_TRACE_IRQFLAGS
945 bl trace_hardirqs_on
946 #endif
947 b ret_to_user
948 ENDPROC(el0_irq)
949
950 el1_error:
951 kernel_entry 1
952 mrs x1, esr_el1
953 gic_prio_kentry_setup tmp=x2
954 enable_dbg
955 mov x0, sp
956 bl do_serror
957 kernel_exit 1
958 ENDPROC(el1_error)
959
960 el0_error:
961 kernel_entry 0
962 el0_error_naked:
963 mrs x25, esr_el1
964 gic_prio_kentry_setup tmp=x2
965 ct_user_exit_irqoff
966 enable_dbg
967 mov x0, sp
968 mov x1, x25
969 bl do_serror
970 enable_da_f
971 b ret_to_user
972 ENDPROC(el0_error)
973
974
975
976
977 work_pending:
978 mov x0, sp
979 bl do_notify_resume
980 #ifdef CONFIG_TRACE_IRQFLAGS
981 bl trace_hardirqs_on
982 #endif
983 ldr x1, [tsk, #TSK_TI_FLAGS]
984 b finish_ret_to_user
985
986
987
988 ret_to_user:
989 disable_daif
990 gic_prio_kentry_setup tmp=x3
991 ldr x1, [tsk, #TSK_TI_FLAGS]
992 and x2, x1, #_TIF_WORK_MASK
993 cbnz x2, work_pending
994 finish_ret_to_user:
995 enable_step_tsk x1, x2
996 #ifdef CONFIG_GCC_PLUGIN_STACKLEAK
997 bl stackleak_erase
998 #endif
999 kernel_exit 0
1000 ENDPROC(ret_to_user)
1001
1002
1003
1004
1005 .align 6
1006 el0_svc:
1007 gic_prio_kentry_setup tmp=x1
1008 mov x0, sp
1009 bl el0_svc_handler
1010 b ret_to_user
1011 ENDPROC(el0_svc)
1012
1013 .popsection
1014
1015 #ifdef CONFIG_UNMAP_KERNEL_AT_EL0
1016
1017
1018
1019 .pushsection ".entry.tramp.text", "ax"
1020
1021 .macro tramp_map_kernel, tmp
1022 mrs \tmp, ttbr1_el1
1023 add \tmp, \tmp, #(PAGE_SIZE + RESERVED_TTBR0_SIZE)
1024 bic \tmp, \tmp, #USER_ASID_FLAG
1025 msr ttbr1_el1, \tmp
1026 #ifdef CONFIG_QCOM_FALKOR_ERRATUM_1003
1027 alternative_if ARM64_WORKAROUND_QCOM_FALKOR_E1003
1028
1029 movk \tmp, #:abs_g2_nc:(TRAMP_VALIAS >> 12)
1030 movk \tmp, #:abs_g1_nc:(TRAMP_VALIAS >> 12)
1031
1032 movk \tmp, #:abs_g0_nc:((TRAMP_VALIAS & ~(SZ_2M - 1)) >> 12)
1033 isb
1034 tlbi vae1, \tmp
1035 dsb nsh
1036 alternative_else_nop_endif
1037 #endif
1038 .endm
1039
1040 .macro tramp_unmap_kernel, tmp
1041 mrs \tmp, ttbr1_el1
1042 sub \tmp, \tmp, #(PAGE_SIZE + RESERVED_TTBR0_SIZE)
1043 orr \tmp, \tmp, #USER_ASID_FLAG
1044 msr ttbr1_el1, \tmp
1045
1046
1047
1048
1049
1050 .endm
1051
1052 .macro tramp_ventry, regsize = 64
1053 .align 7
1054 1:
1055 .if \regsize == 64
1056 msr tpidrro_el0, x30
1057 .endif
1058
1059
1060
1061
1062
1063 bl 2f
1064 b .
1065 2:
1066 tramp_map_kernel x30
1067 #ifdef CONFIG_RANDOMIZE_BASE
1068 adr x30, tramp_vectors + PAGE_SIZE
1069 alternative_insn isb, nop, ARM64_WORKAROUND_QCOM_FALKOR_E1003
1070 ldr x30, [x30]
1071 #else
1072 ldr x30, =vectors
1073 #endif
1074 alternative_if_not ARM64_WORKAROUND_CAVIUM_TX2_219_PRFM
1075 prfm plil1strm, [x30, #(1b - tramp_vectors)]
1076 alternative_else_nop_endif
1077 msr vbar_el1, x30
1078 add x30, x30, #(1b - tramp_vectors)
1079 isb
1080 ret
1081 .endm
1082
1083 .macro tramp_exit, regsize = 64
1084 adr x30, tramp_vectors
1085 msr vbar_el1, x30
1086 tramp_unmap_kernel x30
1087 .if \regsize == 64
1088 mrs x30, far_el1
1089 .endif
1090 eret
1091 sb
1092 .endm
1093
1094 .align 11
1095 ENTRY(tramp_vectors)
1096 .space 0x400
1097
1098 tramp_ventry
1099 tramp_ventry
1100 tramp_ventry
1101 tramp_ventry
1102
1103 tramp_ventry 32
1104 tramp_ventry 32
1105 tramp_ventry 32
1106 tramp_ventry 32
1107 END(tramp_vectors)
1108
1109 ENTRY(tramp_exit_native)
1110 tramp_exit
1111 END(tramp_exit_native)
1112
1113 ENTRY(tramp_exit_compat)
1114 tramp_exit 32
1115 END(tramp_exit_compat)
1116
1117 .ltorg
1118 .popsection
1119 #ifdef CONFIG_RANDOMIZE_BASE
1120 .pushsection ".rodata", "a"
1121 .align PAGE_SHIFT
1122 .globl __entry_tramp_data_start
1123 __entry_tramp_data_start:
1124 .quad vectors
1125 .popsection
1126 #endif
1127 #endif
1128
1129
1130
1131
1132
1133
1134
1135
1136
1137 ENTRY(cpu_switch_to)
1138 mov x10, #THREAD_CPU_CONTEXT
1139 add x8, x0, x10
1140 mov x9, sp
1141 stp x19, x20, [x8], #16
1142 stp x21, x22, [x8], #16
1143 stp x23, x24, [x8], #16
1144 stp x25, x26, [x8], #16
1145 stp x27, x28, [x8], #16
1146 stp x29, x9, [x8], #16
1147 str lr, [x8]
1148 add x8, x1, x10
1149 ldp x19, x20, [x8], #16
1150 ldp x21, x22, [x8], #16
1151 ldp x23, x24, [x8], #16
1152 ldp x25, x26, [x8], #16
1153 ldp x27, x28, [x8], #16
1154 ldp x29, x9, [x8], #16
1155 ldr lr, [x8]
1156 mov sp, x9
1157 msr sp_el0, x1
1158 ret
1159 ENDPROC(cpu_switch_to)
1160 NOKPROBE(cpu_switch_to)
1161
1162
1163
1164
1165 ENTRY(ret_from_fork)
1166 bl schedule_tail
1167 cbz x19, 1f
1168 mov x0, x20
1169 blr x19
1170 1: get_current_task tsk
1171 b ret_to_user
1172 ENDPROC(ret_from_fork)
1173 NOKPROBE(ret_from_fork)
1174
1175 #ifdef CONFIG_ARM_SDE_INTERFACE
1176
1177 #include <asm/sdei.h>
1178 #include <uapi/linux/arm_sdei.h>
1179
1180 .macro sdei_handler_exit exit_mode
1181
1182 cmp \exit_mode, #SDEI_EXIT_SMC
1183 b.ne 99f
1184 smc #0
1185 b .
1186 99: hvc #0
1187 b .
1188 .endm
1189
1190 #ifdef CONFIG_UNMAP_KERNEL_AT_EL0
1191
1192
1193
1194
1195
1196
1197
1198
1199 .ltorg
1200 .pushsection ".entry.tramp.text", "ax"
1201 ENTRY(__sdei_asm_entry_trampoline)
1202 mrs x4, ttbr1_el1
1203 tbz x4, #USER_ASID_BIT, 1f
1204
1205 tramp_map_kernel tmp=x4
1206 isb
1207 mov x4, xzr
1208
1209
1210
1211
1212
1213 1: str x4, [x1, #(SDEI_EVENT_INTREGS + S_ORIG_ADDR_LIMIT)]
1214
1215 #ifdef CONFIG_RANDOMIZE_BASE
1216 adr x4, tramp_vectors + PAGE_SIZE
1217 add x4, x4, #:lo12:__sdei_asm_trampoline_next_handler
1218 ldr x4, [x4]
1219 #else
1220 ldr x4, =__sdei_asm_handler
1221 #endif
1222 br x4
1223 ENDPROC(__sdei_asm_entry_trampoline)
1224 NOKPROBE(__sdei_asm_entry_trampoline)
1225
1226
1227
1228
1229
1230
1231
1232
1233 ENTRY(__sdei_asm_exit_trampoline)
1234 ldr x4, [x4, #(SDEI_EVENT_INTREGS + S_ORIG_ADDR_LIMIT)]
1235 cbnz x4, 1f
1236
1237 tramp_unmap_kernel tmp=x4
1238
1239 1: sdei_handler_exit exit_mode=x2
1240 ENDPROC(__sdei_asm_exit_trampoline)
1241 NOKPROBE(__sdei_asm_exit_trampoline)
1242 .ltorg
1243 .popsection
1244 #ifdef CONFIG_RANDOMIZE_BASE
1245 .pushsection ".rodata", "a"
1246 __sdei_asm_trampoline_next_handler:
1247 .quad __sdei_asm_handler
1248 .popsection
1249 #endif
1250 #endif
1251
1252
1253
1254
1255
1256
1257
1258
1259
1260
1261
1262
1263
1264
1265 ENTRY(__sdei_asm_handler)
1266 stp x2, x3, [x1, #SDEI_EVENT_INTREGS + S_PC]
1267 stp x4, x5, [x1, #SDEI_EVENT_INTREGS + 16 * 2]
1268 stp x6, x7, [x1, #SDEI_EVENT_INTREGS + 16 * 3]
1269 stp x8, x9, [x1, #SDEI_EVENT_INTREGS + 16 * 4]
1270 stp x10, x11, [x1, #SDEI_EVENT_INTREGS + 16 * 5]
1271 stp x12, x13, [x1, #SDEI_EVENT_INTREGS + 16 * 6]
1272 stp x14, x15, [x1, #SDEI_EVENT_INTREGS + 16 * 7]
1273 stp x16, x17, [x1, #SDEI_EVENT_INTREGS + 16 * 8]
1274 stp x18, x19, [x1, #SDEI_EVENT_INTREGS + 16 * 9]
1275 stp x20, x21, [x1, #SDEI_EVENT_INTREGS + 16 * 10]
1276 stp x22, x23, [x1, #SDEI_EVENT_INTREGS + 16 * 11]
1277 stp x24, x25, [x1, #SDEI_EVENT_INTREGS + 16 * 12]
1278 stp x26, x27, [x1, #SDEI_EVENT_INTREGS + 16 * 13]
1279 stp x28, x29, [x1, #SDEI_EVENT_INTREGS + 16 * 14]
1280 mov x4, sp
1281 stp lr, x4, [x1, #SDEI_EVENT_INTREGS + S_LR]
1282
1283 mov x19, x1
1284
1285 #ifdef CONFIG_VMAP_STACK
1286
1287
1288
1289
1290
1291 ldrb w4, [x19, #SDEI_EVENT_PRIORITY]
1292 cbnz w4, 1f
1293 ldr_this_cpu dst=x5, sym=sdei_stack_normal_ptr, tmp=x6
1294 b 2f
1295 1: ldr_this_cpu dst=x5, sym=sdei_stack_critical_ptr, tmp=x6
1296 2: mov x6, #SDEI_STACK_SIZE
1297 add x5, x5, x6
1298 mov sp, x5
1299 #endif
1300
1301
1302
1303
1304
1305 mrs x28, sp_el0
1306 ldr_this_cpu dst=x0, sym=__entry_task, tmp=x1
1307 msr sp_el0, x0
1308
1309
1310 and x0, x3, #0xc
1311 mrs x1, CurrentEL
1312 cmp x0, x1
1313 csel x29, x29, xzr, eq
1314 csel x4, x2, xzr, eq
1315
1316 stp x29, x4, [sp, #-16]!
1317 mov x29, sp
1318
1319 add x0, x19, #SDEI_EVENT_INTREGS
1320 mov x1, x19
1321 bl __sdei_handler
1322
1323 msr sp_el0, x28
1324
1325 mov x4, x19
1326 ldp x28, x29, [x4, #SDEI_EVENT_INTREGS + 16 * 14]
1327 ldp x18, x19, [x4, #SDEI_EVENT_INTREGS + 16 * 9]
1328 ldp lr, x1, [x4, #SDEI_EVENT_INTREGS + S_LR]
1329 mov sp, x1
1330
1331 mov x1, x0
1332
1333 cmp x0, #1
1334 mov_q x2, SDEI_1_0_FN_SDEI_EVENT_COMPLETE
1335 mov_q x3, SDEI_1_0_FN_SDEI_EVENT_COMPLETE_AND_RESUME
1336 csel x0, x2, x3, ls
1337
1338 ldr_l x2, sdei_exit_mode
1339
1340 alternative_if_not ARM64_UNMAP_KERNEL_AT_EL0
1341 sdei_handler_exit exit_mode=x2
1342 alternative_else_nop_endif
1343
1344 #ifdef CONFIG_UNMAP_KERNEL_AT_EL0
1345 tramp_alias dst=x5, sym=__sdei_asm_exit_trampoline
1346 br x5
1347 #endif
1348 ENDPROC(__sdei_asm_handler)
1349 NOKPROBE(__sdei_asm_handler)
1350 #endif