Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0 |
Björn Töpel | dac0914 | 2018-05-18 14:00:21 +0200 | [diff] [blame] | 2 | /* Copyright(c) 2017 - 2018 Intel Corporation. */ |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 3 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 4 | #include <asm/barrier.h> |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 5 | #include <errno.h> |
| 6 | #include <getopt.h> |
| 7 | #include <libgen.h> |
| 8 | #include <linux/bpf.h> |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 9 | #include <linux/compiler.h> |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 10 | #include <linux/if_link.h> |
| 11 | #include <linux/if_xdp.h> |
| 12 | #include <linux/if_ether.h> |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 13 | #include <locale.h> |
| 14 | #include <net/ethernet.h> |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 15 | #include <net/if.h> |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 16 | #include <poll.h> |
| 17 | #include <pthread.h> |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 18 | #include <signal.h> |
| 19 | #include <stdbool.h> |
| 20 | #include <stdio.h> |
| 21 | #include <stdlib.h> |
| 22 | #include <string.h> |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 23 | #include <sys/mman.h> |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 24 | #include <sys/resource.h> |
| 25 | #include <sys/socket.h> |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 26 | #include <sys/types.h> |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 27 | #include <time.h> |
| 28 | #include <unistd.h> |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 29 | |
Daniel T. Lee | 4d18f6d | 2019-06-16 00:14:47 +0900 | [diff] [blame] | 30 | #include "libbpf.h" |
| 31 | #include "xsk.h" |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 32 | #include "xdpsock.h" |
Jakub Kicinski | 2bf3e2e | 2018-05-14 22:35:02 -0700 | [diff] [blame] | 33 | #include <bpf/bpf.h> |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 34 | |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 35 | #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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 47 | #define NUM_FRAMES (4 * 1024) |
| 48 | #define BATCH_SIZE 64 |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 49 | |
| 50 | #define DEBUG_HEXDUMP 0 |
| 51 | |
Björn Töpel | a412ef5 | 2018-06-04 13:57:14 +0200 | [diff] [blame] | 52 | typedef __u64 u64; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 53 | typedef __u32 u32; |
| 54 | |
| 55 | static unsigned long prev_time; |
| 56 | |
| 57 | enum benchmark_type { |
| 58 | BENCH_RXDROP = 0, |
| 59 | BENCH_TXONLY = 1, |
| 60 | BENCH_L2FWD = 2, |
| 61 | }; |
| 62 | |
| 63 | static enum benchmark_type opt_bench = BENCH_RXDROP; |
Maciej Fijalkowski | 743e568 | 2019-02-01 22:42:28 +0100 | [diff] [blame] | 64 | static u32 opt_xdp_flags = XDP_FLAGS_UPDATE_IF_NOEXIST; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 65 | static const char *opt_if = ""; |
| 66 | static int opt_ifindex; |
| 67 | static int opt_queue; |
| 68 | static int opt_poll; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 69 | static int opt_interval = 1; |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 70 | static u32 opt_xdp_bind_flags = XDP_USE_NEED_WAKEUP; |
Kevin Laatz | c543f54 | 2019-08-27 02:25:28 +0000 | [diff] [blame] | 71 | static u32 opt_umem_flags; |
| 72 | static int opt_unaligned_chunks; |
Kevin Laatz | 3945b37 | 2019-08-27 02:25:30 +0000 | [diff] [blame] | 73 | static int opt_mmap_flags; |
Kevin Laatz | c543f54 | 2019-08-27 02:25:28 +0000 | [diff] [blame] | 74 | static u32 opt_xdp_bind_flags; |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 75 | static int opt_xsk_frame_size = XSK_UMEM__DEFAULT_FRAME_SIZE; |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 76 | static int opt_timeout = 1000; |
| 77 | static bool opt_need_wakeup = true; |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 78 | static u32 opt_num_xsks = 1; |
| 79 | static u32 prog_id; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 80 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 81 | struct xsk_umem_info { |
| 82 | struct xsk_ring_prod fq; |
| 83 | struct xsk_ring_cons cq; |
| 84 | struct xsk_umem *umem; |
| 85 | void *buffer; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 86 | }; |
| 87 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 88 | struct 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 Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 93 | unsigned long rx_npkts; |
| 94 | unsigned long tx_npkts; |
| 95 | unsigned long prev_rx_npkts; |
| 96 | unsigned long prev_tx_npkts; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 97 | u32 outstanding_tx; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 98 | }; |
| 99 | |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 100 | static int num_socks; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 101 | struct xsk_socket_info *xsks[MAX_SOCKS]; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 102 | |
| 103 | static 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 Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 111 | static 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 | |
| 139 | static 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 Bhole | 11c3f51 | 2018-08-31 10:00:49 +0900 | [diff] [blame] | 147 | for (i = 0; i < num_socks && xsks[i]; i++) { |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 148 | 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 | |
| 170 | static 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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 181 | static void remove_xdp_program(void) |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 182 | { |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 183 | u32 curr_prog_id = 0; |
Maciej Fijalkowski | 3b7a8ec | 2019-02-01 22:42:30 +0100 | [diff] [blame] | 184 | |
Maciej Fijalkowski | 3b7a8ec | 2019-02-01 22:42:30 +0100 | [diff] [blame] | 185 | 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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 195 | } |
| 196 | |
| 197 | static void int_exit(int sig) |
| 198 | { |
| 199 | struct xsk_umem *umem = xsks[0]->umem->umem; |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 200 | int i; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 201 | |
| 202 | dump_stats(); |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 203 | for (i = 0; i < num_socks; i++) |
| 204 | xsk_socket__delete(xsks[i]->xsk); |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 205 | (void)xsk_umem__delete(umem); |
| 206 | remove_xdp_program(); |
| 207 | |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 208 | exit(EXIT_SUCCESS); |
| 209 | } |
| 210 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 211 | static 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 | |
| 224 | static 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 | |
| 230 | static 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 *)ð->ether_shost; |
| 234 | struct ether_addr *dst_addr = (struct ether_addr *)ð->ether_dhost; |
| 235 | struct ether_addr tmp; |
| 236 | |
| 237 | tmp = *src_addr; |
| 238 | *src_addr = *dst_addr; |
| 239 | *dst_addr = tmp; |
| 240 | } |
| 241 | |
| 242 | static 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 | |
| 277 | static 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 | |
| 284 | static struct xsk_umem_info *xsk_configure_umem(void *buffer, u64 size) |
| 285 | { |
| 286 | struct xsk_umem_info *umem; |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 287 | 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 Laatz | c543f54 | 2019-08-27 02:25:28 +0000 | [diff] [blame] | 292 | .flags = opt_umem_flags |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 293 | }; |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 294 | int ret, i; |
| 295 | u32 idx; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 296 | |
| 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 Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 302 | &cfg); |
Kevin Laatz | c543f54 | 2019-08-27 02:25:28 +0000 | [diff] [blame] | 303 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 304 | if (ret) |
| 305 | exit_with_error(-ret); |
| 306 | |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 307 | 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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 316 | umem->buffer = buffer; |
| 317 | return umem; |
| 318 | } |
| 319 | |
| 320 | static 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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 325 | |
| 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 Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 333 | if (opt_num_xsks > 1) |
| 334 | cfg.libbpf_flags = XSK_LIBBPF_FLAGS__INHIBIT_PROG_LOAD; |
| 335 | else |
| 336 | cfg.libbpf_flags = 0; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 337 | cfg.xdp_flags = opt_xdp_flags; |
| 338 | cfg.bind_flags = opt_xdp_bind_flags; |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 339 | |
| 340 | ret = xsk_socket__create(&xsk->xsk, opt_if, opt_queue, |
| 341 | umem->umem, &xsk->rx, &xsk->tx, &cfg); |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 342 | 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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 349 | return xsk; |
| 350 | } |
| 351 | |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 352 | static 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 Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 359 | {"xdp-skb", no_argument, 0, 'S'}, |
| 360 | {"xdp-native", no_argument, 0, 'N'}, |
| 361 | {"interval", required_argument, 0, 'n'}, |
Björn Töpel | 58c50ae | 2018-08-28 14:44:35 +0200 | [diff] [blame] | 362 | {"zero-copy", no_argument, 0, 'z'}, |
| 363 | {"copy", no_argument, 0, 'c'}, |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 364 | {"frame-size", required_argument, 0, 'f'}, |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 365 | {"no-need-wakeup", no_argument, 0, 'm'}, |
Kevin Laatz | c543f54 | 2019-08-27 02:25:28 +0000 | [diff] [blame] | 366 | {"unaligned", no_argument, 0, 'u'}, |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 367 | {"shared-umem", no_argument, 0, 'M'}, |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 368 | {0, 0, 0, 0} |
| 369 | }; |
| 370 | |
| 371 | static 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 Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 382 | " -S, --xdp-skb=n Use XDP skb-mod\n" |
Anton Ivanov | 4564a8bb | 2019-10-07 09:26:36 +0100 | [diff] [blame] | 383 | " -N, --xdp-native=n Enforce XDP native mode\n" |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 384 | " -n, --interval=n Specify statistics update interval (default 1 sec).\n" |
Björn Töpel | 58c50ae | 2018-08-28 14:44:35 +0200 | [diff] [blame] | 385 | " -z, --zero-copy Force zero-copy mode.\n" |
| 386 | " -c, --copy Force copy mode.\n" |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 387 | " -f, --frame-size=n Set the frame size (must be a power of two, default is %d).\n" |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 388 | " -m, --no-need-wakeup Turn off use of driver need wakeup flag.\n" |
Kevin Laatz | c543f54 | 2019-08-27 02:25:28 +0000 | [diff] [blame] | 389 | " -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 Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 391 | " -M, --shared-umem Enable XDP_SHARED_UMEM\n" |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 392 | "\n"; |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 393 | fprintf(stderr, str, prog, XSK_UMEM__DEFAULT_FRAME_SIZE); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 394 | exit(EXIT_FAILURE); |
| 395 | } |
| 396 | |
| 397 | static void parse_command_line(int argc, char **argv) |
| 398 | { |
| 399 | int option_index, c; |
| 400 | |
| 401 | opterr = 0; |
| 402 | |
| 403 | for (;;) { |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 404 | c = getopt_long(argc, argv, "Frtli:q:psSNn:czf:muM", |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 405 | long_options, &option_index); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 406 | 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 Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 425 | case 'p': |
| 426 | opt_poll = 1; |
| 427 | break; |
| 428 | case 'S': |
| 429 | opt_xdp_flags |= XDP_FLAGS_SKB_MODE; |
Björn Töpel | 9f5232c | 2018-06-04 14:06:01 +0200 | [diff] [blame] | 430 | opt_xdp_bind_flags |= XDP_COPY; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 431 | 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öpel | 58c50ae | 2018-08-28 14:44:35 +0200 | [diff] [blame] | 438 | case 'z': |
| 439 | opt_xdp_bind_flags |= XDP_ZEROCOPY; |
| 440 | break; |
| 441 | case 'c': |
| 442 | opt_xdp_bind_flags |= XDP_COPY; |
| 443 | break; |
Kevin Laatz | c543f54 | 2019-08-27 02:25:28 +0000 | [diff] [blame] | 444 | case 'u': |
| 445 | opt_umem_flags |= XDP_UMEM_UNALIGNED_CHUNK_FLAG; |
| 446 | opt_unaligned_chunks = 1; |
Kevin Laatz | 3945b37 | 2019-08-27 02:25:30 +0000 | [diff] [blame] | 447 | opt_mmap_flags = MAP_HUGETLB; |
Kevin Laatz | c543f54 | 2019-08-27 02:25:28 +0000 | [diff] [blame] | 448 | break; |
Maciej Fijalkowski | 743e568 | 2019-02-01 22:42:28 +0100 | [diff] [blame] | 449 | case 'F': |
| 450 | opt_xdp_flags &= ~XDP_FLAGS_UPDATE_IF_NOEXIST; |
| 451 | break; |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 452 | case 'f': |
| 453 | opt_xsk_frame_size = atoi(optarg); |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 454 | break; |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 455 | case 'm': |
| 456 | opt_need_wakeup = false; |
| 457 | opt_xdp_bind_flags &= ~XDP_USE_NEED_WAKEUP; |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 458 | break; |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 459 | case 'M': |
| 460 | opt_num_xsks = MAX_SOCKS; |
| 461 | break; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 462 | 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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 473 | |
Kevin Laatz | c543f54 | 2019-08-27 02:25:28 +0000 | [diff] [blame] | 474 | if ((opt_xsk_frame_size & (opt_xsk_frame_size - 1)) && |
| 475 | !opt_unaligned_chunks) { |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 476 | fprintf(stderr, "--frame-size=%d is not a power of two\n", |
| 477 | opt_xsk_frame_size); |
| 478 | usage(basename(argv[0])); |
| 479 | } |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 480 | } |
| 481 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 482 | static void kick_tx(struct xsk_socket_info *xsk) |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 483 | { |
| 484 | int ret; |
| 485 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 486 | ret = sendto(xsk_socket__fd(xsk->xsk), NULL, 0, MSG_DONTWAIT, NULL, 0); |
Magnus Karlsson | c03079c | 2018-06-29 09:48:19 +0200 | [diff] [blame] | 487 | if (ret >= 0 || errno == ENOBUFS || errno == EAGAIN || errno == EBUSY) |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 488 | return; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 489 | exit_with_error(errno); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 490 | } |
| 491 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 492 | static inline void complete_tx_l2fwd(struct xsk_socket_info *xsk, |
| 493 | struct pollfd *fds) |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 494 | { |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 495 | struct xsk_umem_info *umem = xsk->umem; |
Yonghong Song | b74e21a | 2019-02-28 22:19:41 -0800 | [diff] [blame] | 496 | u32 idx_cq = 0, idx_fq = 0; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 497 | unsigned int rcvd; |
| 498 | size_t ndescs; |
| 499 | |
| 500 | if (!xsk->outstanding_tx) |
| 501 | return; |
| 502 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 503 | if (!opt_need_wakeup || xsk_ring_prod__needs_wakeup(&xsk->tx)) |
| 504 | kick_tx(xsk); |
| 505 | |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 506 | ndescs = (xsk->outstanding_tx > BATCH_SIZE) ? BATCH_SIZE : |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 507 | xsk->outstanding_tx; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 508 | |
| 509 | /* re-add completed Tx buffers */ |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 510 | rcvd = xsk_ring_cons__peek(&umem->cq, ndescs, &idx_cq); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 511 | if (rcvd > 0) { |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 512 | unsigned int i; |
| 513 | int ret; |
| 514 | |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 515 | ret = xsk_ring_prod__reserve(&umem->fq, rcvd, &idx_fq); |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 516 | while (ret != rcvd) { |
| 517 | if (ret < 0) |
| 518 | exit_with_error(-ret); |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 519 | if (xsk_ring_prod__needs_wakeup(&umem->fq)) |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 520 | ret = poll(fds, num_socks, opt_timeout); |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 521 | ret = xsk_ring_prod__reserve(&umem->fq, rcvd, &idx_fq); |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 522 | } |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 523 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 524 | for (i = 0; i < rcvd; i++) |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 525 | *xsk_ring_prod__fill_addr(&umem->fq, idx_fq++) = |
| 526 | *xsk_ring_cons__comp_addr(&umem->cq, idx_cq++); |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 527 | |
| 528 | xsk_ring_prod__submit(&xsk->umem->fq, rcvd); |
| 529 | xsk_ring_cons__release(&xsk->umem->cq, rcvd); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 530 | xsk->outstanding_tx -= rcvd; |
| 531 | xsk->tx_npkts += rcvd; |
| 532 | } |
| 533 | } |
| 534 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 535 | static inline void complete_tx_only(struct xsk_socket_info *xsk) |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 536 | { |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 537 | unsigned int rcvd; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 538 | u32 idx; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 539 | |
| 540 | if (!xsk->outstanding_tx) |
| 541 | return; |
| 542 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 543 | if (!opt_need_wakeup || xsk_ring_prod__needs_wakeup(&xsk->tx)) |
| 544 | kick_tx(xsk); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 545 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 546 | rcvd = xsk_ring_cons__peek(&xsk->umem->cq, BATCH_SIZE, &idx); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 547 | if (rcvd > 0) { |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 548 | xsk_ring_cons__release(&xsk->umem->cq, rcvd); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 549 | xsk->outstanding_tx -= rcvd; |
| 550 | xsk->tx_npkts += rcvd; |
| 551 | } |
| 552 | } |
| 553 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 554 | static void rx_drop(struct xsk_socket_info *xsk, struct pollfd *fds) |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 555 | { |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 556 | unsigned int rcvd, i; |
Yonghong Song | b74e21a | 2019-02-28 22:19:41 -0800 | [diff] [blame] | 557 | u32 idx_rx = 0, idx_fq = 0; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 558 | int ret; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 559 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 560 | rcvd = xsk_ring_cons__peek(&xsk->rx, BATCH_SIZE, &idx_rx); |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 561 | if (!rcvd) { |
| 562 | if (xsk_ring_prod__needs_wakeup(&xsk->umem->fq)) |
| 563 | ret = poll(fds, num_socks, opt_timeout); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 564 | return; |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 565 | } |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 566 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 567 | 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 Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 571 | if (xsk_ring_prod__needs_wakeup(&xsk->umem->fq)) |
| 572 | ret = poll(fds, num_socks, opt_timeout); |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 573 | ret = xsk_ring_prod__reserve(&xsk->umem->fq, rcvd, &idx_fq); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 574 | } |
| 575 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 576 | 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 Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 579 | u64 orig = xsk_umem__extract_addr(addr); |
| 580 | |
| 581 | addr = xsk_umem__add_offset_to_addr(addr); |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 582 | char *pkt = xsk_umem__get_data(xsk->umem->buffer, addr); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 583 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 584 | hex_dump(pkt, len, addr); |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 585 | *xsk_ring_prod__fill_addr(&xsk->umem->fq, idx_fq++) = orig; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 586 | } |
| 587 | |
| 588 | xsk_ring_prod__submit(&xsk->umem->fq, rcvd); |
| 589 | xsk_ring_cons__release(&xsk->rx, rcvd); |
| 590 | xsk->rx_npkts += rcvd; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 591 | } |
| 592 | |
| 593 | static void rx_drop_all(void) |
| 594 | { |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 595 | struct pollfd fds[MAX_SOCKS] = {}; |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 596 | int i, ret; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 597 | |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 598 | for (i = 0; i < num_socks; i++) { |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 599 | fds[i].fd = xsk_socket__fd(xsks[i]->xsk); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 600 | fds[i].events = POLLIN; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 601 | } |
| 602 | |
| 603 | for (;;) { |
| 604 | if (opt_poll) { |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 605 | ret = poll(fds, num_socks, opt_timeout); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 606 | if (ret <= 0) |
| 607 | continue; |
| 608 | } |
| 609 | |
| 610 | for (i = 0; i < num_socks; i++) |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 611 | rx_drop(xsks[i], fds); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 612 | } |
| 613 | } |
| 614 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 615 | static void tx_only(struct xsk_socket_info *xsk, u32 frame_nb) |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 616 | { |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 617 | 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 | |
| 638 | static void tx_only_all(void) |
| 639 | { |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 640 | struct pollfd fds[MAX_SOCKS] = {}; |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 641 | u32 frame_nb[MAX_SOCKS] = {}; |
| 642 | int i, ret; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 643 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 644 | for (i = 0; i < num_socks; i++) { |
| 645 | fds[0].fd = xsk_socket__fd(xsks[i]->xsk); |
| 646 | fds[0].events = POLLOUT; |
| 647 | } |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 648 | |
| 649 | for (;;) { |
| 650 | if (opt_poll) { |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 651 | ret = poll(fds, num_socks, opt_timeout); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 652 | if (ret <= 0) |
| 653 | continue; |
| 654 | |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 655 | if (!(fds[0].revents & POLLOUT)) |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 656 | continue; |
| 657 | } |
| 658 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 659 | for (i = 0; i < num_socks; i++) |
| 660 | tx_only(xsks[i], frame_nb[i]); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 661 | } |
| 662 | } |
| 663 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 664 | static void l2fwd(struct xsk_socket_info *xsk, struct pollfd *fds) |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 665 | { |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 666 | unsigned int rcvd, i; |
| 667 | u32 idx_rx = 0, idx_tx = 0; |
| 668 | int ret; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 669 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 670 | complete_tx_l2fwd(xsk, fds); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 671 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 672 | 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 Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 678 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 679 | 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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 685 | ret = xsk_ring_prod__reserve(&xsk->tx, rcvd, &idx_tx); |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 686 | } |
| 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 Loftus | 5a712e1 | 2019-09-13 10:39:48 +0000 | [diff] [blame] | 691 | u64 orig = addr; |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 692 | |
| 693 | addr = xsk_umem__add_offset_to_addr(addr); |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 694 | char *pkt = xsk_umem__get_data(xsk->umem->buffer, addr); |
| 695 | |
| 696 | swap_mac_addresses(pkt); |
| 697 | |
| 698 | hex_dump(pkt, len, addr); |
Kevin Laatz | 03895e6 | 2019-08-27 02:25:29 +0000 | [diff] [blame] | 699 | xsk_ring_prod__tx_desc(&xsk->tx, idx_tx)->addr = orig; |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 700 | 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 | |
| 710 | static void l2fwd_all(void) |
| 711 | { |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 712 | struct pollfd fds[MAX_SOCKS] = {}; |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 713 | int i, ret; |
| 714 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 715 | 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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 725 | } |
| 726 | |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 727 | for (i = 0; i < num_socks; i++) |
| 728 | l2fwd(xsks[i], fds); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 729 | } |
| 730 | } |
| 731 | |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 732 | static 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 | |
| 757 | static 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 Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 783 | int main(int argc, char **argv) |
| 784 | { |
| 785 | struct rlimit r = {RLIM_INFINITY, RLIM_INFINITY}; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 786 | struct xsk_umem_info *umem; |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 787 | struct bpf_object *obj; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 788 | pthread_t pt; |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 789 | int i, ret; |
Magnus Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 790 | void *bufs; |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 791 | |
| 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 Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 800 | if (opt_num_xsks > 1) |
| 801 | load_xdp_program(argv, &obj); |
| 802 | |
Kevin Laatz | 3945b37 | 2019-08-27 02:25:30 +0000 | [diff] [blame] | 803 | /* 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 Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 811 | |
| 812 | /* Create sockets... */ |
Maxim Mikityanskiy | 123e8da1 | 2019-06-26 17:35:27 +0300 | [diff] [blame] | 813 | umem = xsk_configure_umem(bufs, NUM_FRAMES * opt_xsk_frame_size); |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 814 | for (i = 0; i < opt_num_xsks; i++) |
| 815 | xsks[num_socks++] = xsk_configure_socket(umem); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 816 | |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 817 | for (i = 0; i < NUM_FRAMES; i++) |
| 818 | gen_eth_frame(umem, i * opt_xsk_frame_size); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 819 | |
Magnus Karlsson | 2e5d72c | 2019-11-07 18:47:37 +0100 | [diff] [blame^] | 820 | if (opt_num_xsks > 1 && opt_bench != BENCH_TXONLY) |
| 821 | enter_xsks_into_map(obj); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 822 | |
| 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 Karlsson | 248c7f9 | 2019-02-21 10:21:27 +0100 | [diff] [blame] | 830 | if (ret) |
| 831 | exit_with_error(ret); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 832 | |
| 833 | prev_time = get_nsecs(); |
| 834 | |
| 835 | if (opt_bench == BENCH_RXDROP) |
| 836 | rx_drop_all(); |
| 837 | else if (opt_bench == BENCH_TXONLY) |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 838 | tx_only_all(); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 839 | else |
Magnus Karlsson | 46738f7 | 2019-08-14 09:27:21 +0200 | [diff] [blame] | 840 | l2fwd_all(); |
Magnus Karlsson | b4b8faa | 2018-05-02 13:01:36 +0200 | [diff] [blame] | 841 | |
| 842 | return 0; |
| 843 | } |