1 | // SPDX-License-Identifier: GPL-2.0 |
2 | #define KBUILD_MODNAME "foo" |
3 | #include <string.h> |
4 | #include <linux/in.h> |
5 | #include <linux/if_ether.h> |
6 | #include <linux/if_packet.h> |
7 | #include <linux/ip.h> |
8 | #include <linux/ipv6.h> |
9 | |
10 | #include <linux/bpf.h> |
11 | #include <bpf/bpf_helpers.h> |
12 | #include <bpf/bpf_endian.h> |
13 | |
14 | /* One map use devmap, another one use devmap_hash for testing */ |
15 | struct { |
16 | __uint(type, BPF_MAP_TYPE_DEVMAP); |
17 | __uint(key_size, sizeof(int)); |
18 | __uint(value_size, sizeof(int)); |
19 | __uint(max_entries, 1024); |
20 | } map_all SEC(".maps" ); |
21 | |
22 | struct { |
23 | __uint(type, BPF_MAP_TYPE_DEVMAP_HASH); |
24 | __uint(key_size, sizeof(int)); |
25 | __uint(value_size, sizeof(struct bpf_devmap_val)); |
26 | __uint(max_entries, 128); |
27 | } map_egress SEC(".maps" ); |
28 | |
29 | /* map to store egress interfaces mac addresses */ |
30 | struct { |
31 | __uint(type, BPF_MAP_TYPE_HASH); |
32 | __type(key, __u32); |
33 | __type(value, __be64); |
34 | __uint(max_entries, 128); |
35 | } mac_map SEC(".maps" ); |
36 | |
37 | SEC("xdp" ) |
38 | int xdp_redirect_map_multi_prog(struct xdp_md *ctx) |
39 | { |
40 | void *data_end = (void *)(long)ctx->data_end; |
41 | void *data = (void *)(long)ctx->data; |
42 | int if_index = ctx->ingress_ifindex; |
43 | struct ethhdr *eth = data; |
44 | __u16 h_proto; |
45 | __u64 nh_off; |
46 | |
47 | nh_off = sizeof(*eth); |
48 | if (data + nh_off > data_end) |
49 | return XDP_DROP; |
50 | |
51 | h_proto = eth->h_proto; |
52 | |
53 | /* Using IPv4 for (BPF_F_BROADCAST | BPF_F_EXCLUDE_INGRESS) testing */ |
54 | if (h_proto == bpf_htons(ETH_P_IP)) |
55 | return bpf_redirect_map(&map_all, 0, |
56 | BPF_F_BROADCAST | BPF_F_EXCLUDE_INGRESS); |
57 | /* Using IPv6 for none flag testing */ |
58 | else if (h_proto == bpf_htons(ETH_P_IPV6)) |
59 | return bpf_redirect_map(&map_all, if_index, 0); |
60 | /* All others for BPF_F_BROADCAST testing */ |
61 | else |
62 | return bpf_redirect_map(&map_all, 0, BPF_F_BROADCAST); |
63 | } |
64 | |
65 | /* The following 2 progs are for 2nd devmap prog testing */ |
66 | SEC("xdp" ) |
67 | int xdp_redirect_map_all_prog(struct xdp_md *ctx) |
68 | { |
69 | return bpf_redirect_map(&map_egress, 0, |
70 | BPF_F_BROADCAST | BPF_F_EXCLUDE_INGRESS); |
71 | } |
72 | |
73 | SEC("xdp/devmap" ) |
74 | int xdp_devmap_prog(struct xdp_md *ctx) |
75 | { |
76 | void *data_end = (void *)(long)ctx->data_end; |
77 | void *data = (void *)(long)ctx->data; |
78 | __u32 key = ctx->egress_ifindex; |
79 | struct ethhdr *eth = data; |
80 | __u64 nh_off; |
81 | __be64 *mac; |
82 | |
83 | nh_off = sizeof(*eth); |
84 | if (data + nh_off > data_end) |
85 | return XDP_DROP; |
86 | |
87 | mac = bpf_map_lookup_elem(&mac_map, &key); |
88 | if (mac) |
89 | __builtin_memcpy(eth->h_source, mac, ETH_ALEN); |
90 | |
91 | return XDP_PASS; |
92 | } |
93 | |
94 | char _license[] SEC("license" ) = "GPL" ; |
95 | |