OSDN Git Service

media: uvcvideo: Avoid cyclic entity chains due to malformed USB descriptors
[sagit-ice-cold/kernel_xiaomi_msm8998.git] / kernel / trace / bpf_trace.c
1 /* Copyright (c) 2011-2015 PLUMgrid, http://plumgrid.com
2  *
3  * This program is free software; you can redistribute it and/or
4  * modify it under the terms of version 2 of the GNU General Public
5  * License as published by the Free Software Foundation.
6  */
7 #include <linux/kernel.h>
8 #include <linux/types.h>
9 #include <linux/slab.h>
10 #include <linux/bpf.h>
11 #include <linux/filter.h>
12 #include <linux/uaccess.h>
13 #include <linux/ctype.h>
14 #include "trace.h"
15
16 static DEFINE_PER_CPU(int, bpf_prog_active);
17
18 /**
19  * trace_call_bpf - invoke BPF program
20  * @prog: BPF program
21  * @ctx: opaque context pointer
22  *
23  * kprobe handlers execute BPF programs via this helper.
24  * Can be used from static tracepoints in the future.
25  *
26  * Return: BPF programs always return an integer which is interpreted by
27  * kprobe handler as:
28  * 0 - return from kprobe (event is filtered out)
29  * 1 - store kprobe event into ring buffer
30  * Other values are reserved and currently alias to 1
31  */
32 unsigned int trace_call_bpf(struct bpf_prog *prog, void *ctx)
33 {
34         unsigned int ret;
35
36         if (in_nmi()) /* not supported yet */
37                 return 1;
38
39         preempt_disable();
40
41         if (unlikely(__this_cpu_inc_return(bpf_prog_active) != 1)) {
42                 /*
43                  * since some bpf program is already running on this cpu,
44                  * don't call into another bpf program (same or different)
45                  * and don't send kprobe event into ring-buffer,
46                  * so return zero here
47                  */
48                 ret = 0;
49                 goto out;
50         }
51
52         rcu_read_lock();
53         ret = BPF_PROG_RUN(prog, ctx);
54         rcu_read_unlock();
55
56  out:
57         __this_cpu_dec(bpf_prog_active);
58         preempt_enable();
59
60         return ret;
61 }
62 EXPORT_SYMBOL_GPL(trace_call_bpf);
63
64 static u64 bpf_probe_read(u64 r1, u64 r2, u64 r3, u64 r4, u64 r5)
65 {
66         void *dst = (void *) (long) r1;
67         int size = (int) r2;
68         void *unsafe_ptr = (void *) (long) r3;
69
70         return probe_kernel_read(dst, unsafe_ptr, size);
71 }
72
73 static const struct bpf_func_proto bpf_probe_read_proto = {
74         .func           = bpf_probe_read,
75         .gpl_only       = true,
76         .ret_type       = RET_INTEGER,
77         .arg1_type      = ARG_PTR_TO_STACK,
78         .arg2_type      = ARG_CONST_STACK_SIZE,
79         .arg3_type      = ARG_ANYTHING,
80 };
81
82 /*
83  * limited trace_printk()
84  * only %d %u %x %ld %lu %lx %lld %llu %llx %p %s conversion specifiers allowed
85  */
86 static u64 bpf_trace_printk(u64 r1, u64 fmt_size, u64 r3, u64 r4, u64 r5)
87 {
88         char *fmt = (char *) (long) r1;
89         bool str_seen = false;
90         int mod[3] = {};
91         int fmt_cnt = 0;
92         u64 unsafe_addr;
93         char buf[64];
94         int i;
95
96         /*
97          * bpf_check()->check_func_arg()->check_stack_boundary()
98          * guarantees that fmt points to bpf program stack,
99          * fmt_size bytes of it were initialized and fmt_size > 0
100          */
101         if (fmt[--fmt_size] != 0)
102                 return -EINVAL;
103
104         /* check format string for allowed specifiers */
105         for (i = 0; i < fmt_size; i++) {
106                 if ((!isprint(fmt[i]) && !isspace(fmt[i])) || !isascii(fmt[i]))
107                         return -EINVAL;
108
109                 if (fmt[i] != '%')
110                         continue;
111
112                 if (fmt_cnt >= 3)
113                         return -EINVAL;
114
115                 /* fmt[i] != 0 && fmt[last] == 0, so we can access fmt[i + 1] */
116                 i++;
117                 if (fmt[i] == 'l') {
118                         mod[fmt_cnt]++;
119                         i++;
120                 } else if (fmt[i] == 'p' || fmt[i] == 's') {
121                         mod[fmt_cnt]++;
122                         /* disallow any further format extensions */
123                         if (fmt[i + 1] != 0 &&
124                             !isspace(fmt[i + 1]) &&
125                             !ispunct(fmt[i + 1]))
126                                 return -EINVAL;
127                         fmt_cnt++;
128                         if (fmt[i] == 's') {
129                                 if (str_seen)
130                                         /* allow only one '%s' per fmt string */
131                                         return -EINVAL;
132                                 str_seen = true;
133
134                                 switch (fmt_cnt) {
135                                 case 1:
136                                         unsafe_addr = r3;
137                                         r3 = (long) buf;
138                                         break;
139                                 case 2:
140                                         unsafe_addr = r4;
141                                         r4 = (long) buf;
142                                         break;
143                                 case 3:
144                                         unsafe_addr = r5;
145                                         r5 = (long) buf;
146                                         break;
147                                 }
148                                 buf[0] = 0;
149                                 strncpy_from_unsafe(buf,
150                                                     (void *) (long) unsafe_addr,
151                                                     sizeof(buf));
152                         }
153                         continue;
154                 }
155
156                 if (fmt[i] == 'l') {
157                         mod[fmt_cnt]++;
158                         i++;
159                 }
160
161                 if (fmt[i] != 'd' && fmt[i] != 'u' && fmt[i] != 'x')
162                         return -EINVAL;
163                 fmt_cnt++;
164         }
165
166         return __trace_printk(1/* fake ip will not be printed */, fmt,
167                               mod[0] == 2 ? r3 : mod[0] == 1 ? (long) r3 : (u32) r3,
168                               mod[1] == 2 ? r4 : mod[1] == 1 ? (long) r4 : (u32) r4,
169                               mod[2] == 2 ? r5 : mod[2] == 1 ? (long) r5 : (u32) r5);
170 }
171
172 static const struct bpf_func_proto bpf_trace_printk_proto = {
173         .func           = bpf_trace_printk,
174         .gpl_only       = true,
175         .ret_type       = RET_INTEGER,
176         .arg1_type      = ARG_PTR_TO_STACK,
177         .arg2_type      = ARG_CONST_STACK_SIZE,
178 };
179
180 const struct bpf_func_proto *bpf_get_trace_printk_proto(void)
181 {
182         /*
183          * this program might be calling bpf_trace_printk,
184          * so allocate per-cpu printk buffers
185          */
186         trace_printk_init_buffers();
187
188         return &bpf_trace_printk_proto;
189 }
190
191 static u64 bpf_perf_event_read(u64 r1, u64 index, u64 r3, u64 r4, u64 r5)
192 {
193         struct bpf_map *map = (struct bpf_map *) (unsigned long) r1;
194         struct bpf_array *array = container_of(map, struct bpf_array, map);
195         struct perf_event *event;
196
197         if (unlikely(index >= array->map.max_entries))
198                 return -E2BIG;
199
200         event = (struct perf_event *)array->ptrs[index];
201         if (!event)
202                 return -ENOENT;
203
204         /* make sure event is local and doesn't have pmu::count */
205         if (event->oncpu != smp_processor_id() ||
206             event->pmu->count)
207                 return -EINVAL;
208
209         /*
210          * we don't know if the function is run successfully by the
211          * return value. It can be judged in other places, such as
212          * eBPF programs.
213          */
214         return perf_event_read_local(event);
215 }
216
217 static const struct bpf_func_proto bpf_perf_event_read_proto = {
218         .func           = bpf_perf_event_read,
219         .gpl_only       = true,
220         .ret_type       = RET_INTEGER,
221         .arg1_type      = ARG_CONST_MAP_PTR,
222         .arg2_type      = ARG_ANYTHING,
223 };
224
225 static u64 bpf_perf_event_output(u64 r1, u64 r2, u64 index, u64 r4, u64 size)
226 {
227         struct pt_regs *regs = (struct pt_regs *) (long) r1;
228         struct bpf_map *map = (struct bpf_map *) (long) r2;
229         struct bpf_array *array = container_of(map, struct bpf_array, map);
230         void *data = (void *) (long) r4;
231         struct perf_sample_data sample_data;
232         struct perf_event *event;
233         struct perf_raw_record raw = {
234                 .size = size,
235                 .data = data,
236         };
237
238         if (unlikely(index >= array->map.max_entries))
239                 return -E2BIG;
240
241         event = (struct perf_event *)array->ptrs[index];
242         if (unlikely(!event))
243                 return -ENOENT;
244
245         if (unlikely(event->attr.type != PERF_TYPE_SOFTWARE ||
246                      event->attr.config != PERF_COUNT_SW_BPF_OUTPUT))
247                 return -EINVAL;
248
249         if (unlikely(event->oncpu != smp_processor_id()))
250                 return -EOPNOTSUPP;
251
252         perf_sample_data_init(&sample_data, 0, 0);
253         sample_data.raw = &raw;
254         perf_event_output(event, &sample_data, regs);
255         return 0;
256 }
257
258 static const struct bpf_func_proto bpf_perf_event_output_proto = {
259         .func           = bpf_perf_event_output,
260         .gpl_only       = true,
261         .ret_type       = RET_INTEGER,
262         .arg1_type      = ARG_PTR_TO_CTX,
263         .arg2_type      = ARG_CONST_MAP_PTR,
264         .arg3_type      = ARG_ANYTHING,
265         .arg4_type      = ARG_PTR_TO_STACK,
266         .arg5_type      = ARG_CONST_STACK_SIZE,
267 };
268
269 static const struct bpf_func_proto *kprobe_prog_func_proto(enum bpf_func_id func_id)
270 {
271         switch (func_id) {
272         case BPF_FUNC_map_lookup_elem:
273                 return &bpf_map_lookup_elem_proto;
274         case BPF_FUNC_map_update_elem:
275                 return &bpf_map_update_elem_proto;
276         case BPF_FUNC_map_delete_elem:
277                 return &bpf_map_delete_elem_proto;
278         case BPF_FUNC_probe_read:
279                 return &bpf_probe_read_proto;
280         case BPF_FUNC_ktime_get_ns:
281                 return &bpf_ktime_get_ns_proto;
282         case BPF_FUNC_tail_call:
283                 return &bpf_tail_call_proto;
284         case BPF_FUNC_get_current_pid_tgid:
285                 return &bpf_get_current_pid_tgid_proto;
286         case BPF_FUNC_get_current_uid_gid:
287                 return &bpf_get_current_uid_gid_proto;
288         case BPF_FUNC_get_current_comm:
289                 return &bpf_get_current_comm_proto;
290         case BPF_FUNC_trace_printk:
291                 return bpf_get_trace_printk_proto();
292         case BPF_FUNC_get_smp_processor_id:
293                 return &bpf_get_smp_processor_id_proto;
294         case BPF_FUNC_perf_event_read:
295                 return &bpf_perf_event_read_proto;
296         case BPF_FUNC_perf_event_output:
297                 return &bpf_perf_event_output_proto;
298         default:
299                 return NULL;
300         }
301 }
302
303 /* bpf+kprobe programs can access fields of 'struct pt_regs' */
304 static bool kprobe_prog_is_valid_access(int off, int size, enum bpf_access_type type)
305 {
306         /* check bounds */
307         if (off < 0 || off >= sizeof(struct pt_regs))
308                 return false;
309
310         /* only read is allowed */
311         if (type != BPF_READ)
312                 return false;
313
314         /* disallow misaligned access */
315         if (off % size != 0)
316                 return false;
317
318         return true;
319 }
320
321 static struct bpf_verifier_ops kprobe_prog_ops = {
322         .get_func_proto  = kprobe_prog_func_proto,
323         .is_valid_access = kprobe_prog_is_valid_access,
324 };
325
326 static struct bpf_prog_type_list kprobe_tl = {
327         .ops    = &kprobe_prog_ops,
328         .type   = BPF_PROG_TYPE_KPROBE,
329 };
330
331 static int __init register_kprobe_prog_ops(void)
332 {
333         bpf_register_prog_type(&kprobe_tl);
334         return 0;
335 }
336 late_initcall(register_kprobe_prog_ops);