/* SPDX-License-Identifier: GPL-2.0 */ /* * Copyright (C) 2022 Loongson Technology Corporation Limited */ #include #include #include #include .text /* * Due to -fpatchable-function-entry=2: the compiler inserted 2 NOPs before the * regular C function prologue. When PC arrived here, the last 2 instructions * are as follows: * move t0, ra * bl callsite (for modules, callsite is a tramplione) * * modules trampoline is as follows: * lu12i.w t1, callsite[31:12] * lu32i.d t1, callsite[51:32] * lu52i.d t1, t1, callsite[63:52] * jirl zero, t1, callsite[11:0] >> 2 * * See arch/loongarch/kernel/ftrace_dyn.c for details. Here, pay attention to * that the T series regs are available and safe because each C functions * follows the LoongArch's psABI as well. */ .macro ftrace_regs_entry allregs=0 PTR_ADDI sp, sp, -PT_SIZE PTR_S t0, sp, PT_R1 /* Save parent ra at PT_R1(RA) */ PTR_S a0, sp, PT_R4 PTR_S a1, sp, PT_R5 PTR_S a2, sp, PT_R6 PTR_S a3, sp, PT_R7 PTR_S a4, sp, PT_R8 PTR_S a5, sp, PT_R9 PTR_S a6, sp, PT_R10 PTR_S a7, sp, PT_R11 PTR_S fp, sp, PT_R22 .if \allregs PTR_S tp, sp, PT_R2 PTR_S t0, sp, PT_R12 PTR_S t2, sp, PT_R14 PTR_S t3, sp, PT_R15 PTR_S t4, sp, PT_R16 PTR_S t5, sp, PT_R17 PTR_S t6, sp, PT_R18 PTR_S t7, sp, PT_R19 PTR_S t8, sp, PT_R20 PTR_S u0, sp, PT_R21 PTR_S s0, sp, PT_R23 PTR_S s1, sp, PT_R24 PTR_S s2, sp, PT_R25 PTR_S s3, sp, PT_R26 PTR_S s4, sp, PT_R27 PTR_S s5, sp, PT_R28 PTR_S s6, sp, PT_R29 PTR_S s7, sp, PT_R30 PTR_S s8, sp, PT_R31 /* Clear it for later use as a flag sometimes. */ PTR_S zero, sp, PT_R0 .endif PTR_S ra, sp, PT_ERA /* Save trace function ra at PT_ERA */ move t1, zero PTR_S t1, sp, PT_R13 PTR_ADDI t8, sp, PT_SIZE PTR_S t8, sp, PT_R3 .endm SYM_FUNC_START(ftrace_stub) jr ra SYM_FUNC_END(ftrace_stub) SYM_CODE_START(ftrace_common) PTR_ADDI a0, ra, -8 /* arg0: ip */ move a1, t0 /* arg1: parent_ip */ la.pcrel t1, function_trace_op PTR_L a2, t1, 0 /* arg2: op */ move a3, sp /* arg3: regs */ SYM_INNER_LABEL(ftrace_call, SYM_L_GLOBAL) bl ftrace_stub #ifdef CONFIG_FUNCTION_GRAPH_TRACER SYM_INNER_LABEL(ftrace_graph_call, SYM_L_GLOBAL) nop /* b ftrace_graph_caller */ #endif /* * As we didn't use S series regs in this assmembly code and all calls * are C function which will save S series regs by themselves, there is * no need to restore S series regs. The T series is available and safe * at the callsite, so there is no need to restore the T series regs. */ ftrace_common_return: PTR_L ra, sp, PT_R1 PTR_L a0, sp, PT_R4 PTR_L a1, sp, PT_R5 PTR_L a2, sp, PT_R6 PTR_L a3, sp, PT_R7 PTR_L a4, sp, PT_R8 PTR_L a5, sp, PT_R9 PTR_L a6, sp, PT_R10 PTR_L a7, sp, PT_R11 PTR_L fp, sp, PT_R22 PTR_L t0, sp, PT_ERA PTR_L t1, sp, PT_R13 PTR_ADDI sp, sp, PT_SIZE bnez t1, .Ldirect jr t0 .Ldirect: jr t1 SYM_CODE_END(ftrace_common) SYM_CODE_START(ftrace_caller) ftrace_regs_entry allregs=0 b ftrace_common SYM_CODE_END(ftrace_caller) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS SYM_CODE_START(ftrace_regs_caller) ftrace_regs_entry allregs=1 b ftrace_common SYM_CODE_END(ftrace_regs_caller) #endif #ifdef CONFIG_FUNCTION_GRAPH_TRACER SYM_CODE_START(ftrace_graph_caller) PTR_L a0, sp, PT_ERA PTR_ADDI a0, a0, -8 /* arg0: self_addr */ PTR_ADDI a1, sp, PT_R1 /* arg1: parent */ bl prepare_ftrace_return b ftrace_common_return SYM_CODE_END(ftrace_graph_caller) SYM_CODE_START(return_to_handler) /* Save return value regs */ PTR_ADDI sp, sp, -FGRET_REGS_SIZE PTR_S a0, sp, FGRET_REGS_A0 PTR_S a1, sp, FGRET_REGS_A1 PTR_S zero, sp, FGRET_REGS_FP move a0, sp bl ftrace_return_to_handler move ra, a0 /* Restore return value regs */ PTR_L a0, sp, FGRET_REGS_A0 PTR_L a1, sp, FGRET_REGS_A1 PTR_ADDI sp, sp, FGRET_REGS_SIZE jr ra SYM_CODE_END(return_to_handler) #endif #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS SYM_CODE_START(ftrace_stub_direct_tramp) jr t0 SYM_CODE_END(ftrace_stub_direct_tramp) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */