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#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
55#define DEV_MAP_BULK_SIZE 16
56struct bpf_dtab_netdev;
57
58struct xdp_bulk_queue {
59 struct xdp_frame *q[DEV_MAP_BULK_SIZE];
60 struct list_head flush_node;
61 struct net_device *dev_rx;
62 struct bpf_dtab_netdev *obj;
63 unsigned int count;
64};
65
66struct bpf_dtab_netdev {
67 struct net_device *dev;
68 struct hlist_node index_hlist;
69 struct bpf_dtab *dtab;
70 struct xdp_bulk_queue __percpu *bulkq;
71 struct rcu_head rcu;
72 unsigned int idx;
73};
74
75struct bpf_dtab {
76 struct bpf_map map;
77 struct bpf_dtab_netdev **netdev_map;
78 struct list_head __percpu *flush_list;
79 struct list_head list;
80
81
82 struct hlist_head *dev_index_head;
83 spinlock_t index_lock;
84 unsigned int items;
85 u32 n_buckets;
86};
87
88static DEFINE_SPINLOCK(dev_map_lock);
89static LIST_HEAD(dev_map_list);
90
91static struct hlist_head *dev_map_create_hash(unsigned int entries)
92{
93 int i;
94 struct hlist_head *hash;
95
96 hash = kmalloc_array(entries, sizeof(*hash), GFP_KERNEL);
97 if (hash != NULL)
98 for (i = 0; i < entries; i++)
99 INIT_HLIST_HEAD(&hash[i]);
100
101 return hash;
102}
103
104static int dev_map_init_map(struct bpf_dtab *dtab, union bpf_attr *attr)
105{
106 int err, cpu;
107 u64 cost;
108
109
110 if (attr->max_entries == 0 || attr->key_size != 4 ||
111 attr->value_size != 4 || attr->map_flags & ~DEV_CREATE_FLAG_MASK)
112 return -EINVAL;
113
114
115
116
117 attr->map_flags |= BPF_F_RDONLY_PROG;
118
119
120 bpf_map_init_from_attr(&dtab->map, attr);
121
122
123 cost = (u64) dtab->map.max_entries * sizeof(struct bpf_dtab_netdev *);
124 cost += sizeof(struct list_head) * num_possible_cpus();
125
126 if (attr->map_type == BPF_MAP_TYPE_DEVMAP_HASH) {
127 dtab->n_buckets = roundup_pow_of_two(dtab->map.max_entries);
128
129 if (!dtab->n_buckets)
130 return -EINVAL;
131 cost += (u64) sizeof(struct hlist_head) * dtab->n_buckets;
132 }
133
134
135 err = bpf_map_charge_init(&dtab->map.memory, cost);
136 if (err)
137 return -EINVAL;
138
139 dtab->flush_list = alloc_percpu(struct list_head);
140 if (!dtab->flush_list)
141 goto free_charge;
142
143 for_each_possible_cpu(cpu)
144 INIT_LIST_HEAD(per_cpu_ptr(dtab->flush_list, cpu));
145
146 dtab->netdev_map = bpf_map_area_alloc(dtab->map.max_entries *
147 sizeof(struct bpf_dtab_netdev *),
148 dtab->map.numa_node);
149 if (!dtab->netdev_map)
150 goto free_percpu;
151
152 if (attr->map_type == BPF_MAP_TYPE_DEVMAP_HASH) {
153 dtab->dev_index_head = dev_map_create_hash(dtab->n_buckets);
154 if (!dtab->dev_index_head)
155 goto free_map_area;
156
157 spin_lock_init(&dtab->index_lock);
158 }
159
160 return 0;
161
162free_map_area:
163 bpf_map_area_free(dtab->netdev_map);
164free_percpu:
165 free_percpu(dtab->flush_list);
166free_charge:
167 bpf_map_charge_finish(&dtab->map.memory);
168 return -ENOMEM;
169}
170
171static struct bpf_map *dev_map_alloc(union bpf_attr *attr)
172{
173 struct bpf_dtab *dtab;
174 int err;
175
176 if (!capable(CAP_NET_ADMIN))
177 return ERR_PTR(-EPERM);
178
179 dtab = kzalloc(sizeof(*dtab), GFP_USER);
180 if (!dtab)
181 return ERR_PTR(-ENOMEM);
182
183 err = dev_map_init_map(dtab, attr);
184 if (err) {
185 kfree(dtab);
186 return ERR_PTR(err);
187 }
188
189 spin_lock(&dev_map_lock);
190 list_add_tail_rcu(&dtab->list, &dev_map_list);
191 spin_unlock(&dev_map_lock);
192
193 return &dtab->map;
194}
195
196static void dev_map_free(struct bpf_map *map)
197{
198 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
199 int i, cpu;
200
201
202
203
204
205
206
207
208
209 spin_lock(&dev_map_lock);
210 list_del_rcu(&dtab->list);
211 spin_unlock(&dev_map_lock);
212
213 bpf_clear_redirect_map(map);
214 synchronize_rcu();
215
216
217 rcu_barrier();
218
219
220
221
222
223
224 for_each_online_cpu(cpu) {
225 struct list_head *flush_list = per_cpu_ptr(dtab->flush_list, cpu);
226
227 while (!list_empty(flush_list))
228 cond_resched();
229 }
230
231 for (i = 0; i < dtab->map.max_entries; i++) {
232 struct bpf_dtab_netdev *dev;
233
234 dev = dtab->netdev_map[i];
235 if (!dev)
236 continue;
237
238 free_percpu(dev->bulkq);
239 dev_put(dev->dev);
240 kfree(dev);
241 }
242
243 free_percpu(dtab->flush_list);
244 bpf_map_area_free(dtab->netdev_map);
245 kfree(dtab->dev_index_head);
246 kfree(dtab);
247}
248
249static int dev_map_get_next_key(struct bpf_map *map, void *key, void *next_key)
250{
251 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
252 u32 index = key ? *(u32 *)key : U32_MAX;
253 u32 *next = next_key;
254
255 if (index >= dtab->map.max_entries) {
256 *next = 0;
257 return 0;
258 }
259
260 if (index == dtab->map.max_entries - 1)
261 return -ENOENT;
262 *next = index + 1;
263 return 0;
264}
265
266static inline struct hlist_head *dev_map_index_hash(struct bpf_dtab *dtab,
267 int idx)
268{
269 return &dtab->dev_index_head[idx & (dtab->n_buckets - 1)];
270}
271
272struct bpf_dtab_netdev *__dev_map_hash_lookup_elem(struct bpf_map *map, u32 key)
273{
274 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
275 struct hlist_head *head = dev_map_index_hash(dtab, key);
276 struct bpf_dtab_netdev *dev;
277
278 hlist_for_each_entry_rcu(dev, head, index_hlist)
279 if (dev->idx == key)
280 return dev;
281
282 return NULL;
283}
284
285static int dev_map_hash_get_next_key(struct bpf_map *map, void *key,
286 void *next_key)
287{
288 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
289 u32 idx, *next = next_key;
290 struct bpf_dtab_netdev *dev, *next_dev;
291 struct hlist_head *head;
292 int i = 0;
293
294 if (!key)
295 goto find_first;
296
297 idx = *(u32 *)key;
298
299 dev = __dev_map_hash_lookup_elem(map, idx);
300 if (!dev)
301 goto find_first;
302
303 next_dev = hlist_entry_safe(rcu_dereference_raw(hlist_next_rcu(&dev->index_hlist)),
304 struct bpf_dtab_netdev, index_hlist);
305
306 if (next_dev) {
307 *next = next_dev->idx;
308 return 0;
309 }
310
311 i = idx & (dtab->n_buckets - 1);
312 i++;
313
314 find_first:
315 for (; i < dtab->n_buckets; i++) {
316 head = dev_map_index_hash(dtab, i);
317
318 next_dev = hlist_entry_safe(rcu_dereference_raw(hlist_first_rcu(head)),
319 struct bpf_dtab_netdev,
320 index_hlist);
321 if (next_dev) {
322 *next = next_dev->idx;
323 return 0;
324 }
325 }
326
327 return -ENOENT;
328}
329
330static int bq_xmit_all(struct xdp_bulk_queue *bq, u32 flags,
331 bool in_napi_ctx)
332{
333 struct bpf_dtab_netdev *obj = bq->obj;
334 struct net_device *dev = obj->dev;
335 int sent = 0, drops = 0, err = 0;
336 int i;
337
338 if (unlikely(!bq->count))
339 return 0;
340
341 for (i = 0; i < bq->count; i++) {
342 struct xdp_frame *xdpf = bq->q[i];
343
344 prefetch(xdpf);
345 }
346
347 sent = dev->netdev_ops->ndo_xdp_xmit(dev, bq->count, bq->q, flags);
348 if (sent < 0) {
349 err = sent;
350 sent = 0;
351 goto error;
352 }
353 drops = bq->count - sent;
354out:
355 bq->count = 0;
356
357 trace_xdp_devmap_xmit(&obj->dtab->map, obj->idx,
358 sent, drops, bq->dev_rx, dev, err);
359 bq->dev_rx = NULL;
360 __list_del_clearprev(&bq->flush_node);
361 return 0;
362error:
363
364
365
366 for (i = 0; i < bq->count; i++) {
367 struct xdp_frame *xdpf = bq->q[i];
368
369
370 if (likely(in_napi_ctx))
371 xdp_return_frame_rx_napi(xdpf);
372 else
373 xdp_return_frame(xdpf);
374 drops++;
375 }
376 goto out;
377}
378
379
380
381
382
383
384
385
386void __dev_map_flush(struct bpf_map *map)
387{
388 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
389 struct list_head *flush_list = this_cpu_ptr(dtab->flush_list);
390 struct xdp_bulk_queue *bq, *tmp;
391
392 rcu_read_lock();
393 list_for_each_entry_safe(bq, tmp, flush_list, flush_node)
394 bq_xmit_all(bq, XDP_XMIT_FLUSH, true);
395 rcu_read_unlock();
396}
397
398
399
400
401
402struct bpf_dtab_netdev *__dev_map_lookup_elem(struct bpf_map *map, u32 key)
403{
404 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
405 struct bpf_dtab_netdev *obj;
406
407 if (key >= map->max_entries)
408 return NULL;
409
410 obj = READ_ONCE(dtab->netdev_map[key]);
411 return obj;
412}
413
414
415
416
417static int bq_enqueue(struct bpf_dtab_netdev *obj, struct xdp_frame *xdpf,
418 struct net_device *dev_rx)
419
420{
421 struct list_head *flush_list = this_cpu_ptr(obj->dtab->flush_list);
422 struct xdp_bulk_queue *bq = this_cpu_ptr(obj->bulkq);
423
424 if (unlikely(bq->count == DEV_MAP_BULK_SIZE))
425 bq_xmit_all(bq, 0, true);
426
427
428
429
430
431 if (!bq->dev_rx)
432 bq->dev_rx = dev_rx;
433
434 bq->q[bq->count++] = xdpf;
435
436 if (!bq->flush_node.prev)
437 list_add(&bq->flush_node, flush_list);
438
439 return 0;
440}
441
442int dev_map_enqueue(struct bpf_dtab_netdev *dst, struct xdp_buff *xdp,
443 struct net_device *dev_rx)
444{
445 struct net_device *dev = dst->dev;
446 struct xdp_frame *xdpf;
447 int err;
448
449 if (!dev->netdev_ops->ndo_xdp_xmit)
450 return -EOPNOTSUPP;
451
452 err = xdp_ok_fwd_dev(dev, xdp->data_end - xdp->data);
453 if (unlikely(err))
454 return err;
455
456 xdpf = convert_to_xdp_frame(xdp);
457 if (unlikely(!xdpf))
458 return -EOVERFLOW;
459
460 return bq_enqueue(dst, xdpf, dev_rx);
461}
462
463int dev_map_generic_redirect(struct bpf_dtab_netdev *dst, struct sk_buff *skb,
464 struct bpf_prog *xdp_prog)
465{
466 int err;
467
468 err = xdp_ok_fwd_dev(dst->dev, skb->len);
469 if (unlikely(err))
470 return err;
471 skb->dev = dst->dev;
472 generic_xdp_tx(skb, xdp_prog);
473
474 return 0;
475}
476
477static void *dev_map_lookup_elem(struct bpf_map *map, void *key)
478{
479 struct bpf_dtab_netdev *obj = __dev_map_lookup_elem(map, *(u32 *)key);
480 struct net_device *dev = obj ? obj->dev : NULL;
481
482 return dev ? &dev->ifindex : NULL;
483}
484
485static void *dev_map_hash_lookup_elem(struct bpf_map *map, void *key)
486{
487 struct bpf_dtab_netdev *obj = __dev_map_hash_lookup_elem(map,
488 *(u32 *)key);
489 struct net_device *dev = obj ? obj->dev : NULL;
490
491 return dev ? &dev->ifindex : NULL;
492}
493
494static void dev_map_flush_old(struct bpf_dtab_netdev *dev)
495{
496 if (dev->dev->netdev_ops->ndo_xdp_xmit) {
497 struct xdp_bulk_queue *bq;
498 int cpu;
499
500 rcu_read_lock();
501 for_each_online_cpu(cpu) {
502 bq = per_cpu_ptr(dev->bulkq, cpu);
503 bq_xmit_all(bq, XDP_XMIT_FLUSH, false);
504 }
505 rcu_read_unlock();
506 }
507}
508
509static void __dev_map_entry_free(struct rcu_head *rcu)
510{
511 struct bpf_dtab_netdev *dev;
512
513 dev = container_of(rcu, struct bpf_dtab_netdev, rcu);
514 dev_map_flush_old(dev);
515 free_percpu(dev->bulkq);
516 dev_put(dev->dev);
517 kfree(dev);
518}
519
520static int dev_map_delete_elem(struct bpf_map *map, void *key)
521{
522 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
523 struct bpf_dtab_netdev *old_dev;
524 int k = *(u32 *)key;
525
526 if (k >= map->max_entries)
527 return -EINVAL;
528
529
530
531
532
533
534
535
536
537 old_dev = xchg(&dtab->netdev_map[k], NULL);
538 if (old_dev)
539 call_rcu(&old_dev->rcu, __dev_map_entry_free);
540 return 0;
541}
542
543static int dev_map_hash_delete_elem(struct bpf_map *map, void *key)
544{
545 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
546 struct bpf_dtab_netdev *old_dev;
547 int k = *(u32 *)key;
548 unsigned long flags;
549 int ret = -ENOENT;
550
551 spin_lock_irqsave(&dtab->index_lock, flags);
552
553 old_dev = __dev_map_hash_lookup_elem(map, k);
554 if (old_dev) {
555 dtab->items--;
556 hlist_del_init_rcu(&old_dev->index_hlist);
557 call_rcu(&old_dev->rcu, __dev_map_entry_free);
558 ret = 0;
559 }
560 spin_unlock_irqrestore(&dtab->index_lock, flags);
561
562 return ret;
563}
564
565static struct bpf_dtab_netdev *__dev_map_alloc_node(struct net *net,
566 struct bpf_dtab *dtab,
567 u32 ifindex,
568 unsigned int idx)
569{
570 gfp_t gfp = GFP_ATOMIC | __GFP_NOWARN;
571 struct bpf_dtab_netdev *dev;
572 struct xdp_bulk_queue *bq;
573 int cpu;
574
575 dev = kmalloc_node(sizeof(*dev), gfp, dtab->map.numa_node);
576 if (!dev)
577 return ERR_PTR(-ENOMEM);
578
579 dev->bulkq = __alloc_percpu_gfp(sizeof(*dev->bulkq),
580 sizeof(void *), gfp);
581 if (!dev->bulkq) {
582 kfree(dev);
583 return ERR_PTR(-ENOMEM);
584 }
585
586 for_each_possible_cpu(cpu) {
587 bq = per_cpu_ptr(dev->bulkq, cpu);
588 bq->obj = dev;
589 }
590
591 dev->dev = dev_get_by_index(net, ifindex);
592 if (!dev->dev) {
593 free_percpu(dev->bulkq);
594 kfree(dev);
595 return ERR_PTR(-EINVAL);
596 }
597
598 dev->idx = idx;
599 dev->dtab = dtab;
600
601 return dev;
602}
603
604static int __dev_map_update_elem(struct net *net, struct bpf_map *map,
605 void *key, void *value, u64 map_flags)
606{
607 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
608 struct bpf_dtab_netdev *dev, *old_dev;
609 u32 ifindex = *(u32 *)value;
610 u32 i = *(u32 *)key;
611
612 if (unlikely(map_flags > BPF_EXIST))
613 return -EINVAL;
614 if (unlikely(i >= dtab->map.max_entries))
615 return -E2BIG;
616 if (unlikely(map_flags == BPF_NOEXIST))
617 return -EEXIST;
618
619 if (!ifindex) {
620 dev = NULL;
621 } else {
622 dev = __dev_map_alloc_node(net, dtab, ifindex, i);
623 if (IS_ERR(dev))
624 return PTR_ERR(dev);
625 }
626
627
628
629
630
631 old_dev = xchg(&dtab->netdev_map[i], dev);
632 if (old_dev)
633 call_rcu(&old_dev->rcu, __dev_map_entry_free);
634
635 return 0;
636}
637
638static int dev_map_update_elem(struct bpf_map *map, void *key, void *value,
639 u64 map_flags)
640{
641 return __dev_map_update_elem(current->nsproxy->net_ns,
642 map, key, value, map_flags);
643}
644
645static int __dev_map_hash_update_elem(struct net *net, struct bpf_map *map,
646 void *key, void *value, u64 map_flags)
647{
648 struct bpf_dtab *dtab = container_of(map, struct bpf_dtab, map);
649 struct bpf_dtab_netdev *dev, *old_dev;
650 u32 ifindex = *(u32 *)value;
651 u32 idx = *(u32 *)key;
652 unsigned long flags;
653 int err = -EEXIST;
654
655 if (unlikely(map_flags > BPF_EXIST || !ifindex))
656 return -EINVAL;
657
658 spin_lock_irqsave(&dtab->index_lock, flags);
659
660 old_dev = __dev_map_hash_lookup_elem(map, idx);
661 if (old_dev && (map_flags & BPF_NOEXIST))
662 goto out_err;
663
664 dev = __dev_map_alloc_node(net, dtab, ifindex, idx);
665 if (IS_ERR(dev)) {
666 err = PTR_ERR(dev);
667 goto out_err;
668 }
669
670 if (old_dev) {
671 hlist_del_rcu(&old_dev->index_hlist);
672 } else {
673 if (dtab->items >= dtab->map.max_entries) {
674 spin_unlock_irqrestore(&dtab->index_lock, flags);
675 call_rcu(&dev->rcu, __dev_map_entry_free);
676 return -E2BIG;
677 }
678 dtab->items++;
679 }
680
681 hlist_add_head_rcu(&dev->index_hlist,
682 dev_map_index_hash(dtab, idx));
683 spin_unlock_irqrestore(&dtab->index_lock, flags);
684
685 if (old_dev)
686 call_rcu(&old_dev->rcu, __dev_map_entry_free);
687
688 return 0;
689
690out_err:
691 spin_unlock_irqrestore(&dtab->index_lock, flags);
692 return err;
693}
694
695static int dev_map_hash_update_elem(struct bpf_map *map, void *key, void *value,
696 u64 map_flags)
697{
698 return __dev_map_hash_update_elem(current->nsproxy->net_ns,
699 map, key, value, map_flags);
700}
701
702const struct bpf_map_ops dev_map_ops = {
703 .map_alloc = dev_map_alloc,
704 .map_free = dev_map_free,
705 .map_get_next_key = dev_map_get_next_key,
706 .map_lookup_elem = dev_map_lookup_elem,
707 .map_update_elem = dev_map_update_elem,
708 .map_delete_elem = dev_map_delete_elem,
709 .map_check_btf = map_check_no_btf,
710};
711
712const struct bpf_map_ops dev_map_hash_ops = {
713 .map_alloc = dev_map_alloc,
714 .map_free = dev_map_free,
715 .map_get_next_key = dev_map_hash_get_next_key,
716 .map_lookup_elem = dev_map_hash_lookup_elem,
717 .map_update_elem = dev_map_hash_update_elem,
718 .map_delete_elem = dev_map_hash_delete_elem,
719 .map_check_btf = map_check_no_btf,
720};
721
722static void dev_map_hash_remove_netdev(struct bpf_dtab *dtab,
723 struct net_device *netdev)
724{
725 unsigned long flags;
726 u32 i;
727
728 spin_lock_irqsave(&dtab->index_lock, flags);
729 for (i = 0; i < dtab->n_buckets; i++) {
730 struct bpf_dtab_netdev *dev;
731 struct hlist_head *head;
732 struct hlist_node *next;
733
734 head = dev_map_index_hash(dtab, i);
735
736 hlist_for_each_entry_safe(dev, next, head, index_hlist) {
737 if (netdev != dev->dev)
738 continue;
739
740 dtab->items--;
741 hlist_del_rcu(&dev->index_hlist);
742 call_rcu(&dev->rcu, __dev_map_entry_free);
743 }
744 }
745 spin_unlock_irqrestore(&dtab->index_lock, flags);
746}
747
748static int dev_map_notification(struct notifier_block *notifier,
749 ulong event, void *ptr)
750{
751 struct net_device *netdev = netdev_notifier_info_to_dev(ptr);
752 struct bpf_dtab *dtab;
753 int i;
754
755 switch (event) {
756 case NETDEV_UNREGISTER:
757
758
759
760
761
762 rcu_read_lock();
763 list_for_each_entry_rcu(dtab, &dev_map_list, list) {
764 if (dtab->map.map_type == BPF_MAP_TYPE_DEVMAP_HASH) {
765 dev_map_hash_remove_netdev(dtab, netdev);
766 continue;
767 }
768
769 for (i = 0; i < dtab->map.max_entries; i++) {
770 struct bpf_dtab_netdev *dev, *odev;
771
772 dev = READ_ONCE(dtab->netdev_map[i]);
773 if (!dev || netdev != dev->dev)
774 continue;
775 odev = cmpxchg(&dtab->netdev_map[i], dev, NULL);
776 if (dev == odev)
777 call_rcu(&dev->rcu,
778 __dev_map_entry_free);
779 }
780 }
781 rcu_read_unlock();
782 break;
783 default:
784 break;
785 }
786 return NOTIFY_OK;
787}
788
789static struct notifier_block dev_map_notifier = {
790 .notifier_call = dev_map_notification,
791};
792
793static int __init dev_map_init(void)
794{
795
796 BUILD_BUG_ON(offsetof(struct bpf_dtab_netdev, dev) !=
797 offsetof(struct _bpf_dtab_netdev, dev));
798 register_netdevice_notifier(&dev_map_notifier);
799 return 0;
800}
801
802subsys_initcall(dev_map_init);
803