1 /*
2 * Low-level ftrace handling
3 *
4 * Copyright (C) 2009 Michal Simek <monstr@mons
5 * Copyright (C) 2009 PetaLogix
6 *
7 * This file is subject to the terms and condi
8 * Public License. See the file COPYING in the
9 * archive for more details.
10 */
11
12 #include <linux/linkage.h>
13
14 #define NOALIGN_ENTRY(name) .globl name; n
15
16 /* FIXME MS: I think that I don't need to save
17 #define SAVE_REGS \
18 addik r1, r1, -120; \
19 swi r2, r1, 4; \
20 swi r3, r1, 8; \
21 swi r4, r1, 12; \
22 swi r5, r1, 116; \
23 swi r6, r1, 16; \
24 swi r7, r1, 20; \
25 swi r8, r1, 24; \
26 swi r9, r1, 28; \
27 swi r10, r1, 32; \
28 swi r11, r1, 36; \
29 swi r12, r1, 40; \
30 swi r13, r1, 44; \
31 swi r14, r1, 48; \
32 swi r16, r1, 52; \
33 swi r17, r1, 56; \
34 swi r18, r1, 60; \
35 swi r19, r1, 64; \
36 swi r20, r1, 68; \
37 swi r21, r1, 72; \
38 swi r22, r1, 76; \
39 swi r23, r1, 80; \
40 swi r24, r1, 84; \
41 swi r25, r1, 88; \
42 swi r26, r1, 92; \
43 swi r27, r1, 96; \
44 swi r28, r1, 100; \
45 swi r29, r1, 104; \
46 swi r30, r1, 108; \
47 swi r31, r1, 112;
48
49 #define RESTORE_REGS \
50 lwi r2, r1, 4; \
51 lwi r3, r1, 8; \
52 lwi r4, r1, 12; \
53 lwi r5, r1, 116; \
54 lwi r6, r1, 16; \
55 lwi r7, r1, 20; \
56 lwi r8, r1, 24; \
57 lwi r9, r1, 28; \
58 lwi r10, r1, 32; \
59 lwi r11, r1, 36; \
60 lwi r12, r1, 40; \
61 lwi r13, r1, 44; \
62 lwi r14, r1, 48; \
63 lwi r16, r1, 52; \
64 lwi r17, r1, 56; \
65 lwi r18, r1, 60; \
66 lwi r19, r1, 64; \
67 lwi r20, r1, 68; \
68 lwi r21, r1, 72; \
69 lwi r22, r1, 76; \
70 lwi r23, r1, 80; \
71 lwi r24, r1, 84; \
72 lwi r25, r1, 88; \
73 lwi r26, r1, 92; \
74 lwi r27, r1, 96; \
75 lwi r28, r1, 100; \
76 lwi r29, r1, 104; \
77 lwi r30, r1, 108; \
78 lwi r31, r1, 112; \
79 addik r1, r1, 120;
80
81 ENTRY(ftrace_stub)
82 rtsd r15, 8;
83 nop;
84
85 ENTRY(_mcount)
86 #ifdef CONFIG_DYNAMIC_FTRACE
87 ENTRY(ftrace_caller)
88 /* MS: It is just barrier which is rem
89 rtsd r15, 8
90 nop
91 #endif /* CONFIG_DYNAMIC_FTRACE */
92 SAVE_REGS
93 swi r15, r1, 0;
94 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
95 #ifndef CONFIG_DYNAMIC_FTRACE
96 lwi r5, r0, ftrace_graph_return;
97 addik r6, r0, ftrace_stub; /* asm im
98 cmpu r5, r5, r6; /* ftrace_graph_re
99 beqid r5, end_graph_tracer;
100 nop;
101
102 lwi r6, r0, ftrace_graph_entry;
103 addik r5, r0, ftrace_graph_entry_stu
104 cmpu r5, r5, r6; /* ftrace_graph_en
105 beqid r5, end_graph_tracer;
106 nop;
107 #else /* CONFIG_DYNAMIC_FTRACE */
108 NOALIGN_ENTRY(ftrace_call_graph)
109 /* MS: jump over graph function - repl
110 bri end_graph_tracer
111 #endif /* CONFIG_DYNAMIC_FTRACE */
112 addik r5, r1, 120; /* MS: load paren
113 addik r6, r15, 0; /* MS: load curren
114 bralid r15, prepare_ftrace_return;
115 nop;
116 /* MS: graph was taken that's why - ca
117 brid end;
118 nop;
119 end_graph_tracer:
120 #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
121 #ifndef CONFIG_DYNAMIC_FTRACE
122 /* MS: test function trace if is taken
123 lwi r20, r0, ftrace_trace_function
124 addik r6, r0, ftrace_stub;
125 cmpu r5, r20, r6; /* ftrace_trace_f
126 beqid r5, end; /* MS: not taken -> j
127 nop;
128 #else /* CONFIG_DYNAMIC_FTRACE */
129 NOALIGN_ENTRY(ftrace_call)
130 /* instruction for setup imm FUNC_part1, addik
131 nop
132 nop
133 #endif /* CONFIG_DYNAMIC_FTRACE */
134 /* static normal trace */
135 lwi r6, r1, 120; /* MS: load paren
136 addik r5, r15, -4; /* MS: load curre
137 /* MS: here is dependency on previous
138 brald r15, r20; /* MS: jump to ftrac
139 nop;
140 end:
141 lwi r15, r1, 0;
142 RESTORE_REGS
143
144 rtsd r15, 8; /* MS: jump back */
145 nop;
146
147 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
148 ENTRY(return_to_handler)
149 nop; /* MS: just barrier for rtsd r15,
150 nop;
151 SAVE_REGS
152 swi r15, r1, 0;
153
154 /* MS: find out returning address */
155 bralid r15, ftrace_return_to_handler;
156 nop;
157
158 /* MS: return value from ftrace_return
159 * must be before restore regs because
160 addik r15, r3, 0;
161 RESTORE_REGS
162
163 rtsd r15, 8; /* MS: jump back */
164 nop;
165 #endif /* CONFIG_FUNCTION_TRACER */
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.