1 /* SPDX-License-Identifier: GPL-2.0-or-later */ 2 3 /* TOC (Transfer of Control) handler. */ 4 5 .level 1.1 6 7 #include <asm/assembly.h> 8 #include <linux/threads.h> 9 #include <linux/linkage.h> 10 11 .text 12 .import toc_intr,code 13 .import toc_stack,data 14 .align 16 15 ENTRY_CFI(toc_handler) 16 load32 PA(toc_stack),%sp 17 18 #ifdef CONFIG_SMP 19 /* get per-cpu toc_stack address. */ 20 mfctl %cr30, %r1 21 tophys %r1,%r2 /* task_struct */ 22 LDREG TASK_TI_CPU(%r2),%r4 /* cpu */ 23 load32 PA(__per_cpu_offset),%r1 24 LDREGX %r4(%r1),%r4 25 add %r4,%sp,%sp 26 #endif 27 28 /* 29 * setup pt_regs on stack and save the 30 * floating point registers. PIM_TOC doesn't 31 * save fp registers, so we're doing it here. 32 */ 33 copy %sp,%arg0 34 ldo PT_SZ_ALGN(%sp), %sp 35 36 /* clear pt_regs */ 37 copy %arg0,%r1 38 0: cmpb,<<,n %r1,%sp,0b 39 stw,ma %r0,4(%r1) 40 41 ldo PT_FR0(%arg0),%r25 42 save_fp %r25 43 44 /* go virtual */ 45 load32 PA(swapper_pg_dir),%r4 46 mtctl %r4,%cr24 47 mtctl %r4,%cr25 48 49 /* Clear sr4-sr7 */ 50 mtsp %r0, %sr4 51 mtsp %r0, %sr5 52 mtsp %r0, %sr6 53 mtsp %r0, %sr7 54 55 tovirt_r1 %sp 56 tovirt_r1 %arg0 57 virt_map 58 59 loadgp 60 61 #ifdef CONFIG_64BIT 62 ldo -16(%sp),%r29 63 #endif 64 load32 toc_intr,%r1 65 be 0(%sr7,%r1) 66 nop 67 ENDPROC_CFI(toc_handler) 68 69 /* 70 * keep this checksum here, as it is part of the toc_handler 71 * spanned by toc_handler_size (all words in toc_handler are 72 * added in PDC and the sum must equal to zero. 73 */ 74 SYM_DATA(toc_handler_csum, .long 0) 75 SYM_DATA(toc_handler_size, .long . - toc_handler) 76