Merge tag 'xfs-5.12-merge-5' of git://git.kernel.org/pub/scm/fs/xfs/xfs-linux
[linux-2.6-microblaze.git] / samples / bpf / xdp_redirect_map_user.c
index 31131b6..0e81926 100644 (file)
 #include <unistd.h>
 #include <libgen.h>
 #include <sys/resource.h>
+#include <sys/ioctl.h>
+#include <sys/types.h>
+#include <sys/socket.h>
+#include <netinet/in.h>
 
 #include "bpf_util.h"
 #include <bpf/bpf.h>
@@ -22,6 +26,7 @@
 static int ifindex_in;
 static int ifindex_out;
 static bool ifindex_out_xdp_dummy_attached = true;
+static bool xdp_devmap_attached;
 static __u32 prog_id;
 static __u32 dummy_prog_id;
 
@@ -83,6 +88,32 @@ static void poll_stats(int interval, int ifindex)
        }
 }
 
+static int get_mac_addr(unsigned int ifindex_out, void *mac_addr)
+{
+       char ifname[IF_NAMESIZE];
+       struct ifreq ifr;
+       int fd, ret = -1;
+
+       fd = socket(AF_INET, SOCK_DGRAM, 0);
+       if (fd < 0)
+               return ret;
+
+       if (!if_indextoname(ifindex_out, ifname))
+               goto err_out;
+
+       strcpy(ifr.ifr_name, ifname);
+
+       if (ioctl(fd, SIOCGIFHWADDR, &ifr) != 0)
+               goto err_out;
+
+       memcpy(mac_addr, ifr.ifr_hwaddr.sa_data, 6 * sizeof(char));
+       ret = 0;
+
+err_out:
+       close(fd);
+       return ret;
+}
+
 static void usage(const char *prog)
 {
        fprintf(stderr,
@@ -90,24 +121,26 @@ static void usage(const char *prog)
                "OPTS:\n"
                "    -S    use skb-mode\n"
                "    -N    enforce native mode\n"
-               "    -F    force loading prog\n",
+               "    -F    force loading prog\n"
+               "    -X    load xdp program on egress\n",
                prog);
 }
 
 int main(int argc, char **argv)
 {
        struct bpf_prog_load_attr prog_load_attr = {
-               .prog_type      = BPF_PROG_TYPE_XDP,
+               .prog_type      = BPF_PROG_TYPE_UNSPEC,
        };
-       struct bpf_program *prog, *dummy_prog;
+       struct bpf_program *prog, *dummy_prog, *devmap_prog;
+       int prog_fd, dummy_prog_fd, devmap_prog_fd = 0;
+       int tx_port_map_fd, tx_mac_map_fd;
+       struct bpf_devmap_val devmap_val;
        struct bpf_prog_info info = {};
        __u32 info_len = sizeof(info);
-       int prog_fd, dummy_prog_fd;
-       const char *optstr = "FSN";
+       const char *optstr = "FSNX";
        struct bpf_object *obj;
        int ret, opt, key = 0;
        char filename[256];
-       int tx_port_map_fd;
 
        while ((opt = getopt(argc, argv, optstr)) != -1) {
                switch (opt) {
@@ -120,14 +153,21 @@ int main(int argc, char **argv)
                case 'F':
                        xdp_flags &= ~XDP_FLAGS_UPDATE_IF_NOEXIST;
                        break;
+               case 'X':
+                       xdp_devmap_attached = true;
+                       break;
                default:
                        usage(basename(argv[0]));
                        return 1;
                }
        }
 
-       if (!(xdp_flags & XDP_FLAGS_SKB_MODE))
+       if (!(xdp_flags & XDP_FLAGS_SKB_MODE)) {
                xdp_flags |= XDP_FLAGS_DRV_MODE;
+       } else if (xdp_devmap_attached) {
+               printf("Load xdp program on egress with SKB mode not supported yet\n");
+               return 1;
+       }
 
        if (optind == argc) {
                printf("usage: %s <IFNAME|IFINDEX>_IN <IFNAME|IFINDEX>_OUT\n", argv[0]);
@@ -150,24 +190,28 @@ int main(int argc, char **argv)
        if (bpf_prog_load_xattr(&prog_load_attr, &obj, &prog_fd))
                return 1;
 
-       prog = bpf_program__next(NULL, obj);
-       dummy_prog = bpf_program__next(prog, obj);
-       if (!prog || !dummy_prog) {
-               printf("finding a prog in obj file failed\n");
-               return 1;
+       if (xdp_flags & XDP_FLAGS_SKB_MODE) {
+               prog = bpf_object__find_program_by_name(obj, "xdp_redirect_map_general");
+               tx_port_map_fd = bpf_object__find_map_fd_by_name(obj, "tx_port_general");
+       } else {
+               prog = bpf_object__find_program_by_name(obj, "xdp_redirect_map_native");
+               tx_port_map_fd = bpf_object__find_map_fd_by_name(obj, "tx_port_native");
+       }
+       dummy_prog = bpf_object__find_program_by_name(obj, "xdp_redirect_dummy_prog");
+       if (!prog || dummy_prog < 0 || tx_port_map_fd < 0) {
+               printf("finding prog/dummy_prog/tx_port_map in obj file failed\n");
+               goto out;
        }
-       /* bpf_prog_load_xattr gives us the pointer to first prog's fd,
-        * so we're missing only the fd for dummy prog
-        */
+       prog_fd = bpf_program__fd(prog);
        dummy_prog_fd = bpf_program__fd(dummy_prog);
-       if (prog_fd < 0 || dummy_prog_fd < 0) {
+       if (prog_fd < 0 || dummy_prog_fd < 0 || tx_port_map_fd < 0) {
                printf("bpf_prog_load_xattr: %s\n", strerror(errno));
                return 1;
        }
 
-       tx_port_map_fd = bpf_object__find_map_fd_by_name(obj, "tx_port");
+       tx_mac_map_fd = bpf_object__find_map_fd_by_name(obj, "tx_mac");
        rxcnt_map_fd = bpf_object__find_map_fd_by_name(obj, "rxcnt");
-       if (tx_port_map_fd < 0 || rxcnt_map_fd < 0) {
+       if (tx_mac_map_fd < 0 || rxcnt_map_fd < 0) {
                printf("bpf_object__find_map_fd_by_name failed\n");
                return 1;
        }
@@ -199,11 +243,39 @@ int main(int argc, char **argv)
        }
        dummy_prog_id = info.id;
 
+       /* Load 2nd xdp prog on egress. */
+       if (xdp_devmap_attached) {
+               unsigned char mac_addr[6];
+
+               devmap_prog = bpf_object__find_program_by_name(obj, "xdp_redirect_map_egress");
+               if (!devmap_prog) {
+                       printf("finding devmap_prog in obj file failed\n");
+                       goto out;
+               }
+               devmap_prog_fd = bpf_program__fd(devmap_prog);
+               if (devmap_prog_fd < 0) {
+                       printf("finding devmap_prog fd failed\n");
+                       goto out;
+               }
+
+               if (get_mac_addr(ifindex_out, mac_addr) < 0) {
+                       printf("get interface %d mac failed\n", ifindex_out);
+                       goto out;
+               }
+
+               ret = bpf_map_update_elem(tx_mac_map_fd, &key, mac_addr, 0);
+               if (ret) {
+                       perror("bpf_update_elem tx_mac_map_fd");
+                       goto out;
+               }
+       }
+
        signal(SIGINT, int_exit);
        signal(SIGTERM, int_exit);
 
-       /* populate virtual to physical port map */
-       ret = bpf_map_update_elem(tx_port_map_fd, &key, &ifindex_out, 0);
+       devmap_val.ifindex = ifindex_out;
+       devmap_val.bpf_prog.fd = devmap_prog_fd;
+       ret = bpf_map_update_elem(tx_port_map_fd, &key, &devmap_val, 0);
        if (ret) {
                perror("bpf_update_elem");
                goto out;