blob: d3dba93dbab36de9291d40b5358b877166746cc6 [file] [log] [blame]
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +02001// SPDX-License-Identifier: GPL-2.0
Björn Töpeldac09142018-05-18 14:00:21 +02002/* Copyright(c) 2017 - 2018 Intel Corporation. */
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +02003
Magnus Karlsson248c7f92019-02-21 10:21:27 +01004#include <asm/barrier.h>
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +02005#include <errno.h>
6#include <getopt.h>
7#include <libgen.h>
8#include <linux/bpf.h>
Magnus Karlsson248c7f92019-02-21 10:21:27 +01009#include <linux/compiler.h>
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020010#include <linux/if_link.h>
11#include <linux/if_xdp.h>
12#include <linux/if_ether.h>
Magnus Karlsson248c7f92019-02-21 10:21:27 +010013#include <locale.h>
14#include <net/ethernet.h>
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020015#include <net/if.h>
Magnus Karlsson248c7f92019-02-21 10:21:27 +010016#include <poll.h>
17#include <pthread.h>
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020018#include <signal.h>
19#include <stdbool.h>
20#include <stdio.h>
21#include <stdlib.h>
22#include <string.h>
Magnus Karlsson248c7f92019-02-21 10:21:27 +010023#include <sys/mman.h>
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020024#include <sys/resource.h>
25#include <sys/socket.h>
Magnus Karlsson248c7f92019-02-21 10:21:27 +010026#include <sys/types.h>
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020027#include <time.h>
28#include <unistd.h>
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020029
Daniel T. Lee4d18f6d2019-06-16 00:14:47 +090030#include "libbpf.h"
31#include "xsk.h"
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +010032#include "xdpsock.h"
Jakub Kicinski2bf3e2e2018-05-14 22:35:02 -070033#include <bpf/bpf.h>
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020034
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020035#ifndef SOL_XDP
36#define SOL_XDP 283
37#endif
38
39#ifndef AF_XDP
40#define AF_XDP 44
41#endif
42
43#ifndef PF_XDP
44#define PF_XDP AF_XDP
45#endif
46
Magnus Karlsson248c7f92019-02-21 10:21:27 +010047#define NUM_FRAMES (4 * 1024)
48#define BATCH_SIZE 64
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020049
50#define DEBUG_HEXDUMP 0
51
Björn Töpela412ef52018-06-04 13:57:14 +020052typedef __u64 u64;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020053typedef __u32 u32;
54
55static unsigned long prev_time;
56
57enum benchmark_type {
58 BENCH_RXDROP = 0,
59 BENCH_TXONLY = 1,
60 BENCH_L2FWD = 2,
61};
62
63static enum benchmark_type opt_bench = BENCH_RXDROP;
Maciej Fijalkowski743e5682019-02-01 22:42:28 +010064static u32 opt_xdp_flags = XDP_FLAGS_UPDATE_IF_NOEXIST;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020065static const char *opt_if = "";
66static int opt_ifindex;
67static int opt_queue;
68static int opt_poll;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020069static int opt_interval = 1;
Magnus Karlsson46738f72019-08-14 09:27:21 +020070static u32 opt_xdp_bind_flags = XDP_USE_NEED_WAKEUP;
Kevin Laatzc543f542019-08-27 02:25:28 +000071static u32 opt_umem_flags;
72static int opt_unaligned_chunks;
Kevin Laatz3945b372019-08-27 02:25:30 +000073static int opt_mmap_flags;
Kevin Laatzc543f542019-08-27 02:25:28 +000074static u32 opt_xdp_bind_flags;
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +030075static int opt_xsk_frame_size = XSK_UMEM__DEFAULT_FRAME_SIZE;
Magnus Karlsson46738f72019-08-14 09:27:21 +020076static int opt_timeout = 1000;
77static bool opt_need_wakeup = true;
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +010078static u32 opt_num_xsks = 1;
79static u32 prog_id;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020080
Magnus Karlsson248c7f92019-02-21 10:21:27 +010081struct xsk_umem_info {
82 struct xsk_ring_prod fq;
83 struct xsk_ring_cons cq;
84 struct xsk_umem *umem;
85 void *buffer;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020086};
87
Magnus Karlsson248c7f92019-02-21 10:21:27 +010088struct xsk_socket_info {
89 struct xsk_ring_cons rx;
90 struct xsk_ring_prod tx;
91 struct xsk_umem_info *umem;
92 struct xsk_socket *xsk;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020093 unsigned long rx_npkts;
94 unsigned long tx_npkts;
95 unsigned long prev_rx_npkts;
96 unsigned long prev_tx_npkts;
Magnus Karlsson248c7f92019-02-21 10:21:27 +010097 u32 outstanding_tx;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +020098};
99
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200100static int num_socks;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100101struct xsk_socket_info *xsks[MAX_SOCKS];
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200102
103static unsigned long get_nsecs(void)
104{
105 struct timespec ts;
106
107 clock_gettime(CLOCK_MONOTONIC, &ts);
108 return ts.tv_sec * 1000000000UL + ts.tv_nsec;
109}
110
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200111static void print_benchmark(bool running)
112{
113 const char *bench_str = "INVALID";
114
115 if (opt_bench == BENCH_RXDROP)
116 bench_str = "rxdrop";
117 else if (opt_bench == BENCH_TXONLY)
118 bench_str = "txonly";
119 else if (opt_bench == BENCH_L2FWD)
120 bench_str = "l2fwd";
121
122 printf("%s:%d %s ", opt_if, opt_queue, bench_str);
123 if (opt_xdp_flags & XDP_FLAGS_SKB_MODE)
124 printf("xdp-skb ");
125 else if (opt_xdp_flags & XDP_FLAGS_DRV_MODE)
126 printf("xdp-drv ");
127 else
128 printf(" ");
129
130 if (opt_poll)
131 printf("poll() ");
132
133 if (running) {
134 printf("running...");
135 fflush(stdout);
136 }
137}
138
139static void dump_stats(void)
140{
141 unsigned long now = get_nsecs();
142 long dt = now - prev_time;
143 int i;
144
145 prev_time = now;
146
Prashant Bhole11c3f512018-08-31 10:00:49 +0900147 for (i = 0; i < num_socks && xsks[i]; i++) {
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200148 char *fmt = "%-15s %'-11.0f %'-11lu\n";
149 double rx_pps, tx_pps;
150
151 rx_pps = (xsks[i]->rx_npkts - xsks[i]->prev_rx_npkts) *
152 1000000000. / dt;
153 tx_pps = (xsks[i]->tx_npkts - xsks[i]->prev_tx_npkts) *
154 1000000000. / dt;
155
156 printf("\n sock%d@", i);
157 print_benchmark(false);
158 printf("\n");
159
160 printf("%-15s %-11s %-11s %-11.2f\n", "", "pps", "pkts",
161 dt / 1000000000.);
162 printf(fmt, "rx", rx_pps, xsks[i]->rx_npkts);
163 printf(fmt, "tx", tx_pps, xsks[i]->tx_npkts);
164
165 xsks[i]->prev_rx_npkts = xsks[i]->rx_npkts;
166 xsks[i]->prev_tx_npkts = xsks[i]->tx_npkts;
167 }
168}
169
170static void *poller(void *arg)
171{
172 (void)arg;
173 for (;;) {
174 sleep(opt_interval);
175 dump_stats();
176 }
177
178 return NULL;
179}
180
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100181static void remove_xdp_program(void)
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200182{
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100183 u32 curr_prog_id = 0;
Maciej Fijalkowski3b7a8ec2019-02-01 22:42:30 +0100184
Maciej Fijalkowski3b7a8ec2019-02-01 22:42:30 +0100185 if (bpf_get_link_xdp_id(opt_ifindex, &curr_prog_id, opt_xdp_flags)) {
186 printf("bpf_get_link_xdp_id failed\n");
187 exit(EXIT_FAILURE);
188 }
189 if (prog_id == curr_prog_id)
190 bpf_set_link_xdp_fd(opt_ifindex, -1, opt_xdp_flags);
191 else if (!curr_prog_id)
192 printf("couldn't find a prog id on a given interface\n");
193 else
194 printf("program on interface changed, not removing\n");
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100195}
196
197static void int_exit(int sig)
198{
199 struct xsk_umem *umem = xsks[0]->umem->umem;
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100200 int i;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100201
202 dump_stats();
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100203 for (i = 0; i < num_socks; i++)
204 xsk_socket__delete(xsks[i]->xsk);
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100205 (void)xsk_umem__delete(umem);
206 remove_xdp_program();
207
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200208 exit(EXIT_SUCCESS);
209}
210
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100211static void __exit_with_error(int error, const char *file, const char *func,
212 int line)
213{
214 fprintf(stderr, "%s:%s:%i: errno: %d/\"%s\"\n", file, func,
215 line, error, strerror(error));
216 dump_stats();
217 remove_xdp_program();
218 exit(EXIT_FAILURE);
219}
220
221#define exit_with_error(error) __exit_with_error(error, __FILE__, __func__, \
222 __LINE__)
223
224static const char pkt_data[] =
225 "\x3c\xfd\xfe\x9e\x7f\x71\xec\xb1\xd7\x98\x3a\xc0\x08\x00\x45\x00"
226 "\x00\x2e\x00\x00\x00\x00\x40\x11\x88\x97\x05\x08\x07\x08\xc8\x14"
227 "\x1e\x04\x10\x92\x10\x92\x00\x1a\x6d\xa3\x34\x33\x1f\x69\x40\x6b"
228 "\x54\x59\xb6\x14\x2d\x11\x44\xbf\xaf\xd9\xbe\xaa";
229
230static void swap_mac_addresses(void *data)
231{
232 struct ether_header *eth = (struct ether_header *)data;
233 struct ether_addr *src_addr = (struct ether_addr *)&eth->ether_shost;
234 struct ether_addr *dst_addr = (struct ether_addr *)&eth->ether_dhost;
235 struct ether_addr tmp;
236
237 tmp = *src_addr;
238 *src_addr = *dst_addr;
239 *dst_addr = tmp;
240}
241
242static void hex_dump(void *pkt, size_t length, u64 addr)
243{
244 const unsigned char *address = (unsigned char *)pkt;
245 const unsigned char *line = address;
246 size_t line_size = 32;
247 unsigned char c;
248 char buf[32];
249 int i = 0;
250
251 if (!DEBUG_HEXDUMP)
252 return;
253
254 sprintf(buf, "addr=%llu", addr);
255 printf("length = %zu\n", length);
256 printf("%s | ", buf);
257 while (length-- > 0) {
258 printf("%02X ", *address++);
259 if (!(++i % line_size) || (length == 0 && i % line_size)) {
260 if (length == 0) {
261 while (i++ % line_size)
262 printf("__ ");
263 }
264 printf(" | "); /* right close */
265 while (line < address) {
266 c = *line++;
267 printf("%c", (c < 33 || c == 255) ? 0x2E : c);
268 }
269 printf("\n");
270 if (length > 0)
271 printf("%s | ", buf);
272 }
273 }
274 printf("\n");
275}
276
277static size_t gen_eth_frame(struct xsk_umem_info *umem, u64 addr)
278{
279 memcpy(xsk_umem__get_data(umem->buffer, addr), pkt_data,
280 sizeof(pkt_data) - 1);
281 return sizeof(pkt_data) - 1;
282}
283
284static struct xsk_umem_info *xsk_configure_umem(void *buffer, u64 size)
285{
286 struct xsk_umem_info *umem;
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300287 struct xsk_umem_config cfg = {
288 .fill_size = XSK_RING_PROD__DEFAULT_NUM_DESCS,
289 .comp_size = XSK_RING_CONS__DEFAULT_NUM_DESCS,
290 .frame_size = opt_xsk_frame_size,
291 .frame_headroom = XSK_UMEM__DEFAULT_FRAME_HEADROOM,
Kevin Laatzc543f542019-08-27 02:25:28 +0000292 .flags = opt_umem_flags
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300293 };
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100294 int ret, i;
295 u32 idx;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100296
297 umem = calloc(1, sizeof(*umem));
298 if (!umem)
299 exit_with_error(errno);
300
301 ret = xsk_umem__create(&umem->umem, buffer, size, &umem->fq, &umem->cq,
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300302 &cfg);
Kevin Laatzc543f542019-08-27 02:25:28 +0000303
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100304 if (ret)
305 exit_with_error(-ret);
306
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100307 ret = xsk_ring_prod__reserve(&umem->fq,
308 XSK_RING_PROD__DEFAULT_NUM_DESCS, &idx);
309 if (ret != XSK_RING_PROD__DEFAULT_NUM_DESCS)
310 exit_with_error(-ret);
311 for (i = 0; i < XSK_RING_PROD__DEFAULT_NUM_DESCS; i++)
312 *xsk_ring_prod__fill_addr(&umem->fq, idx++) =
313 i * opt_xsk_frame_size;
314 xsk_ring_prod__submit(&umem->fq, XSK_RING_PROD__DEFAULT_NUM_DESCS);
315
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100316 umem->buffer = buffer;
317 return umem;
318}
319
320static struct xsk_socket_info *xsk_configure_socket(struct xsk_umem_info *umem)
321{
322 struct xsk_socket_config cfg;
323 struct xsk_socket_info *xsk;
324 int ret;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100325
326 xsk = calloc(1, sizeof(*xsk));
327 if (!xsk)
328 exit_with_error(errno);
329
330 xsk->umem = umem;
331 cfg.rx_size = XSK_RING_CONS__DEFAULT_NUM_DESCS;
332 cfg.tx_size = XSK_RING_PROD__DEFAULT_NUM_DESCS;
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100333 if (opt_num_xsks > 1)
334 cfg.libbpf_flags = XSK_LIBBPF_FLAGS__INHIBIT_PROG_LOAD;
335 else
336 cfg.libbpf_flags = 0;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100337 cfg.xdp_flags = opt_xdp_flags;
338 cfg.bind_flags = opt_xdp_bind_flags;
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100339
340 ret = xsk_socket__create(&xsk->xsk, opt_if, opt_queue,
341 umem->umem, &xsk->rx, &xsk->tx, &cfg);
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100342 if (ret)
343 exit_with_error(-ret);
344
345 ret = bpf_get_link_xdp_id(opt_ifindex, &prog_id, opt_xdp_flags);
346 if (ret)
347 exit_with_error(-ret);
348
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100349 return xsk;
350}
351
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200352static struct option long_options[] = {
353 {"rxdrop", no_argument, 0, 'r'},
354 {"txonly", no_argument, 0, 't'},
355 {"l2fwd", no_argument, 0, 'l'},
356 {"interface", required_argument, 0, 'i'},
357 {"queue", required_argument, 0, 'q'},
358 {"poll", no_argument, 0, 'p'},
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200359 {"xdp-skb", no_argument, 0, 'S'},
360 {"xdp-native", no_argument, 0, 'N'},
361 {"interval", required_argument, 0, 'n'},
Björn Töpel58c50ae2018-08-28 14:44:35 +0200362 {"zero-copy", no_argument, 0, 'z'},
363 {"copy", no_argument, 0, 'c'},
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300364 {"frame-size", required_argument, 0, 'f'},
Magnus Karlsson46738f72019-08-14 09:27:21 +0200365 {"no-need-wakeup", no_argument, 0, 'm'},
Kevin Laatzc543f542019-08-27 02:25:28 +0000366 {"unaligned", no_argument, 0, 'u'},
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100367 {"shared-umem", no_argument, 0, 'M'},
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200368 {0, 0, 0, 0}
369};
370
371static void usage(const char *prog)
372{
373 const char *str =
374 " Usage: %s [OPTIONS]\n"
375 " Options:\n"
376 " -r, --rxdrop Discard all incoming packets (default)\n"
377 " -t, --txonly Only send packets\n"
378 " -l, --l2fwd MAC swap L2 forwarding\n"
379 " -i, --interface=n Run on interface n\n"
380 " -q, --queue=n Use queue n (default 0)\n"
381 " -p, --poll Use poll syscall\n"
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200382 " -S, --xdp-skb=n Use XDP skb-mod\n"
Anton Ivanov4564a8bb2019-10-07 09:26:36 +0100383 " -N, --xdp-native=n Enforce XDP native mode\n"
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200384 " -n, --interval=n Specify statistics update interval (default 1 sec).\n"
Björn Töpel58c50ae2018-08-28 14:44:35 +0200385 " -z, --zero-copy Force zero-copy mode.\n"
386 " -c, --copy Force copy mode.\n"
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300387 " -f, --frame-size=n Set the frame size (must be a power of two, default is %d).\n"
Magnus Karlsson46738f72019-08-14 09:27:21 +0200388 " -m, --no-need-wakeup Turn off use of driver need wakeup flag.\n"
Kevin Laatzc543f542019-08-27 02:25:28 +0000389 " -f, --frame-size=n Set the frame size (must be a power of two in aligned mode, default is %d).\n"
390 " -u, --unaligned Enable unaligned chunk placement\n"
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100391 " -M, --shared-umem Enable XDP_SHARED_UMEM\n"
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200392 "\n";
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300393 fprintf(stderr, str, prog, XSK_UMEM__DEFAULT_FRAME_SIZE);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200394 exit(EXIT_FAILURE);
395}
396
397static void parse_command_line(int argc, char **argv)
398{
399 int option_index, c;
400
401 opterr = 0;
402
403 for (;;) {
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100404 c = getopt_long(argc, argv, "Frtli:q:psSNn:czf:muM",
Magnus Karlsson46738f72019-08-14 09:27:21 +0200405 long_options, &option_index);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200406 if (c == -1)
407 break;
408
409 switch (c) {
410 case 'r':
411 opt_bench = BENCH_RXDROP;
412 break;
413 case 't':
414 opt_bench = BENCH_TXONLY;
415 break;
416 case 'l':
417 opt_bench = BENCH_L2FWD;
418 break;
419 case 'i':
420 opt_if = optarg;
421 break;
422 case 'q':
423 opt_queue = atoi(optarg);
424 break;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200425 case 'p':
426 opt_poll = 1;
427 break;
428 case 'S':
429 opt_xdp_flags |= XDP_FLAGS_SKB_MODE;
Björn Töpel9f5232c2018-06-04 14:06:01 +0200430 opt_xdp_bind_flags |= XDP_COPY;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200431 break;
432 case 'N':
433 opt_xdp_flags |= XDP_FLAGS_DRV_MODE;
434 break;
435 case 'n':
436 opt_interval = atoi(optarg);
437 break;
Björn Töpel58c50ae2018-08-28 14:44:35 +0200438 case 'z':
439 opt_xdp_bind_flags |= XDP_ZEROCOPY;
440 break;
441 case 'c':
442 opt_xdp_bind_flags |= XDP_COPY;
443 break;
Kevin Laatzc543f542019-08-27 02:25:28 +0000444 case 'u':
445 opt_umem_flags |= XDP_UMEM_UNALIGNED_CHUNK_FLAG;
446 opt_unaligned_chunks = 1;
Kevin Laatz3945b372019-08-27 02:25:30 +0000447 opt_mmap_flags = MAP_HUGETLB;
Kevin Laatzc543f542019-08-27 02:25:28 +0000448 break;
Maciej Fijalkowski743e5682019-02-01 22:42:28 +0100449 case 'F':
450 opt_xdp_flags &= ~XDP_FLAGS_UPDATE_IF_NOEXIST;
451 break;
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300452 case 'f':
453 opt_xsk_frame_size = atoi(optarg);
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100454 break;
Magnus Karlsson46738f72019-08-14 09:27:21 +0200455 case 'm':
456 opt_need_wakeup = false;
457 opt_xdp_bind_flags &= ~XDP_USE_NEED_WAKEUP;
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300458 break;
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100459 case 'M':
460 opt_num_xsks = MAX_SOCKS;
461 break;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200462 default:
463 usage(basename(argv[0]));
464 }
465 }
466
467 opt_ifindex = if_nametoindex(opt_if);
468 if (!opt_ifindex) {
469 fprintf(stderr, "ERROR: interface \"%s\" does not exist\n",
470 opt_if);
471 usage(basename(argv[0]));
472 }
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100473
Kevin Laatzc543f542019-08-27 02:25:28 +0000474 if ((opt_xsk_frame_size & (opt_xsk_frame_size - 1)) &&
475 !opt_unaligned_chunks) {
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300476 fprintf(stderr, "--frame-size=%d is not a power of two\n",
477 opt_xsk_frame_size);
478 usage(basename(argv[0]));
479 }
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200480}
481
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100482static void kick_tx(struct xsk_socket_info *xsk)
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200483{
484 int ret;
485
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100486 ret = sendto(xsk_socket__fd(xsk->xsk), NULL, 0, MSG_DONTWAIT, NULL, 0);
Magnus Karlssonc03079c2018-06-29 09:48:19 +0200487 if (ret >= 0 || errno == ENOBUFS || errno == EAGAIN || errno == EBUSY)
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200488 return;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100489 exit_with_error(errno);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200490}
491
Magnus Karlsson46738f72019-08-14 09:27:21 +0200492static inline void complete_tx_l2fwd(struct xsk_socket_info *xsk,
493 struct pollfd *fds)
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200494{
Kevin Laatz03895e62019-08-27 02:25:29 +0000495 struct xsk_umem_info *umem = xsk->umem;
Yonghong Songb74e21a2019-02-28 22:19:41 -0800496 u32 idx_cq = 0, idx_fq = 0;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200497 unsigned int rcvd;
498 size_t ndescs;
499
500 if (!xsk->outstanding_tx)
501 return;
502
Magnus Karlsson46738f72019-08-14 09:27:21 +0200503 if (!opt_need_wakeup || xsk_ring_prod__needs_wakeup(&xsk->tx))
504 kick_tx(xsk);
505
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200506 ndescs = (xsk->outstanding_tx > BATCH_SIZE) ? BATCH_SIZE :
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100507 xsk->outstanding_tx;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200508
509 /* re-add completed Tx buffers */
Kevin Laatz03895e62019-08-27 02:25:29 +0000510 rcvd = xsk_ring_cons__peek(&umem->cq, ndescs, &idx_cq);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200511 if (rcvd > 0) {
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100512 unsigned int i;
513 int ret;
514
Kevin Laatz03895e62019-08-27 02:25:29 +0000515 ret = xsk_ring_prod__reserve(&umem->fq, rcvd, &idx_fq);
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100516 while (ret != rcvd) {
517 if (ret < 0)
518 exit_with_error(-ret);
Kevin Laatz03895e62019-08-27 02:25:29 +0000519 if (xsk_ring_prod__needs_wakeup(&umem->fq))
Magnus Karlsson46738f72019-08-14 09:27:21 +0200520 ret = poll(fds, num_socks, opt_timeout);
Kevin Laatz03895e62019-08-27 02:25:29 +0000521 ret = xsk_ring_prod__reserve(&umem->fq, rcvd, &idx_fq);
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100522 }
Kevin Laatz03895e62019-08-27 02:25:29 +0000523
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100524 for (i = 0; i < rcvd; i++)
Kevin Laatz03895e62019-08-27 02:25:29 +0000525 *xsk_ring_prod__fill_addr(&umem->fq, idx_fq++) =
526 *xsk_ring_cons__comp_addr(&umem->cq, idx_cq++);
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100527
528 xsk_ring_prod__submit(&xsk->umem->fq, rcvd);
529 xsk_ring_cons__release(&xsk->umem->cq, rcvd);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200530 xsk->outstanding_tx -= rcvd;
531 xsk->tx_npkts += rcvd;
532 }
533}
534
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100535static inline void complete_tx_only(struct xsk_socket_info *xsk)
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200536{
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200537 unsigned int rcvd;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100538 u32 idx;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200539
540 if (!xsk->outstanding_tx)
541 return;
542
Magnus Karlsson46738f72019-08-14 09:27:21 +0200543 if (!opt_need_wakeup || xsk_ring_prod__needs_wakeup(&xsk->tx))
544 kick_tx(xsk);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200545
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100546 rcvd = xsk_ring_cons__peek(&xsk->umem->cq, BATCH_SIZE, &idx);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200547 if (rcvd > 0) {
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100548 xsk_ring_cons__release(&xsk->umem->cq, rcvd);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200549 xsk->outstanding_tx -= rcvd;
550 xsk->tx_npkts += rcvd;
551 }
552}
553
Magnus Karlsson46738f72019-08-14 09:27:21 +0200554static void rx_drop(struct xsk_socket_info *xsk, struct pollfd *fds)
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200555{
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200556 unsigned int rcvd, i;
Yonghong Songb74e21a2019-02-28 22:19:41 -0800557 u32 idx_rx = 0, idx_fq = 0;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100558 int ret;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200559
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100560 rcvd = xsk_ring_cons__peek(&xsk->rx, BATCH_SIZE, &idx_rx);
Magnus Karlsson46738f72019-08-14 09:27:21 +0200561 if (!rcvd) {
562 if (xsk_ring_prod__needs_wakeup(&xsk->umem->fq))
563 ret = poll(fds, num_socks, opt_timeout);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200564 return;
Magnus Karlsson46738f72019-08-14 09:27:21 +0200565 }
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200566
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100567 ret = xsk_ring_prod__reserve(&xsk->umem->fq, rcvd, &idx_fq);
568 while (ret != rcvd) {
569 if (ret < 0)
570 exit_with_error(-ret);
Magnus Karlsson46738f72019-08-14 09:27:21 +0200571 if (xsk_ring_prod__needs_wakeup(&xsk->umem->fq))
572 ret = poll(fds, num_socks, opt_timeout);
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100573 ret = xsk_ring_prod__reserve(&xsk->umem->fq, rcvd, &idx_fq);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200574 }
575
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100576 for (i = 0; i < rcvd; i++) {
577 u64 addr = xsk_ring_cons__rx_desc(&xsk->rx, idx_rx)->addr;
578 u32 len = xsk_ring_cons__rx_desc(&xsk->rx, idx_rx++)->len;
Kevin Laatz03895e62019-08-27 02:25:29 +0000579 u64 orig = xsk_umem__extract_addr(addr);
580
581 addr = xsk_umem__add_offset_to_addr(addr);
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100582 char *pkt = xsk_umem__get_data(xsk->umem->buffer, addr);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200583
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100584 hex_dump(pkt, len, addr);
Kevin Laatz03895e62019-08-27 02:25:29 +0000585 *xsk_ring_prod__fill_addr(&xsk->umem->fq, idx_fq++) = orig;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100586 }
587
588 xsk_ring_prod__submit(&xsk->umem->fq, rcvd);
589 xsk_ring_cons__release(&xsk->rx, rcvd);
590 xsk->rx_npkts += rcvd;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200591}
592
593static void rx_drop_all(void)
594{
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100595 struct pollfd fds[MAX_SOCKS] = {};
Magnus Karlsson46738f72019-08-14 09:27:21 +0200596 int i, ret;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200597
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200598 for (i = 0; i < num_socks; i++) {
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100599 fds[i].fd = xsk_socket__fd(xsks[i]->xsk);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200600 fds[i].events = POLLIN;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200601 }
602
603 for (;;) {
604 if (opt_poll) {
Magnus Karlsson46738f72019-08-14 09:27:21 +0200605 ret = poll(fds, num_socks, opt_timeout);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200606 if (ret <= 0)
607 continue;
608 }
609
610 for (i = 0; i < num_socks; i++)
Magnus Karlsson46738f72019-08-14 09:27:21 +0200611 rx_drop(xsks[i], fds);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200612 }
613}
614
Magnus Karlsson46738f72019-08-14 09:27:21 +0200615static void tx_only(struct xsk_socket_info *xsk, u32 frame_nb)
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200616{
Magnus Karlsson46738f72019-08-14 09:27:21 +0200617 u32 idx;
618
619 if (xsk_ring_prod__reserve(&xsk->tx, BATCH_SIZE, &idx) == BATCH_SIZE) {
620 unsigned int i;
621
622 for (i = 0; i < BATCH_SIZE; i++) {
623 xsk_ring_prod__tx_desc(&xsk->tx, idx + i)->addr =
624 (frame_nb + i) << XSK_UMEM__DEFAULT_FRAME_SHIFT;
625 xsk_ring_prod__tx_desc(&xsk->tx, idx + i)->len =
626 sizeof(pkt_data) - 1;
627 }
628
629 xsk_ring_prod__submit(&xsk->tx, BATCH_SIZE);
630 xsk->outstanding_tx += BATCH_SIZE;
631 frame_nb += BATCH_SIZE;
632 frame_nb %= NUM_FRAMES;
633 }
634
635 complete_tx_only(xsk);
636}
637
638static void tx_only_all(void)
639{
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100640 struct pollfd fds[MAX_SOCKS] = {};
Magnus Karlsson46738f72019-08-14 09:27:21 +0200641 u32 frame_nb[MAX_SOCKS] = {};
642 int i, ret;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200643
Magnus Karlsson46738f72019-08-14 09:27:21 +0200644 for (i = 0; i < num_socks; i++) {
645 fds[0].fd = xsk_socket__fd(xsks[i]->xsk);
646 fds[0].events = POLLOUT;
647 }
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200648
649 for (;;) {
650 if (opt_poll) {
Magnus Karlsson46738f72019-08-14 09:27:21 +0200651 ret = poll(fds, num_socks, opt_timeout);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200652 if (ret <= 0)
653 continue;
654
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100655 if (!(fds[0].revents & POLLOUT))
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200656 continue;
657 }
658
Magnus Karlsson46738f72019-08-14 09:27:21 +0200659 for (i = 0; i < num_socks; i++)
660 tx_only(xsks[i], frame_nb[i]);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200661 }
662}
663
Magnus Karlsson46738f72019-08-14 09:27:21 +0200664static void l2fwd(struct xsk_socket_info *xsk, struct pollfd *fds)
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200665{
Magnus Karlsson46738f72019-08-14 09:27:21 +0200666 unsigned int rcvd, i;
667 u32 idx_rx = 0, idx_tx = 0;
668 int ret;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200669
Magnus Karlsson46738f72019-08-14 09:27:21 +0200670 complete_tx_l2fwd(xsk, fds);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200671
Magnus Karlsson46738f72019-08-14 09:27:21 +0200672 rcvd = xsk_ring_cons__peek(&xsk->rx, BATCH_SIZE, &idx_rx);
673 if (!rcvd) {
674 if (xsk_ring_prod__needs_wakeup(&xsk->umem->fq))
675 ret = poll(fds, num_socks, opt_timeout);
676 return;
677 }
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200678
Magnus Karlsson46738f72019-08-14 09:27:21 +0200679 ret = xsk_ring_prod__reserve(&xsk->tx, rcvd, &idx_tx);
680 while (ret != rcvd) {
681 if (ret < 0)
682 exit_with_error(-ret);
683 if (xsk_ring_prod__needs_wakeup(&xsk->tx))
684 kick_tx(xsk);
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100685 ret = xsk_ring_prod__reserve(&xsk->tx, rcvd, &idx_tx);
Magnus Karlsson46738f72019-08-14 09:27:21 +0200686 }
687
688 for (i = 0; i < rcvd; i++) {
689 u64 addr = xsk_ring_cons__rx_desc(&xsk->rx, idx_rx)->addr;
690 u32 len = xsk_ring_cons__rx_desc(&xsk->rx, idx_rx++)->len;
Ciara Loftus5a712e12019-09-13 10:39:48 +0000691 u64 orig = addr;
Kevin Laatz03895e62019-08-27 02:25:29 +0000692
693 addr = xsk_umem__add_offset_to_addr(addr);
Magnus Karlsson46738f72019-08-14 09:27:21 +0200694 char *pkt = xsk_umem__get_data(xsk->umem->buffer, addr);
695
696 swap_mac_addresses(pkt);
697
698 hex_dump(pkt, len, addr);
Kevin Laatz03895e62019-08-27 02:25:29 +0000699 xsk_ring_prod__tx_desc(&xsk->tx, idx_tx)->addr = orig;
Magnus Karlsson46738f72019-08-14 09:27:21 +0200700 xsk_ring_prod__tx_desc(&xsk->tx, idx_tx++)->len = len;
701 }
702
703 xsk_ring_prod__submit(&xsk->tx, rcvd);
704 xsk_ring_cons__release(&xsk->rx, rcvd);
705
706 xsk->rx_npkts += rcvd;
707 xsk->outstanding_tx += rcvd;
708}
709
710static void l2fwd_all(void)
711{
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100712 struct pollfd fds[MAX_SOCKS] = {};
Magnus Karlsson46738f72019-08-14 09:27:21 +0200713 int i, ret;
714
Magnus Karlsson46738f72019-08-14 09:27:21 +0200715 for (i = 0; i < num_socks; i++) {
716 fds[i].fd = xsk_socket__fd(xsks[i]->xsk);
717 fds[i].events = POLLOUT | POLLIN;
718 }
719
720 for (;;) {
721 if (opt_poll) {
722 ret = poll(fds, num_socks, opt_timeout);
723 if (ret <= 0)
724 continue;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100725 }
726
Magnus Karlsson46738f72019-08-14 09:27:21 +0200727 for (i = 0; i < num_socks; i++)
728 l2fwd(xsks[i], fds);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200729 }
730}
731
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100732static void load_xdp_program(char **argv, struct bpf_object **obj)
733{
734 struct bpf_prog_load_attr prog_load_attr = {
735 .prog_type = BPF_PROG_TYPE_XDP,
736 };
737 char xdp_filename[256];
738 int prog_fd;
739
740 snprintf(xdp_filename, sizeof(xdp_filename), "%s_kern.o", argv[0]);
741 prog_load_attr.file = xdp_filename;
742
743 if (bpf_prog_load_xattr(&prog_load_attr, obj, &prog_fd))
744 exit(EXIT_FAILURE);
745 if (prog_fd < 0) {
746 fprintf(stderr, "ERROR: no program found: %s\n",
747 strerror(prog_fd));
748 exit(EXIT_FAILURE);
749 }
750
751 if (bpf_set_link_xdp_fd(opt_ifindex, prog_fd, opt_xdp_flags) < 0) {
752 fprintf(stderr, "ERROR: link set xdp fd failed\n");
753 exit(EXIT_FAILURE);
754 }
755}
756
757static void enter_xsks_into_map(struct bpf_object *obj)
758{
759 struct bpf_map *map;
760 int i, xsks_map;
761
762 map = bpf_object__find_map_by_name(obj, "xsks_map");
763 xsks_map = bpf_map__fd(map);
764 if (xsks_map < 0) {
765 fprintf(stderr, "ERROR: no xsks map found: %s\n",
766 strerror(xsks_map));
767 exit(EXIT_FAILURE);
768 }
769
770 for (i = 0; i < num_socks; i++) {
771 int fd = xsk_socket__fd(xsks[i]->xsk);
772 int key, ret;
773
774 key = i;
775 ret = bpf_map_update_elem(xsks_map, &key, &fd, 0);
776 if (ret) {
777 fprintf(stderr, "ERROR: bpf_map_update_elem %d\n", i);
778 exit(EXIT_FAILURE);
779 }
780 }
781}
782
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200783int main(int argc, char **argv)
784{
785 struct rlimit r = {RLIM_INFINITY, RLIM_INFINITY};
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100786 struct xsk_umem_info *umem;
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100787 struct bpf_object *obj;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200788 pthread_t pt;
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100789 int i, ret;
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100790 void *bufs;
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200791
792 parse_command_line(argc, argv);
793
794 if (setrlimit(RLIMIT_MEMLOCK, &r)) {
795 fprintf(stderr, "ERROR: setrlimit(RLIMIT_MEMLOCK) \"%s\"\n",
796 strerror(errno));
797 exit(EXIT_FAILURE);
798 }
799
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100800 if (opt_num_xsks > 1)
801 load_xdp_program(argv, &obj);
802
Kevin Laatz3945b372019-08-27 02:25:30 +0000803 /* Reserve memory for the umem. Use hugepages if unaligned chunk mode */
804 bufs = mmap(NULL, NUM_FRAMES * opt_xsk_frame_size,
805 PROT_READ | PROT_WRITE,
806 MAP_PRIVATE | MAP_ANONYMOUS | opt_mmap_flags, -1, 0);
807 if (bufs == MAP_FAILED) {
808 printf("ERROR: mmap failed\n");
809 exit(EXIT_FAILURE);
810 }
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100811
812 /* Create sockets... */
Maxim Mikityanskiy123e8da12019-06-26 17:35:27 +0300813 umem = xsk_configure_umem(bufs, NUM_FRAMES * opt_xsk_frame_size);
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100814 for (i = 0; i < opt_num_xsks; i++)
815 xsks[num_socks++] = xsk_configure_socket(umem);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200816
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100817 for (i = 0; i < NUM_FRAMES; i++)
818 gen_eth_frame(umem, i * opt_xsk_frame_size);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200819
Magnus Karlsson2e5d72c2019-11-07 18:47:37 +0100820 if (opt_num_xsks > 1 && opt_bench != BENCH_TXONLY)
821 enter_xsks_into_map(obj);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200822
823 signal(SIGINT, int_exit);
824 signal(SIGTERM, int_exit);
825 signal(SIGABRT, int_exit);
826
827 setlocale(LC_ALL, "");
828
829 ret = pthread_create(&pt, NULL, poller, NULL);
Magnus Karlsson248c7f92019-02-21 10:21:27 +0100830 if (ret)
831 exit_with_error(ret);
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200832
833 prev_time = get_nsecs();
834
835 if (opt_bench == BENCH_RXDROP)
836 rx_drop_all();
837 else if (opt_bench == BENCH_TXONLY)
Magnus Karlsson46738f72019-08-14 09:27:21 +0200838 tx_only_all();
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200839 else
Magnus Karlsson46738f72019-08-14 09:27:21 +0200840 l2fwd_all();
Magnus Karlssonb4b8faa2018-05-02 13:01:36 +0200841
842 return 0;
843}