| /* SPDX-License-Identifier: GPL-2.0-or-later */ |
| |
| /* TOC (Transfer of Control) handler. */ |
| |
| .level 1.1 |
| |
| #include <asm/assembly.h> |
| #include <linux/threads.h> |
| #include <linux/linkage.h> |
| |
| .text |
| .import toc_intr,code |
| .import toc_stack,data |
| .align 16 |
| ENTRY_CFI(toc_handler) |
| load32 PA(toc_stack),%sp |
| |
| #ifdef CONFIG_SMP |
| /* get per-cpu toc_stack address. */ |
| mfctl %cr30, %r1 |
| tophys %r1,%r2 /* task_struct */ |
| LDREG TASK_TI_CPU(%r2),%r4 /* cpu */ |
| load32 PA(__per_cpu_offset),%r1 |
| LDREGX %r4(%r1),%r4 |
| add %r4,%sp,%sp |
| #endif |
| |
| /* |
| * setup pt_regs on stack and save the |
| * floating point registers. PIM_TOC doesn't |
| * save fp registers, so we're doing it here. |
| */ |
| copy %sp,%arg0 |
| ldo PT_SZ_ALGN(%sp), %sp |
| |
| /* clear pt_regs */ |
| copy %arg0,%r1 |
| 0: cmpb,<<,n %r1,%sp,0b |
| stw,ma %r0,4(%r1) |
| |
| ldo PT_FR0(%arg0),%r25 |
| save_fp %r25 |
| |
| /* go virtual */ |
| load32 PA(swapper_pg_dir),%r4 |
| mtctl %r4,%cr24 |
| mtctl %r4,%cr25 |
| |
| /* Clear sr4-sr7 */ |
| mtsp %r0, %sr4 |
| mtsp %r0, %sr5 |
| mtsp %r0, %sr6 |
| mtsp %r0, %sr7 |
| |
| tovirt_r1 %sp |
| tovirt_r1 %arg0 |
| virt_map |
| |
| loadgp |
| |
| #ifdef CONFIG_64BIT |
| ldo -16(%sp),%r29 |
| #endif |
| load32 toc_intr,%r1 |
| be 0(%sr7,%r1) |
| nop |
| ENDPROC_CFI(toc_handler) |
| |
| /* |
| * keep this checksum here, as it is part of the toc_handler |
| * spanned by toc_handler_size (all words in toc_handler are |
| * added in PDC and the sum must equal to zero. |
| */ |
| SYM_DATA(toc_handler_csum, .long 0) |
| SYM_DATA(toc_handler_size, .long . - toc_handler) |
