ronnie
2022-10-23 e3a1b9bdd0692904702c0e734ea5dfde3b0ac8fb
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
#include <linux/sched.h>
#include <linux/stacktrace.h>
#include <linux/stacktrace.h>
#include <asm/stacktrace.h>
 
void walk_stackframe(unsigned long sp,
            int (*fn)(unsigned long addr, void *data),
            void *data)
{
   unsigned long high = ALIGN(sp, THREAD_SIZE);
 
   for (; sp <= high - 4; sp += 4) {
       unsigned long addr = *(unsigned long *) sp;
 
       if (!kernel_text_address(addr))
           continue;
 
       if (fn(addr, data))
           break;
   }
}
 
struct stack_trace_data {
   struct stack_trace *trace;
   unsigned int no_sched_functions;
   unsigned int skip;
};
 
#ifdef CONFIG_STACKTRACE
 
static int save_trace(unsigned long addr, void *d)
{
   struct stack_trace_data *data = d;
   struct stack_trace *trace = data->trace;
 
   if (data->no_sched_functions && in_sched_functions(addr))
       return 0;
 
   if (data->skip) {
       data->skip--;
       return 0;
   }
 
   trace->entries[trace->nr_entries++] = addr;
 
   return trace->nr_entries >= trace->max_entries;
}
 
void save_stack_trace_tsk(struct task_struct *tsk, struct stack_trace *trace)
{
   struct stack_trace_data data;
   unsigned long sp;
 
   data.trace = trace;
   data.skip = trace->skip;
 
   if (tsk != current) {
       data.no_sched_functions = 1;
       sp = tsk->thread.ksp;
   } else {
       data.no_sched_functions = 0;
       sp = rdsp();
   }
 
   walk_stackframe(sp, save_trace, &data);
   if (trace->nr_entries < trace->max_entries)
       trace->entries[trace->nr_entries++] = ULONG_MAX;
}
 
void save_stack_trace(struct stack_trace *trace)
{
   save_stack_trace_tsk(current, trace);
}
EXPORT_SYMBOL_GPL(save_stack_trace);
 
#endif /* CONFIG_STACKTRACE */