1018a8e75SMaciej Fijalkowski // SPDX-License-Identifier: GPL-2.0 2018a8e75SMaciej Fijalkowski /* Copyright(c) 2020 Intel Corporation. */ 3018a8e75SMaciej Fijalkowski 4018a8e75SMaciej Fijalkowski /* 5018a8e75SMaciej Fijalkowski * Some functions in this program are taken from 6018a8e75SMaciej Fijalkowski * Linux kernel samples/bpf/xdpsock* and modified 7018a8e75SMaciej Fijalkowski * for use. 8018a8e75SMaciej Fijalkowski * 9018a8e75SMaciej Fijalkowski * See test_xsk.sh for detailed information on test topology 10018a8e75SMaciej Fijalkowski * and prerequisite network setup. 11018a8e75SMaciej Fijalkowski * 12018a8e75SMaciej Fijalkowski * This test program contains two threads, each thread is single socket with 13018a8e75SMaciej Fijalkowski * a unique UMEM. It validates in-order packet delivery and packet content 14018a8e75SMaciej Fijalkowski * by sending packets to each other. 15018a8e75SMaciej Fijalkowski * 16018a8e75SMaciej Fijalkowski * Tests Information: 17018a8e75SMaciej Fijalkowski * ------------------ 18018a8e75SMaciej Fijalkowski * These selftests test AF_XDP SKB and Native/DRV modes using veth 19018a8e75SMaciej Fijalkowski * Virtual Ethernet interfaces. 20018a8e75SMaciej Fijalkowski * 21018a8e75SMaciej Fijalkowski * For each mode, the following tests are run: 22018a8e75SMaciej Fijalkowski * a. nopoll - soft-irq processing in run-to-completion mode 23018a8e75SMaciej Fijalkowski * b. poll - using poll() syscall 24018a8e75SMaciej Fijalkowski * c. Socket Teardown 25018a8e75SMaciej Fijalkowski * Create a Tx and a Rx socket, Tx from one socket, Rx on another. Destroy 26018a8e75SMaciej Fijalkowski * both sockets, then repeat multiple times. Only nopoll mode is used 27018a8e75SMaciej Fijalkowski * d. Bi-directional sockets 28018a8e75SMaciej Fijalkowski * Configure sockets as bi-directional tx/rx sockets, sets up fill and 29018a8e75SMaciej Fijalkowski * completion rings on each socket, tx/rx in both directions. Only nopoll 30018a8e75SMaciej Fijalkowski * mode is used 31018a8e75SMaciej Fijalkowski * e. Statistics 32018a8e75SMaciej Fijalkowski * Trigger some error conditions and ensure that the appropriate statistics 33018a8e75SMaciej Fijalkowski * are incremented. Within this test, the following statistics are tested: 34018a8e75SMaciej Fijalkowski * i. rx dropped 35018a8e75SMaciej Fijalkowski * Increase the UMEM frame headroom to a value which results in 36018a8e75SMaciej Fijalkowski * insufficient space in the rx buffer for both the packet and the headroom. 37018a8e75SMaciej Fijalkowski * ii. tx invalid 38018a8e75SMaciej Fijalkowski * Set the 'len' field of tx descriptors to an invalid value (umem frame 39018a8e75SMaciej Fijalkowski * size + 1). 40018a8e75SMaciej Fijalkowski * iii. rx ring full 41018a8e75SMaciej Fijalkowski * Reduce the size of the RX ring to a fraction of the fill ring size. 42018a8e75SMaciej Fijalkowski * iv. fill queue empty 43018a8e75SMaciej Fijalkowski * Do not populate the fill queue and then try to receive pkts. 44018a8e75SMaciej Fijalkowski * f. bpf_link resource persistence 45018a8e75SMaciej Fijalkowski * Configure sockets at indexes 0 and 1, run a traffic on queue ids 0, 46018a8e75SMaciej Fijalkowski * then remove xsk sockets from queue 0 on both veth interfaces and 47018a8e75SMaciej Fijalkowski * finally run a traffic on queues ids 1 48018a8e75SMaciej Fijalkowski * g. unaligned mode 49018a8e75SMaciej Fijalkowski * h. tests for invalid and corner case Tx descriptors so that the correct ones 50018a8e75SMaciej Fijalkowski * are discarded and let through, respectively. 51018a8e75SMaciej Fijalkowski * i. 2K frame size tests 52018a8e75SMaciej Fijalkowski * 53018a8e75SMaciej Fijalkowski * Total tests: 12 54018a8e75SMaciej Fijalkowski * 55018a8e75SMaciej Fijalkowski * Flow: 56018a8e75SMaciej Fijalkowski * ----- 57018a8e75SMaciej Fijalkowski * - Single process spawns two threads: Tx and Rx 5864aef77dSMagnus Karlsson * - Each of these two threads attach to a veth interface 5964aef77dSMagnus Karlsson * - Each thread creates one AF_XDP socket connected to a unique umem for each 60018a8e75SMaciej Fijalkowski * veth interface 6164aef77dSMagnus Karlsson * - Tx thread Transmits a number of packets from veth<xxxx> to veth<yyyy> 6264aef77dSMagnus Karlsson * - Rx thread verifies if all packets were received and delivered in-order, 63018a8e75SMaciej Fijalkowski * and have the right content 64018a8e75SMaciej Fijalkowski * 65018a8e75SMaciej Fijalkowski * Enable/disable packet dump mode: 66018a8e75SMaciej Fijalkowski * -------------------------- 67018a8e75SMaciej Fijalkowski * To enable L2 - L4 headers and payload dump of each packet on STDOUT, add 68018a8e75SMaciej Fijalkowski * parameter -D to params array in test_xsk.sh, i.e. params=("-S" "-D") 69018a8e75SMaciej Fijalkowski */ 70018a8e75SMaciej Fijalkowski 71018a8e75SMaciej Fijalkowski #define _GNU_SOURCE 72018a8e75SMaciej Fijalkowski #include <fcntl.h> 73018a8e75SMaciej Fijalkowski #include <errno.h> 74018a8e75SMaciej Fijalkowski #include <getopt.h> 75018a8e75SMaciej Fijalkowski #include <asm/barrier.h> 76018a8e75SMaciej Fijalkowski #include <linux/if_link.h> 77018a8e75SMaciej Fijalkowski #include <linux/if_ether.h> 78018a8e75SMaciej Fijalkowski #include <linux/ip.h> 79018a8e75SMaciej Fijalkowski #include <linux/udp.h> 80018a8e75SMaciej Fijalkowski #include <arpa/inet.h> 81018a8e75SMaciej Fijalkowski #include <net/if.h> 82018a8e75SMaciej Fijalkowski #include <locale.h> 83018a8e75SMaciej Fijalkowski #include <poll.h> 84018a8e75SMaciej Fijalkowski #include <pthread.h> 85018a8e75SMaciej Fijalkowski #include <signal.h> 86018a8e75SMaciej Fijalkowski #include <stdbool.h> 87018a8e75SMaciej Fijalkowski #include <stdio.h> 88018a8e75SMaciej Fijalkowski #include <stdlib.h> 89018a8e75SMaciej Fijalkowski #include <string.h> 90018a8e75SMaciej Fijalkowski #include <stddef.h> 91018a8e75SMaciej Fijalkowski #include <sys/mman.h> 92018a8e75SMaciej Fijalkowski #include <sys/socket.h> 93018a8e75SMaciej Fijalkowski #include <sys/time.h> 94018a8e75SMaciej Fijalkowski #include <sys/types.h> 95018a8e75SMaciej Fijalkowski #include <sys/queue.h> 96018a8e75SMaciej Fijalkowski #include <time.h> 97018a8e75SMaciej Fijalkowski #include <unistd.h> 98018a8e75SMaciej Fijalkowski #include <stdatomic.h> 99018a8e75SMaciej Fijalkowski #include "xsk.h" 100018a8e75SMaciej Fijalkowski #include "xskxceiver.h" 1010d68e6feSMaciej Fijalkowski #include <bpf/bpf.h> 1020d68e6feSMaciej Fijalkowski #include <linux/filter.h> 103018a8e75SMaciej Fijalkowski #include "../kselftest.h" 104018a8e75SMaciej Fijalkowski 105018a8e75SMaciej Fijalkowski static const char *MAC1 = "\x00\x0A\x56\x9E\xEE\x62"; 106018a8e75SMaciej Fijalkowski static const char *MAC2 = "\x00\x0A\x56\x9E\xEE\x61"; 107018a8e75SMaciej Fijalkowski static const char *IP1 = "192.168.100.162"; 108018a8e75SMaciej Fijalkowski static const char *IP2 = "192.168.100.161"; 109018a8e75SMaciej Fijalkowski static const u16 UDP_PORT1 = 2020; 110018a8e75SMaciej Fijalkowski static const u16 UDP_PORT2 = 2121; 111018a8e75SMaciej Fijalkowski 112018a8e75SMaciej Fijalkowski static void __exit_with_error(int error, const char *file, const char *func, int line) 113018a8e75SMaciej Fijalkowski { 114018a8e75SMaciej Fijalkowski ksft_test_result_fail("[%s:%s:%i]: ERROR: %d/\"%s\"\n", file, func, line, error, 115018a8e75SMaciej Fijalkowski strerror(error)); 116018a8e75SMaciej Fijalkowski ksft_exit_xfail(); 117018a8e75SMaciej Fijalkowski } 118018a8e75SMaciej Fijalkowski 119018a8e75SMaciej Fijalkowski #define exit_with_error(error) __exit_with_error(error, __FILE__, __func__, __LINE__) 120018a8e75SMaciej Fijalkowski #define busy_poll_string(test) (test)->ifobj_tx->busy_poll ? "BUSY-POLL " : "" 121fe2ad08eSMaciej Fijalkowski static char *mode_string(struct test_spec *test) 122fe2ad08eSMaciej Fijalkowski { 123fe2ad08eSMaciej Fijalkowski switch (test->mode) { 124fe2ad08eSMaciej Fijalkowski case TEST_MODE_SKB: 125fe2ad08eSMaciej Fijalkowski return "SKB"; 126fe2ad08eSMaciej Fijalkowski case TEST_MODE_DRV: 127fe2ad08eSMaciej Fijalkowski return "DRV"; 128fe2ad08eSMaciej Fijalkowski case TEST_MODE_ZC: 129fe2ad08eSMaciej Fijalkowski return "ZC"; 130fe2ad08eSMaciej Fijalkowski default: 131fe2ad08eSMaciej Fijalkowski return "BOGUS"; 132fe2ad08eSMaciej Fijalkowski } 133fe2ad08eSMaciej Fijalkowski } 134018a8e75SMaciej Fijalkowski 135018a8e75SMaciej Fijalkowski static void report_failure(struct test_spec *test) 136018a8e75SMaciej Fijalkowski { 137018a8e75SMaciej Fijalkowski if (test->fail) 138018a8e75SMaciej Fijalkowski return; 139018a8e75SMaciej Fijalkowski 140018a8e75SMaciej Fijalkowski ksft_test_result_fail("FAIL: %s %s%s\n", mode_string(test), busy_poll_string(test), 141018a8e75SMaciej Fijalkowski test->name); 142018a8e75SMaciej Fijalkowski test->fail = true; 143018a8e75SMaciej Fijalkowski } 144018a8e75SMaciej Fijalkowski 145018a8e75SMaciej Fijalkowski static void memset32_htonl(void *dest, u32 val, u32 size) 146018a8e75SMaciej Fijalkowski { 147018a8e75SMaciej Fijalkowski u32 *ptr = (u32 *)dest; 148018a8e75SMaciej Fijalkowski int i; 149018a8e75SMaciej Fijalkowski 150018a8e75SMaciej Fijalkowski val = htonl(val); 151018a8e75SMaciej Fijalkowski 152018a8e75SMaciej Fijalkowski for (i = 0; i < (size & (~0x3)); i += 4) 153018a8e75SMaciej Fijalkowski ptr[i >> 2] = val; 154018a8e75SMaciej Fijalkowski } 155018a8e75SMaciej Fijalkowski 156018a8e75SMaciej Fijalkowski /* 157018a8e75SMaciej Fijalkowski * Fold a partial checksum 158018a8e75SMaciej Fijalkowski * This function code has been taken from 159018a8e75SMaciej Fijalkowski * Linux kernel include/asm-generic/checksum.h 160018a8e75SMaciej Fijalkowski */ 161018a8e75SMaciej Fijalkowski static __u16 csum_fold(__u32 csum) 162018a8e75SMaciej Fijalkowski { 163018a8e75SMaciej Fijalkowski u32 sum = (__force u32)csum; 164018a8e75SMaciej Fijalkowski 165018a8e75SMaciej Fijalkowski sum = (sum & 0xffff) + (sum >> 16); 166018a8e75SMaciej Fijalkowski sum = (sum & 0xffff) + (sum >> 16); 167018a8e75SMaciej Fijalkowski return (__force __u16)~sum; 168018a8e75SMaciej Fijalkowski } 169018a8e75SMaciej Fijalkowski 170018a8e75SMaciej Fijalkowski /* 171018a8e75SMaciej Fijalkowski * This function code has been taken from 172018a8e75SMaciej Fijalkowski * Linux kernel lib/checksum.c 173018a8e75SMaciej Fijalkowski */ 174018a8e75SMaciej Fijalkowski static u32 from64to32(u64 x) 175018a8e75SMaciej Fijalkowski { 176018a8e75SMaciej Fijalkowski /* add up 32-bit and 32-bit for 32+c bit */ 177018a8e75SMaciej Fijalkowski x = (x & 0xffffffff) + (x >> 32); 178018a8e75SMaciej Fijalkowski /* add up carry.. */ 179018a8e75SMaciej Fijalkowski x = (x & 0xffffffff) + (x >> 32); 180018a8e75SMaciej Fijalkowski return (u32)x; 181018a8e75SMaciej Fijalkowski } 182018a8e75SMaciej Fijalkowski 183018a8e75SMaciej Fijalkowski /* 184018a8e75SMaciej Fijalkowski * This function code has been taken from 185018a8e75SMaciej Fijalkowski * Linux kernel lib/checksum.c 186018a8e75SMaciej Fijalkowski */ 187018a8e75SMaciej Fijalkowski static __u32 csum_tcpudp_nofold(__be32 saddr, __be32 daddr, __u32 len, __u8 proto, __u32 sum) 188018a8e75SMaciej Fijalkowski { 189018a8e75SMaciej Fijalkowski unsigned long long s = (__force u32)sum; 190018a8e75SMaciej Fijalkowski 191018a8e75SMaciej Fijalkowski s += (__force u32)saddr; 192018a8e75SMaciej Fijalkowski s += (__force u32)daddr; 193018a8e75SMaciej Fijalkowski #ifdef __BIG_ENDIAN__ 194018a8e75SMaciej Fijalkowski s += proto + len; 195018a8e75SMaciej Fijalkowski #else 196018a8e75SMaciej Fijalkowski s += (proto + len) << 8; 197018a8e75SMaciej Fijalkowski #endif 198018a8e75SMaciej Fijalkowski return (__force __u32)from64to32(s); 199018a8e75SMaciej Fijalkowski } 200018a8e75SMaciej Fijalkowski 201018a8e75SMaciej Fijalkowski /* 202018a8e75SMaciej Fijalkowski * This function has been taken from 203018a8e75SMaciej Fijalkowski * Linux kernel include/asm-generic/checksum.h 204018a8e75SMaciej Fijalkowski */ 205018a8e75SMaciej Fijalkowski static __u16 csum_tcpudp_magic(__be32 saddr, __be32 daddr, __u32 len, __u8 proto, __u32 sum) 206018a8e75SMaciej Fijalkowski { 207018a8e75SMaciej Fijalkowski return csum_fold(csum_tcpudp_nofold(saddr, daddr, len, proto, sum)); 208018a8e75SMaciej Fijalkowski } 209018a8e75SMaciej Fijalkowski 210018a8e75SMaciej Fijalkowski static u16 udp_csum(u32 saddr, u32 daddr, u32 len, u8 proto, u16 *udp_pkt) 211018a8e75SMaciej Fijalkowski { 212018a8e75SMaciej Fijalkowski u32 csum = 0; 213018a8e75SMaciej Fijalkowski u32 cnt = 0; 214018a8e75SMaciej Fijalkowski 215018a8e75SMaciej Fijalkowski /* udp hdr and data */ 216018a8e75SMaciej Fijalkowski for (; cnt < len; cnt += 2) 217018a8e75SMaciej Fijalkowski csum += udp_pkt[cnt >> 1]; 218018a8e75SMaciej Fijalkowski 219018a8e75SMaciej Fijalkowski return csum_tcpudp_magic(saddr, daddr, len, proto, csum); 220018a8e75SMaciej Fijalkowski } 221018a8e75SMaciej Fijalkowski 222018a8e75SMaciej Fijalkowski static void gen_eth_hdr(struct ifobject *ifobject, struct ethhdr *eth_hdr) 223018a8e75SMaciej Fijalkowski { 224018a8e75SMaciej Fijalkowski memcpy(eth_hdr->h_dest, ifobject->dst_mac, ETH_ALEN); 225018a8e75SMaciej Fijalkowski memcpy(eth_hdr->h_source, ifobject->src_mac, ETH_ALEN); 226018a8e75SMaciej Fijalkowski eth_hdr->h_proto = htons(ETH_P_IP); 227018a8e75SMaciej Fijalkowski } 228018a8e75SMaciej Fijalkowski 229018a8e75SMaciej Fijalkowski static void gen_ip_hdr(struct ifobject *ifobject, struct iphdr *ip_hdr) 230018a8e75SMaciej Fijalkowski { 231018a8e75SMaciej Fijalkowski ip_hdr->version = IP_PKT_VER; 232018a8e75SMaciej Fijalkowski ip_hdr->ihl = 0x5; 233018a8e75SMaciej Fijalkowski ip_hdr->tos = IP_PKT_TOS; 234018a8e75SMaciej Fijalkowski ip_hdr->tot_len = htons(IP_PKT_SIZE); 235018a8e75SMaciej Fijalkowski ip_hdr->id = 0; 236018a8e75SMaciej Fijalkowski ip_hdr->frag_off = 0; 237018a8e75SMaciej Fijalkowski ip_hdr->ttl = IPDEFTTL; 238018a8e75SMaciej Fijalkowski ip_hdr->protocol = IPPROTO_UDP; 239018a8e75SMaciej Fijalkowski ip_hdr->saddr = ifobject->src_ip; 240018a8e75SMaciej Fijalkowski ip_hdr->daddr = ifobject->dst_ip; 241018a8e75SMaciej Fijalkowski ip_hdr->check = 0; 242018a8e75SMaciej Fijalkowski } 243018a8e75SMaciej Fijalkowski 244018a8e75SMaciej Fijalkowski static void gen_udp_hdr(u32 payload, void *pkt, struct ifobject *ifobject, 245018a8e75SMaciej Fijalkowski struct udphdr *udp_hdr) 246018a8e75SMaciej Fijalkowski { 247018a8e75SMaciej Fijalkowski udp_hdr->source = htons(ifobject->src_port); 248018a8e75SMaciej Fijalkowski udp_hdr->dest = htons(ifobject->dst_port); 249018a8e75SMaciej Fijalkowski udp_hdr->len = htons(UDP_PKT_SIZE); 250018a8e75SMaciej Fijalkowski memset32_htonl(pkt + PKT_HDR_SIZE, payload, UDP_PKT_DATA_SIZE); 251018a8e75SMaciej Fijalkowski } 252018a8e75SMaciej Fijalkowski 2533143d10bSShibin Koikkara Reeny static bool is_umem_valid(struct ifobject *ifobj) 2543143d10bSShibin Koikkara Reeny { 2553143d10bSShibin Koikkara Reeny return !!ifobj->umem->umem; 2563143d10bSShibin Koikkara Reeny } 2573143d10bSShibin Koikkara Reeny 258018a8e75SMaciej Fijalkowski static void gen_udp_csum(struct udphdr *udp_hdr, struct iphdr *ip_hdr) 259018a8e75SMaciej Fijalkowski { 260018a8e75SMaciej Fijalkowski udp_hdr->check = 0; 261018a8e75SMaciej Fijalkowski udp_hdr->check = 262018a8e75SMaciej Fijalkowski udp_csum(ip_hdr->saddr, ip_hdr->daddr, UDP_PKT_SIZE, IPPROTO_UDP, (u16 *)udp_hdr); 263018a8e75SMaciej Fijalkowski } 264018a8e75SMaciej Fijalkowski 265aa61d81fSMagnus Karlsson static u32 mode_to_xdp_flags(enum test_mode mode) 266aa61d81fSMagnus Karlsson { 267aa61d81fSMagnus Karlsson return (mode == TEST_MODE_SKB) ? XDP_FLAGS_SKB_MODE : XDP_FLAGS_DRV_MODE; 268aa61d81fSMagnus Karlsson } 269aa61d81fSMagnus Karlsson 270018a8e75SMaciej Fijalkowski static int xsk_configure_umem(struct xsk_umem_info *umem, void *buffer, u64 size) 271018a8e75SMaciej Fijalkowski { 272018a8e75SMaciej Fijalkowski struct xsk_umem_config cfg = { 273018a8e75SMaciej Fijalkowski .fill_size = XSK_RING_PROD__DEFAULT_NUM_DESCS, 274018a8e75SMaciej Fijalkowski .comp_size = XSK_RING_CONS__DEFAULT_NUM_DESCS, 275018a8e75SMaciej Fijalkowski .frame_size = umem->frame_size, 276018a8e75SMaciej Fijalkowski .frame_headroom = umem->frame_headroom, 277018a8e75SMaciej Fijalkowski .flags = XSK_UMEM__DEFAULT_FLAGS 278018a8e75SMaciej Fijalkowski }; 279018a8e75SMaciej Fijalkowski int ret; 280018a8e75SMaciej Fijalkowski 281018a8e75SMaciej Fijalkowski if (umem->unaligned_mode) 282018a8e75SMaciej Fijalkowski cfg.flags |= XDP_UMEM_UNALIGNED_CHUNK_FLAG; 283018a8e75SMaciej Fijalkowski 284018a8e75SMaciej Fijalkowski ret = xsk_umem__create(&umem->umem, buffer, size, 285018a8e75SMaciej Fijalkowski &umem->fq, &umem->cq, &cfg); 286018a8e75SMaciej Fijalkowski if (ret) 287018a8e75SMaciej Fijalkowski return ret; 288018a8e75SMaciej Fijalkowski 289018a8e75SMaciej Fijalkowski umem->buffer = buffer; 290018a8e75SMaciej Fijalkowski return 0; 291018a8e75SMaciej Fijalkowski } 292018a8e75SMaciej Fijalkowski 293018a8e75SMaciej Fijalkowski static void enable_busy_poll(struct xsk_socket_info *xsk) 294018a8e75SMaciej Fijalkowski { 295018a8e75SMaciej Fijalkowski int sock_opt; 296018a8e75SMaciej Fijalkowski 297018a8e75SMaciej Fijalkowski sock_opt = 1; 298018a8e75SMaciej Fijalkowski if (setsockopt(xsk_socket__fd(xsk->xsk), SOL_SOCKET, SO_PREFER_BUSY_POLL, 299018a8e75SMaciej Fijalkowski (void *)&sock_opt, sizeof(sock_opt)) < 0) 300018a8e75SMaciej Fijalkowski exit_with_error(errno); 301018a8e75SMaciej Fijalkowski 302018a8e75SMaciej Fijalkowski sock_opt = 20; 303018a8e75SMaciej Fijalkowski if (setsockopt(xsk_socket__fd(xsk->xsk), SOL_SOCKET, SO_BUSY_POLL, 304018a8e75SMaciej Fijalkowski (void *)&sock_opt, sizeof(sock_opt)) < 0) 305018a8e75SMaciej Fijalkowski exit_with_error(errno); 306018a8e75SMaciej Fijalkowski 307018a8e75SMaciej Fijalkowski sock_opt = BATCH_SIZE; 308018a8e75SMaciej Fijalkowski if (setsockopt(xsk_socket__fd(xsk->xsk), SOL_SOCKET, SO_BUSY_POLL_BUDGET, 309018a8e75SMaciej Fijalkowski (void *)&sock_opt, sizeof(sock_opt)) < 0) 310018a8e75SMaciej Fijalkowski exit_with_error(errno); 311018a8e75SMaciej Fijalkowski } 312018a8e75SMaciej Fijalkowski 313a693ff3eSMaciej Fijalkowski static int __xsk_configure_socket(struct xsk_socket_info *xsk, struct xsk_umem_info *umem, 314018a8e75SMaciej Fijalkowski struct ifobject *ifobject, bool shared) 315018a8e75SMaciej Fijalkowski { 316018a8e75SMaciej Fijalkowski struct xsk_socket_config cfg = {}; 317018a8e75SMaciej Fijalkowski struct xsk_ring_cons *rxr; 318018a8e75SMaciej Fijalkowski struct xsk_ring_prod *txr; 319018a8e75SMaciej Fijalkowski 320018a8e75SMaciej Fijalkowski xsk->umem = umem; 321018a8e75SMaciej Fijalkowski cfg.rx_size = xsk->rxqsize; 322018a8e75SMaciej Fijalkowski cfg.tx_size = XSK_RING_PROD__DEFAULT_NUM_DESCS; 323018a8e75SMaciej Fijalkowski cfg.bind_flags = ifobject->bind_flags; 324018a8e75SMaciej Fijalkowski if (shared) 325018a8e75SMaciej Fijalkowski cfg.bind_flags |= XDP_SHARED_UMEM; 326018a8e75SMaciej Fijalkowski 327018a8e75SMaciej Fijalkowski txr = ifobject->tx_on ? &xsk->tx : NULL; 328018a8e75SMaciej Fijalkowski rxr = ifobject->rx_on ? &xsk->rx : NULL; 329aa61d81fSMagnus Karlsson return xsk_socket__create(&xsk->xsk, ifobject->ifindex, 0, umem->umem, rxr, txr, &cfg); 330018a8e75SMaciej Fijalkowski } 331018a8e75SMaciej Fijalkowski 332fe2ad08eSMaciej Fijalkowski static bool ifobj_zc_avail(struct ifobject *ifobject) 333fe2ad08eSMaciej Fijalkowski { 334fe2ad08eSMaciej Fijalkowski size_t umem_sz = DEFAULT_UMEM_BUFFERS * XSK_UMEM__DEFAULT_FRAME_SIZE; 335fe2ad08eSMaciej Fijalkowski int mmap_flags = MAP_PRIVATE | MAP_ANONYMOUS | MAP_NORESERVE; 336fe2ad08eSMaciej Fijalkowski struct xsk_socket_info *xsk; 337fe2ad08eSMaciej Fijalkowski struct xsk_umem_info *umem; 338fe2ad08eSMaciej Fijalkowski bool zc_avail = false; 339fe2ad08eSMaciej Fijalkowski void *bufs; 340fe2ad08eSMaciej Fijalkowski int ret; 341fe2ad08eSMaciej Fijalkowski 342fe2ad08eSMaciej Fijalkowski bufs = mmap(NULL, umem_sz, PROT_READ | PROT_WRITE, mmap_flags, -1, 0); 343fe2ad08eSMaciej Fijalkowski if (bufs == MAP_FAILED) 344fe2ad08eSMaciej Fijalkowski exit_with_error(errno); 345fe2ad08eSMaciej Fijalkowski 346fe2ad08eSMaciej Fijalkowski umem = calloc(1, sizeof(struct xsk_umem_info)); 347fe2ad08eSMaciej Fijalkowski if (!umem) { 348fe2ad08eSMaciej Fijalkowski munmap(bufs, umem_sz); 349085dcccfSMagnus Karlsson exit_with_error(ENOMEM); 350fe2ad08eSMaciej Fijalkowski } 351fe2ad08eSMaciej Fijalkowski umem->frame_size = XSK_UMEM__DEFAULT_FRAME_SIZE; 352fe2ad08eSMaciej Fijalkowski ret = xsk_configure_umem(umem, bufs, umem_sz); 353fe2ad08eSMaciej Fijalkowski if (ret) 354fe2ad08eSMaciej Fijalkowski exit_with_error(-ret); 355fe2ad08eSMaciej Fijalkowski 356fe2ad08eSMaciej Fijalkowski xsk = calloc(1, sizeof(struct xsk_socket_info)); 357fe2ad08eSMaciej Fijalkowski if (!xsk) 358fe2ad08eSMaciej Fijalkowski goto out; 359aa61d81fSMagnus Karlsson ifobject->xdp_flags = XDP_FLAGS_DRV_MODE; 360fe2ad08eSMaciej Fijalkowski ifobject->bind_flags = XDP_USE_NEED_WAKEUP | XDP_ZEROCOPY; 361fe2ad08eSMaciej Fijalkowski ifobject->rx_on = true; 362fe2ad08eSMaciej Fijalkowski xsk->rxqsize = XSK_RING_CONS__DEFAULT_NUM_DESCS; 363fe2ad08eSMaciej Fijalkowski ret = __xsk_configure_socket(xsk, umem, ifobject, false); 364fe2ad08eSMaciej Fijalkowski if (!ret) 365fe2ad08eSMaciej Fijalkowski zc_avail = true; 366fe2ad08eSMaciej Fijalkowski 367fe2ad08eSMaciej Fijalkowski xsk_socket__delete(xsk->xsk); 368fe2ad08eSMaciej Fijalkowski free(xsk); 369fe2ad08eSMaciej Fijalkowski out: 370fe2ad08eSMaciej Fijalkowski munmap(umem->buffer, umem_sz); 371fe2ad08eSMaciej Fijalkowski xsk_umem__delete(umem->umem); 372fe2ad08eSMaciej Fijalkowski free(umem); 373fe2ad08eSMaciej Fijalkowski return zc_avail; 374fe2ad08eSMaciej Fijalkowski } 375fe2ad08eSMaciej Fijalkowski 376018a8e75SMaciej Fijalkowski static struct option long_options[] = { 377018a8e75SMaciej Fijalkowski {"interface", required_argument, 0, 'i'}, 378018a8e75SMaciej Fijalkowski {"busy-poll", no_argument, 0, 'b'}, 379018a8e75SMaciej Fijalkowski {"dump-pkts", no_argument, 0, 'D'}, 380018a8e75SMaciej Fijalkowski {"verbose", no_argument, 0, 'v'}, 381018a8e75SMaciej Fijalkowski {0, 0, 0, 0} 382018a8e75SMaciej Fijalkowski }; 383018a8e75SMaciej Fijalkowski 384018a8e75SMaciej Fijalkowski static void usage(const char *prog) 385018a8e75SMaciej Fijalkowski { 386018a8e75SMaciej Fijalkowski const char *str = 387018a8e75SMaciej Fijalkowski " Usage: %s [OPTIONS]\n" 388018a8e75SMaciej Fijalkowski " Options:\n" 389018a8e75SMaciej Fijalkowski " -i, --interface Use interface\n" 390018a8e75SMaciej Fijalkowski " -D, --dump-pkts Dump packets L2 - L5\n" 391018a8e75SMaciej Fijalkowski " -v, --verbose Verbose output\n" 392018a8e75SMaciej Fijalkowski " -b, --busy-poll Enable busy poll\n"; 393018a8e75SMaciej Fijalkowski 394018a8e75SMaciej Fijalkowski ksft_print_msg(str, prog); 395018a8e75SMaciej Fijalkowski } 396018a8e75SMaciej Fijalkowski 397018a8e75SMaciej Fijalkowski static bool validate_interface(struct ifobject *ifobj) 398018a8e75SMaciej Fijalkowski { 399018a8e75SMaciej Fijalkowski if (!strcmp(ifobj->ifname, "")) 400018a8e75SMaciej Fijalkowski return false; 401018a8e75SMaciej Fijalkowski return true; 402018a8e75SMaciej Fijalkowski } 403018a8e75SMaciej Fijalkowski 404018a8e75SMaciej Fijalkowski static void parse_command_line(struct ifobject *ifobj_tx, struct ifobject *ifobj_rx, int argc, 405018a8e75SMaciej Fijalkowski char **argv) 406018a8e75SMaciej Fijalkowski { 407018a8e75SMaciej Fijalkowski struct ifobject *ifobj; 408018a8e75SMaciej Fijalkowski u32 interface_nb = 0; 409018a8e75SMaciej Fijalkowski int option_index, c; 410018a8e75SMaciej Fijalkowski 411018a8e75SMaciej Fijalkowski opterr = 0; 412018a8e75SMaciej Fijalkowski 413018a8e75SMaciej Fijalkowski for (;;) { 414018a8e75SMaciej Fijalkowski c = getopt_long(argc, argv, "i:Dvb", long_options, &option_index); 415018a8e75SMaciej Fijalkowski if (c == -1) 416018a8e75SMaciej Fijalkowski break; 417018a8e75SMaciej Fijalkowski 418018a8e75SMaciej Fijalkowski switch (c) { 419018a8e75SMaciej Fijalkowski case 'i': 420018a8e75SMaciej Fijalkowski if (interface_nb == 0) 421018a8e75SMaciej Fijalkowski ifobj = ifobj_tx; 422018a8e75SMaciej Fijalkowski else if (interface_nb == 1) 423018a8e75SMaciej Fijalkowski ifobj = ifobj_rx; 424018a8e75SMaciej Fijalkowski else 425018a8e75SMaciej Fijalkowski break; 426018a8e75SMaciej Fijalkowski 42764aef77dSMagnus Karlsson memcpy(ifobj->ifname, optarg, 42864aef77dSMagnus Karlsson min_t(size_t, MAX_INTERFACE_NAME_CHARS, strlen(optarg))); 429aa61d81fSMagnus Karlsson 430aa61d81fSMagnus Karlsson ifobj->ifindex = if_nametoindex(ifobj->ifname); 431aa61d81fSMagnus Karlsson if (!ifobj->ifindex) 432aa61d81fSMagnus Karlsson exit_with_error(errno); 433aa61d81fSMagnus Karlsson 434018a8e75SMaciej Fijalkowski interface_nb++; 435018a8e75SMaciej Fijalkowski break; 436018a8e75SMaciej Fijalkowski case 'D': 437018a8e75SMaciej Fijalkowski opt_pkt_dump = true; 438018a8e75SMaciej Fijalkowski break; 439018a8e75SMaciej Fijalkowski case 'v': 440018a8e75SMaciej Fijalkowski opt_verbose = true; 441018a8e75SMaciej Fijalkowski break; 442018a8e75SMaciej Fijalkowski case 'b': 443018a8e75SMaciej Fijalkowski ifobj_tx->busy_poll = true; 444018a8e75SMaciej Fijalkowski ifobj_rx->busy_poll = true; 445018a8e75SMaciej Fijalkowski break; 446018a8e75SMaciej Fijalkowski default: 447018a8e75SMaciej Fijalkowski usage(basename(argv[0])); 448018a8e75SMaciej Fijalkowski ksft_exit_xfail(); 449018a8e75SMaciej Fijalkowski } 450018a8e75SMaciej Fijalkowski } 451018a8e75SMaciej Fijalkowski } 452018a8e75SMaciej Fijalkowski 453018a8e75SMaciej Fijalkowski static void __test_spec_init(struct test_spec *test, struct ifobject *ifobj_tx, 454018a8e75SMaciej Fijalkowski struct ifobject *ifobj_rx) 455018a8e75SMaciej Fijalkowski { 456018a8e75SMaciej Fijalkowski u32 i, j; 457018a8e75SMaciej Fijalkowski 458018a8e75SMaciej Fijalkowski for (i = 0; i < MAX_INTERFACES; i++) { 459018a8e75SMaciej Fijalkowski struct ifobject *ifobj = i ? ifobj_rx : ifobj_tx; 460018a8e75SMaciej Fijalkowski 461018a8e75SMaciej Fijalkowski ifobj->xsk = &ifobj->xsk_arr[0]; 462018a8e75SMaciej Fijalkowski ifobj->use_poll = false; 463018a8e75SMaciej Fijalkowski ifobj->use_fill_ring = true; 464018a8e75SMaciej Fijalkowski ifobj->release_rx = true; 465018a8e75SMaciej Fijalkowski ifobj->validation_func = NULL; 466018a8e75SMaciej Fijalkowski 467018a8e75SMaciej Fijalkowski if (i == 0) { 468018a8e75SMaciej Fijalkowski ifobj->rx_on = false; 469018a8e75SMaciej Fijalkowski ifobj->tx_on = true; 4701adef064SMaciej Fijalkowski ifobj->pkt_stream = test->tx_pkt_stream_default; 471018a8e75SMaciej Fijalkowski } else { 472018a8e75SMaciej Fijalkowski ifobj->rx_on = true; 473018a8e75SMaciej Fijalkowski ifobj->tx_on = false; 4741adef064SMaciej Fijalkowski ifobj->pkt_stream = test->rx_pkt_stream_default; 475018a8e75SMaciej Fijalkowski } 476018a8e75SMaciej Fijalkowski 477018a8e75SMaciej Fijalkowski memset(ifobj->umem, 0, sizeof(*ifobj->umem)); 478018a8e75SMaciej Fijalkowski ifobj->umem->num_frames = DEFAULT_UMEM_BUFFERS; 479018a8e75SMaciej Fijalkowski ifobj->umem->frame_size = XSK_UMEM__DEFAULT_FRAME_SIZE; 480a693ff3eSMaciej Fijalkowski if (ifobj->shared_umem && ifobj->rx_on) 481a693ff3eSMaciej Fijalkowski ifobj->umem->base_addr = DEFAULT_UMEM_BUFFERS * 482a693ff3eSMaciej Fijalkowski XSK_UMEM__DEFAULT_FRAME_SIZE; 483018a8e75SMaciej Fijalkowski 484018a8e75SMaciej Fijalkowski for (j = 0; j < MAX_SOCKETS; j++) { 485018a8e75SMaciej Fijalkowski memset(&ifobj->xsk_arr[j], 0, sizeof(ifobj->xsk_arr[j])); 486018a8e75SMaciej Fijalkowski ifobj->xsk_arr[j].rxqsize = XSK_RING_CONS__DEFAULT_NUM_DESCS; 487018a8e75SMaciej Fijalkowski } 488018a8e75SMaciej Fijalkowski } 489018a8e75SMaciej Fijalkowski 490018a8e75SMaciej Fijalkowski test->ifobj_tx = ifobj_tx; 491018a8e75SMaciej Fijalkowski test->ifobj_rx = ifobj_rx; 492018a8e75SMaciej Fijalkowski test->current_step = 0; 493018a8e75SMaciej Fijalkowski test->total_steps = 1; 494018a8e75SMaciej Fijalkowski test->nb_sockets = 1; 495018a8e75SMaciej Fijalkowski test->fail = false; 496018a8e75SMaciej Fijalkowski } 497018a8e75SMaciej Fijalkowski 498018a8e75SMaciej Fijalkowski static void test_spec_init(struct test_spec *test, struct ifobject *ifobj_tx, 499018a8e75SMaciej Fijalkowski struct ifobject *ifobj_rx, enum test_mode mode) 500018a8e75SMaciej Fijalkowski { 5011adef064SMaciej Fijalkowski struct pkt_stream *tx_pkt_stream; 5021adef064SMaciej Fijalkowski struct pkt_stream *rx_pkt_stream; 503018a8e75SMaciej Fijalkowski u32 i; 504018a8e75SMaciej Fijalkowski 5051adef064SMaciej Fijalkowski tx_pkt_stream = test->tx_pkt_stream_default; 5061adef064SMaciej Fijalkowski rx_pkt_stream = test->rx_pkt_stream_default; 507018a8e75SMaciej Fijalkowski memset(test, 0, sizeof(*test)); 5081adef064SMaciej Fijalkowski test->tx_pkt_stream_default = tx_pkt_stream; 5091adef064SMaciej Fijalkowski test->rx_pkt_stream_default = rx_pkt_stream; 510018a8e75SMaciej Fijalkowski 511018a8e75SMaciej Fijalkowski for (i = 0; i < MAX_INTERFACES; i++) { 512018a8e75SMaciej Fijalkowski struct ifobject *ifobj = i ? ifobj_rx : ifobj_tx; 513018a8e75SMaciej Fijalkowski 514fe2ad08eSMaciej Fijalkowski ifobj->bind_flags = XDP_USE_NEED_WAKEUP; 515fe2ad08eSMaciej Fijalkowski if (mode == TEST_MODE_ZC) 516fe2ad08eSMaciej Fijalkowski ifobj->bind_flags |= XDP_ZEROCOPY; 517fe2ad08eSMaciej Fijalkowski else 518fe2ad08eSMaciej Fijalkowski ifobj->bind_flags |= XDP_COPY; 519018a8e75SMaciej Fijalkowski } 520018a8e75SMaciej Fijalkowski 521fe2ad08eSMaciej Fijalkowski test->mode = mode; 522018a8e75SMaciej Fijalkowski __test_spec_init(test, ifobj_tx, ifobj_rx); 523018a8e75SMaciej Fijalkowski } 524018a8e75SMaciej Fijalkowski 525018a8e75SMaciej Fijalkowski static void test_spec_reset(struct test_spec *test) 526018a8e75SMaciej Fijalkowski { 527018a8e75SMaciej Fijalkowski __test_spec_init(test, test->ifobj_tx, test->ifobj_rx); 528018a8e75SMaciej Fijalkowski } 529018a8e75SMaciej Fijalkowski 530018a8e75SMaciej Fijalkowski static void test_spec_set_name(struct test_spec *test, const char *name) 531018a8e75SMaciej Fijalkowski { 532018a8e75SMaciej Fijalkowski strncpy(test->name, name, MAX_TEST_NAME_SIZE); 533018a8e75SMaciej Fijalkowski } 534018a8e75SMaciej Fijalkowski 535018a8e75SMaciej Fijalkowski static void pkt_stream_reset(struct pkt_stream *pkt_stream) 536018a8e75SMaciej Fijalkowski { 537018a8e75SMaciej Fijalkowski if (pkt_stream) 538018a8e75SMaciej Fijalkowski pkt_stream->rx_pkt_nb = 0; 539018a8e75SMaciej Fijalkowski } 540018a8e75SMaciej Fijalkowski 541018a8e75SMaciej Fijalkowski static struct pkt *pkt_stream_get_pkt(struct pkt_stream *pkt_stream, u32 pkt_nb) 542018a8e75SMaciej Fijalkowski { 543018a8e75SMaciej Fijalkowski if (pkt_nb >= pkt_stream->nb_pkts) 544018a8e75SMaciej Fijalkowski return NULL; 545018a8e75SMaciej Fijalkowski 546018a8e75SMaciej Fijalkowski return &pkt_stream->pkts[pkt_nb]; 547018a8e75SMaciej Fijalkowski } 548018a8e75SMaciej Fijalkowski 549018a8e75SMaciej Fijalkowski static struct pkt *pkt_stream_get_next_rx_pkt(struct pkt_stream *pkt_stream, u32 *pkts_sent) 550018a8e75SMaciej Fijalkowski { 551018a8e75SMaciej Fijalkowski while (pkt_stream->rx_pkt_nb < pkt_stream->nb_pkts) { 552018a8e75SMaciej Fijalkowski (*pkts_sent)++; 553018a8e75SMaciej Fijalkowski if (pkt_stream->pkts[pkt_stream->rx_pkt_nb].valid) 554018a8e75SMaciej Fijalkowski return &pkt_stream->pkts[pkt_stream->rx_pkt_nb++]; 555018a8e75SMaciej Fijalkowski pkt_stream->rx_pkt_nb++; 556018a8e75SMaciej Fijalkowski } 557018a8e75SMaciej Fijalkowski return NULL; 558018a8e75SMaciej Fijalkowski } 559018a8e75SMaciej Fijalkowski 560018a8e75SMaciej Fijalkowski static void pkt_stream_delete(struct pkt_stream *pkt_stream) 561018a8e75SMaciej Fijalkowski { 562018a8e75SMaciej Fijalkowski free(pkt_stream->pkts); 563018a8e75SMaciej Fijalkowski free(pkt_stream); 564018a8e75SMaciej Fijalkowski } 565018a8e75SMaciej Fijalkowski 566018a8e75SMaciej Fijalkowski static void pkt_stream_restore_default(struct test_spec *test) 567018a8e75SMaciej Fijalkowski { 568018a8e75SMaciej Fijalkowski struct pkt_stream *tx_pkt_stream = test->ifobj_tx->pkt_stream; 5691adef064SMaciej Fijalkowski struct pkt_stream *rx_pkt_stream = test->ifobj_rx->pkt_stream; 570018a8e75SMaciej Fijalkowski 5711adef064SMaciej Fijalkowski if (tx_pkt_stream != test->tx_pkt_stream_default) { 572018a8e75SMaciej Fijalkowski pkt_stream_delete(test->ifobj_tx->pkt_stream); 5731adef064SMaciej Fijalkowski test->ifobj_tx->pkt_stream = test->tx_pkt_stream_default; 574018a8e75SMaciej Fijalkowski } 575018a8e75SMaciej Fijalkowski 5761adef064SMaciej Fijalkowski if (rx_pkt_stream != test->rx_pkt_stream_default) { 577018a8e75SMaciej Fijalkowski pkt_stream_delete(test->ifobj_rx->pkt_stream); 5781adef064SMaciej Fijalkowski test->ifobj_rx->pkt_stream = test->rx_pkt_stream_default; 5791adef064SMaciej Fijalkowski } 580018a8e75SMaciej Fijalkowski } 581018a8e75SMaciej Fijalkowski 582018a8e75SMaciej Fijalkowski static struct pkt_stream *__pkt_stream_alloc(u32 nb_pkts) 583018a8e75SMaciej Fijalkowski { 584018a8e75SMaciej Fijalkowski struct pkt_stream *pkt_stream; 585018a8e75SMaciej Fijalkowski 586018a8e75SMaciej Fijalkowski pkt_stream = calloc(1, sizeof(*pkt_stream)); 587018a8e75SMaciej Fijalkowski if (!pkt_stream) 588018a8e75SMaciej Fijalkowski return NULL; 589018a8e75SMaciej Fijalkowski 590018a8e75SMaciej Fijalkowski pkt_stream->pkts = calloc(nb_pkts, sizeof(*pkt_stream->pkts)); 591018a8e75SMaciej Fijalkowski if (!pkt_stream->pkts) { 592018a8e75SMaciej Fijalkowski free(pkt_stream); 593018a8e75SMaciej Fijalkowski return NULL; 594018a8e75SMaciej Fijalkowski } 595018a8e75SMaciej Fijalkowski 596018a8e75SMaciej Fijalkowski pkt_stream->nb_pkts = nb_pkts; 597018a8e75SMaciej Fijalkowski return pkt_stream; 598018a8e75SMaciej Fijalkowski } 599018a8e75SMaciej Fijalkowski 600018a8e75SMaciej Fijalkowski static void pkt_set(struct xsk_umem_info *umem, struct pkt *pkt, u64 addr, u32 len) 601018a8e75SMaciej Fijalkowski { 6021adef064SMaciej Fijalkowski pkt->addr = addr + umem->base_addr; 603018a8e75SMaciej Fijalkowski pkt->len = len; 604018a8e75SMaciej Fijalkowski if (len > umem->frame_size - XDP_PACKET_HEADROOM - MIN_PKT_SIZE * 2 - umem->frame_headroom) 605018a8e75SMaciej Fijalkowski pkt->valid = false; 606018a8e75SMaciej Fijalkowski else 607018a8e75SMaciej Fijalkowski pkt->valid = true; 608018a8e75SMaciej Fijalkowski } 609018a8e75SMaciej Fijalkowski 610018a8e75SMaciej Fijalkowski static struct pkt_stream *pkt_stream_generate(struct xsk_umem_info *umem, u32 nb_pkts, u32 pkt_len) 611018a8e75SMaciej Fijalkowski { 612018a8e75SMaciej Fijalkowski struct pkt_stream *pkt_stream; 613018a8e75SMaciej Fijalkowski u32 i; 614018a8e75SMaciej Fijalkowski 615018a8e75SMaciej Fijalkowski pkt_stream = __pkt_stream_alloc(nb_pkts); 616018a8e75SMaciej Fijalkowski if (!pkt_stream) 617018a8e75SMaciej Fijalkowski exit_with_error(ENOMEM); 618018a8e75SMaciej Fijalkowski 619018a8e75SMaciej Fijalkowski pkt_stream->nb_pkts = nb_pkts; 620018a8e75SMaciej Fijalkowski for (i = 0; i < nb_pkts; i++) { 621018a8e75SMaciej Fijalkowski pkt_set(umem, &pkt_stream->pkts[i], (i % umem->num_frames) * umem->frame_size, 622018a8e75SMaciej Fijalkowski pkt_len); 623018a8e75SMaciej Fijalkowski pkt_stream->pkts[i].payload = i; 624018a8e75SMaciej Fijalkowski } 625018a8e75SMaciej Fijalkowski 626018a8e75SMaciej Fijalkowski return pkt_stream; 627018a8e75SMaciej Fijalkowski } 628018a8e75SMaciej Fijalkowski 629018a8e75SMaciej Fijalkowski static struct pkt_stream *pkt_stream_clone(struct xsk_umem_info *umem, 630018a8e75SMaciej Fijalkowski struct pkt_stream *pkt_stream) 631018a8e75SMaciej Fijalkowski { 632018a8e75SMaciej Fijalkowski return pkt_stream_generate(umem, pkt_stream->nb_pkts, pkt_stream->pkts[0].len); 633018a8e75SMaciej Fijalkowski } 634018a8e75SMaciej Fijalkowski 635018a8e75SMaciej Fijalkowski static void pkt_stream_replace(struct test_spec *test, u32 nb_pkts, u32 pkt_len) 636018a8e75SMaciej Fijalkowski { 637018a8e75SMaciej Fijalkowski struct pkt_stream *pkt_stream; 638018a8e75SMaciej Fijalkowski 639018a8e75SMaciej Fijalkowski pkt_stream = pkt_stream_generate(test->ifobj_tx->umem, nb_pkts, pkt_len); 640018a8e75SMaciej Fijalkowski test->ifobj_tx->pkt_stream = pkt_stream; 6411adef064SMaciej Fijalkowski pkt_stream = pkt_stream_generate(test->ifobj_rx->umem, nb_pkts, pkt_len); 642018a8e75SMaciej Fijalkowski test->ifobj_rx->pkt_stream = pkt_stream; 643018a8e75SMaciej Fijalkowski } 644018a8e75SMaciej Fijalkowski 6451adef064SMaciej Fijalkowski static void __pkt_stream_replace_half(struct ifobject *ifobj, u32 pkt_len, 6461adef064SMaciej Fijalkowski int offset) 6471adef064SMaciej Fijalkowski { 6481adef064SMaciej Fijalkowski struct xsk_umem_info *umem = ifobj->umem; 6491adef064SMaciej Fijalkowski struct pkt_stream *pkt_stream; 6501adef064SMaciej Fijalkowski u32 i; 6511adef064SMaciej Fijalkowski 6521adef064SMaciej Fijalkowski pkt_stream = pkt_stream_clone(umem, ifobj->pkt_stream); 6531adef064SMaciej Fijalkowski for (i = 1; i < ifobj->pkt_stream->nb_pkts; i += 2) 6541adef064SMaciej Fijalkowski pkt_set(umem, &pkt_stream->pkts[i], 6551adef064SMaciej Fijalkowski (i % umem->num_frames) * umem->frame_size + offset, pkt_len); 6561adef064SMaciej Fijalkowski 6571adef064SMaciej Fijalkowski ifobj->pkt_stream = pkt_stream; 6581adef064SMaciej Fijalkowski } 6591adef064SMaciej Fijalkowski 660018a8e75SMaciej Fijalkowski static void pkt_stream_replace_half(struct test_spec *test, u32 pkt_len, int offset) 661018a8e75SMaciej Fijalkowski { 6621adef064SMaciej Fijalkowski __pkt_stream_replace_half(test->ifobj_tx, pkt_len, offset); 6631adef064SMaciej Fijalkowski __pkt_stream_replace_half(test->ifobj_rx, pkt_len, offset); 664018a8e75SMaciej Fijalkowski } 665018a8e75SMaciej Fijalkowski 666018a8e75SMaciej Fijalkowski static void pkt_stream_receive_half(struct test_spec *test) 667018a8e75SMaciej Fijalkowski { 668018a8e75SMaciej Fijalkowski struct xsk_umem_info *umem = test->ifobj_rx->umem; 669018a8e75SMaciej Fijalkowski struct pkt_stream *pkt_stream = test->ifobj_tx->pkt_stream; 670018a8e75SMaciej Fijalkowski u32 i; 671018a8e75SMaciej Fijalkowski 672018a8e75SMaciej Fijalkowski test->ifobj_rx->pkt_stream = pkt_stream_generate(umem, pkt_stream->nb_pkts, 673018a8e75SMaciej Fijalkowski pkt_stream->pkts[0].len); 674018a8e75SMaciej Fijalkowski pkt_stream = test->ifobj_rx->pkt_stream; 675018a8e75SMaciej Fijalkowski for (i = 1; i < pkt_stream->nb_pkts; i += 2) 676018a8e75SMaciej Fijalkowski pkt_stream->pkts[i].valid = false; 677018a8e75SMaciej Fijalkowski } 678018a8e75SMaciej Fijalkowski 679018a8e75SMaciej Fijalkowski static struct pkt *pkt_generate(struct ifobject *ifobject, u32 pkt_nb) 680018a8e75SMaciej Fijalkowski { 681018a8e75SMaciej Fijalkowski struct pkt *pkt = pkt_stream_get_pkt(ifobject->pkt_stream, pkt_nb); 682018a8e75SMaciej Fijalkowski struct udphdr *udp_hdr; 683018a8e75SMaciej Fijalkowski struct ethhdr *eth_hdr; 684018a8e75SMaciej Fijalkowski struct iphdr *ip_hdr; 685018a8e75SMaciej Fijalkowski void *data; 686018a8e75SMaciej Fijalkowski 687018a8e75SMaciej Fijalkowski if (!pkt) 688018a8e75SMaciej Fijalkowski return NULL; 689018a8e75SMaciej Fijalkowski if (!pkt->valid || pkt->len < MIN_PKT_SIZE) 690018a8e75SMaciej Fijalkowski return pkt; 691018a8e75SMaciej Fijalkowski 692018a8e75SMaciej Fijalkowski data = xsk_umem__get_data(ifobject->umem->buffer, pkt->addr); 693018a8e75SMaciej Fijalkowski udp_hdr = (struct udphdr *)(data + sizeof(struct ethhdr) + sizeof(struct iphdr)); 694018a8e75SMaciej Fijalkowski ip_hdr = (struct iphdr *)(data + sizeof(struct ethhdr)); 695018a8e75SMaciej Fijalkowski eth_hdr = (struct ethhdr *)data; 696018a8e75SMaciej Fijalkowski 697018a8e75SMaciej Fijalkowski gen_udp_hdr(pkt_nb, data, ifobject, udp_hdr); 698018a8e75SMaciej Fijalkowski gen_ip_hdr(ifobject, ip_hdr); 699018a8e75SMaciej Fijalkowski gen_udp_csum(udp_hdr, ip_hdr); 700018a8e75SMaciej Fijalkowski gen_eth_hdr(ifobject, eth_hdr); 701018a8e75SMaciej Fijalkowski 702018a8e75SMaciej Fijalkowski return pkt; 703018a8e75SMaciej Fijalkowski } 704018a8e75SMaciej Fijalkowski 7051adef064SMaciej Fijalkowski static void __pkt_stream_generate_custom(struct ifobject *ifobj, 7061adef064SMaciej Fijalkowski struct pkt *pkts, u32 nb_pkts) 707018a8e75SMaciej Fijalkowski { 708018a8e75SMaciej Fijalkowski struct pkt_stream *pkt_stream; 709018a8e75SMaciej Fijalkowski u32 i; 710018a8e75SMaciej Fijalkowski 711018a8e75SMaciej Fijalkowski pkt_stream = __pkt_stream_alloc(nb_pkts); 712018a8e75SMaciej Fijalkowski if (!pkt_stream) 713018a8e75SMaciej Fijalkowski exit_with_error(ENOMEM); 714018a8e75SMaciej Fijalkowski 715018a8e75SMaciej Fijalkowski for (i = 0; i < nb_pkts; i++) { 7161adef064SMaciej Fijalkowski pkt_stream->pkts[i].addr = pkts[i].addr + ifobj->umem->base_addr; 717018a8e75SMaciej Fijalkowski pkt_stream->pkts[i].len = pkts[i].len; 718018a8e75SMaciej Fijalkowski pkt_stream->pkts[i].payload = i; 719018a8e75SMaciej Fijalkowski pkt_stream->pkts[i].valid = pkts[i].valid; 720018a8e75SMaciej Fijalkowski } 7211adef064SMaciej Fijalkowski 7221adef064SMaciej Fijalkowski ifobj->pkt_stream = pkt_stream; 7231adef064SMaciej Fijalkowski } 7241adef064SMaciej Fijalkowski 7251adef064SMaciej Fijalkowski static void pkt_stream_generate_custom(struct test_spec *test, struct pkt *pkts, u32 nb_pkts) 7261adef064SMaciej Fijalkowski { 7271adef064SMaciej Fijalkowski __pkt_stream_generate_custom(test->ifobj_tx, pkts, nb_pkts); 7281adef064SMaciej Fijalkowski __pkt_stream_generate_custom(test->ifobj_rx, pkts, nb_pkts); 729018a8e75SMaciej Fijalkowski } 730018a8e75SMaciej Fijalkowski 731018a8e75SMaciej Fijalkowski static void pkt_dump(void *pkt, u32 len) 732018a8e75SMaciej Fijalkowski { 733018a8e75SMaciej Fijalkowski char s[INET_ADDRSTRLEN]; 734018a8e75SMaciej Fijalkowski struct ethhdr *ethhdr; 735018a8e75SMaciej Fijalkowski struct udphdr *udphdr; 736018a8e75SMaciej Fijalkowski struct iphdr *iphdr; 7372d0b2ae2SMagnus Karlsson u32 payload, i; 738018a8e75SMaciej Fijalkowski 739018a8e75SMaciej Fijalkowski ethhdr = pkt; 740018a8e75SMaciej Fijalkowski iphdr = pkt + sizeof(*ethhdr); 741018a8e75SMaciej Fijalkowski udphdr = pkt + sizeof(*ethhdr) + sizeof(*iphdr); 742018a8e75SMaciej Fijalkowski 743018a8e75SMaciej Fijalkowski /*extract L2 frame */ 744018a8e75SMaciej Fijalkowski fprintf(stdout, "DEBUG>> L2: dst mac: "); 745018a8e75SMaciej Fijalkowski for (i = 0; i < ETH_ALEN; i++) 746018a8e75SMaciej Fijalkowski fprintf(stdout, "%02X", ethhdr->h_dest[i]); 747018a8e75SMaciej Fijalkowski 748018a8e75SMaciej Fijalkowski fprintf(stdout, "\nDEBUG>> L2: src mac: "); 749018a8e75SMaciej Fijalkowski for (i = 0; i < ETH_ALEN; i++) 750018a8e75SMaciej Fijalkowski fprintf(stdout, "%02X", ethhdr->h_source[i]); 751018a8e75SMaciej Fijalkowski 752018a8e75SMaciej Fijalkowski /*extract L3 frame */ 753018a8e75SMaciej Fijalkowski fprintf(stdout, "\nDEBUG>> L3: ip_hdr->ihl: %02X\n", iphdr->ihl); 754018a8e75SMaciej Fijalkowski fprintf(stdout, "DEBUG>> L3: ip_hdr->saddr: %s\n", 755018a8e75SMaciej Fijalkowski inet_ntop(AF_INET, &iphdr->saddr, s, sizeof(s))); 756018a8e75SMaciej Fijalkowski fprintf(stdout, "DEBUG>> L3: ip_hdr->daddr: %s\n", 757018a8e75SMaciej Fijalkowski inet_ntop(AF_INET, &iphdr->daddr, s, sizeof(s))); 758018a8e75SMaciej Fijalkowski /*extract L4 frame */ 759018a8e75SMaciej Fijalkowski fprintf(stdout, "DEBUG>> L4: udp_hdr->src: %d\n", ntohs(udphdr->source)); 760018a8e75SMaciej Fijalkowski fprintf(stdout, "DEBUG>> L4: udp_hdr->dst: %d\n", ntohs(udphdr->dest)); 761018a8e75SMaciej Fijalkowski /*extract L5 frame */ 7622d0b2ae2SMagnus Karlsson payload = ntohl(*((u32 *)(pkt + PKT_HDR_SIZE))); 763018a8e75SMaciej Fijalkowski 764018a8e75SMaciej Fijalkowski fprintf(stdout, "DEBUG>> L5: payload: %d\n", payload); 765018a8e75SMaciej Fijalkowski fprintf(stdout, "---------------------------------------\n"); 766018a8e75SMaciej Fijalkowski } 767018a8e75SMaciej Fijalkowski 768018a8e75SMaciej Fijalkowski static bool is_offset_correct(struct xsk_umem_info *umem, struct pkt_stream *pkt_stream, u64 addr, 769018a8e75SMaciej Fijalkowski u64 pkt_stream_addr) 770018a8e75SMaciej Fijalkowski { 771018a8e75SMaciej Fijalkowski u32 headroom = umem->unaligned_mode ? 0 : umem->frame_headroom; 772018a8e75SMaciej Fijalkowski u32 offset = addr % umem->frame_size, expected_offset = 0; 773018a8e75SMaciej Fijalkowski 774018a8e75SMaciej Fijalkowski if (!pkt_stream->use_addr_for_fill) 775018a8e75SMaciej Fijalkowski pkt_stream_addr = 0; 776018a8e75SMaciej Fijalkowski 777018a8e75SMaciej Fijalkowski expected_offset += (pkt_stream_addr + headroom + XDP_PACKET_HEADROOM) % umem->frame_size; 778018a8e75SMaciej Fijalkowski 779018a8e75SMaciej Fijalkowski if (offset == expected_offset) 780018a8e75SMaciej Fijalkowski return true; 781018a8e75SMaciej Fijalkowski 782018a8e75SMaciej Fijalkowski ksft_print_msg("[%s] expected [%u], got [%u]\n", __func__, expected_offset, offset); 783018a8e75SMaciej Fijalkowski return false; 784018a8e75SMaciej Fijalkowski } 785018a8e75SMaciej Fijalkowski 786018a8e75SMaciej Fijalkowski static bool is_pkt_valid(struct pkt *pkt, void *buffer, u64 addr, u32 len) 787018a8e75SMaciej Fijalkowski { 788018a8e75SMaciej Fijalkowski void *data = xsk_umem__get_data(buffer, addr); 789018a8e75SMaciej Fijalkowski struct iphdr *iphdr = (struct iphdr *)(data + sizeof(struct ethhdr)); 790018a8e75SMaciej Fijalkowski 791018a8e75SMaciej Fijalkowski if (!pkt) { 792018a8e75SMaciej Fijalkowski ksft_print_msg("[%s] too many packets received\n", __func__); 793018a8e75SMaciej Fijalkowski return false; 794018a8e75SMaciej Fijalkowski } 795018a8e75SMaciej Fijalkowski 796018a8e75SMaciej Fijalkowski if (len < MIN_PKT_SIZE || pkt->len < MIN_PKT_SIZE) { 797018a8e75SMaciej Fijalkowski /* Do not try to verify packets that are smaller than minimum size. */ 798018a8e75SMaciej Fijalkowski return true; 799018a8e75SMaciej Fijalkowski } 800018a8e75SMaciej Fijalkowski 801018a8e75SMaciej Fijalkowski if (pkt->len != len) { 802018a8e75SMaciej Fijalkowski ksft_print_msg("[%s] expected length [%d], got length [%d]\n", 803018a8e75SMaciej Fijalkowski __func__, pkt->len, len); 804018a8e75SMaciej Fijalkowski return false; 805018a8e75SMaciej Fijalkowski } 806018a8e75SMaciej Fijalkowski 807018a8e75SMaciej Fijalkowski if (iphdr->version == IP_PKT_VER && iphdr->tos == IP_PKT_TOS) { 808018a8e75SMaciej Fijalkowski u32 seqnum = ntohl(*((u32 *)(data + PKT_HDR_SIZE))); 809018a8e75SMaciej Fijalkowski 810018a8e75SMaciej Fijalkowski if (opt_pkt_dump) 811018a8e75SMaciej Fijalkowski pkt_dump(data, PKT_SIZE); 812018a8e75SMaciej Fijalkowski 813018a8e75SMaciej Fijalkowski if (pkt->payload != seqnum) { 814018a8e75SMaciej Fijalkowski ksft_print_msg("[%s] expected seqnum [%d], got seqnum [%d]\n", 815018a8e75SMaciej Fijalkowski __func__, pkt->payload, seqnum); 816018a8e75SMaciej Fijalkowski return false; 817018a8e75SMaciej Fijalkowski } 818018a8e75SMaciej Fijalkowski } else { 819018a8e75SMaciej Fijalkowski ksft_print_msg("Invalid frame received: "); 820018a8e75SMaciej Fijalkowski ksft_print_msg("[IP_PKT_VER: %02X], [IP_PKT_TOS: %02X]\n", iphdr->version, 821018a8e75SMaciej Fijalkowski iphdr->tos); 822018a8e75SMaciej Fijalkowski return false; 823018a8e75SMaciej Fijalkowski } 824018a8e75SMaciej Fijalkowski 825018a8e75SMaciej Fijalkowski return true; 826018a8e75SMaciej Fijalkowski } 827018a8e75SMaciej Fijalkowski 828018a8e75SMaciej Fijalkowski static void kick_tx(struct xsk_socket_info *xsk) 829018a8e75SMaciej Fijalkowski { 830018a8e75SMaciej Fijalkowski int ret; 831018a8e75SMaciej Fijalkowski 832018a8e75SMaciej Fijalkowski ret = sendto(xsk_socket__fd(xsk->xsk), NULL, 0, MSG_DONTWAIT, NULL, 0); 833018a8e75SMaciej Fijalkowski if (ret >= 0) 834018a8e75SMaciej Fijalkowski return; 835018a8e75SMaciej Fijalkowski if (errno == ENOBUFS || errno == EAGAIN || errno == EBUSY || errno == ENETDOWN) { 836018a8e75SMaciej Fijalkowski usleep(100); 837018a8e75SMaciej Fijalkowski return; 838018a8e75SMaciej Fijalkowski } 839018a8e75SMaciej Fijalkowski exit_with_error(errno); 840018a8e75SMaciej Fijalkowski } 841018a8e75SMaciej Fijalkowski 842018a8e75SMaciej Fijalkowski static void kick_rx(struct xsk_socket_info *xsk) 843018a8e75SMaciej Fijalkowski { 844018a8e75SMaciej Fijalkowski int ret; 845018a8e75SMaciej Fijalkowski 846018a8e75SMaciej Fijalkowski ret = recvfrom(xsk_socket__fd(xsk->xsk), NULL, 0, MSG_DONTWAIT, NULL, NULL); 847018a8e75SMaciej Fijalkowski if (ret < 0) 848018a8e75SMaciej Fijalkowski exit_with_error(errno); 849018a8e75SMaciej Fijalkowski } 850018a8e75SMaciej Fijalkowski 851018a8e75SMaciej Fijalkowski static int complete_pkts(struct xsk_socket_info *xsk, int batch_size) 852018a8e75SMaciej Fijalkowski { 853018a8e75SMaciej Fijalkowski unsigned int rcvd; 854018a8e75SMaciej Fijalkowski u32 idx; 855018a8e75SMaciej Fijalkowski 856018a8e75SMaciej Fijalkowski if (xsk_ring_prod__needs_wakeup(&xsk->tx)) 857018a8e75SMaciej Fijalkowski kick_tx(xsk); 858018a8e75SMaciej Fijalkowski 859018a8e75SMaciej Fijalkowski rcvd = xsk_ring_cons__peek(&xsk->umem->cq, batch_size, &idx); 860018a8e75SMaciej Fijalkowski if (rcvd) { 861018a8e75SMaciej Fijalkowski if (rcvd > xsk->outstanding_tx) { 862018a8e75SMaciej Fijalkowski u64 addr = *xsk_ring_cons__comp_addr(&xsk->umem->cq, idx + rcvd - 1); 863018a8e75SMaciej Fijalkowski 864018a8e75SMaciej Fijalkowski ksft_print_msg("[%s] Too many packets completed\n", __func__); 865018a8e75SMaciej Fijalkowski ksft_print_msg("Last completion address: %llx\n", addr); 866018a8e75SMaciej Fijalkowski return TEST_FAILURE; 867018a8e75SMaciej Fijalkowski } 868018a8e75SMaciej Fijalkowski 869018a8e75SMaciej Fijalkowski xsk_ring_cons__release(&xsk->umem->cq, rcvd); 870018a8e75SMaciej Fijalkowski xsk->outstanding_tx -= rcvd; 871018a8e75SMaciej Fijalkowski } 872018a8e75SMaciej Fijalkowski 873018a8e75SMaciej Fijalkowski return TEST_PASS; 874018a8e75SMaciej Fijalkowski } 875018a8e75SMaciej Fijalkowski 8763143d10bSShibin Koikkara Reeny static int receive_pkts(struct test_spec *test, struct pollfd *fds) 877018a8e75SMaciej Fijalkowski { 8783143d10bSShibin Koikkara Reeny struct timeval tv_end, tv_now, tv_timeout = {THREAD_TMOUT, 0}; 8793143d10bSShibin Koikkara Reeny struct pkt_stream *pkt_stream = test->ifobj_rx->pkt_stream; 880018a8e75SMaciej Fijalkowski u32 idx_rx = 0, idx_fq = 0, rcvd, i, pkts_sent = 0; 8813143d10bSShibin Koikkara Reeny struct xsk_socket_info *xsk = test->ifobj_rx->xsk; 8823143d10bSShibin Koikkara Reeny struct ifobject *ifobj = test->ifobj_rx; 883018a8e75SMaciej Fijalkowski struct xsk_umem_info *umem = xsk->umem; 884018a8e75SMaciej Fijalkowski struct pkt *pkt; 885018a8e75SMaciej Fijalkowski int ret; 886018a8e75SMaciej Fijalkowski 887018a8e75SMaciej Fijalkowski ret = gettimeofday(&tv_now, NULL); 888018a8e75SMaciej Fijalkowski if (ret) 889018a8e75SMaciej Fijalkowski exit_with_error(errno); 890018a8e75SMaciej Fijalkowski timeradd(&tv_now, &tv_timeout, &tv_end); 891018a8e75SMaciej Fijalkowski 892018a8e75SMaciej Fijalkowski pkt = pkt_stream_get_next_rx_pkt(pkt_stream, &pkts_sent); 893018a8e75SMaciej Fijalkowski while (pkt) { 894018a8e75SMaciej Fijalkowski ret = gettimeofday(&tv_now, NULL); 895018a8e75SMaciej Fijalkowski if (ret) 896018a8e75SMaciej Fijalkowski exit_with_error(errno); 897018a8e75SMaciej Fijalkowski if (timercmp(&tv_now, &tv_end, >)) { 898018a8e75SMaciej Fijalkowski ksft_print_msg("ERROR: [%s] Receive loop timed out\n", __func__); 899018a8e75SMaciej Fijalkowski return TEST_FAILURE; 900018a8e75SMaciej Fijalkowski } 901018a8e75SMaciej Fijalkowski 902018a8e75SMaciej Fijalkowski kick_rx(xsk); 9033143d10bSShibin Koikkara Reeny if (ifobj->use_poll) { 904018a8e75SMaciej Fijalkowski ret = poll(fds, 1, POLL_TMOUT); 905018a8e75SMaciej Fijalkowski if (ret < 0) 906085dcccfSMagnus Karlsson exit_with_error(errno); 9073143d10bSShibin Koikkara Reeny 9083143d10bSShibin Koikkara Reeny if (!ret) { 9093143d10bSShibin Koikkara Reeny if (!is_umem_valid(test->ifobj_tx)) 9103143d10bSShibin Koikkara Reeny return TEST_PASS; 9113143d10bSShibin Koikkara Reeny 9123143d10bSShibin Koikkara Reeny ksft_print_msg("ERROR: [%s] Poll timed out\n", __func__); 9133143d10bSShibin Koikkara Reeny return TEST_FAILURE; 9143143d10bSShibin Koikkara Reeny 915018a8e75SMaciej Fijalkowski } 9163143d10bSShibin Koikkara Reeny 9173143d10bSShibin Koikkara Reeny if (!(fds->revents & POLLIN)) 918018a8e75SMaciej Fijalkowski continue; 919018a8e75SMaciej Fijalkowski } 920018a8e75SMaciej Fijalkowski 9213143d10bSShibin Koikkara Reeny rcvd = xsk_ring_cons__peek(&xsk->rx, BATCH_SIZE, &idx_rx); 9223143d10bSShibin Koikkara Reeny if (!rcvd) 9233143d10bSShibin Koikkara Reeny continue; 9243143d10bSShibin Koikkara Reeny 925018a8e75SMaciej Fijalkowski if (ifobj->use_fill_ring) { 926018a8e75SMaciej Fijalkowski ret = xsk_ring_prod__reserve(&umem->fq, rcvd, &idx_fq); 927018a8e75SMaciej Fijalkowski while (ret != rcvd) { 928018a8e75SMaciej Fijalkowski if (ret < 0) 929018a8e75SMaciej Fijalkowski exit_with_error(-ret); 930018a8e75SMaciej Fijalkowski if (xsk_ring_prod__needs_wakeup(&umem->fq)) { 931018a8e75SMaciej Fijalkowski ret = poll(fds, 1, POLL_TMOUT); 932018a8e75SMaciej Fijalkowski if (ret < 0) 933085dcccfSMagnus Karlsson exit_with_error(errno); 934018a8e75SMaciej Fijalkowski } 935018a8e75SMaciej Fijalkowski ret = xsk_ring_prod__reserve(&umem->fq, rcvd, &idx_fq); 936018a8e75SMaciej Fijalkowski } 937018a8e75SMaciej Fijalkowski } 938018a8e75SMaciej Fijalkowski 939018a8e75SMaciej Fijalkowski for (i = 0; i < rcvd; i++) { 940018a8e75SMaciej Fijalkowski const struct xdp_desc *desc = xsk_ring_cons__rx_desc(&xsk->rx, idx_rx++); 941018a8e75SMaciej Fijalkowski u64 addr = desc->addr, orig; 942018a8e75SMaciej Fijalkowski 943018a8e75SMaciej Fijalkowski orig = xsk_umem__extract_addr(addr); 944018a8e75SMaciej Fijalkowski addr = xsk_umem__add_offset_to_addr(addr); 945018a8e75SMaciej Fijalkowski 946018a8e75SMaciej Fijalkowski if (!is_pkt_valid(pkt, umem->buffer, addr, desc->len) || 947018a8e75SMaciej Fijalkowski !is_offset_correct(umem, pkt_stream, addr, pkt->addr)) 948018a8e75SMaciej Fijalkowski return TEST_FAILURE; 949018a8e75SMaciej Fijalkowski 950018a8e75SMaciej Fijalkowski if (ifobj->use_fill_ring) 951018a8e75SMaciej Fijalkowski *xsk_ring_prod__fill_addr(&umem->fq, idx_fq++) = orig; 952018a8e75SMaciej Fijalkowski pkt = pkt_stream_get_next_rx_pkt(pkt_stream, &pkts_sent); 953018a8e75SMaciej Fijalkowski } 954018a8e75SMaciej Fijalkowski 955018a8e75SMaciej Fijalkowski if (ifobj->use_fill_ring) 956018a8e75SMaciej Fijalkowski xsk_ring_prod__submit(&umem->fq, rcvd); 957018a8e75SMaciej Fijalkowski if (ifobj->release_rx) 958018a8e75SMaciej Fijalkowski xsk_ring_cons__release(&xsk->rx, rcvd); 959018a8e75SMaciej Fijalkowski 960018a8e75SMaciej Fijalkowski pthread_mutex_lock(&pacing_mutex); 961018a8e75SMaciej Fijalkowski pkts_in_flight -= pkts_sent; 962018a8e75SMaciej Fijalkowski if (pkts_in_flight < umem->num_frames) 963018a8e75SMaciej Fijalkowski pthread_cond_signal(&pacing_cond); 964018a8e75SMaciej Fijalkowski pthread_mutex_unlock(&pacing_mutex); 965018a8e75SMaciej Fijalkowski pkts_sent = 0; 966018a8e75SMaciej Fijalkowski } 967018a8e75SMaciej Fijalkowski 968018a8e75SMaciej Fijalkowski return TEST_PASS; 969018a8e75SMaciej Fijalkowski } 970018a8e75SMaciej Fijalkowski 9713143d10bSShibin Koikkara Reeny static int __send_pkts(struct ifobject *ifobject, u32 *pkt_nb, struct pollfd *fds, 9723143d10bSShibin Koikkara Reeny bool timeout) 973018a8e75SMaciej Fijalkowski { 974018a8e75SMaciej Fijalkowski struct xsk_socket_info *xsk = ifobject->xsk; 9753143d10bSShibin Koikkara Reeny bool use_poll = ifobject->use_poll; 976e8f50c4fSKang Minchul u32 i, idx = 0, valid_pkts = 0; 977e8f50c4fSKang Minchul int ret; 978018a8e75SMaciej Fijalkowski 9793143d10bSShibin Koikkara Reeny while (xsk_ring_prod__reserve(&xsk->tx, BATCH_SIZE, &idx) < BATCH_SIZE) { 9803143d10bSShibin Koikkara Reeny if (use_poll) { 9813143d10bSShibin Koikkara Reeny ret = poll(fds, 1, POLL_TMOUT); 9823143d10bSShibin Koikkara Reeny if (timeout) { 9833143d10bSShibin Koikkara Reeny if (ret < 0) { 9843143d10bSShibin Koikkara Reeny ksft_print_msg("ERROR: [%s] Poll error %d\n", 985085dcccfSMagnus Karlsson __func__, errno); 9863143d10bSShibin Koikkara Reeny return TEST_FAILURE; 9873143d10bSShibin Koikkara Reeny } 9883143d10bSShibin Koikkara Reeny if (ret == 0) 9893143d10bSShibin Koikkara Reeny return TEST_PASS; 9903143d10bSShibin Koikkara Reeny break; 9913143d10bSShibin Koikkara Reeny } 9923143d10bSShibin Koikkara Reeny if (ret <= 0) { 9933143d10bSShibin Koikkara Reeny ksft_print_msg("ERROR: [%s] Poll error %d\n", 994085dcccfSMagnus Karlsson __func__, errno); 9953143d10bSShibin Koikkara Reeny return TEST_FAILURE; 9963143d10bSShibin Koikkara Reeny } 9973143d10bSShibin Koikkara Reeny } 9983143d10bSShibin Koikkara Reeny 999018a8e75SMaciej Fijalkowski complete_pkts(xsk, BATCH_SIZE); 10003143d10bSShibin Koikkara Reeny } 1001018a8e75SMaciej Fijalkowski 1002018a8e75SMaciej Fijalkowski for (i = 0; i < BATCH_SIZE; i++) { 1003018a8e75SMaciej Fijalkowski struct xdp_desc *tx_desc = xsk_ring_prod__tx_desc(&xsk->tx, idx + i); 1004018a8e75SMaciej Fijalkowski struct pkt *pkt = pkt_generate(ifobject, *pkt_nb); 1005018a8e75SMaciej Fijalkowski 1006018a8e75SMaciej Fijalkowski if (!pkt) 1007018a8e75SMaciej Fijalkowski break; 1008018a8e75SMaciej Fijalkowski 1009018a8e75SMaciej Fijalkowski tx_desc->addr = pkt->addr; 1010018a8e75SMaciej Fijalkowski tx_desc->len = pkt->len; 1011018a8e75SMaciej Fijalkowski (*pkt_nb)++; 1012018a8e75SMaciej Fijalkowski if (pkt->valid) 1013018a8e75SMaciej Fijalkowski valid_pkts++; 1014018a8e75SMaciej Fijalkowski } 1015018a8e75SMaciej Fijalkowski 1016018a8e75SMaciej Fijalkowski pthread_mutex_lock(&pacing_mutex); 1017018a8e75SMaciej Fijalkowski pkts_in_flight += valid_pkts; 1018018a8e75SMaciej Fijalkowski /* pkts_in_flight might be negative if many invalid packets are sent */ 1019018a8e75SMaciej Fijalkowski if (pkts_in_flight >= (int)(ifobject->umem->num_frames - BATCH_SIZE)) { 1020018a8e75SMaciej Fijalkowski kick_tx(xsk); 1021018a8e75SMaciej Fijalkowski pthread_cond_wait(&pacing_cond, &pacing_mutex); 1022018a8e75SMaciej Fijalkowski } 1023018a8e75SMaciej Fijalkowski pthread_mutex_unlock(&pacing_mutex); 1024018a8e75SMaciej Fijalkowski 1025018a8e75SMaciej Fijalkowski xsk_ring_prod__submit(&xsk->tx, i); 1026018a8e75SMaciej Fijalkowski xsk->outstanding_tx += valid_pkts; 10273143d10bSShibin Koikkara Reeny 10283143d10bSShibin Koikkara Reeny if (use_poll) { 10293143d10bSShibin Koikkara Reeny ret = poll(fds, 1, POLL_TMOUT); 10303143d10bSShibin Koikkara Reeny if (ret <= 0) { 10313143d10bSShibin Koikkara Reeny if (ret == 0 && timeout) 10323143d10bSShibin Koikkara Reeny return TEST_PASS; 10333143d10bSShibin Koikkara Reeny 10343143d10bSShibin Koikkara Reeny ksft_print_msg("ERROR: [%s] Poll error %d\n", __func__, ret); 10353143d10bSShibin Koikkara Reeny return TEST_FAILURE; 10363143d10bSShibin Koikkara Reeny } 10373143d10bSShibin Koikkara Reeny } 10383143d10bSShibin Koikkara Reeny 10393143d10bSShibin Koikkara Reeny if (!timeout) { 1040018a8e75SMaciej Fijalkowski if (complete_pkts(xsk, i)) 1041018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1042018a8e75SMaciej Fijalkowski 1043018a8e75SMaciej Fijalkowski usleep(10); 1044018a8e75SMaciej Fijalkowski return TEST_PASS; 1045018a8e75SMaciej Fijalkowski } 1046018a8e75SMaciej Fijalkowski 10473143d10bSShibin Koikkara Reeny return TEST_CONTINUE; 10483143d10bSShibin Koikkara Reeny } 10493143d10bSShibin Koikkara Reeny 1050018a8e75SMaciej Fijalkowski static void wait_for_tx_completion(struct xsk_socket_info *xsk) 1051018a8e75SMaciej Fijalkowski { 1052018a8e75SMaciej Fijalkowski while (xsk->outstanding_tx) 1053018a8e75SMaciej Fijalkowski complete_pkts(xsk, BATCH_SIZE); 1054018a8e75SMaciej Fijalkowski } 1055018a8e75SMaciej Fijalkowski 1056018a8e75SMaciej Fijalkowski static int send_pkts(struct test_spec *test, struct ifobject *ifobject) 1057018a8e75SMaciej Fijalkowski { 10583143d10bSShibin Koikkara Reeny bool timeout = !is_umem_valid(test->ifobj_rx); 1059018a8e75SMaciej Fijalkowski struct pollfd fds = { }; 10603143d10bSShibin Koikkara Reeny u32 pkt_cnt = 0, ret; 1061018a8e75SMaciej Fijalkowski 1062018a8e75SMaciej Fijalkowski fds.fd = xsk_socket__fd(ifobject->xsk->xsk); 1063018a8e75SMaciej Fijalkowski fds.events = POLLOUT; 1064018a8e75SMaciej Fijalkowski 1065018a8e75SMaciej Fijalkowski while (pkt_cnt < ifobject->pkt_stream->nb_pkts) { 10663143d10bSShibin Koikkara Reeny ret = __send_pkts(ifobject, &pkt_cnt, &fds, timeout); 10673143d10bSShibin Koikkara Reeny if ((ret || test->fail) && !timeout) 1068018a8e75SMaciej Fijalkowski return TEST_FAILURE; 10693143d10bSShibin Koikkara Reeny else if (ret == TEST_PASS && timeout) 10703143d10bSShibin Koikkara Reeny return ret; 1071018a8e75SMaciej Fijalkowski } 1072018a8e75SMaciej Fijalkowski 1073018a8e75SMaciej Fijalkowski wait_for_tx_completion(ifobject->xsk); 1074018a8e75SMaciej Fijalkowski return TEST_PASS; 1075018a8e75SMaciej Fijalkowski } 1076018a8e75SMaciej Fijalkowski 1077018a8e75SMaciej Fijalkowski static int get_xsk_stats(struct xsk_socket *xsk, struct xdp_statistics *stats) 1078018a8e75SMaciej Fijalkowski { 1079018a8e75SMaciej Fijalkowski int fd = xsk_socket__fd(xsk), err; 1080018a8e75SMaciej Fijalkowski socklen_t optlen, expected_len; 1081018a8e75SMaciej Fijalkowski 1082018a8e75SMaciej Fijalkowski optlen = sizeof(*stats); 1083018a8e75SMaciej Fijalkowski err = getsockopt(fd, SOL_XDP, XDP_STATISTICS, stats, &optlen); 1084018a8e75SMaciej Fijalkowski if (err) { 1085018a8e75SMaciej Fijalkowski ksft_print_msg("[%s] getsockopt(XDP_STATISTICS) error %u %s\n", 1086018a8e75SMaciej Fijalkowski __func__, -err, strerror(-err)); 1087018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1088018a8e75SMaciej Fijalkowski } 1089018a8e75SMaciej Fijalkowski 1090018a8e75SMaciej Fijalkowski expected_len = sizeof(struct xdp_statistics); 1091018a8e75SMaciej Fijalkowski if (optlen != expected_len) { 1092018a8e75SMaciej Fijalkowski ksft_print_msg("[%s] getsockopt optlen error. Expected: %u got: %u\n", 1093018a8e75SMaciej Fijalkowski __func__, expected_len, optlen); 1094018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1095018a8e75SMaciej Fijalkowski } 1096018a8e75SMaciej Fijalkowski 1097018a8e75SMaciej Fijalkowski return TEST_PASS; 1098018a8e75SMaciej Fijalkowski } 1099018a8e75SMaciej Fijalkowski 1100018a8e75SMaciej Fijalkowski static int validate_rx_dropped(struct ifobject *ifobject) 1101018a8e75SMaciej Fijalkowski { 1102018a8e75SMaciej Fijalkowski struct xsk_socket *xsk = ifobject->xsk->xsk; 1103018a8e75SMaciej Fijalkowski struct xdp_statistics stats; 1104018a8e75SMaciej Fijalkowski int err; 1105018a8e75SMaciej Fijalkowski 1106018a8e75SMaciej Fijalkowski kick_rx(ifobject->xsk); 1107018a8e75SMaciej Fijalkowski 1108018a8e75SMaciej Fijalkowski err = get_xsk_stats(xsk, &stats); 1109018a8e75SMaciej Fijalkowski if (err) 1110018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1111018a8e75SMaciej Fijalkowski 1112018a8e75SMaciej Fijalkowski if (stats.rx_dropped == ifobject->pkt_stream->nb_pkts / 2) 1113018a8e75SMaciej Fijalkowski return TEST_PASS; 1114018a8e75SMaciej Fijalkowski 1115018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1116018a8e75SMaciej Fijalkowski } 1117018a8e75SMaciej Fijalkowski 1118018a8e75SMaciej Fijalkowski static int validate_rx_full(struct ifobject *ifobject) 1119018a8e75SMaciej Fijalkowski { 1120018a8e75SMaciej Fijalkowski struct xsk_socket *xsk = ifobject->xsk->xsk; 1121018a8e75SMaciej Fijalkowski struct xdp_statistics stats; 1122018a8e75SMaciej Fijalkowski int err; 1123018a8e75SMaciej Fijalkowski 1124018a8e75SMaciej Fijalkowski usleep(1000); 1125018a8e75SMaciej Fijalkowski kick_rx(ifobject->xsk); 1126018a8e75SMaciej Fijalkowski 1127018a8e75SMaciej Fijalkowski err = get_xsk_stats(xsk, &stats); 1128018a8e75SMaciej Fijalkowski if (err) 1129018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1130018a8e75SMaciej Fijalkowski 1131018a8e75SMaciej Fijalkowski if (stats.rx_ring_full) 1132018a8e75SMaciej Fijalkowski return TEST_PASS; 1133018a8e75SMaciej Fijalkowski 1134018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1135018a8e75SMaciej Fijalkowski } 1136018a8e75SMaciej Fijalkowski 1137018a8e75SMaciej Fijalkowski static int validate_fill_empty(struct ifobject *ifobject) 1138018a8e75SMaciej Fijalkowski { 1139018a8e75SMaciej Fijalkowski struct xsk_socket *xsk = ifobject->xsk->xsk; 1140018a8e75SMaciej Fijalkowski struct xdp_statistics stats; 1141018a8e75SMaciej Fijalkowski int err; 1142018a8e75SMaciej Fijalkowski 1143018a8e75SMaciej Fijalkowski usleep(1000); 1144018a8e75SMaciej Fijalkowski kick_rx(ifobject->xsk); 1145018a8e75SMaciej Fijalkowski 1146018a8e75SMaciej Fijalkowski err = get_xsk_stats(xsk, &stats); 1147018a8e75SMaciej Fijalkowski if (err) 1148018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1149018a8e75SMaciej Fijalkowski 1150018a8e75SMaciej Fijalkowski if (stats.rx_fill_ring_empty_descs) 1151018a8e75SMaciej Fijalkowski return TEST_PASS; 1152018a8e75SMaciej Fijalkowski 1153018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1154018a8e75SMaciej Fijalkowski } 1155018a8e75SMaciej Fijalkowski 1156018a8e75SMaciej Fijalkowski static int validate_tx_invalid_descs(struct ifobject *ifobject) 1157018a8e75SMaciej Fijalkowski { 1158018a8e75SMaciej Fijalkowski struct xsk_socket *xsk = ifobject->xsk->xsk; 1159018a8e75SMaciej Fijalkowski int fd = xsk_socket__fd(xsk); 1160018a8e75SMaciej Fijalkowski struct xdp_statistics stats; 1161018a8e75SMaciej Fijalkowski socklen_t optlen; 1162018a8e75SMaciej Fijalkowski int err; 1163018a8e75SMaciej Fijalkowski 1164018a8e75SMaciej Fijalkowski optlen = sizeof(stats); 1165018a8e75SMaciej Fijalkowski err = getsockopt(fd, SOL_XDP, XDP_STATISTICS, &stats, &optlen); 1166018a8e75SMaciej Fijalkowski if (err) { 1167018a8e75SMaciej Fijalkowski ksft_print_msg("[%s] getsockopt(XDP_STATISTICS) error %u %s\n", 1168018a8e75SMaciej Fijalkowski __func__, -err, strerror(-err)); 1169018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1170018a8e75SMaciej Fijalkowski } 1171018a8e75SMaciej Fijalkowski 1172018a8e75SMaciej Fijalkowski if (stats.tx_invalid_descs != ifobject->pkt_stream->nb_pkts / 2) { 1173018a8e75SMaciej Fijalkowski ksft_print_msg("[%s] tx_invalid_descs incorrect. Got [%u] expected [%u]\n", 1174018a8e75SMaciej Fijalkowski __func__, stats.tx_invalid_descs, ifobject->pkt_stream->nb_pkts); 1175018a8e75SMaciej Fijalkowski return TEST_FAILURE; 1176018a8e75SMaciej Fijalkowski } 1177018a8e75SMaciej Fijalkowski 1178018a8e75SMaciej Fijalkowski return TEST_PASS; 1179018a8e75SMaciej Fijalkowski } 1180018a8e75SMaciej Fijalkowski 1181a693ff3eSMaciej Fijalkowski static void xsk_configure_socket(struct test_spec *test, struct ifobject *ifobject, 1182a693ff3eSMaciej Fijalkowski struct xsk_umem_info *umem, bool tx) 1183a693ff3eSMaciej Fijalkowski { 1184a693ff3eSMaciej Fijalkowski int i, ret; 1185a693ff3eSMaciej Fijalkowski 1186a693ff3eSMaciej Fijalkowski for (i = 0; i < test->nb_sockets; i++) { 1187a693ff3eSMaciej Fijalkowski bool shared = (ifobject->shared_umem && tx) ? true : !!i; 1188a693ff3eSMaciej Fijalkowski u32 ctr = 0; 1189a693ff3eSMaciej Fijalkowski 1190a693ff3eSMaciej Fijalkowski while (ctr++ < SOCK_RECONF_CTR) { 1191a693ff3eSMaciej Fijalkowski ret = __xsk_configure_socket(&ifobject->xsk_arr[i], umem, 1192a693ff3eSMaciej Fijalkowski ifobject, shared); 1193a693ff3eSMaciej Fijalkowski if (!ret) 1194a693ff3eSMaciej Fijalkowski break; 1195a693ff3eSMaciej Fijalkowski 1196a693ff3eSMaciej Fijalkowski /* Retry if it fails as xsk_socket__create() is asynchronous */ 1197a693ff3eSMaciej Fijalkowski if (ctr >= SOCK_RECONF_CTR) 1198a693ff3eSMaciej Fijalkowski exit_with_error(-ret); 1199a693ff3eSMaciej Fijalkowski usleep(USLEEP_MAX); 1200a693ff3eSMaciej Fijalkowski } 1201a693ff3eSMaciej Fijalkowski if (ifobject->busy_poll) 1202a693ff3eSMaciej Fijalkowski enable_busy_poll(&ifobject->xsk_arr[i]); 1203a693ff3eSMaciej Fijalkowski } 1204a693ff3eSMaciej Fijalkowski } 1205a693ff3eSMaciej Fijalkowski 1206a693ff3eSMaciej Fijalkowski static void thread_common_ops_tx(struct test_spec *test, struct ifobject *ifobject) 1207a693ff3eSMaciej Fijalkowski { 1208a693ff3eSMaciej Fijalkowski xsk_configure_socket(test, ifobject, test->ifobj_rx->umem, true); 1209a693ff3eSMaciej Fijalkowski ifobject->xsk = &ifobject->xsk_arr[0]; 1210f0a249dfSMagnus Karlsson ifobject->xskmap = test->ifobj_rx->xskmap; 1211a693ff3eSMaciej Fijalkowski memcpy(ifobject->umem, test->ifobj_rx->umem, sizeof(struct xsk_umem_info)); 1212a693ff3eSMaciej Fijalkowski } 1213a693ff3eSMaciej Fijalkowski 1214a693ff3eSMaciej Fijalkowski static void xsk_populate_fill_ring(struct xsk_umem_info *umem, struct pkt_stream *pkt_stream) 1215a693ff3eSMaciej Fijalkowski { 1216a693ff3eSMaciej Fijalkowski u32 idx = 0, i, buffers_to_fill; 1217a693ff3eSMaciej Fijalkowski int ret; 1218a693ff3eSMaciej Fijalkowski 1219a693ff3eSMaciej Fijalkowski if (umem->num_frames < XSK_RING_PROD__DEFAULT_NUM_DESCS) 1220a693ff3eSMaciej Fijalkowski buffers_to_fill = umem->num_frames; 1221a693ff3eSMaciej Fijalkowski else 1222a693ff3eSMaciej Fijalkowski buffers_to_fill = XSK_RING_PROD__DEFAULT_NUM_DESCS; 1223a693ff3eSMaciej Fijalkowski 1224a693ff3eSMaciej Fijalkowski ret = xsk_ring_prod__reserve(&umem->fq, buffers_to_fill, &idx); 1225a693ff3eSMaciej Fijalkowski if (ret != buffers_to_fill) 1226a693ff3eSMaciej Fijalkowski exit_with_error(ENOSPC); 1227a693ff3eSMaciej Fijalkowski for (i = 0; i < buffers_to_fill; i++) { 1228a693ff3eSMaciej Fijalkowski u64 addr; 1229a693ff3eSMaciej Fijalkowski 1230a693ff3eSMaciej Fijalkowski if (pkt_stream->use_addr_for_fill) { 1231a693ff3eSMaciej Fijalkowski struct pkt *pkt = pkt_stream_get_pkt(pkt_stream, i); 1232a693ff3eSMaciej Fijalkowski 1233a693ff3eSMaciej Fijalkowski if (!pkt) 1234a693ff3eSMaciej Fijalkowski break; 1235a693ff3eSMaciej Fijalkowski addr = pkt->addr; 1236a693ff3eSMaciej Fijalkowski } else { 1237a693ff3eSMaciej Fijalkowski addr = i * umem->frame_size; 1238a693ff3eSMaciej Fijalkowski } 1239a693ff3eSMaciej Fijalkowski 1240a693ff3eSMaciej Fijalkowski *xsk_ring_prod__fill_addr(&umem->fq, idx++) = addr; 1241a693ff3eSMaciej Fijalkowski } 12421e04f23bSMagnus Karlsson xsk_ring_prod__submit(&umem->fq, i); 1243a693ff3eSMaciej Fijalkowski } 1244a693ff3eSMaciej Fijalkowski 1245018a8e75SMaciej Fijalkowski static void thread_common_ops(struct test_spec *test, struct ifobject *ifobject) 1246018a8e75SMaciej Fijalkowski { 1247018a8e75SMaciej Fijalkowski u64 umem_sz = ifobject->umem->num_frames * ifobject->umem->frame_size; 1248018a8e75SMaciej Fijalkowski int mmap_flags = MAP_PRIVATE | MAP_ANONYMOUS | MAP_NORESERVE; 1249018a8e75SMaciej Fijalkowski LIBBPF_OPTS(bpf_xdp_query_opts, opts); 1250018a8e75SMaciej Fijalkowski void *bufs; 1251f0a249dfSMagnus Karlsson int ret; 1252018a8e75SMaciej Fijalkowski 1253018a8e75SMaciej Fijalkowski if (ifobject->umem->unaligned_mode) 1254018a8e75SMaciej Fijalkowski mmap_flags |= MAP_HUGETLB; 1255018a8e75SMaciej Fijalkowski 1256a693ff3eSMaciej Fijalkowski if (ifobject->shared_umem) 1257a693ff3eSMaciej Fijalkowski umem_sz *= 2; 1258a693ff3eSMaciej Fijalkowski 1259018a8e75SMaciej Fijalkowski bufs = mmap(NULL, umem_sz, PROT_READ | PROT_WRITE, mmap_flags, -1, 0); 1260018a8e75SMaciej Fijalkowski if (bufs == MAP_FAILED) 1261018a8e75SMaciej Fijalkowski exit_with_error(errno); 1262018a8e75SMaciej Fijalkowski 1263018a8e75SMaciej Fijalkowski ret = xsk_configure_umem(ifobject->umem, bufs, umem_sz); 1264018a8e75SMaciej Fijalkowski if (ret) 1265018a8e75SMaciej Fijalkowski exit_with_error(-ret); 1266018a8e75SMaciej Fijalkowski 1267a693ff3eSMaciej Fijalkowski xsk_populate_fill_ring(ifobject->umem, ifobject->pkt_stream); 1268018a8e75SMaciej Fijalkowski 1269a693ff3eSMaciej Fijalkowski xsk_configure_socket(test, ifobject, ifobject->umem, false); 1270018a8e75SMaciej Fijalkowski 1271018a8e75SMaciej Fijalkowski ifobject->xsk = &ifobject->xsk_arr[0]; 1272018a8e75SMaciej Fijalkowski 1273018a8e75SMaciej Fijalkowski if (!ifobject->rx_on) 1274018a8e75SMaciej Fijalkowski return; 1275018a8e75SMaciej Fijalkowski 1276f0a249dfSMagnus Karlsson ret = xsk_update_xskmap(ifobject->xskmap, ifobject->xsk->xsk); 1277018a8e75SMaciej Fijalkowski if (ret) 1278085dcccfSMagnus Karlsson exit_with_error(errno); 1279018a8e75SMaciej Fijalkowski } 1280018a8e75SMaciej Fijalkowski 1281018a8e75SMaciej Fijalkowski static void *worker_testapp_validate_tx(void *arg) 1282018a8e75SMaciej Fijalkowski { 1283018a8e75SMaciej Fijalkowski struct test_spec *test = (struct test_spec *)arg; 1284018a8e75SMaciej Fijalkowski struct ifobject *ifobject = test->ifobj_tx; 1285018a8e75SMaciej Fijalkowski int err; 1286018a8e75SMaciej Fijalkowski 1287a693ff3eSMaciej Fijalkowski if (test->current_step == 1) { 1288a693ff3eSMaciej Fijalkowski if (!ifobject->shared_umem) 1289018a8e75SMaciej Fijalkowski thread_common_ops(test, ifobject); 1290a693ff3eSMaciej Fijalkowski else 1291a693ff3eSMaciej Fijalkowski thread_common_ops_tx(test, ifobject); 1292a693ff3eSMaciej Fijalkowski } 1293018a8e75SMaciej Fijalkowski 1294018a8e75SMaciej Fijalkowski print_verbose("Sending %d packets on interface %s\n", ifobject->pkt_stream->nb_pkts, 1295018a8e75SMaciej Fijalkowski ifobject->ifname); 1296018a8e75SMaciej Fijalkowski err = send_pkts(test, ifobject); 1297018a8e75SMaciej Fijalkowski 1298018a8e75SMaciej Fijalkowski if (!err && ifobject->validation_func) 1299018a8e75SMaciej Fijalkowski err = ifobject->validation_func(ifobject); 1300018a8e75SMaciej Fijalkowski if (err) 1301018a8e75SMaciej Fijalkowski report_failure(test); 1302018a8e75SMaciej Fijalkowski 1303018a8e75SMaciej Fijalkowski pthread_exit(NULL); 1304018a8e75SMaciej Fijalkowski } 1305018a8e75SMaciej Fijalkowski 1306018a8e75SMaciej Fijalkowski static void *worker_testapp_validate_rx(void *arg) 1307018a8e75SMaciej Fijalkowski { 1308018a8e75SMaciej Fijalkowski struct test_spec *test = (struct test_spec *)arg; 1309018a8e75SMaciej Fijalkowski struct ifobject *ifobject = test->ifobj_rx; 1310018a8e75SMaciej Fijalkowski struct pollfd fds = { }; 1311f0a249dfSMagnus Karlsson int err; 1312018a8e75SMaciej Fijalkowski 1313a693ff3eSMaciej Fijalkowski if (test->current_step == 1) { 1314018a8e75SMaciej Fijalkowski thread_common_ops(test, ifobject); 1315a693ff3eSMaciej Fijalkowski } else { 1316f0a249dfSMagnus Karlsson xsk_clear_xskmap(ifobject->xskmap); 1317f0a249dfSMagnus Karlsson err = xsk_update_xskmap(ifobject->xskmap, ifobject->xsk->xsk); 1318aa61d81fSMagnus Karlsson if (err) { 1319f0a249dfSMagnus Karlsson printf("Error: Failed to update xskmap, error %s\n", strerror(-err)); 1320f0a249dfSMagnus Karlsson exit_with_error(-err); 1321aa61d81fSMagnus Karlsson } 1322a693ff3eSMaciej Fijalkowski } 1323018a8e75SMaciej Fijalkowski 1324018a8e75SMaciej Fijalkowski fds.fd = xsk_socket__fd(ifobject->xsk->xsk); 1325018a8e75SMaciej Fijalkowski fds.events = POLLIN; 1326018a8e75SMaciej Fijalkowski 1327018a8e75SMaciej Fijalkowski pthread_barrier_wait(&barr); 1328018a8e75SMaciej Fijalkowski 13293143d10bSShibin Koikkara Reeny err = receive_pkts(test, &fds); 1330018a8e75SMaciej Fijalkowski 1331018a8e75SMaciej Fijalkowski if (!err && ifobject->validation_func) 1332018a8e75SMaciej Fijalkowski err = ifobject->validation_func(ifobject); 1333018a8e75SMaciej Fijalkowski if (err) { 1334018a8e75SMaciej Fijalkowski report_failure(test); 1335018a8e75SMaciej Fijalkowski pthread_mutex_lock(&pacing_mutex); 1336018a8e75SMaciej Fijalkowski pthread_cond_signal(&pacing_cond); 1337018a8e75SMaciej Fijalkowski pthread_mutex_unlock(&pacing_mutex); 1338018a8e75SMaciej Fijalkowski } 1339018a8e75SMaciej Fijalkowski 1340018a8e75SMaciej Fijalkowski pthread_exit(NULL); 1341018a8e75SMaciej Fijalkowski } 1342018a8e75SMaciej Fijalkowski 1343a693ff3eSMaciej Fijalkowski static void testapp_clean_xsk_umem(struct ifobject *ifobj) 1344a693ff3eSMaciej Fijalkowski { 1345a693ff3eSMaciej Fijalkowski u64 umem_sz = ifobj->umem->num_frames * ifobj->umem->frame_size; 1346a693ff3eSMaciej Fijalkowski 1347a693ff3eSMaciej Fijalkowski if (ifobj->shared_umem) 1348a693ff3eSMaciej Fijalkowski umem_sz *= 2; 1349a693ff3eSMaciej Fijalkowski 1350a693ff3eSMaciej Fijalkowski xsk_umem__delete(ifobj->umem->umem); 1351a693ff3eSMaciej Fijalkowski munmap(ifobj->umem->buffer, umem_sz); 1352a693ff3eSMaciej Fijalkowski } 1353a693ff3eSMaciej Fijalkowski 1354c29fe883SMaciej Fijalkowski static void handler(int signum) 1355c29fe883SMaciej Fijalkowski { 1356c29fe883SMaciej Fijalkowski pthread_exit(NULL); 1357c29fe883SMaciej Fijalkowski } 1358c29fe883SMaciej Fijalkowski 13593143d10bSShibin Koikkara Reeny static int testapp_validate_traffic_single_thread(struct test_spec *test, struct ifobject *ifobj, 13603143d10bSShibin Koikkara Reeny enum test_type type) 13613143d10bSShibin Koikkara Reeny { 1362a693ff3eSMaciej Fijalkowski bool old_shared_umem = ifobj->shared_umem; 13633143d10bSShibin Koikkara Reeny pthread_t t0; 13643143d10bSShibin Koikkara Reeny 13653143d10bSShibin Koikkara Reeny if (pthread_barrier_init(&barr, NULL, 2)) 13663143d10bSShibin Koikkara Reeny exit_with_error(errno); 13673143d10bSShibin Koikkara Reeny 13683143d10bSShibin Koikkara Reeny test->current_step++; 13693143d10bSShibin Koikkara Reeny if (type == TEST_TYPE_POLL_RXQ_TMOUT) 13703143d10bSShibin Koikkara Reeny pkt_stream_reset(ifobj->pkt_stream); 13713143d10bSShibin Koikkara Reeny pkts_in_flight = 0; 13723143d10bSShibin Koikkara Reeny 1373a693ff3eSMaciej Fijalkowski test->ifobj_rx->shared_umem = false; 1374a693ff3eSMaciej Fijalkowski test->ifobj_tx->shared_umem = false; 1375a693ff3eSMaciej Fijalkowski 1376c29fe883SMaciej Fijalkowski signal(SIGUSR1, handler); 13773143d10bSShibin Koikkara Reeny /* Spawn thread */ 13783143d10bSShibin Koikkara Reeny pthread_create(&t0, NULL, ifobj->func_ptr, test); 13793143d10bSShibin Koikkara Reeny 13803143d10bSShibin Koikkara Reeny if (type != TEST_TYPE_POLL_TXQ_TMOUT) 13813143d10bSShibin Koikkara Reeny pthread_barrier_wait(&barr); 13823143d10bSShibin Koikkara Reeny 13833143d10bSShibin Koikkara Reeny if (pthread_barrier_destroy(&barr)) 13843143d10bSShibin Koikkara Reeny exit_with_error(errno); 13853143d10bSShibin Koikkara Reeny 1386c29fe883SMaciej Fijalkowski pthread_kill(t0, SIGUSR1); 13873143d10bSShibin Koikkara Reeny pthread_join(t0, NULL); 13883143d10bSShibin Koikkara Reeny 1389a693ff3eSMaciej Fijalkowski if (test->total_steps == test->current_step || test->fail) { 1390a693ff3eSMaciej Fijalkowski xsk_socket__delete(ifobj->xsk->xsk); 1391f0a249dfSMagnus Karlsson xsk_clear_xskmap(ifobj->xskmap); 1392a693ff3eSMaciej Fijalkowski testapp_clean_xsk_umem(ifobj); 1393a693ff3eSMaciej Fijalkowski } 1394a693ff3eSMaciej Fijalkowski 1395a693ff3eSMaciej Fijalkowski test->ifobj_rx->shared_umem = old_shared_umem; 1396a693ff3eSMaciej Fijalkowski test->ifobj_tx->shared_umem = old_shared_umem; 1397a693ff3eSMaciej Fijalkowski 13983143d10bSShibin Koikkara Reeny return !!test->fail; 13993143d10bSShibin Koikkara Reeny } 14003143d10bSShibin Koikkara Reeny 1401018a8e75SMaciej Fijalkowski static int testapp_validate_traffic(struct test_spec *test) 1402018a8e75SMaciej Fijalkowski { 1403018a8e75SMaciej Fijalkowski struct ifobject *ifobj_tx = test->ifobj_tx; 1404018a8e75SMaciej Fijalkowski struct ifobject *ifobj_rx = test->ifobj_rx; 1405018a8e75SMaciej Fijalkowski pthread_t t0, t1; 1406018a8e75SMaciej Fijalkowski 1407018a8e75SMaciej Fijalkowski if (pthread_barrier_init(&barr, NULL, 2)) 1408018a8e75SMaciej Fijalkowski exit_with_error(errno); 1409018a8e75SMaciej Fijalkowski 1410018a8e75SMaciej Fijalkowski test->current_step++; 1411018a8e75SMaciej Fijalkowski pkt_stream_reset(ifobj_rx->pkt_stream); 1412018a8e75SMaciej Fijalkowski pkts_in_flight = 0; 1413018a8e75SMaciej Fijalkowski 1414018a8e75SMaciej Fijalkowski /*Spawn RX thread */ 1415018a8e75SMaciej Fijalkowski pthread_create(&t0, NULL, ifobj_rx->func_ptr, test); 1416018a8e75SMaciej Fijalkowski 1417018a8e75SMaciej Fijalkowski pthread_barrier_wait(&barr); 1418018a8e75SMaciej Fijalkowski if (pthread_barrier_destroy(&barr)) 1419018a8e75SMaciej Fijalkowski exit_with_error(errno); 1420018a8e75SMaciej Fijalkowski 1421018a8e75SMaciej Fijalkowski /*Spawn TX thread */ 1422018a8e75SMaciej Fijalkowski pthread_create(&t1, NULL, ifobj_tx->func_ptr, test); 1423018a8e75SMaciej Fijalkowski 1424018a8e75SMaciej Fijalkowski pthread_join(t1, NULL); 1425018a8e75SMaciej Fijalkowski pthread_join(t0, NULL); 1426018a8e75SMaciej Fijalkowski 1427a693ff3eSMaciej Fijalkowski if (test->total_steps == test->current_step || test->fail) { 1428a693ff3eSMaciej Fijalkowski xsk_socket__delete(ifobj_tx->xsk->xsk); 1429a693ff3eSMaciej Fijalkowski xsk_socket__delete(ifobj_rx->xsk->xsk); 1430a693ff3eSMaciej Fijalkowski testapp_clean_xsk_umem(ifobj_rx); 1431a693ff3eSMaciej Fijalkowski if (!ifobj_tx->shared_umem) 1432a693ff3eSMaciej Fijalkowski testapp_clean_xsk_umem(ifobj_tx); 1433a693ff3eSMaciej Fijalkowski } 1434a693ff3eSMaciej Fijalkowski 1435018a8e75SMaciej Fijalkowski return !!test->fail; 1436018a8e75SMaciej Fijalkowski } 1437018a8e75SMaciej Fijalkowski 1438018a8e75SMaciej Fijalkowski static void testapp_teardown(struct test_spec *test) 1439018a8e75SMaciej Fijalkowski { 1440018a8e75SMaciej Fijalkowski int i; 1441018a8e75SMaciej Fijalkowski 1442018a8e75SMaciej Fijalkowski test_spec_set_name(test, "TEARDOWN"); 1443018a8e75SMaciej Fijalkowski for (i = 0; i < MAX_TEARDOWN_ITER; i++) { 1444018a8e75SMaciej Fijalkowski if (testapp_validate_traffic(test)) 1445018a8e75SMaciej Fijalkowski return; 1446018a8e75SMaciej Fijalkowski test_spec_reset(test); 1447018a8e75SMaciej Fijalkowski } 1448018a8e75SMaciej Fijalkowski } 1449018a8e75SMaciej Fijalkowski 1450018a8e75SMaciej Fijalkowski static void swap_directions(struct ifobject **ifobj1, struct ifobject **ifobj2) 1451018a8e75SMaciej Fijalkowski { 1452018a8e75SMaciej Fijalkowski thread_func_t tmp_func_ptr = (*ifobj1)->func_ptr; 1453018a8e75SMaciej Fijalkowski struct ifobject *tmp_ifobj = (*ifobj1); 1454018a8e75SMaciej Fijalkowski 1455018a8e75SMaciej Fijalkowski (*ifobj1)->func_ptr = (*ifobj2)->func_ptr; 1456018a8e75SMaciej Fijalkowski (*ifobj2)->func_ptr = tmp_func_ptr; 1457018a8e75SMaciej Fijalkowski 1458018a8e75SMaciej Fijalkowski *ifobj1 = *ifobj2; 1459018a8e75SMaciej Fijalkowski *ifobj2 = tmp_ifobj; 1460018a8e75SMaciej Fijalkowski } 1461018a8e75SMaciej Fijalkowski 1462018a8e75SMaciej Fijalkowski static void testapp_bidi(struct test_spec *test) 1463018a8e75SMaciej Fijalkowski { 1464018a8e75SMaciej Fijalkowski test_spec_set_name(test, "BIDIRECTIONAL"); 1465018a8e75SMaciej Fijalkowski test->ifobj_tx->rx_on = true; 1466018a8e75SMaciej Fijalkowski test->ifobj_rx->tx_on = true; 1467018a8e75SMaciej Fijalkowski test->total_steps = 2; 1468018a8e75SMaciej Fijalkowski if (testapp_validate_traffic(test)) 1469018a8e75SMaciej Fijalkowski return; 1470018a8e75SMaciej Fijalkowski 1471018a8e75SMaciej Fijalkowski print_verbose("Switching Tx/Rx vectors\n"); 1472018a8e75SMaciej Fijalkowski swap_directions(&test->ifobj_rx, &test->ifobj_tx); 1473018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1474018a8e75SMaciej Fijalkowski 1475018a8e75SMaciej Fijalkowski swap_directions(&test->ifobj_rx, &test->ifobj_tx); 1476018a8e75SMaciej Fijalkowski } 1477018a8e75SMaciej Fijalkowski 1478018a8e75SMaciej Fijalkowski static void swap_xsk_resources(struct ifobject *ifobj_tx, struct ifobject *ifobj_rx) 1479018a8e75SMaciej Fijalkowski { 1480f0a249dfSMagnus Karlsson int ret; 1481018a8e75SMaciej Fijalkowski 1482018a8e75SMaciej Fijalkowski xsk_socket__delete(ifobj_tx->xsk->xsk); 1483018a8e75SMaciej Fijalkowski xsk_socket__delete(ifobj_rx->xsk->xsk); 1484018a8e75SMaciej Fijalkowski ifobj_tx->xsk = &ifobj_tx->xsk_arr[1]; 1485018a8e75SMaciej Fijalkowski ifobj_rx->xsk = &ifobj_rx->xsk_arr[1]; 1486018a8e75SMaciej Fijalkowski 1487f0a249dfSMagnus Karlsson ret = xsk_update_xskmap(ifobj_rx->xskmap, ifobj_rx->xsk->xsk); 1488018a8e75SMaciej Fijalkowski if (ret) 1489085dcccfSMagnus Karlsson exit_with_error(errno); 1490018a8e75SMaciej Fijalkowski } 1491018a8e75SMaciej Fijalkowski 1492018a8e75SMaciej Fijalkowski static void testapp_bpf_res(struct test_spec *test) 1493018a8e75SMaciej Fijalkowski { 1494018a8e75SMaciej Fijalkowski test_spec_set_name(test, "BPF_RES"); 1495018a8e75SMaciej Fijalkowski test->total_steps = 2; 1496018a8e75SMaciej Fijalkowski test->nb_sockets = 2; 1497018a8e75SMaciej Fijalkowski if (testapp_validate_traffic(test)) 1498018a8e75SMaciej Fijalkowski return; 1499018a8e75SMaciej Fijalkowski 1500018a8e75SMaciej Fijalkowski swap_xsk_resources(test->ifobj_tx, test->ifobj_rx); 1501018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1502018a8e75SMaciej Fijalkowski } 1503018a8e75SMaciej Fijalkowski 1504018a8e75SMaciej Fijalkowski static void testapp_headroom(struct test_spec *test) 1505018a8e75SMaciej Fijalkowski { 1506018a8e75SMaciej Fijalkowski test_spec_set_name(test, "UMEM_HEADROOM"); 1507018a8e75SMaciej Fijalkowski test->ifobj_rx->umem->frame_headroom = UMEM_HEADROOM_TEST_SIZE; 1508018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1509018a8e75SMaciej Fijalkowski } 1510018a8e75SMaciej Fijalkowski 1511018a8e75SMaciej Fijalkowski static void testapp_stats_rx_dropped(struct test_spec *test) 1512018a8e75SMaciej Fijalkowski { 1513018a8e75SMaciej Fijalkowski test_spec_set_name(test, "STAT_RX_DROPPED"); 1514a693ff3eSMaciej Fijalkowski pkt_stream_replace_half(test, MIN_PKT_SIZE * 4, 0); 1515018a8e75SMaciej Fijalkowski test->ifobj_rx->umem->frame_headroom = test->ifobj_rx->umem->frame_size - 1516018a8e75SMaciej Fijalkowski XDP_PACKET_HEADROOM - MIN_PKT_SIZE * 3; 1517018a8e75SMaciej Fijalkowski pkt_stream_receive_half(test); 1518018a8e75SMaciej Fijalkowski test->ifobj_rx->validation_func = validate_rx_dropped; 1519018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1520018a8e75SMaciej Fijalkowski } 1521018a8e75SMaciej Fijalkowski 1522018a8e75SMaciej Fijalkowski static void testapp_stats_tx_invalid_descs(struct test_spec *test) 1523018a8e75SMaciej Fijalkowski { 1524018a8e75SMaciej Fijalkowski test_spec_set_name(test, "STAT_TX_INVALID"); 1525018a8e75SMaciej Fijalkowski pkt_stream_replace_half(test, XSK_UMEM__INVALID_FRAME_SIZE, 0); 1526018a8e75SMaciej Fijalkowski test->ifobj_tx->validation_func = validate_tx_invalid_descs; 1527018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1528018a8e75SMaciej Fijalkowski 1529018a8e75SMaciej Fijalkowski pkt_stream_restore_default(test); 1530018a8e75SMaciej Fijalkowski } 1531018a8e75SMaciej Fijalkowski 1532018a8e75SMaciej Fijalkowski static void testapp_stats_rx_full(struct test_spec *test) 1533018a8e75SMaciej Fijalkowski { 1534018a8e75SMaciej Fijalkowski test_spec_set_name(test, "STAT_RX_FULL"); 1535018a8e75SMaciej Fijalkowski pkt_stream_replace(test, DEFAULT_UMEM_BUFFERS + DEFAULT_UMEM_BUFFERS / 2, PKT_SIZE); 1536018a8e75SMaciej Fijalkowski test->ifobj_rx->pkt_stream = pkt_stream_generate(test->ifobj_rx->umem, 1537018a8e75SMaciej Fijalkowski DEFAULT_UMEM_BUFFERS, PKT_SIZE); 1538018a8e75SMaciej Fijalkowski if (!test->ifobj_rx->pkt_stream) 1539018a8e75SMaciej Fijalkowski exit_with_error(ENOMEM); 1540018a8e75SMaciej Fijalkowski 1541018a8e75SMaciej Fijalkowski test->ifobj_rx->xsk->rxqsize = DEFAULT_UMEM_BUFFERS; 1542018a8e75SMaciej Fijalkowski test->ifobj_rx->release_rx = false; 1543018a8e75SMaciej Fijalkowski test->ifobj_rx->validation_func = validate_rx_full; 1544018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1545018a8e75SMaciej Fijalkowski 1546018a8e75SMaciej Fijalkowski pkt_stream_restore_default(test); 1547018a8e75SMaciej Fijalkowski } 1548018a8e75SMaciej Fijalkowski 1549018a8e75SMaciej Fijalkowski static void testapp_stats_fill_empty(struct test_spec *test) 1550018a8e75SMaciej Fijalkowski { 1551018a8e75SMaciej Fijalkowski test_spec_set_name(test, "STAT_RX_FILL_EMPTY"); 1552018a8e75SMaciej Fijalkowski pkt_stream_replace(test, DEFAULT_UMEM_BUFFERS + DEFAULT_UMEM_BUFFERS / 2, PKT_SIZE); 1553018a8e75SMaciej Fijalkowski test->ifobj_rx->pkt_stream = pkt_stream_generate(test->ifobj_rx->umem, 1554018a8e75SMaciej Fijalkowski DEFAULT_UMEM_BUFFERS, PKT_SIZE); 1555018a8e75SMaciej Fijalkowski if (!test->ifobj_rx->pkt_stream) 1556018a8e75SMaciej Fijalkowski exit_with_error(ENOMEM); 1557018a8e75SMaciej Fijalkowski 1558018a8e75SMaciej Fijalkowski test->ifobj_rx->use_fill_ring = false; 1559018a8e75SMaciej Fijalkowski test->ifobj_rx->validation_func = validate_fill_empty; 1560018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1561018a8e75SMaciej Fijalkowski 1562018a8e75SMaciej Fijalkowski pkt_stream_restore_default(test); 1563018a8e75SMaciej Fijalkowski } 1564018a8e75SMaciej Fijalkowski 1565018a8e75SMaciej Fijalkowski /* Simple test */ 1566018a8e75SMaciej Fijalkowski static bool hugepages_present(struct ifobject *ifobject) 1567018a8e75SMaciej Fijalkowski { 1568018a8e75SMaciej Fijalkowski const size_t mmap_sz = 2 * ifobject->umem->num_frames * ifobject->umem->frame_size; 1569018a8e75SMaciej Fijalkowski void *bufs; 1570018a8e75SMaciej Fijalkowski 1571018a8e75SMaciej Fijalkowski bufs = mmap(NULL, mmap_sz, PROT_READ | PROT_WRITE, 1572018a8e75SMaciej Fijalkowski MAP_PRIVATE | MAP_ANONYMOUS | MAP_HUGETLB, -1, 0); 1573018a8e75SMaciej Fijalkowski if (bufs == MAP_FAILED) 1574018a8e75SMaciej Fijalkowski return false; 1575018a8e75SMaciej Fijalkowski 1576018a8e75SMaciej Fijalkowski munmap(bufs, mmap_sz); 1577018a8e75SMaciej Fijalkowski return true; 1578018a8e75SMaciej Fijalkowski } 1579018a8e75SMaciej Fijalkowski 1580018a8e75SMaciej Fijalkowski static bool testapp_unaligned(struct test_spec *test) 1581018a8e75SMaciej Fijalkowski { 1582018a8e75SMaciej Fijalkowski if (!hugepages_present(test->ifobj_tx)) { 1583018a8e75SMaciej Fijalkowski ksft_test_result_skip("No 2M huge pages present.\n"); 1584018a8e75SMaciej Fijalkowski return false; 1585018a8e75SMaciej Fijalkowski } 1586018a8e75SMaciej Fijalkowski 1587018a8e75SMaciej Fijalkowski test_spec_set_name(test, "UNALIGNED_MODE"); 1588018a8e75SMaciej Fijalkowski test->ifobj_tx->umem->unaligned_mode = true; 1589018a8e75SMaciej Fijalkowski test->ifobj_rx->umem->unaligned_mode = true; 1590018a8e75SMaciej Fijalkowski /* Let half of the packets straddle a buffer boundrary */ 1591018a8e75SMaciej Fijalkowski pkt_stream_replace_half(test, PKT_SIZE, -PKT_SIZE / 2); 1592018a8e75SMaciej Fijalkowski test->ifobj_rx->pkt_stream->use_addr_for_fill = true; 1593018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1594018a8e75SMaciej Fijalkowski 1595018a8e75SMaciej Fijalkowski pkt_stream_restore_default(test); 1596018a8e75SMaciej Fijalkowski return true; 1597018a8e75SMaciej Fijalkowski } 1598018a8e75SMaciej Fijalkowski 1599018a8e75SMaciej Fijalkowski static void testapp_single_pkt(struct test_spec *test) 1600018a8e75SMaciej Fijalkowski { 1601018a8e75SMaciej Fijalkowski struct pkt pkts[] = {{0x1000, PKT_SIZE, 0, true}}; 1602018a8e75SMaciej Fijalkowski 1603018a8e75SMaciej Fijalkowski pkt_stream_generate_custom(test, pkts, ARRAY_SIZE(pkts)); 1604018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1605018a8e75SMaciej Fijalkowski pkt_stream_restore_default(test); 1606018a8e75SMaciej Fijalkowski } 1607018a8e75SMaciej Fijalkowski 1608018a8e75SMaciej Fijalkowski static void testapp_invalid_desc(struct test_spec *test) 1609018a8e75SMaciej Fijalkowski { 1610018a8e75SMaciej Fijalkowski struct pkt pkts[] = { 1611018a8e75SMaciej Fijalkowski /* Zero packet address allowed */ 1612018a8e75SMaciej Fijalkowski {0, PKT_SIZE, 0, true}, 1613018a8e75SMaciej Fijalkowski /* Allowed packet */ 1614018a8e75SMaciej Fijalkowski {0x1000, PKT_SIZE, 0, true}, 1615018a8e75SMaciej Fijalkowski /* Straddling the start of umem */ 1616018a8e75SMaciej Fijalkowski {-2, PKT_SIZE, 0, false}, 1617018a8e75SMaciej Fijalkowski /* Packet too large */ 1618018a8e75SMaciej Fijalkowski {0x2000, XSK_UMEM__INVALID_FRAME_SIZE, 0, false}, 1619018a8e75SMaciej Fijalkowski /* After umem ends */ 1620018a8e75SMaciej Fijalkowski {UMEM_SIZE, PKT_SIZE, 0, false}, 1621018a8e75SMaciej Fijalkowski /* Straddle the end of umem */ 1622018a8e75SMaciej Fijalkowski {UMEM_SIZE - PKT_SIZE / 2, PKT_SIZE, 0, false}, 1623018a8e75SMaciej Fijalkowski /* Straddle a page boundrary */ 1624018a8e75SMaciej Fijalkowski {0x3000 - PKT_SIZE / 2, PKT_SIZE, 0, false}, 1625018a8e75SMaciej Fijalkowski /* Straddle a 2K boundrary */ 1626018a8e75SMaciej Fijalkowski {0x3800 - PKT_SIZE / 2, PKT_SIZE, 0, true}, 1627018a8e75SMaciej Fijalkowski /* Valid packet for synch so that something is received */ 1628018a8e75SMaciej Fijalkowski {0x4000, PKT_SIZE, 0, true}}; 1629018a8e75SMaciej Fijalkowski 1630018a8e75SMaciej Fijalkowski if (test->ifobj_tx->umem->unaligned_mode) { 1631018a8e75SMaciej Fijalkowski /* Crossing a page boundrary allowed */ 1632018a8e75SMaciej Fijalkowski pkts[6].valid = true; 1633018a8e75SMaciej Fijalkowski } 1634018a8e75SMaciej Fijalkowski if (test->ifobj_tx->umem->frame_size == XSK_UMEM__DEFAULT_FRAME_SIZE / 2) { 1635018a8e75SMaciej Fijalkowski /* Crossing a 2K frame size boundrary not allowed */ 1636018a8e75SMaciej Fijalkowski pkts[7].valid = false; 1637018a8e75SMaciej Fijalkowski } 1638018a8e75SMaciej Fijalkowski 1639a693ff3eSMaciej Fijalkowski if (test->ifobj_tx->shared_umem) { 1640a693ff3eSMaciej Fijalkowski pkts[4].addr += UMEM_SIZE; 1641a693ff3eSMaciej Fijalkowski pkts[5].addr += UMEM_SIZE; 1642a693ff3eSMaciej Fijalkowski } 1643a693ff3eSMaciej Fijalkowski 1644018a8e75SMaciej Fijalkowski pkt_stream_generate_custom(test, pkts, ARRAY_SIZE(pkts)); 1645018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1646018a8e75SMaciej Fijalkowski pkt_stream_restore_default(test); 1647018a8e75SMaciej Fijalkowski } 1648018a8e75SMaciej Fijalkowski 1649*80bea9acSMagnus Karlsson static void testapp_xdp_drop(struct test_spec *test) 1650*80bea9acSMagnus Karlsson { 1651*80bea9acSMagnus Karlsson struct ifobject *ifobj = test->ifobj_rx; 1652*80bea9acSMagnus Karlsson int err; 1653*80bea9acSMagnus Karlsson 1654*80bea9acSMagnus Karlsson test_spec_set_name(test, "XDP_DROP_HALF"); 1655*80bea9acSMagnus Karlsson xsk_detach_xdp_program(ifobj->ifindex, ifobj->xdp_flags); 1656*80bea9acSMagnus Karlsson err = xsk_attach_xdp_program(ifobj->xdp_progs->progs.xsk_xdp_drop, ifobj->ifindex, 1657*80bea9acSMagnus Karlsson ifobj->xdp_flags); 1658*80bea9acSMagnus Karlsson if (err) { 1659*80bea9acSMagnus Karlsson printf("Error attaching XDP_DROP program\n"); 1660*80bea9acSMagnus Karlsson test->fail = true; 1661*80bea9acSMagnus Karlsson return; 1662*80bea9acSMagnus Karlsson } 1663*80bea9acSMagnus Karlsson 1664*80bea9acSMagnus Karlsson pkt_stream_receive_half(test); 1665*80bea9acSMagnus Karlsson testapp_validate_traffic(test); 1666*80bea9acSMagnus Karlsson 1667*80bea9acSMagnus Karlsson pkt_stream_restore_default(test); 1668*80bea9acSMagnus Karlsson xsk_detach_xdp_program(ifobj->ifindex, ifobj->xdp_flags); 1669*80bea9acSMagnus Karlsson err = xsk_attach_xdp_program(ifobj->xdp_progs->progs.xsk_def_prog, ifobj->ifindex, 1670*80bea9acSMagnus Karlsson ifobj->xdp_flags); 1671*80bea9acSMagnus Karlsson if (err) { 1672*80bea9acSMagnus Karlsson printf("Error restoring default XDP program\n"); 1673*80bea9acSMagnus Karlsson exit_with_error(-err); 1674*80bea9acSMagnus Karlsson } 1675*80bea9acSMagnus Karlsson } 1676*80bea9acSMagnus Karlsson 1677f0a249dfSMagnus Karlsson static int xsk_load_xdp_programs(struct ifobject *ifobj) 1678f0a249dfSMagnus Karlsson { 1679f0a249dfSMagnus Karlsson ifobj->xdp_progs = xsk_xdp_progs__open_and_load(); 1680f0a249dfSMagnus Karlsson if (libbpf_get_error(ifobj->xdp_progs)) 1681f0a249dfSMagnus Karlsson return libbpf_get_error(ifobj->xdp_progs); 1682f0a249dfSMagnus Karlsson 1683f0a249dfSMagnus Karlsson return 0; 1684f0a249dfSMagnus Karlsson } 1685f0a249dfSMagnus Karlsson 1686f0a249dfSMagnus Karlsson static void xsk_unload_xdp_programs(struct ifobject *ifobj) 1687f0a249dfSMagnus Karlsson { 1688f0a249dfSMagnus Karlsson xsk_xdp_progs__destroy(ifobj->xdp_progs); 1689f0a249dfSMagnus Karlsson } 1690f0a249dfSMagnus Karlsson 1691018a8e75SMaciej Fijalkowski static void init_iface(struct ifobject *ifobj, const char *dst_mac, const char *src_mac, 1692018a8e75SMaciej Fijalkowski const char *dst_ip, const char *src_ip, const u16 dst_port, 1693aa61d81fSMagnus Karlsson const u16 src_port, thread_func_t func_ptr, bool load_xdp) 1694018a8e75SMaciej Fijalkowski { 1695018a8e75SMaciej Fijalkowski struct in_addr ip; 1696f0a249dfSMagnus Karlsson int err; 1697018a8e75SMaciej Fijalkowski 1698018a8e75SMaciej Fijalkowski memcpy(ifobj->dst_mac, dst_mac, ETH_ALEN); 1699018a8e75SMaciej Fijalkowski memcpy(ifobj->src_mac, src_mac, ETH_ALEN); 1700018a8e75SMaciej Fijalkowski 1701018a8e75SMaciej Fijalkowski inet_aton(dst_ip, &ip); 1702018a8e75SMaciej Fijalkowski ifobj->dst_ip = ip.s_addr; 1703018a8e75SMaciej Fijalkowski 1704018a8e75SMaciej Fijalkowski inet_aton(src_ip, &ip); 1705018a8e75SMaciej Fijalkowski ifobj->src_ip = ip.s_addr; 1706018a8e75SMaciej Fijalkowski 1707018a8e75SMaciej Fijalkowski ifobj->dst_port = dst_port; 1708018a8e75SMaciej Fijalkowski ifobj->src_port = src_port; 1709018a8e75SMaciej Fijalkowski 1710018a8e75SMaciej Fijalkowski ifobj->func_ptr = func_ptr; 1711aa61d81fSMagnus Karlsson 1712aa61d81fSMagnus Karlsson if (!load_xdp) 1713aa61d81fSMagnus Karlsson return; 1714aa61d81fSMagnus Karlsson 1715f0a249dfSMagnus Karlsson err = xsk_load_xdp_programs(ifobj); 1716aa61d81fSMagnus Karlsson if (err) { 1717aa61d81fSMagnus Karlsson printf("Error loading XDP program\n"); 1718aa61d81fSMagnus Karlsson exit_with_error(err); 1719aa61d81fSMagnus Karlsson } 1720aa61d81fSMagnus Karlsson 1721aa61d81fSMagnus Karlsson ifobj->xdp_flags = mode_to_xdp_flags(TEST_MODE_SKB); 1722f0a249dfSMagnus Karlsson err = xsk_attach_xdp_program(ifobj->xdp_progs->progs.xsk_def_prog, ifobj->ifindex, 1723f0a249dfSMagnus Karlsson ifobj->xdp_flags); 1724f0a249dfSMagnus Karlsson if (err) { 1725aa61d81fSMagnus Karlsson printf("Error attaching XDP program\n"); 1726f0a249dfSMagnus Karlsson exit_with_error(-err); 1727aa61d81fSMagnus Karlsson } 1728f0a249dfSMagnus Karlsson ifobj->xskmap = ifobj->xdp_progs->maps.xsk; 1729018a8e75SMaciej Fijalkowski } 1730018a8e75SMaciej Fijalkowski 1731018a8e75SMaciej Fijalkowski static void run_pkt_test(struct test_spec *test, enum test_mode mode, enum test_type type) 1732018a8e75SMaciej Fijalkowski { 1733018a8e75SMaciej Fijalkowski switch (type) { 1734018a8e75SMaciej Fijalkowski case TEST_TYPE_STATS_RX_DROPPED: 1735fe2ad08eSMaciej Fijalkowski if (mode == TEST_MODE_ZC) { 1736fe2ad08eSMaciej Fijalkowski ksft_test_result_skip("Can not run RX_DROPPED test for ZC mode\n"); 1737fe2ad08eSMaciej Fijalkowski return; 1738fe2ad08eSMaciej Fijalkowski } 1739018a8e75SMaciej Fijalkowski testapp_stats_rx_dropped(test); 1740018a8e75SMaciej Fijalkowski break; 1741018a8e75SMaciej Fijalkowski case TEST_TYPE_STATS_TX_INVALID_DESCS: 1742018a8e75SMaciej Fijalkowski testapp_stats_tx_invalid_descs(test); 1743018a8e75SMaciej Fijalkowski break; 1744018a8e75SMaciej Fijalkowski case TEST_TYPE_STATS_RX_FULL: 1745018a8e75SMaciej Fijalkowski testapp_stats_rx_full(test); 1746018a8e75SMaciej Fijalkowski break; 1747018a8e75SMaciej Fijalkowski case TEST_TYPE_STATS_FILL_EMPTY: 1748018a8e75SMaciej Fijalkowski testapp_stats_fill_empty(test); 1749018a8e75SMaciej Fijalkowski break; 1750018a8e75SMaciej Fijalkowski case TEST_TYPE_TEARDOWN: 1751018a8e75SMaciej Fijalkowski testapp_teardown(test); 1752018a8e75SMaciej Fijalkowski break; 1753018a8e75SMaciej Fijalkowski case TEST_TYPE_BIDI: 1754018a8e75SMaciej Fijalkowski testapp_bidi(test); 1755018a8e75SMaciej Fijalkowski break; 1756018a8e75SMaciej Fijalkowski case TEST_TYPE_BPF_RES: 1757018a8e75SMaciej Fijalkowski testapp_bpf_res(test); 1758018a8e75SMaciej Fijalkowski break; 1759018a8e75SMaciej Fijalkowski case TEST_TYPE_RUN_TO_COMPLETION: 1760018a8e75SMaciej Fijalkowski test_spec_set_name(test, "RUN_TO_COMPLETION"); 1761018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1762018a8e75SMaciej Fijalkowski break; 1763018a8e75SMaciej Fijalkowski case TEST_TYPE_RUN_TO_COMPLETION_SINGLE_PKT: 1764018a8e75SMaciej Fijalkowski test_spec_set_name(test, "RUN_TO_COMPLETION_SINGLE_PKT"); 1765018a8e75SMaciej Fijalkowski testapp_single_pkt(test); 1766018a8e75SMaciej Fijalkowski break; 1767018a8e75SMaciej Fijalkowski case TEST_TYPE_RUN_TO_COMPLETION_2K_FRAME: 1768018a8e75SMaciej Fijalkowski test_spec_set_name(test, "RUN_TO_COMPLETION_2K_FRAME_SIZE"); 1769018a8e75SMaciej Fijalkowski test->ifobj_tx->umem->frame_size = 2048; 1770018a8e75SMaciej Fijalkowski test->ifobj_rx->umem->frame_size = 2048; 1771018a8e75SMaciej Fijalkowski pkt_stream_replace(test, DEFAULT_PKT_CNT, PKT_SIZE); 1772018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1773018a8e75SMaciej Fijalkowski 1774018a8e75SMaciej Fijalkowski pkt_stream_restore_default(test); 1775018a8e75SMaciej Fijalkowski break; 17763143d10bSShibin Koikkara Reeny case TEST_TYPE_RX_POLL: 1777018a8e75SMaciej Fijalkowski test->ifobj_rx->use_poll = true; 17783143d10bSShibin Koikkara Reeny test_spec_set_name(test, "POLL_RX"); 1779018a8e75SMaciej Fijalkowski testapp_validate_traffic(test); 1780018a8e75SMaciej Fijalkowski break; 17813143d10bSShibin Koikkara Reeny case TEST_TYPE_TX_POLL: 17823143d10bSShibin Koikkara Reeny test->ifobj_tx->use_poll = true; 17833143d10bSShibin Koikkara Reeny test_spec_set_name(test, "POLL_TX"); 17843143d10bSShibin Koikkara Reeny testapp_validate_traffic(test); 17853143d10bSShibin Koikkara Reeny break; 17863143d10bSShibin Koikkara Reeny case TEST_TYPE_POLL_TXQ_TMOUT: 17873143d10bSShibin Koikkara Reeny test_spec_set_name(test, "POLL_TXQ_FULL"); 17883143d10bSShibin Koikkara Reeny test->ifobj_tx->use_poll = true; 17893143d10bSShibin Koikkara Reeny /* create invalid frame by set umem frame_size and pkt length equal to 2048 */ 17903143d10bSShibin Koikkara Reeny test->ifobj_tx->umem->frame_size = 2048; 17913143d10bSShibin Koikkara Reeny pkt_stream_replace(test, 2 * DEFAULT_PKT_CNT, 2048); 17923143d10bSShibin Koikkara Reeny testapp_validate_traffic_single_thread(test, test->ifobj_tx, type); 17933143d10bSShibin Koikkara Reeny pkt_stream_restore_default(test); 17943143d10bSShibin Koikkara Reeny break; 17953143d10bSShibin Koikkara Reeny case TEST_TYPE_POLL_RXQ_TMOUT: 17963143d10bSShibin Koikkara Reeny test_spec_set_name(test, "POLL_RXQ_EMPTY"); 17973143d10bSShibin Koikkara Reeny test->ifobj_rx->use_poll = true; 17983143d10bSShibin Koikkara Reeny testapp_validate_traffic_single_thread(test, test->ifobj_rx, type); 17993143d10bSShibin Koikkara Reeny break; 1800018a8e75SMaciej Fijalkowski case TEST_TYPE_ALIGNED_INV_DESC: 1801018a8e75SMaciej Fijalkowski test_spec_set_name(test, "ALIGNED_INV_DESC"); 1802018a8e75SMaciej Fijalkowski testapp_invalid_desc(test); 1803018a8e75SMaciej Fijalkowski break; 1804018a8e75SMaciej Fijalkowski case TEST_TYPE_ALIGNED_INV_DESC_2K_FRAME: 1805018a8e75SMaciej Fijalkowski test_spec_set_name(test, "ALIGNED_INV_DESC_2K_FRAME_SIZE"); 1806018a8e75SMaciej Fijalkowski test->ifobj_tx->umem->frame_size = 2048; 1807018a8e75SMaciej Fijalkowski test->ifobj_rx->umem->frame_size = 2048; 1808018a8e75SMaciej Fijalkowski testapp_invalid_desc(test); 1809018a8e75SMaciej Fijalkowski break; 1810018a8e75SMaciej Fijalkowski case TEST_TYPE_UNALIGNED_INV_DESC: 1811018a8e75SMaciej Fijalkowski if (!hugepages_present(test->ifobj_tx)) { 1812018a8e75SMaciej Fijalkowski ksft_test_result_skip("No 2M huge pages present.\n"); 1813018a8e75SMaciej Fijalkowski return; 1814018a8e75SMaciej Fijalkowski } 1815018a8e75SMaciej Fijalkowski test_spec_set_name(test, "UNALIGNED_INV_DESC"); 1816018a8e75SMaciej Fijalkowski test->ifobj_tx->umem->unaligned_mode = true; 1817018a8e75SMaciej Fijalkowski test->ifobj_rx->umem->unaligned_mode = true; 1818018a8e75SMaciej Fijalkowski testapp_invalid_desc(test); 1819018a8e75SMaciej Fijalkowski break; 1820018a8e75SMaciej Fijalkowski case TEST_TYPE_UNALIGNED: 1821018a8e75SMaciej Fijalkowski if (!testapp_unaligned(test)) 1822018a8e75SMaciej Fijalkowski return; 1823018a8e75SMaciej Fijalkowski break; 1824018a8e75SMaciej Fijalkowski case TEST_TYPE_HEADROOM: 1825018a8e75SMaciej Fijalkowski testapp_headroom(test); 1826018a8e75SMaciej Fijalkowski break; 1827*80bea9acSMagnus Karlsson case TEST_TYPE_XDP_DROP_HALF: 1828*80bea9acSMagnus Karlsson testapp_xdp_drop(test); 1829*80bea9acSMagnus Karlsson break; 1830018a8e75SMaciej Fijalkowski default: 1831018a8e75SMaciej Fijalkowski break; 1832018a8e75SMaciej Fijalkowski } 1833018a8e75SMaciej Fijalkowski 1834018a8e75SMaciej Fijalkowski if (!test->fail) 1835018a8e75SMaciej Fijalkowski ksft_test_result_pass("PASS: %s %s%s\n", mode_string(test), busy_poll_string(test), 1836018a8e75SMaciej Fijalkowski test->name); 1837018a8e75SMaciej Fijalkowski } 1838018a8e75SMaciej Fijalkowski 1839018a8e75SMaciej Fijalkowski static struct ifobject *ifobject_create(void) 1840018a8e75SMaciej Fijalkowski { 1841018a8e75SMaciej Fijalkowski struct ifobject *ifobj; 1842018a8e75SMaciej Fijalkowski 1843018a8e75SMaciej Fijalkowski ifobj = calloc(1, sizeof(struct ifobject)); 1844018a8e75SMaciej Fijalkowski if (!ifobj) 1845018a8e75SMaciej Fijalkowski return NULL; 1846018a8e75SMaciej Fijalkowski 1847018a8e75SMaciej Fijalkowski ifobj->xsk_arr = calloc(MAX_SOCKETS, sizeof(*ifobj->xsk_arr)); 1848018a8e75SMaciej Fijalkowski if (!ifobj->xsk_arr) 1849018a8e75SMaciej Fijalkowski goto out_xsk_arr; 1850018a8e75SMaciej Fijalkowski 1851018a8e75SMaciej Fijalkowski ifobj->umem = calloc(1, sizeof(*ifobj->umem)); 1852018a8e75SMaciej Fijalkowski if (!ifobj->umem) 1853018a8e75SMaciej Fijalkowski goto out_umem; 1854018a8e75SMaciej Fijalkowski 1855018a8e75SMaciej Fijalkowski return ifobj; 1856018a8e75SMaciej Fijalkowski 1857018a8e75SMaciej Fijalkowski out_umem: 1858018a8e75SMaciej Fijalkowski free(ifobj->xsk_arr); 1859018a8e75SMaciej Fijalkowski out_xsk_arr: 1860018a8e75SMaciej Fijalkowski free(ifobj); 1861018a8e75SMaciej Fijalkowski return NULL; 1862018a8e75SMaciej Fijalkowski } 1863018a8e75SMaciej Fijalkowski 1864018a8e75SMaciej Fijalkowski static void ifobject_delete(struct ifobject *ifobj) 1865018a8e75SMaciej Fijalkowski { 1866018a8e75SMaciej Fijalkowski free(ifobj->umem); 1867018a8e75SMaciej Fijalkowski free(ifobj->xsk_arr); 1868018a8e75SMaciej Fijalkowski free(ifobj); 1869018a8e75SMaciej Fijalkowski } 1870018a8e75SMaciej Fijalkowski 1871aa61d81fSMagnus Karlsson static bool is_xdp_supported(int ifindex) 18720d68e6feSMaciej Fijalkowski { 18730d68e6feSMaciej Fijalkowski int flags = XDP_FLAGS_DRV_MODE; 18740d68e6feSMaciej Fijalkowski 18750d68e6feSMaciej Fijalkowski LIBBPF_OPTS(bpf_link_create_opts, opts, .flags = flags); 18760d68e6feSMaciej Fijalkowski struct bpf_insn insns[2] = { 18770d68e6feSMaciej Fijalkowski BPF_MOV64_IMM(BPF_REG_0, XDP_PASS), 18780d68e6feSMaciej Fijalkowski BPF_EXIT_INSN() 18790d68e6feSMaciej Fijalkowski }; 18800d68e6feSMaciej Fijalkowski int prog_fd, insn_cnt = ARRAY_SIZE(insns); 18810d68e6feSMaciej Fijalkowski int err; 18820d68e6feSMaciej Fijalkowski 18830d68e6feSMaciej Fijalkowski prog_fd = bpf_prog_load(BPF_PROG_TYPE_XDP, NULL, "GPL", insns, insn_cnt, NULL); 18840d68e6feSMaciej Fijalkowski if (prog_fd < 0) 18850d68e6feSMaciej Fijalkowski return false; 18860d68e6feSMaciej Fijalkowski 18870d68e6feSMaciej Fijalkowski err = bpf_xdp_attach(ifindex, prog_fd, flags, NULL); 18880d68e6feSMaciej Fijalkowski if (err) { 18890d68e6feSMaciej Fijalkowski close(prog_fd); 18900d68e6feSMaciej Fijalkowski return false; 18910d68e6feSMaciej Fijalkowski } 18920d68e6feSMaciej Fijalkowski 18930d68e6feSMaciej Fijalkowski bpf_xdp_detach(ifindex, flags, NULL); 18940d68e6feSMaciej Fijalkowski close(prog_fd); 18950d68e6feSMaciej Fijalkowski 18960d68e6feSMaciej Fijalkowski return true; 18970d68e6feSMaciej Fijalkowski } 18980d68e6feSMaciej Fijalkowski 1899aa61d81fSMagnus Karlsson static void change_to_drv_mode(struct ifobject *ifobj) 1900aa61d81fSMagnus Karlsson { 1901aa61d81fSMagnus Karlsson LIBBPF_OPTS(bpf_xdp_query_opts, opts); 1902aa61d81fSMagnus Karlsson int ret; 1903aa61d81fSMagnus Karlsson 1904f0a249dfSMagnus Karlsson xsk_detach_xdp_program(ifobj->ifindex, ifobj->xdp_flags); 1905f0a249dfSMagnus Karlsson ifobj->xdp_flags = XDP_FLAGS_DRV_MODE; 1906f0a249dfSMagnus Karlsson ret = xsk_attach_xdp_program(ifobj->xdp_progs->progs.xsk_def_prog, ifobj->ifindex, 1907f0a249dfSMagnus Karlsson ifobj->xdp_flags); 1908f0a249dfSMagnus Karlsson if (ret) { 1909aa61d81fSMagnus Karlsson ksft_print_msg("Error attaching XDP program\n"); 1910f0a249dfSMagnus Karlsson exit_with_error(-ret); 1911aa61d81fSMagnus Karlsson } 1912f0a249dfSMagnus Karlsson ifobj->xskmap = ifobj->xdp_progs->maps.xsk; 1913aa61d81fSMagnus Karlsson 1914aa61d81fSMagnus Karlsson ret = bpf_xdp_query(ifobj->ifindex, XDP_FLAGS_DRV_MODE, &opts); 1915aa61d81fSMagnus Karlsson if (ret) 1916aa61d81fSMagnus Karlsson exit_with_error(errno); 1917aa61d81fSMagnus Karlsson 1918aa61d81fSMagnus Karlsson if (opts.attach_mode != XDP_ATTACHED_DRV) { 1919aa61d81fSMagnus Karlsson ksft_print_msg("ERROR: XDP prog not in DRV mode\n"); 1920aa61d81fSMagnus Karlsson exit_with_error(EINVAL); 1921aa61d81fSMagnus Karlsson } 1922aa61d81fSMagnus Karlsson } 1923aa61d81fSMagnus Karlsson 1924018a8e75SMaciej Fijalkowski int main(int argc, char **argv) 1925018a8e75SMaciej Fijalkowski { 19261adef064SMaciej Fijalkowski struct pkt_stream *rx_pkt_stream_default; 19271adef064SMaciej Fijalkowski struct pkt_stream *tx_pkt_stream_default; 1928018a8e75SMaciej Fijalkowski struct ifobject *ifobj_tx, *ifobj_rx; 19290d68e6feSMaciej Fijalkowski int modes = TEST_MODE_SKB + 1; 1930018a8e75SMaciej Fijalkowski u32 i, j, failed_tests = 0; 1931018a8e75SMaciej Fijalkowski struct test_spec test; 1932aa61d81fSMagnus Karlsson bool shared_netdev; 1933018a8e75SMaciej Fijalkowski 1934018a8e75SMaciej Fijalkowski /* Use libbpf 1.0 API mode */ 1935018a8e75SMaciej Fijalkowski libbpf_set_strict_mode(LIBBPF_STRICT_ALL); 1936018a8e75SMaciej Fijalkowski 1937018a8e75SMaciej Fijalkowski ifobj_tx = ifobject_create(); 1938018a8e75SMaciej Fijalkowski if (!ifobj_tx) 1939018a8e75SMaciej Fijalkowski exit_with_error(ENOMEM); 1940018a8e75SMaciej Fijalkowski ifobj_rx = ifobject_create(); 1941018a8e75SMaciej Fijalkowski if (!ifobj_rx) 1942018a8e75SMaciej Fijalkowski exit_with_error(ENOMEM); 1943018a8e75SMaciej Fijalkowski 1944018a8e75SMaciej Fijalkowski setlocale(LC_ALL, ""); 1945018a8e75SMaciej Fijalkowski 1946018a8e75SMaciej Fijalkowski parse_command_line(ifobj_tx, ifobj_rx, argc, argv); 1947a693ff3eSMaciej Fijalkowski 1948aa61d81fSMagnus Karlsson shared_netdev = (ifobj_tx->ifindex == ifobj_rx->ifindex); 1949aa61d81fSMagnus Karlsson ifobj_tx->shared_umem = shared_netdev; 1950aa61d81fSMagnus Karlsson ifobj_rx->shared_umem = shared_netdev; 1951018a8e75SMaciej Fijalkowski 1952018a8e75SMaciej Fijalkowski if (!validate_interface(ifobj_tx) || !validate_interface(ifobj_rx)) { 1953018a8e75SMaciej Fijalkowski usage(basename(argv[0])); 1954018a8e75SMaciej Fijalkowski ksft_exit_xfail(); 1955018a8e75SMaciej Fijalkowski } 1956018a8e75SMaciej Fijalkowski 1957aa61d81fSMagnus Karlsson if (is_xdp_supported(ifobj_tx->ifindex)) { 19580d68e6feSMaciej Fijalkowski modes++; 1959fe2ad08eSMaciej Fijalkowski if (ifobj_zc_avail(ifobj_tx)) 1960fe2ad08eSMaciej Fijalkowski modes++; 1961fe2ad08eSMaciej Fijalkowski } 19620d68e6feSMaciej Fijalkowski 1963aa61d81fSMagnus Karlsson init_iface(ifobj_rx, MAC1, MAC2, IP1, IP2, UDP_PORT1, UDP_PORT2, 1964aa61d81fSMagnus Karlsson worker_testapp_validate_rx, true); 1965aa61d81fSMagnus Karlsson init_iface(ifobj_tx, MAC2, MAC1, IP2, IP1, UDP_PORT2, UDP_PORT1, 1966aa61d81fSMagnus Karlsson worker_testapp_validate_tx, !shared_netdev); 1967aa61d81fSMagnus Karlsson 1968018a8e75SMaciej Fijalkowski test_spec_init(&test, ifobj_tx, ifobj_rx, 0); 19691adef064SMaciej Fijalkowski tx_pkt_stream_default = pkt_stream_generate(ifobj_tx->umem, DEFAULT_PKT_CNT, PKT_SIZE); 19701adef064SMaciej Fijalkowski rx_pkt_stream_default = pkt_stream_generate(ifobj_rx->umem, DEFAULT_PKT_CNT, PKT_SIZE); 19711adef064SMaciej Fijalkowski if (!tx_pkt_stream_default || !rx_pkt_stream_default) 1972018a8e75SMaciej Fijalkowski exit_with_error(ENOMEM); 19731adef064SMaciej Fijalkowski test.tx_pkt_stream_default = tx_pkt_stream_default; 19741adef064SMaciej Fijalkowski test.rx_pkt_stream_default = rx_pkt_stream_default; 1975018a8e75SMaciej Fijalkowski 19760d68e6feSMaciej Fijalkowski ksft_set_plan(modes * TEST_TYPE_MAX); 1977018a8e75SMaciej Fijalkowski 1978aa61d81fSMagnus Karlsson for (i = 0; i < modes; i++) { 1979aa61d81fSMagnus Karlsson if (i == TEST_MODE_DRV) { 1980aa61d81fSMagnus Karlsson change_to_drv_mode(ifobj_rx); 1981aa61d81fSMagnus Karlsson if (!shared_netdev) 1982aa61d81fSMagnus Karlsson change_to_drv_mode(ifobj_tx); 1983aa61d81fSMagnus Karlsson } 1984aa61d81fSMagnus Karlsson 1985018a8e75SMaciej Fijalkowski for (j = 0; j < TEST_TYPE_MAX; j++) { 1986018a8e75SMaciej Fijalkowski test_spec_init(&test, ifobj_tx, ifobj_rx, i); 1987018a8e75SMaciej Fijalkowski run_pkt_test(&test, i, j); 1988018a8e75SMaciej Fijalkowski usleep(USLEEP_MAX); 1989018a8e75SMaciej Fijalkowski 1990018a8e75SMaciej Fijalkowski if (test.fail) 1991018a8e75SMaciej Fijalkowski failed_tests++; 1992018a8e75SMaciej Fijalkowski } 1993aa61d81fSMagnus Karlsson } 1994018a8e75SMaciej Fijalkowski 19951adef064SMaciej Fijalkowski pkt_stream_delete(tx_pkt_stream_default); 19961adef064SMaciej Fijalkowski pkt_stream_delete(rx_pkt_stream_default); 1997f0a249dfSMagnus Karlsson xsk_unload_xdp_programs(ifobj_tx); 1998f0a249dfSMagnus Karlsson xsk_unload_xdp_programs(ifobj_rx); 1999018a8e75SMaciej Fijalkowski ifobject_delete(ifobj_tx); 2000018a8e75SMaciej Fijalkowski ifobject_delete(ifobj_rx); 2001018a8e75SMaciej Fijalkowski 2002018a8e75SMaciej Fijalkowski if (failed_tests) 2003018a8e75SMaciej Fijalkowski ksft_exit_fail(); 2004018a8e75SMaciej Fijalkowski else 2005018a8e75SMaciej Fijalkowski ksft_exit_pass(); 2006018a8e75SMaciej Fijalkowski } 2007