76 lines
1.4 KiB
ArmAsm
76 lines
1.4 KiB
ArmAsm
/* 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)
|