blob: 01149821ded91a2995b58a6656edb6f05916102e [file] [log] [blame]
David Brazdil0f672f62019-12-10 10:32:29 +00001// SPDX-License-Identifier: GPL-2.0-only
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002/* Copyright (c) 2017 Covalent IO, Inc. http://covalent.io
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003 */
4
5/* Devmaps primary use is as a backend map for XDP BPF helper call
6 * bpf_redirect_map(). Because XDP is mostly concerned with performance we
7 * spent some effort to ensure the datapath with redirect maps does not use
8 * any locking. This is a quick note on the details.
9 *
10 * We have three possible paths to get into the devmap control plane bpf
11 * syscalls, bpf programs, and driver side xmit/flush operations. A bpf syscall
12 * will invoke an update, delete, or lookup operation. To ensure updates and
13 * deletes appear atomic from the datapath side xchg() is used to modify the
14 * netdev_map array. Then because the datapath does a lookup into the netdev_map
15 * array (read-only) from an RCU critical section we use call_rcu() to wait for
16 * an rcu grace period before free'ing the old data structures. This ensures the
17 * datapath always has a valid copy. However, the datapath does a "flush"
18 * operation that pushes any pending packets in the driver outside the RCU
19 * critical section. Each bpf_dtab_netdev tracks these pending operations using
David Brazdil0f672f62019-12-10 10:32:29 +000020 * a per-cpu flush list. The bpf_dtab_netdev object will not be destroyed until
21 * this list is empty, indicating outstanding flush operations have completed.
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000022 *
23 * BPF syscalls may race with BPF program calls on any of the update, delete
24 * or lookup operations. As noted above the xchg() operation also keep the
25 * netdev_map consistent in this case. From the devmap side BPF programs
26 * calling into these operations are the same as multiple user space threads
27 * making system calls.
28 *
29 * Finally, any of the above may race with a netdev_unregister notifier. The
30 * unregister notifier must search for net devices in the map structure that
31 * contain a reference to the net device and remove them. This is a two step
32 * process (a) dereference the bpf_dtab_netdev object in netdev_map and (b)
33 * check to see if the ifindex is the same as the net_device being removed.
34 * When removing the dev a cmpxchg() is used to ensure the correct dev is
35 * removed, in the case of a concurrent update or delete operation it is
36 * possible that the initially referenced dev is no longer in the map. As the
37 * notifier hook walks the map we know that new dev references can not be
38 * added by the user because core infrastructure ensures dev_get_by_index()
39 * calls will fail at this point.
David Brazdil0f672f62019-12-10 10:32:29 +000040 *
41 * The devmap_hash type is a map type which interprets keys as ifindexes and
42 * indexes these using a hashmap. This allows maps that use ifindex as key to be
43 * densely packed instead of having holes in the lookup array for unused
44 * ifindexes. The setup and packet enqueue/send code is shared between the two
45 * types of devmap; only the lookup and insertion is different.
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000046 */
47#include <linux/bpf.h>
48#include <net/xdp.h>
49#include <linux/filter.h>
50#include <trace/events/xdp.h>
51
52#define DEV_CREATE_FLAG_MASK \
53 (BPF_F_NUMA_NODE | BPF_F_RDONLY | BPF_F_WRONLY)
54
Olivier Deprez157378f2022-04-04 15:47:50 +020055struct xdp_dev_bulk_queue {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000056 struct xdp_frame *q[DEV_MAP_BULK_SIZE];
David Brazdil0f672f62019-12-10 10:32:29 +000057 struct list_head flush_node;
Olivier Deprez157378f2022-04-04 15:47:50 +020058 struct net_device *dev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000059 struct net_device *dev_rx;
60 unsigned int count;
61};
62
63struct bpf_dtab_netdev {
64 struct net_device *dev; /* must be first member, due to tracepoint */
David Brazdil0f672f62019-12-10 10:32:29 +000065 struct hlist_node index_hlist;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000066 struct bpf_dtab *dtab;
Olivier Deprez157378f2022-04-04 15:47:50 +020067 struct bpf_prog *xdp_prog;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000068 struct rcu_head rcu;
Olivier Deprez157378f2022-04-04 15:47:50 +020069 unsigned int idx;
70 struct bpf_devmap_val val;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000071};
72
73struct bpf_dtab {
74 struct bpf_map map;
Olivier Deprez0e641232021-09-23 10:07:05 +020075 struct bpf_dtab_netdev **netdev_map; /* DEVMAP type only */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000076 struct list_head list;
David Brazdil0f672f62019-12-10 10:32:29 +000077
78 /* these are only used for DEVMAP_HASH type maps */
79 struct hlist_head *dev_index_head;
80 spinlock_t index_lock;
81 unsigned int items;
82 u32 n_buckets;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000083};
84
Olivier Deprez157378f2022-04-04 15:47:50 +020085static DEFINE_PER_CPU(struct list_head, dev_flush_list);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000086static DEFINE_SPINLOCK(dev_map_lock);
87static LIST_HEAD(dev_map_list);
88
Olivier Deprez0e641232021-09-23 10:07:05 +020089static struct hlist_head *dev_map_create_hash(unsigned int entries,
90 int numa_node)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000091{
David Brazdil0f672f62019-12-10 10:32:29 +000092 int i;
93 struct hlist_head *hash;
94
Olivier Deprez157378f2022-04-04 15:47:50 +020095 hash = bpf_map_area_alloc((u64) entries * sizeof(*hash), numa_node);
David Brazdil0f672f62019-12-10 10:32:29 +000096 if (hash != NULL)
97 for (i = 0; i < entries; i++)
98 INIT_HLIST_HEAD(&hash[i]);
99
100 return hash;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000101}
102
Olivier Deprez0e641232021-09-23 10:07:05 +0200103static inline struct hlist_head *dev_map_index_hash(struct bpf_dtab *dtab,
104 int idx)
105{
106 return &dtab->dev_index_head[idx & (dtab->n_buckets - 1)];
107}
108
David Brazdil0f672f62019-12-10 10:32:29 +0000109static int dev_map_init_map(struct bpf_dtab *dtab, union bpf_attr *attr)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000110{
Olivier Deprez157378f2022-04-04 15:47:50 +0200111 u32 valsize = attr->value_size;
112 u64 cost = 0;
113 int err;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000114
Olivier Deprez157378f2022-04-04 15:47:50 +0200115 /* check sanity of attributes. 2 value sizes supported:
116 * 4 bytes: ifindex
117 * 8 bytes: ifindex + prog fd
118 */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000119 if (attr->max_entries == 0 || attr->key_size != 4 ||
Olivier Deprez157378f2022-04-04 15:47:50 +0200120 (valsize != offsetofend(struct bpf_devmap_val, ifindex) &&
121 valsize != offsetofend(struct bpf_devmap_val, bpf_prog.fd)) ||
122 attr->map_flags & ~DEV_CREATE_FLAG_MASK)
David Brazdil0f672f62019-12-10 10:32:29 +0000123 return -EINVAL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000124
David Brazdil0f672f62019-12-10 10:32:29 +0000125 /* Lookup returns a pointer straight to dev->ifindex, so make sure the
126 * verifier prevents writes from the BPF side
127 */
128 attr->map_flags |= BPF_F_RDONLY_PROG;
129
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000130
131 bpf_map_init_from_attr(&dtab->map, attr);
132
David Brazdil0f672f62019-12-10 10:32:29 +0000133 if (attr->map_type == BPF_MAP_TYPE_DEVMAP_HASH) {
134 dtab->n_buckets = roundup_pow_of_two(dtab->map.max_entries);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000135
David Brazdil0f672f62019-12-10 10:32:29 +0000136 if (!dtab->n_buckets) /* Overflow check */
137 return -EINVAL;
138 cost += (u64) sizeof(struct hlist_head) * dtab->n_buckets;
Olivier Deprez0e641232021-09-23 10:07:05 +0200139 } else {
140 cost += (u64) dtab->map.max_entries * sizeof(struct bpf_dtab_netdev *);
David Brazdil0f672f62019-12-10 10:32:29 +0000141 }
142
143 /* if map size is larger than memlock limit, reject it */
144 err = bpf_map_charge_init(&dtab->map.memory, cost);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000145 if (err)
David Brazdil0f672f62019-12-10 10:32:29 +0000146 return -EINVAL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000147
David Brazdil0f672f62019-12-10 10:32:29 +0000148 if (attr->map_type == BPF_MAP_TYPE_DEVMAP_HASH) {
Olivier Deprez0e641232021-09-23 10:07:05 +0200149 dtab->dev_index_head = dev_map_create_hash(dtab->n_buckets,
150 dtab->map.numa_node);
David Brazdil0f672f62019-12-10 10:32:29 +0000151 if (!dtab->dev_index_head)
Olivier Deprez157378f2022-04-04 15:47:50 +0200152 goto free_charge;
David Brazdil0f672f62019-12-10 10:32:29 +0000153
154 spin_lock_init(&dtab->index_lock);
Olivier Deprez0e641232021-09-23 10:07:05 +0200155 } else {
Olivier Deprez157378f2022-04-04 15:47:50 +0200156 dtab->netdev_map = bpf_map_area_alloc((u64) dtab->map.max_entries *
Olivier Deprez0e641232021-09-23 10:07:05 +0200157 sizeof(struct bpf_dtab_netdev *),
158 dtab->map.numa_node);
159 if (!dtab->netdev_map)
Olivier Deprez157378f2022-04-04 15:47:50 +0200160 goto free_charge;
David Brazdil0f672f62019-12-10 10:32:29 +0000161 }
162
163 return 0;
164
David Brazdil0f672f62019-12-10 10:32:29 +0000165free_charge:
166 bpf_map_charge_finish(&dtab->map.memory);
167 return -ENOMEM;
168}
169
170static struct bpf_map *dev_map_alloc(union bpf_attr *attr)
171{
172 struct bpf_dtab *dtab;
173 int err;
174
175 if (!capable(CAP_NET_ADMIN))
176 return ERR_PTR(-EPERM);
177
178 dtab = kzalloc(sizeof(*dtab), GFP_USER);
179 if (!dtab)
180 return ERR_PTR(-ENOMEM);
181
182 err = dev_map_init_map(dtab, attr);
183 if (err) {
184 kfree(dtab);
185 return ERR_PTR(err);
186 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000187
188 spin_lock(&dev_map_lock);
189 list_add_tail_rcu(&dtab->list, &dev_map_list);
190 spin_unlock(&dev_map_lock);
191
192 return &dtab->map;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000193}
194
195static void dev_map_free(struct bpf_map *map)
196{
197 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
Olivier Deprez157378f2022-04-04 15:47:50 +0200198 int i;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000199
200 /* At this point bpf_prog->aux->refcnt == 0 and this map->refcnt == 0,
201 * so the programs (can be more than one that used this map) were
Olivier Deprez157378f2022-04-04 15:47:50 +0200202 * disconnected from events. The following synchronize_rcu() guarantees
203 * both rcu read critical sections complete and waits for
204 * preempt-disable regions (NAPI being the relevant context here) so we
205 * are certain there will be no further reads against the netdev_map and
206 * all flush operations are complete. Flush operations can only be done
207 * from NAPI context for this reason.
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000208 */
209
210 spin_lock(&dev_map_lock);
211 list_del_rcu(&dtab->list);
212 spin_unlock(&dev_map_lock);
213
214 bpf_clear_redirect_map(map);
215 synchronize_rcu();
216
David Brazdil0f672f62019-12-10 10:32:29 +0000217 /* Make sure prior __dev_map_entry_free() have completed. */
218 rcu_barrier();
219
Olivier Deprez0e641232021-09-23 10:07:05 +0200220 if (dtab->map.map_type == BPF_MAP_TYPE_DEVMAP_HASH) {
221 for (i = 0; i < dtab->n_buckets; i++) {
222 struct bpf_dtab_netdev *dev;
223 struct hlist_head *head;
224 struct hlist_node *next;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000225
Olivier Deprez0e641232021-09-23 10:07:05 +0200226 head = dev_map_index_hash(dtab, i);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000227
Olivier Deprez0e641232021-09-23 10:07:05 +0200228 hlist_for_each_entry_safe(dev, next, head, index_hlist) {
229 hlist_del_rcu(&dev->index_hlist);
Olivier Deprez157378f2022-04-04 15:47:50 +0200230 if (dev->xdp_prog)
231 bpf_prog_put(dev->xdp_prog);
Olivier Deprez0e641232021-09-23 10:07:05 +0200232 dev_put(dev->dev);
233 kfree(dev);
234 }
235 }
236
237 bpf_map_area_free(dtab->dev_index_head);
238 } else {
239 for (i = 0; i < dtab->map.max_entries; i++) {
240 struct bpf_dtab_netdev *dev;
241
242 dev = dtab->netdev_map[i];
243 if (!dev)
244 continue;
245
Olivier Deprez157378f2022-04-04 15:47:50 +0200246 if (dev->xdp_prog)
247 bpf_prog_put(dev->xdp_prog);
Olivier Deprez0e641232021-09-23 10:07:05 +0200248 dev_put(dev->dev);
249 kfree(dev);
250 }
251
252 bpf_map_area_free(dtab->netdev_map);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000253 }
254
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000255 kfree(dtab);
256}
257
258static int dev_map_get_next_key(struct bpf_map *map, void *key, void *next_key)
259{
260 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
261 u32 index = key ? *(u32 *)key : U32_MAX;
262 u32 *next = next_key;
263
264 if (index >= dtab->map.max_entries) {
265 *next = 0;
266 return 0;
267 }
268
269 if (index == dtab->map.max_entries - 1)
270 return -ENOENT;
271 *next = index + 1;
272 return 0;
273}
274
David Brazdil0f672f62019-12-10 10:32:29 +0000275struct bpf_dtab_netdev *__dev_map_hash_lookup_elem(struct bpf_map *map, u32 key)
276{
277 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
278 struct hlist_head *head = dev_map_index_hash(dtab, key);
279 struct bpf_dtab_netdev *dev;
280
Olivier Deprez0e641232021-09-23 10:07:05 +0200281 hlist_for_each_entry_rcu(dev, head, index_hlist,
282 lockdep_is_held(&dtab->index_lock))
David Brazdil0f672f62019-12-10 10:32:29 +0000283 if (dev->idx == key)
284 return dev;
285
286 return NULL;
287}
288
289static int dev_map_hash_get_next_key(struct bpf_map *map, void *key,
290 void *next_key)
291{
292 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
293 u32 idx, *next = next_key;
294 struct bpf_dtab_netdev *dev, *next_dev;
295 struct hlist_head *head;
296 int i = 0;
297
298 if (!key)
299 goto find_first;
300
301 idx = *(u32 *)key;
302
303 dev = __dev_map_hash_lookup_elem(map, idx);
304 if (!dev)
305 goto find_first;
306
307 next_dev = hlist_entry_safe(rcu_dereference_raw(hlist_next_rcu(&dev->index_hlist)),
308 struct bpf_dtab_netdev, index_hlist);
309
310 if (next_dev) {
311 *next = next_dev->idx;
312 return 0;
313 }
314
315 i = idx & (dtab->n_buckets - 1);
316 i++;
317
318 find_first:
319 for (; i < dtab->n_buckets; i++) {
320 head = dev_map_index_hash(dtab, i);
321
322 next_dev = hlist_entry_safe(rcu_dereference_raw(hlist_first_rcu(head)),
323 struct bpf_dtab_netdev,
324 index_hlist);
325 if (next_dev) {
326 *next = next_dev->idx;
327 return 0;
328 }
329 }
330
331 return -ENOENT;
332}
333
Olivier Deprez157378f2022-04-04 15:47:50 +0200334bool dev_map_can_have_prog(struct bpf_map *map)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000335{
Olivier Deprez157378f2022-04-04 15:47:50 +0200336 if ((map->map_type == BPF_MAP_TYPE_DEVMAP ||
337 map->map_type == BPF_MAP_TYPE_DEVMAP_HASH) &&
338 map->value_size != offsetofend(struct bpf_devmap_val, ifindex))
339 return true;
340
341 return false;
342}
343
344static void bq_xmit_all(struct xdp_dev_bulk_queue *bq, u32 flags)
345{
346 struct net_device *dev = bq->dev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000347 int sent = 0, drops = 0, err = 0;
348 int i;
349
350 if (unlikely(!bq->count))
Olivier Deprez157378f2022-04-04 15:47:50 +0200351 return;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000352
353 for (i = 0; i < bq->count; i++) {
354 struct xdp_frame *xdpf = bq->q[i];
355
356 prefetch(xdpf);
357 }
358
359 sent = dev->netdev_ops->ndo_xdp_xmit(dev, bq->count, bq->q, flags);
360 if (sent < 0) {
361 err = sent;
362 sent = 0;
363 goto error;
364 }
365 drops = bq->count - sent;
366out:
367 bq->count = 0;
368
Olivier Deprez157378f2022-04-04 15:47:50 +0200369 trace_xdp_devmap_xmit(bq->dev_rx, dev, sent, drops, err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000370 bq->dev_rx = NULL;
David Brazdil0f672f62019-12-10 10:32:29 +0000371 __list_del_clearprev(&bq->flush_node);
Olivier Deprez157378f2022-04-04 15:47:50 +0200372 return;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000373error:
374 /* If ndo_xdp_xmit fails with an errno, no frames have been
375 * xmit'ed and it's our responsibility to them free all.
376 */
377 for (i = 0; i < bq->count; i++) {
378 struct xdp_frame *xdpf = bq->q[i];
379
Olivier Deprez157378f2022-04-04 15:47:50 +0200380 xdp_return_frame_rx_napi(xdpf);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000381 drops++;
382 }
383 goto out;
384}
385
Olivier Deprez157378f2022-04-04 15:47:50 +0200386/* __dev_flush is called from xdp_do_flush() which _must_ be signaled
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000387 * from the driver before returning from its napi->poll() routine. The poll()
388 * routine is called either from busy_poll context or net_rx_action signaled
389 * from NET_RX_SOFTIRQ. Either way the poll routine must complete before the
David Brazdil0f672f62019-12-10 10:32:29 +0000390 * net device can be torn down. On devmap tear down we ensure the flush list
391 * is empty before completing to ensure all flush operations have completed.
Olivier Deprez157378f2022-04-04 15:47:50 +0200392 * When drivers update the bpf program they may need to ensure any flush ops
393 * are also complete. Using synchronize_rcu or call_rcu will suffice for this
394 * because both wait for napi context to exit.
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000395 */
Olivier Deprez157378f2022-04-04 15:47:50 +0200396void __dev_flush(void)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000397{
Olivier Deprez157378f2022-04-04 15:47:50 +0200398 struct list_head *flush_list = this_cpu_ptr(&dev_flush_list);
399 struct xdp_dev_bulk_queue *bq, *tmp;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000400
David Brazdil0f672f62019-12-10 10:32:29 +0000401 list_for_each_entry_safe(bq, tmp, flush_list, flush_node)
Olivier Deprez157378f2022-04-04 15:47:50 +0200402 bq_xmit_all(bq, XDP_XMIT_FLUSH);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000403}
404
405/* rcu_read_lock (from syscall and BPF contexts) ensures that if a delete and/or
406 * update happens in parallel here a dev_put wont happen until after reading the
407 * ifindex.
408 */
409struct bpf_dtab_netdev *__dev_map_lookup_elem(struct bpf_map *map, u32 key)
410{
411 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
412 struct bpf_dtab_netdev *obj;
413
414 if (key >= map->max_entries)
415 return NULL;
416
417 obj = READ_ONCE(dtab->netdev_map[key]);
418 return obj;
419}
420
421/* Runs under RCU-read-side, plus in softirq under NAPI protection.
422 * Thus, safe percpu variable access.
423 */
Olivier Deprez157378f2022-04-04 15:47:50 +0200424static void bq_enqueue(struct net_device *dev, struct xdp_frame *xdpf,
425 struct net_device *dev_rx)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000426{
Olivier Deprez157378f2022-04-04 15:47:50 +0200427 struct list_head *flush_list = this_cpu_ptr(&dev_flush_list);
428 struct xdp_dev_bulk_queue *bq = this_cpu_ptr(dev->xdp_bulkq);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000429
430 if (unlikely(bq->count == DEV_MAP_BULK_SIZE))
Olivier Deprez157378f2022-04-04 15:47:50 +0200431 bq_xmit_all(bq, 0);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000432
433 /* Ingress dev_rx will be the same for all xdp_frame's in
434 * bulk_queue, because bq stored per-CPU and must be flushed
435 * from net_device drivers NAPI func end.
436 */
437 if (!bq->dev_rx)
438 bq->dev_rx = dev_rx;
439
440 bq->q[bq->count++] = xdpf;
David Brazdil0f672f62019-12-10 10:32:29 +0000441
442 if (!bq->flush_node.prev)
443 list_add(&bq->flush_node, flush_list);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000444}
445
Olivier Deprez157378f2022-04-04 15:47:50 +0200446static inline int __xdp_enqueue(struct net_device *dev, struct xdp_buff *xdp,
447 struct net_device *dev_rx)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000448{
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000449 struct xdp_frame *xdpf;
450 int err;
451
452 if (!dev->netdev_ops->ndo_xdp_xmit)
453 return -EOPNOTSUPP;
454
455 err = xdp_ok_fwd_dev(dev, xdp->data_end - xdp->data);
456 if (unlikely(err))
457 return err;
458
Olivier Deprez157378f2022-04-04 15:47:50 +0200459 xdpf = xdp_convert_buff_to_frame(xdp);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000460 if (unlikely(!xdpf))
461 return -EOVERFLOW;
462
Olivier Deprez157378f2022-04-04 15:47:50 +0200463 bq_enqueue(dev, xdpf, dev_rx);
464 return 0;
465}
466
467static struct xdp_buff *dev_map_run_prog(struct net_device *dev,
468 struct xdp_buff *xdp,
469 struct bpf_prog *xdp_prog)
470{
471 struct xdp_txq_info txq = { .dev = dev };
472 u32 act;
473
474 xdp_set_data_meta_invalid(xdp);
475 xdp->txq = &txq;
476
477 act = bpf_prog_run_xdp(xdp_prog, xdp);
478 switch (act) {
479 case XDP_PASS:
480 return xdp;
481 case XDP_DROP:
482 break;
483 default:
484 bpf_warn_invalid_xdp_action(act);
485 fallthrough;
486 case XDP_ABORTED:
487 trace_xdp_exception(dev, xdp_prog, act);
488 break;
489 }
490
491 xdp_return_buff(xdp);
492 return NULL;
493}
494
495int dev_xdp_enqueue(struct net_device *dev, struct xdp_buff *xdp,
496 struct net_device *dev_rx)
497{
498 return __xdp_enqueue(dev, xdp, dev_rx);
499}
500
501int dev_map_enqueue(struct bpf_dtab_netdev *dst, struct xdp_buff *xdp,
502 struct net_device *dev_rx)
503{
504 struct net_device *dev = dst->dev;
505
506 if (dst->xdp_prog) {
507 xdp = dev_map_run_prog(dev, xdp, dst->xdp_prog);
508 if (!xdp)
509 return 0;
510 }
511 return __xdp_enqueue(dev, xdp, dev_rx);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000512}
513
514int dev_map_generic_redirect(struct bpf_dtab_netdev *dst, struct sk_buff *skb,
515 struct bpf_prog *xdp_prog)
516{
517 int err;
518
519 err = xdp_ok_fwd_dev(dst->dev, skb->len);
520 if (unlikely(err))
521 return err;
522 skb->dev = dst->dev;
523 generic_xdp_tx(skb, xdp_prog);
524
525 return 0;
526}
527
528static void *dev_map_lookup_elem(struct bpf_map *map, void *key)
529{
530 struct bpf_dtab_netdev *obj = __dev_map_lookup_elem(map, *(u32 *)key);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000531
Olivier Deprez157378f2022-04-04 15:47:50 +0200532 return obj ? &obj->val : NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000533}
534
David Brazdil0f672f62019-12-10 10:32:29 +0000535static void *dev_map_hash_lookup_elem(struct bpf_map *map, void *key)
536{
537 struct bpf_dtab_netdev *obj = __dev_map_hash_lookup_elem(map,
538 *(u32 *)key);
Olivier Deprez157378f2022-04-04 15:47:50 +0200539 return obj ? &obj->val : NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000540}
541
542static void __dev_map_entry_free(struct rcu_head *rcu)
543{
544 struct bpf_dtab_netdev *dev;
545
546 dev = container_of(rcu, struct bpf_dtab_netdev, rcu);
Olivier Deprez157378f2022-04-04 15:47:50 +0200547 if (dev->xdp_prog)
548 bpf_prog_put(dev->xdp_prog);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000549 dev_put(dev->dev);
550 kfree(dev);
551}
552
553static int dev_map_delete_elem(struct bpf_map *map, void *key)
554{
555 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
556 struct bpf_dtab_netdev *old_dev;
557 int k = *(u32 *)key;
558
559 if (k >= map->max_entries)
560 return -EINVAL;
561
562 /* Use call_rcu() here to ensure any rcu critical sections have
Olivier Deprez157378f2022-04-04 15:47:50 +0200563 * completed as well as any flush operations because call_rcu
564 * will wait for preempt-disable region to complete, NAPI in this
565 * context. And additionally, the driver tear down ensures all
566 * soft irqs are complete before removing the net device in the
567 * case of dev_put equals zero.
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000568 */
569 old_dev = xchg(&dtab->netdev_map[k], NULL);
570 if (old_dev)
571 call_rcu(&old_dev->rcu, __dev_map_entry_free);
572 return 0;
573}
574
David Brazdil0f672f62019-12-10 10:32:29 +0000575static int dev_map_hash_delete_elem(struct bpf_map *map, void *key)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000576{
577 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
David Brazdil0f672f62019-12-10 10:32:29 +0000578 struct bpf_dtab_netdev *old_dev;
579 int k = *(u32 *)key;
580 unsigned long flags;
581 int ret = -ENOENT;
582
583 spin_lock_irqsave(&dtab->index_lock, flags);
584
585 old_dev = __dev_map_hash_lookup_elem(map, k);
586 if (old_dev) {
587 dtab->items--;
588 hlist_del_init_rcu(&old_dev->index_hlist);
589 call_rcu(&old_dev->rcu, __dev_map_entry_free);
590 ret = 0;
591 }
592 spin_unlock_irqrestore(&dtab->index_lock, flags);
593
594 return ret;
595}
596
597static struct bpf_dtab_netdev *__dev_map_alloc_node(struct net *net,
598 struct bpf_dtab *dtab,
Olivier Deprez157378f2022-04-04 15:47:50 +0200599 struct bpf_devmap_val *val,
David Brazdil0f672f62019-12-10 10:32:29 +0000600 unsigned int idx)
601{
Olivier Deprez157378f2022-04-04 15:47:50 +0200602 struct bpf_prog *prog = NULL;
David Brazdil0f672f62019-12-10 10:32:29 +0000603 struct bpf_dtab_netdev *dev;
David Brazdil0f672f62019-12-10 10:32:29 +0000604
Olivier Deprez157378f2022-04-04 15:47:50 +0200605 dev = kmalloc_node(sizeof(*dev), GFP_ATOMIC | __GFP_NOWARN,
606 dtab->map.numa_node);
David Brazdil0f672f62019-12-10 10:32:29 +0000607 if (!dev)
608 return ERR_PTR(-ENOMEM);
609
Olivier Deprez157378f2022-04-04 15:47:50 +0200610 dev->dev = dev_get_by_index(net, val->ifindex);
611 if (!dev->dev)
612 goto err_out;
David Brazdil0f672f62019-12-10 10:32:29 +0000613
Olivier Deprez157378f2022-04-04 15:47:50 +0200614 if (val->bpf_prog.fd > 0) {
615 prog = bpf_prog_get_type_dev(val->bpf_prog.fd,
616 BPF_PROG_TYPE_XDP, false);
617 if (IS_ERR(prog))
618 goto err_put_dev;
619 if (prog->expected_attach_type != BPF_XDP_DEVMAP)
620 goto err_put_prog;
David Brazdil0f672f62019-12-10 10:32:29 +0000621 }
622
623 dev->idx = idx;
624 dev->dtab = dtab;
Olivier Deprez157378f2022-04-04 15:47:50 +0200625 if (prog) {
626 dev->xdp_prog = prog;
627 dev->val.bpf_prog.id = prog->aux->id;
628 } else {
629 dev->xdp_prog = NULL;
630 dev->val.bpf_prog.id = 0;
631 }
632 dev->val.ifindex = val->ifindex;
David Brazdil0f672f62019-12-10 10:32:29 +0000633
634 return dev;
Olivier Deprez157378f2022-04-04 15:47:50 +0200635err_put_prog:
636 bpf_prog_put(prog);
637err_put_dev:
638 dev_put(dev->dev);
639err_out:
640 kfree(dev);
641 return ERR_PTR(-EINVAL);
David Brazdil0f672f62019-12-10 10:32:29 +0000642}
643
644static int __dev_map_update_elem(struct net *net, struct bpf_map *map,
645 void *key, void *value, u64 map_flags)
646{
647 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000648 struct bpf_dtab_netdev *dev, *old_dev;
Olivier Deprez157378f2022-04-04 15:47:50 +0200649 struct bpf_devmap_val val = {};
David Brazdil0f672f62019-12-10 10:32:29 +0000650 u32 i = *(u32 *)key;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000651
652 if (unlikely(map_flags > BPF_EXIST))
653 return -EINVAL;
654 if (unlikely(i >= dtab->map.max_entries))
655 return -E2BIG;
656 if (unlikely(map_flags == BPF_NOEXIST))
657 return -EEXIST;
658
Olivier Deprez157378f2022-04-04 15:47:50 +0200659 /* already verified value_size <= sizeof val */
660 memcpy(&val, value, map->value_size);
661
662 if (!val.ifindex) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000663 dev = NULL;
Olivier Deprez157378f2022-04-04 15:47:50 +0200664 /* can not specify fd if ifindex is 0 */
665 if (val.bpf_prog.fd > 0)
666 return -EINVAL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000667 } else {
Olivier Deprez157378f2022-04-04 15:47:50 +0200668 dev = __dev_map_alloc_node(net, dtab, &val, i);
David Brazdil0f672f62019-12-10 10:32:29 +0000669 if (IS_ERR(dev))
670 return PTR_ERR(dev);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000671 }
672
673 /* Use call_rcu() here to ensure rcu critical sections have completed
674 * Remembering the driver side flush operation will happen before the
675 * net device is removed.
676 */
677 old_dev = xchg(&dtab->netdev_map[i], dev);
678 if (old_dev)
679 call_rcu(&old_dev->rcu, __dev_map_entry_free);
680
681 return 0;
682}
683
David Brazdil0f672f62019-12-10 10:32:29 +0000684static int dev_map_update_elem(struct bpf_map *map, void *key, void *value,
685 u64 map_flags)
686{
687 return __dev_map_update_elem(current->nsproxy->net_ns,
688 map, key, value, map_flags);
689}
690
691static int __dev_map_hash_update_elem(struct net *net, struct bpf_map *map,
692 void *key, void *value, u64 map_flags)
693{
694 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
695 struct bpf_dtab_netdev *dev, *old_dev;
Olivier Deprez157378f2022-04-04 15:47:50 +0200696 struct bpf_devmap_val val = {};
David Brazdil0f672f62019-12-10 10:32:29 +0000697 u32 idx = *(u32 *)key;
698 unsigned long flags;
699 int err = -EEXIST;
700
Olivier Deprez157378f2022-04-04 15:47:50 +0200701 /* already verified value_size <= sizeof val */
702 memcpy(&val, value, map->value_size);
703
704 if (unlikely(map_flags > BPF_EXIST || !val.ifindex))
David Brazdil0f672f62019-12-10 10:32:29 +0000705 return -EINVAL;
706
707 spin_lock_irqsave(&dtab->index_lock, flags);
708
709 old_dev = __dev_map_hash_lookup_elem(map, idx);
710 if (old_dev && (map_flags & BPF_NOEXIST))
711 goto out_err;
712
Olivier Deprez157378f2022-04-04 15:47:50 +0200713 dev = __dev_map_alloc_node(net, dtab, &val, idx);
David Brazdil0f672f62019-12-10 10:32:29 +0000714 if (IS_ERR(dev)) {
715 err = PTR_ERR(dev);
716 goto out_err;
717 }
718
719 if (old_dev) {
720 hlist_del_rcu(&old_dev->index_hlist);
721 } else {
722 if (dtab->items >= dtab->map.max_entries) {
723 spin_unlock_irqrestore(&dtab->index_lock, flags);
724 call_rcu(&dev->rcu, __dev_map_entry_free);
725 return -E2BIG;
726 }
727 dtab->items++;
728 }
729
730 hlist_add_head_rcu(&dev->index_hlist,
731 dev_map_index_hash(dtab, idx));
732 spin_unlock_irqrestore(&dtab->index_lock, flags);
733
734 if (old_dev)
735 call_rcu(&old_dev->rcu, __dev_map_entry_free);
736
737 return 0;
738
739out_err:
740 spin_unlock_irqrestore(&dtab->index_lock, flags);
741 return err;
742}
743
744static int dev_map_hash_update_elem(struct bpf_map *map, void *key, void *value,
745 u64 map_flags)
746{
747 return __dev_map_hash_update_elem(current->nsproxy->net_ns,
748 map, key, value, map_flags);
749}
750
Olivier Deprez157378f2022-04-04 15:47:50 +0200751static int dev_map_btf_id;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000752const struct bpf_map_ops dev_map_ops = {
Olivier Deprez157378f2022-04-04 15:47:50 +0200753 .map_meta_equal = bpf_map_meta_equal,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000754 .map_alloc = dev_map_alloc,
755 .map_free = dev_map_free,
756 .map_get_next_key = dev_map_get_next_key,
757 .map_lookup_elem = dev_map_lookup_elem,
758 .map_update_elem = dev_map_update_elem,
759 .map_delete_elem = dev_map_delete_elem,
760 .map_check_btf = map_check_no_btf,
Olivier Deprez157378f2022-04-04 15:47:50 +0200761 .map_btf_name = "bpf_dtab",
762 .map_btf_id = &dev_map_btf_id,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000763};
764
Olivier Deprez157378f2022-04-04 15:47:50 +0200765static int dev_map_hash_map_btf_id;
David Brazdil0f672f62019-12-10 10:32:29 +0000766const struct bpf_map_ops dev_map_hash_ops = {
Olivier Deprez157378f2022-04-04 15:47:50 +0200767 .map_meta_equal = bpf_map_meta_equal,
David Brazdil0f672f62019-12-10 10:32:29 +0000768 .map_alloc = dev_map_alloc,
769 .map_free = dev_map_free,
770 .map_get_next_key = dev_map_hash_get_next_key,
771 .map_lookup_elem = dev_map_hash_lookup_elem,
772 .map_update_elem = dev_map_hash_update_elem,
773 .map_delete_elem = dev_map_hash_delete_elem,
774 .map_check_btf = map_check_no_btf,
Olivier Deprez157378f2022-04-04 15:47:50 +0200775 .map_btf_name = "bpf_dtab",
776 .map_btf_id = &dev_map_hash_map_btf_id,
David Brazdil0f672f62019-12-10 10:32:29 +0000777};
778
779static void dev_map_hash_remove_netdev(struct bpf_dtab *dtab,
780 struct net_device *netdev)
781{
782 unsigned long flags;
783 u32 i;
784
785 spin_lock_irqsave(&dtab->index_lock, flags);
786 for (i = 0; i < dtab->n_buckets; i++) {
787 struct bpf_dtab_netdev *dev;
788 struct hlist_head *head;
789 struct hlist_node *next;
790
791 head = dev_map_index_hash(dtab, i);
792
793 hlist_for_each_entry_safe(dev, next, head, index_hlist) {
794 if (netdev != dev->dev)
795 continue;
796
797 dtab->items--;
798 hlist_del_rcu(&dev->index_hlist);
799 call_rcu(&dev->rcu, __dev_map_entry_free);
800 }
801 }
802 spin_unlock_irqrestore(&dtab->index_lock, flags);
803}
804
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000805static int dev_map_notification(struct notifier_block *notifier,
806 ulong event, void *ptr)
807{
808 struct net_device *netdev = netdev_notifier_info_to_dev(ptr);
809 struct bpf_dtab *dtab;
Olivier Deprez157378f2022-04-04 15:47:50 +0200810 int i, cpu;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000811
812 switch (event) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200813 case NETDEV_REGISTER:
814 if (!netdev->netdev_ops->ndo_xdp_xmit || netdev->xdp_bulkq)
815 break;
816
817 /* will be freed in free_netdev() */
818 netdev->xdp_bulkq = alloc_percpu(struct xdp_dev_bulk_queue);
819 if (!netdev->xdp_bulkq)
820 return NOTIFY_BAD;
821
822 for_each_possible_cpu(cpu)
823 per_cpu_ptr(netdev->xdp_bulkq, cpu)->dev = netdev;
824 break;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000825 case NETDEV_UNREGISTER:
826 /* This rcu_read_lock/unlock pair is needed because
827 * dev_map_list is an RCU list AND to ensure a delete
828 * operation does not free a netdev_map entry while we
829 * are comparing it against the netdev being unregistered.
830 */
831 rcu_read_lock();
832 list_for_each_entry_rcu(dtab, &dev_map_list, list) {
David Brazdil0f672f62019-12-10 10:32:29 +0000833 if (dtab->map.map_type == BPF_MAP_TYPE_DEVMAP_HASH) {
834 dev_map_hash_remove_netdev(dtab, netdev);
835 continue;
836 }
837
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000838 for (i = 0; i < dtab->map.max_entries; i++) {
839 struct bpf_dtab_netdev *dev, *odev;
840
841 dev = READ_ONCE(dtab->netdev_map[i]);
David Brazdil0f672f62019-12-10 10:32:29 +0000842 if (!dev || netdev != dev->dev)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000843 continue;
844 odev = cmpxchg(&dtab->netdev_map[i], dev, NULL);
845 if (dev == odev)
846 call_rcu(&dev->rcu,
847 __dev_map_entry_free);
848 }
849 }
850 rcu_read_unlock();
851 break;
852 default:
853 break;
854 }
855 return NOTIFY_OK;
856}
857
858static struct notifier_block dev_map_notifier = {
859 .notifier_call = dev_map_notification,
860};
861
862static int __init dev_map_init(void)
863{
Olivier Deprez157378f2022-04-04 15:47:50 +0200864 int cpu;
865
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000866 /* Assure tracepoint shadow struct _bpf_dtab_netdev is in sync */
867 BUILD_BUG_ON(offsetof(struct bpf_dtab_netdev, dev) !=
868 offsetof(struct _bpf_dtab_netdev, dev));
869 register_netdevice_notifier(&dev_map_notifier);
Olivier Deprez157378f2022-04-04 15:47:50 +0200870
871 for_each_possible_cpu(cpu)
872 INIT_LIST_HEAD(&per_cpu(dev_flush_list, cpu));
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000873 return 0;
874}
875
876subsys_initcall(dev_map_init);