GNU Linux-libre 4.14.328-gnu1
[releases.git] / net / bpf / test_run.c
1 /* Copyright (c) 2017 Facebook
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/bpf.h>
8 #include <linux/slab.h>
9 #include <linux/vmalloc.h>
10 #include <linux/etherdevice.h>
11 #include <linux/filter.h>
12 #include <linux/sched/signal.h>
13
14 static __always_inline u32 bpf_test_run_one(struct bpf_prog *prog, void *ctx)
15 {
16         u32 ret;
17
18         preempt_disable();
19         rcu_read_lock();
20         ret = BPF_PROG_RUN(prog, ctx);
21         rcu_read_unlock();
22         preempt_enable();
23
24         return ret;
25 }
26
27 static u32 bpf_test_run(struct bpf_prog *prog, void *ctx, u32 repeat, u32 *time)
28 {
29         u64 time_start, time_spent = 0;
30         u32 ret = 0, i;
31
32         if (!repeat)
33                 repeat = 1;
34         time_start = ktime_get_ns();
35         for (i = 0; i < repeat; i++) {
36                 ret = bpf_test_run_one(prog, ctx);
37                 if (need_resched()) {
38                         if (signal_pending(current))
39                                 break;
40                         time_spent += ktime_get_ns() - time_start;
41                         cond_resched();
42                         time_start = ktime_get_ns();
43                 }
44         }
45         time_spent += ktime_get_ns() - time_start;
46         do_div(time_spent, repeat);
47         *time = time_spent > U32_MAX ? U32_MAX : (u32)time_spent;
48
49         return ret;
50 }
51
52 static int bpf_test_finish(const union bpf_attr *kattr,
53                            union bpf_attr __user *uattr, const void *data,
54                            u32 size, u32 retval, u32 duration)
55 {
56         void __user *data_out = u64_to_user_ptr(kattr->test.data_out);
57         int err = -EFAULT;
58
59         if (data_out && copy_to_user(data_out, data, size))
60                 goto out;
61         if (copy_to_user(&uattr->test.data_size_out, &size, sizeof(size)))
62                 goto out;
63         if (copy_to_user(&uattr->test.retval, &retval, sizeof(retval)))
64                 goto out;
65         if (copy_to_user(&uattr->test.duration, &duration, sizeof(duration)))
66                 goto out;
67         err = 0;
68 out:
69         return err;
70 }
71
72 static void *bpf_test_init(const union bpf_attr *kattr, u32 size,
73                            u32 headroom, u32 tailroom)
74 {
75         void __user *data_in = u64_to_user_ptr(kattr->test.data_in);
76         void *data;
77
78         if (size < ETH_HLEN || size > PAGE_SIZE - headroom - tailroom)
79                 return ERR_PTR(-EINVAL);
80
81         size = SKB_DATA_ALIGN(size);
82         data = kzalloc(size + headroom + tailroom, GFP_USER);
83         if (!data)
84                 return ERR_PTR(-ENOMEM);
85
86         if (copy_from_user(data + headroom, data_in, size)) {
87                 kfree(data);
88                 return ERR_PTR(-EFAULT);
89         }
90         return data;
91 }
92
93 int bpf_prog_test_run_skb(struct bpf_prog *prog, const union bpf_attr *kattr,
94                           union bpf_attr __user *uattr)
95 {
96         bool is_l2 = false, is_direct_pkt_access = false;
97         u32 size = kattr->test.data_size_in;
98         u32 repeat = kattr->test.repeat;
99         u32 retval, duration;
100         int hh_len = ETH_HLEN;
101         struct sk_buff *skb;
102         void *data;
103         int ret;
104
105         data = bpf_test_init(kattr, size, NET_SKB_PAD + NET_IP_ALIGN,
106                              SKB_DATA_ALIGN(sizeof(struct skb_shared_info)));
107         if (IS_ERR(data))
108                 return PTR_ERR(data);
109
110         switch (prog->type) {
111         case BPF_PROG_TYPE_SCHED_CLS:
112         case BPF_PROG_TYPE_SCHED_ACT:
113                 is_l2 = true;
114                 /* fall through */
115         case BPF_PROG_TYPE_LWT_IN:
116         case BPF_PROG_TYPE_LWT_OUT:
117         case BPF_PROG_TYPE_LWT_XMIT:
118                 is_direct_pkt_access = true;
119                 break;
120         default:
121                 break;
122         }
123
124         skb = build_skb(data, 0);
125         if (!skb) {
126                 kfree(data);
127                 return -ENOMEM;
128         }
129
130         skb_reserve(skb, NET_SKB_PAD + NET_IP_ALIGN);
131         __skb_put(skb, size);
132         skb->protocol = eth_type_trans(skb, current->nsproxy->net_ns->loopback_dev);
133         skb_reset_network_header(skb);
134
135         if (is_l2)
136                 __skb_push(skb, hh_len);
137         if (is_direct_pkt_access)
138                 bpf_compute_data_end(skb);
139         retval = bpf_test_run(prog, skb, repeat, &duration);
140         if (!is_l2) {
141                 if (skb_headroom(skb) < hh_len) {
142                         int nhead = HH_DATA_ALIGN(hh_len - skb_headroom(skb));
143
144                         if (pskb_expand_head(skb, nhead, 0, GFP_USER)) {
145                                 kfree_skb(skb);
146                                 return -ENOMEM;
147                         }
148                 }
149                 memset(__skb_push(skb, hh_len), 0, hh_len);
150         }
151
152         size = skb->len;
153         /* bpf program can never convert linear skb to non-linear */
154         if (WARN_ON_ONCE(skb_is_nonlinear(skb)))
155                 size = skb_headlen(skb);
156         ret = bpf_test_finish(kattr, uattr, skb->data, size, retval, duration);
157         kfree_skb(skb);
158         return ret;
159 }
160
161 int bpf_prog_test_run_xdp(struct bpf_prog *prog, const union bpf_attr *kattr,
162                           union bpf_attr __user *uattr)
163 {
164         u32 size = kattr->test.data_size_in;
165         u32 repeat = kattr->test.repeat;
166         struct xdp_buff xdp = {};
167         u32 retval, duration;
168         void *data;
169         int ret;
170
171         data = bpf_test_init(kattr, size, XDP_PACKET_HEADROOM + NET_IP_ALIGN, 0);
172         if (IS_ERR(data))
173                 return PTR_ERR(data);
174
175         xdp.data_hard_start = data;
176         xdp.data = data + XDP_PACKET_HEADROOM + NET_IP_ALIGN;
177         xdp.data_end = xdp.data + size;
178
179         retval = bpf_test_run(prog, &xdp, repeat, &duration);
180         if (xdp.data != data + XDP_PACKET_HEADROOM + NET_IP_ALIGN)
181                 size = xdp.data_end - xdp.data;
182         ret = bpf_test_finish(kattr, uattr, xdp.data, size, retval, duration);
183         kfree(data);
184         return ret;
185 }