samples/bpf/xdp_sample_pkts_user.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 #include <stdio.h>
   3 #include <stdlib.h>
   4 #include <string.h>
   5 #include <linux/perf_event.h>
   6 #include <linux/bpf.h>
   7 #include <net/if.h>
   8 #include <errno.h>
   9 #include <assert.h>
  10 #include <sys/sysinfo.h>
  11 #include <sys/ioctl.h>
  12 #include <signal.h>
  13 #include <bpf/libbpf.h>
  14 #include <bpf/bpf.h>
  15 #include <sys/resource.h>
  16 #include <libgen.h>
  17 #include <linux/if_link.h>
  18
  19 #include "perf-sys.h"
  20
  21 static int if_idx;
  22 static char *if_name;
  23 static __u32 xdp_flags = XDP_FLAGS_UPDATE_IF_NOEXIST;
  24 static __u32 prog_id;
  25 static struct perf_buffer *pb = NULL;
  26
  27 static int do_attach(int idx, int fd, const char *name)
  28 {
  29         struct bpf_prog_info info = {};
  30         __u32 info_len = sizeof(info);
  31         int err;
  32
  33         err = bpf_set_link_xdp_fd(idx, fd, xdp_flags);
  34         if (err < 0) {
  35                 printf("ERROR: failed to attach program to %s\n", name);
  36                 return err;
  37         }
  38
  39         err = bpf_obj_get_info_by_fd(fd, &info, &info_len);
  40         if (err) {
  41                 printf("can't get prog info - %s\n", strerror(errno));
  42                 return err;
  43         }
  44         prog_id = info.id;
  45
  46         return err;
  47 }
  48
  49 static int do_detach(int idx, const char *name)
  50 {
  51         __u32 curr_prog_id = 0;
  52         int err = 0;
  53
  54         err = bpf_get_link_xdp_id(idx, &curr_prog_id, xdp_flags);
  55         if (err) {
  56                 printf("bpf_get_link_xdp_id failed\n");
  57                 return err;
  58         }
  59         if (prog_id == curr_prog_id) {
  60                 err = bpf_set_link_xdp_fd(idx, -1, xdp_flags);
  61                 if (err < 0)
  62                         printf("ERROR: failed to detach prog from %s\n", name);
  63         } else if (!curr_prog_id) {
  64                 printf("couldn't find a prog id on a %s\n", name);
  65         } else {
  66                 printf("program on interface changed, not removing\n");
  67         }
  68
  69         return err;
  70 }
  71
  72 #define SAMPLE_SIZE 64
  73
  74 static void print_bpf_output(void *ctx, int cpu, void *data, __u32 size)
  75 {
  76         struct {
  77                 __u16 cookie;
  78                 __u16 pkt_len;
  79                 __u8  pkt_data[SAMPLE_SIZE];
  80         } __packed *e = data;
  81         int i;
  82
  83         if (e->cookie != 0xdead) {
  84                 printf("BUG cookie %x sized %d\n", e->cookie, size);
  85                 return;
  86         }
  87
  88         printf("Pkt len: %-5d bytes. Ethernet hdr: ", e->pkt_len);
  89         for (i = 0; i < 14 && i < e->pkt_len; i++)
  90                 printf("%02x ", e->pkt_data[i]);
  91         printf("\n");
  92 }
  93
  94 static void sig_handler(int signo)
  95 {
  96         do_detach(if_idx, if_name);
  97         perf_buffer__free(pb);
  98         exit(0);
  99 }
 100
 101 static void usage(const char *prog)
 102 {
 103         fprintf(stderr,
 104                 "%s: %s [OPTS] <ifname|ifindex>\n\n"
 105                 "OPTS:\n"
 106                 "    -F    force loading prog\n"
 107                 "    -S    use skb-mode\n",
 108                 __func__, prog);
 109 }
 110
 111 int main(int argc, char **argv)
 112 {
 113         const char *optstr = "FS";
 114         int prog_fd, map_fd, opt;
 115         struct bpf_program *prog;
 116         struct bpf_object *obj;
 117         struct bpf_map *map;
 118         char filename[256];
 119         int ret, err;
 120
 121         while ((opt = getopt(argc, argv, optstr)) != -1) {
 122                 switch (opt) {
 123                 case 'F':
 124                         xdp_flags &= ~XDP_FLAGS_UPDATE_IF_NOEXIST;
 125                         break;
 126                 case 'S':
 127                         xdp_flags |= XDP_FLAGS_SKB_MODE;
 128                         break;
 129                 default:
 130                         usage(basename(argv[0]));
 131                         return 1;
 132                 }
 133         }
 134
 135         if (!(xdp_flags & XDP_FLAGS_SKB_MODE))
 136                 xdp_flags |= XDP_FLAGS_DRV_MODE;
 137
 138         if (optind == argc) {
 139                 usage(basename(argv[0]));
 140                 return 1;
 141         }
 142
 143         snprintf(filename, sizeof(filename), "%s_kern.o", argv[0]);
 144
 145         obj = bpf_object__open_file(filename, NULL);
 146         if (libbpf_get_error(obj))
 147                 return 1;
 148
 149         prog = bpf_object__next_program(obj, NULL);
 150         bpf_program__set_type(prog, BPF_PROG_TYPE_XDP);
 151
 152         err = bpf_object__load(obj);
 153         if (err)
 154                 return 1;
 155
 156         prog_fd = bpf_program__fd(prog);
 157
 158         map = bpf_object__next_map(obj, NULL);
 159         if (!map) {
 160                 printf("finding a map in obj file failed\n");
 161                 return 1;
 162         }
 163         map_fd = bpf_map__fd(map);
 164
 165         if_idx = if_nametoindex(argv[optind]);
 166         if (!if_idx)
 167                 if_idx = strtoul(argv[optind], NULL, 0);
 168
 169         if (!if_idx) {
 170                 fprintf(stderr, "Invalid ifname\n");
 171                 return 1;
 172         }
 173         if_name = argv[optind];
 174         err = do_attach(if_idx, prog_fd, if_name);
 175         if (err)
 176                 return err;
 177
 178         if (signal(SIGINT, sig_handler) ||
 179             signal(SIGHUP, sig_handler) ||
 180             signal(SIGTERM, sig_handler)) {
 181                 perror("signal");
 182                 return 1;
 183         }
 184
 185         pb = perf_buffer__new(map_fd, 8, print_bpf_output, NULL, NULL, NULL);
 186         err = libbpf_get_error(pb);
 187         if (err) {
 188                 perror("perf_buffer setup failed");
 189                 return 1;
 190         }
 191
 192         while ((ret = perf_buffer__poll(pb, 1000)) >= 0) {
 193         }
 194
 195         kill(0, SIGINT);
 196         return ret;
 197 }