13998e2a0SBruce Richardson /* SPDX-License-Identifier: BSD-3-Clause 23998e2a0SBruce Richardson * Copyright(c) 2010-2014 Intel Corporation 3af75078fSIntel */ 4af75078fSIntel 5af75078fSIntel #include <stdio.h> 6af75078fSIntel #include <stdlib.h> 7af75078fSIntel #include <stdint.h> 8af75078fSIntel #include <inttypes.h> 9af75078fSIntel #include <sys/types.h> 10af75078fSIntel #include <string.h> 11af75078fSIntel #include <sys/queue.h> 12af75078fSIntel #include <stdarg.h> 13af75078fSIntel #include <errno.h> 14af75078fSIntel #include <getopt.h> 15af75078fSIntel 16af75078fSIntel #include <rte_common.h> 17af75078fSIntel #include <rte_byteorder.h> 18af75078fSIntel #include <rte_log.h> 19af75078fSIntel #include <rte_memory.h> 20af75078fSIntel #include <rte_memcpy.h> 21af75078fSIntel #include <rte_eal.h> 22af75078fSIntel #include <rte_launch.h> 23af75078fSIntel #include <rte_atomic.h> 24af75078fSIntel #include <rte_cycles.h> 25af75078fSIntel #include <rte_prefetch.h> 26af75078fSIntel #include <rte_lcore.h> 27af75078fSIntel #include <rte_per_lcore.h> 28af75078fSIntel #include <rte_branch_prediction.h> 29af75078fSIntel #include <rte_interrupts.h> 30af75078fSIntel #include <rte_random.h> 31af75078fSIntel #include <rte_debug.h> 32af75078fSIntel #include <rte_ether.h> 33af75078fSIntel #include <rte_ethdev.h> 34af75078fSIntel #include <rte_mempool.h> 35af75078fSIntel #include <rte_mbuf.h> 36af75078fSIntel #include <rte_malloc.h> 37af75078fSIntel #include <rte_fbk_hash.h> 38af75078fSIntel #include <rte_ip.h> 39af75078fSIntel 40af75078fSIntel #define RTE_LOGTYPE_IPv4_MULTICAST RTE_LOGTYPE_USER1 41af75078fSIntel 42af75078fSIntel #define MAX_PORTS 16 43af75078fSIntel 44af75078fSIntel #define MCAST_CLONE_PORTS 2 45af75078fSIntel #define MCAST_CLONE_SEGS 2 46af75078fSIntel 47824cb29cSKonstantin Ananyev #define PKT_MBUF_DATA_SIZE RTE_MBUF_DEFAULT_BUF_SIZE 48af75078fSIntel #define NB_PKT_MBUF 8192 49af75078fSIntel 50ea0c20eaSOlivier Matz #define HDR_MBUF_DATA_SIZE (2 * RTE_PKTMBUF_HEADROOM) 51af75078fSIntel #define NB_HDR_MBUF (NB_PKT_MBUF * MAX_PORTS) 52af75078fSIntel 53af75078fSIntel #define NB_CLONE_MBUF (NB_PKT_MBUF * MCAST_CLONE_PORTS * MCAST_CLONE_SEGS * 2) 54af75078fSIntel 55af75078fSIntel /* allow max jumbo frame 9.5 KB */ 56af75078fSIntel #define JUMBO_FRAME_MAX_SIZE 0x2600 57af75078fSIntel 58af75078fSIntel #define MAX_PKT_BURST 32 595c95261dSIntel #define BURST_TX_DRAIN_US 100 /* TX drain every ~100us */ 60af75078fSIntel 61af75078fSIntel /* Configure how many packets ahead to prefetch, when reading packets */ 62af75078fSIntel #define PREFETCH_OFFSET 3 63af75078fSIntel 64af75078fSIntel /* 65af75078fSIntel * Construct Ethernet multicast address from IPv4 multicast address. 66af75078fSIntel * Citing RFC 1112, section 6.4: 67af75078fSIntel * "An IP host group address is mapped to an Ethernet multicast address 68af75078fSIntel * by placing the low-order 23-bits of the IP address into the low-order 69af75078fSIntel * 23 bits of the Ethernet multicast address 01-00-5E-00-00-00 (hex)." 70af75078fSIntel */ 71af75078fSIntel #define ETHER_ADDR_FOR_IPV4_MCAST(x) \ 72af75078fSIntel (rte_cpu_to_be_64(0x01005e000000ULL | ((x) & 0x7fffff)) >> 16) 73af75078fSIntel 74af75078fSIntel /* 75af75078fSIntel * Configurable number of RX/TX ring descriptors 76af75078fSIntel */ 77867a6c66SKevin Laatz #define RTE_TEST_RX_DESC_DEFAULT 1024 78867a6c66SKevin Laatz #define RTE_TEST_TX_DESC_DEFAULT 1024 79af75078fSIntel static uint16_t nb_rxd = RTE_TEST_RX_DESC_DEFAULT; 80af75078fSIntel static uint16_t nb_txd = RTE_TEST_TX_DESC_DEFAULT; 81af75078fSIntel 82af75078fSIntel /* ethernet addresses of ports */ 836d13ea8eSOlivier Matz static struct rte_ether_addr ports_eth_addr[MAX_PORTS]; 84af75078fSIntel 85af75078fSIntel /* mask of enabled ports */ 86af75078fSIntel static uint32_t enabled_port_mask = 0; 87af75078fSIntel 88f8244c63SZhiyong Yang static uint16_t nb_ports; 89af75078fSIntel 90af75078fSIntel static int rx_queue_per_lcore = 1; 91af75078fSIntel 92af75078fSIntel struct mbuf_table { 93af75078fSIntel uint16_t len; 94af75078fSIntel struct rte_mbuf *m_table[MAX_PKT_BURST]; 95af75078fSIntel }; 96af75078fSIntel 97af75078fSIntel #define MAX_RX_QUEUE_PER_LCORE 16 98af75078fSIntel #define MAX_TX_QUEUE_PER_PORT 16 99af75078fSIntel struct lcore_queue_conf { 100af75078fSIntel uint64_t tx_tsc; 101af75078fSIntel uint16_t n_rx_queue; 102af75078fSIntel uint8_t rx_queue_list[MAX_RX_QUEUE_PER_LCORE]; 103af75078fSIntel uint16_t tx_queue_id[MAX_PORTS]; 104af75078fSIntel struct mbuf_table tx_mbufs[MAX_PORTS]; 105af75078fSIntel } __rte_cache_aligned; 106af75078fSIntel static struct lcore_queue_conf lcore_queue_conf[RTE_MAX_LCORE]; 107af75078fSIntel 1085e470a66SAndriy Berestovskyy static struct rte_eth_conf port_conf = { 109af75078fSIntel .rxmode = { 110af75078fSIntel .max_rx_pkt_len = JUMBO_FRAME_MAX_SIZE, 111af75078fSIntel .split_hdr_size = 0, 112323e7b66SFerruh Yigit .offloads = DEV_RX_OFFLOAD_JUMBO_FRAME, 113af75078fSIntel }, 114af75078fSIntel .txmode = { 11532e7aa0bSIntel .mq_mode = ETH_MQ_TX_NONE, 1166b85f708SShahaf Shuler .offloads = DEV_TX_OFFLOAD_MULTI_SEGS, 117af75078fSIntel }, 118af75078fSIntel }; 119af75078fSIntel 120af75078fSIntel static struct rte_mempool *packet_pool, *header_pool, *clone_pool; 121af75078fSIntel 122af75078fSIntel 123af75078fSIntel /* Multicast */ 124af75078fSIntel static struct rte_fbk_hash_params mcast_hash_params = { 125af75078fSIntel .name = "MCAST_HASH", 126af75078fSIntel .entries = 1024, 127af75078fSIntel .entries_per_bucket = 4, 128e60f71ebSIntel .socket_id = 0, 129af75078fSIntel .hash_func = NULL, 130af75078fSIntel .init_val = 0, 131af75078fSIntel }; 132af75078fSIntel 133af75078fSIntel struct rte_fbk_hash_table *mcast_hash = NULL; 134af75078fSIntel 135af75078fSIntel struct mcast_group_params { 136af75078fSIntel uint32_t ip; 137af75078fSIntel uint16_t port_mask; 138af75078fSIntel }; 139af75078fSIntel 140af75078fSIntel static struct mcast_group_params mcast_group_table[] = { 141af75078fSIntel {IPv4(224,0,0,101), 0x1}, 142af75078fSIntel {IPv4(224,0,0,102), 0x2}, 143af75078fSIntel {IPv4(224,0,0,103), 0x3}, 144af75078fSIntel {IPv4(224,0,0,104), 0x4}, 145af75078fSIntel {IPv4(224,0,0,105), 0x5}, 146af75078fSIntel {IPv4(224,0,0,106), 0x6}, 147af75078fSIntel {IPv4(224,0,0,107), 0x7}, 148af75078fSIntel {IPv4(224,0,0,108), 0x8}, 149af75078fSIntel {IPv4(224,0,0,109), 0x9}, 150af75078fSIntel {IPv4(224,0,0,110), 0xA}, 151af75078fSIntel {IPv4(224,0,0,111), 0xB}, 152af75078fSIntel {IPv4(224,0,0,112), 0xC}, 153af75078fSIntel {IPv4(224,0,0,113), 0xD}, 154af75078fSIntel {IPv4(224,0,0,114), 0xE}, 155af75078fSIntel {IPv4(224,0,0,115), 0xF}, 156af75078fSIntel }; 157af75078fSIntel 158af75078fSIntel #define N_MCAST_GROUPS \ 159af75078fSIntel (sizeof (mcast_group_table) / sizeof (mcast_group_table[0])) 160af75078fSIntel 161af75078fSIntel 162af75078fSIntel /* Send burst of packets on an output interface */ 163af75078fSIntel static void 164f8244c63SZhiyong Yang send_burst(struct lcore_queue_conf *qconf, uint16_t port) 165af75078fSIntel { 166af75078fSIntel struct rte_mbuf **m_table; 167af75078fSIntel uint16_t n, queueid; 168af75078fSIntel int ret; 169af75078fSIntel 170af75078fSIntel queueid = qconf->tx_queue_id[port]; 171af75078fSIntel m_table = (struct rte_mbuf **)qconf->tx_mbufs[port].m_table; 172af75078fSIntel n = qconf->tx_mbufs[port].len; 173af75078fSIntel 174af75078fSIntel ret = rte_eth_tx_burst(port, queueid, m_table, n); 175af75078fSIntel while (unlikely (ret < n)) { 176af75078fSIntel rte_pktmbuf_free(m_table[ret]); 177af75078fSIntel ret++; 178af75078fSIntel } 179af75078fSIntel 180af75078fSIntel qconf->tx_mbufs[port].len = 0; 181af75078fSIntel } 182af75078fSIntel 183af75078fSIntel /* Get number of bits set. */ 184af75078fSIntel static inline uint32_t 185af75078fSIntel bitcnt(uint32_t v) 186af75078fSIntel { 187af75078fSIntel uint32_t n; 188af75078fSIntel 189af75078fSIntel for (n = 0; v != 0; v &= v - 1, n++) 190af75078fSIntel ; 191af75078fSIntel 192693f715dSHuawei Xie return n; 193af75078fSIntel } 194af75078fSIntel 195af75078fSIntel /** 196af75078fSIntel * Create the output multicast packet based on the given input packet. 197af75078fSIntel * There are two approaches for creating outgoing packet, though both 198af75078fSIntel * are based on data zero-copy idea, they differ in few details: 199af75078fSIntel * First one creates a clone of the input packet, e.g - walk though all 200af75078fSIntel * segments of the input packet, and for each of them create a new packet 201af75078fSIntel * mbuf and attach that new mbuf to the segment (refer to rte_pktmbuf_clone() 202af75078fSIntel * for more details). Then new mbuf is allocated for the packet header 203af75078fSIntel * and is prepended to the 'clone' mbuf. 204af75078fSIntel * Second approach doesn't make a clone, it just increment refcnt for all 205af75078fSIntel * input packet segments. Then it allocates new mbuf for the packet header 206af75078fSIntel * and prepends it to the input packet. 207af75078fSIntel * Basically first approach reuses only input packet's data, but creates 208af75078fSIntel * it's own copy of packet's metadata. Second approach reuses both input's 209af75078fSIntel * packet data and metadata. 210af75078fSIntel * The advantage of first approach - is that each outgoing packet has it's 211af75078fSIntel * own copy of metadata, so we can safely modify data pointer of the 212af75078fSIntel * input packet. That allows us to skip creation if the output packet for 213af75078fSIntel * the last destination port, but instead modify input packet's header inplace, 214af75078fSIntel * e.g: for N destination ports we need to invoke mcast_out_pkt (N-1) times. 215af75078fSIntel * The advantage of second approach - less work for each outgoing packet, 216af75078fSIntel * e.g: we skip "clone" operation completely. Though it comes with a price - 217af75078fSIntel * input packet's metadata has to be intact. So for N destination ports we 218af75078fSIntel * need to invoke mcast_out_pkt N times. 219af75078fSIntel * So for small number of outgoing ports (and segments in the input packet) 220af75078fSIntel * first approach will be faster. 221af75078fSIntel * As number of outgoing ports (and/or input segments) will grow, 222af75078fSIntel * second way will become more preferable. 223af75078fSIntel * 224af75078fSIntel * @param pkt 225af75078fSIntel * Input packet mbuf. 226af75078fSIntel * @param use_clone 227af75078fSIntel * Control which of the two approaches described above should be used: 228af75078fSIntel * - 0 - use second approach: 229af75078fSIntel * Don't "clone" input packet. 230af75078fSIntel * Prepend new header directly to the input packet 231af75078fSIntel * - 1 - use first approach: 232af75078fSIntel * Make a "clone" of input packet first. 233af75078fSIntel * Prepend new header to the clone of the input packet 234af75078fSIntel * @return 235af75078fSIntel * - The pointer to the new outgoing packet. 236af75078fSIntel * - NULL if operation failed. 237af75078fSIntel */ 238af75078fSIntel static inline struct rte_mbuf * 239af75078fSIntel mcast_out_pkt(struct rte_mbuf *pkt, int use_clone) 240af75078fSIntel { 241af75078fSIntel struct rte_mbuf *hdr; 242af75078fSIntel 243af75078fSIntel /* Create new mbuf for the header. */ 244af75078fSIntel if (unlikely ((hdr = rte_pktmbuf_alloc(header_pool)) == NULL)) 245693f715dSHuawei Xie return NULL; 246af75078fSIntel 247af75078fSIntel /* If requested, then make a new clone packet. */ 248af75078fSIntel if (use_clone != 0 && 249af75078fSIntel unlikely ((pkt = rte_pktmbuf_clone(pkt, clone_pool)) == NULL)) { 250af75078fSIntel rte_pktmbuf_free(hdr); 251693f715dSHuawei Xie return NULL; 252af75078fSIntel } 253af75078fSIntel 254af75078fSIntel /* prepend new header */ 255ea672a8bSOlivier Matz hdr->next = pkt; 256af75078fSIntel 257af75078fSIntel /* update header's fields */ 258ea672a8bSOlivier Matz hdr->pkt_len = (uint16_t)(hdr->data_len + pkt->pkt_len); 2594c20622aSIlya V. Matveychikov hdr->nb_segs = pkt->nb_segs + 1; 260af75078fSIntel 2619aaccf1aSOlivier Matz __rte_mbuf_sanity_check(hdr, 1); 262693f715dSHuawei Xie return hdr; 263af75078fSIntel } 264af75078fSIntel 265af75078fSIntel /* 266af75078fSIntel * Write new Ethernet header to the outgoing packet, 267af75078fSIntel * and put it into the outgoing queue for the given port. 268af75078fSIntel */ 269af75078fSIntel static inline void 2706d13ea8eSOlivier Matz mcast_send_pkt(struct rte_mbuf *pkt, struct rte_ether_addr *dest_addr, 271f8244c63SZhiyong Yang struct lcore_queue_conf *qconf, uint16_t port) 272af75078fSIntel { 2736d13ea8eSOlivier Matz struct rte_ether_hdr *ethdr; 274af75078fSIntel uint16_t len; 275af75078fSIntel 276af75078fSIntel /* Construct Ethernet header. */ 2776d13ea8eSOlivier Matz ethdr = (struct rte_ether_hdr *) 2786d13ea8eSOlivier Matz rte_pktmbuf_prepend(pkt, (uint16_t)sizeof(*ethdr)); 27950705e8eSThomas Monjalon RTE_ASSERT(ethdr != NULL); 280af75078fSIntel 281538da7a1SOlivier Matz rte_ether_addr_copy(dest_addr, ðdr->d_addr); 282538da7a1SOlivier Matz rte_ether_addr_copy(&ports_eth_addr[port], ðdr->s_addr); 28335b2d13fSOlivier Matz ethdr->ether_type = rte_be_to_cpu_16(RTE_ETHER_TYPE_IPv4); 284af75078fSIntel 285af75078fSIntel /* Put new packet into the output queue */ 286af75078fSIntel len = qconf->tx_mbufs[port].len; 287af75078fSIntel qconf->tx_mbufs[port].m_table[len] = pkt; 288af75078fSIntel qconf->tx_mbufs[port].len = ++len; 289af75078fSIntel 290af75078fSIntel /* Transmit packets */ 291af75078fSIntel if (unlikely(MAX_PKT_BURST == len)) 292af75078fSIntel send_burst(qconf, port); 293af75078fSIntel } 294af75078fSIntel 295af75078fSIntel /* Multicast forward of the input packet */ 296af75078fSIntel static inline void 297af75078fSIntel mcast_forward(struct rte_mbuf *m, struct lcore_queue_conf *qconf) 298af75078fSIntel { 299af75078fSIntel struct rte_mbuf *mc; 300*a7c528e5SOlivier Matz struct rte_ipv4_hdr *iphdr; 301af75078fSIntel uint32_t dest_addr, port_mask, port_num, use_clone; 302af75078fSIntel int32_t hash; 303f8244c63SZhiyong Yang uint16_t port; 304af75078fSIntel union { 305af75078fSIntel uint64_t as_int; 3066d13ea8eSOlivier Matz struct rte_ether_addr as_addr; 307af75078fSIntel } dst_eth_addr; 308af75078fSIntel 309af75078fSIntel /* Remove the Ethernet header from the input packet */ 310*a7c528e5SOlivier Matz iphdr = (struct rte_ipv4_hdr *) 3116d13ea8eSOlivier Matz rte_pktmbuf_adj(m, (uint16_t)sizeof(struct rte_ether_hdr)); 31250705e8eSThomas Monjalon RTE_ASSERT(iphdr != NULL); 313af75078fSIntel 314af75078fSIntel dest_addr = rte_be_to_cpu_32(iphdr->dst_addr); 315af75078fSIntel 316af75078fSIntel /* 317af75078fSIntel * Check that it is a valid multicast address and 318af75078fSIntel * we have some active ports assigned to it. 319af75078fSIntel */ 320af75078fSIntel if(!IS_IPV4_MCAST(dest_addr) || 321af75078fSIntel (hash = rte_fbk_hash_lookup(mcast_hash, dest_addr)) <= 0 || 322af75078fSIntel (port_mask = hash & enabled_port_mask) == 0) { 323af75078fSIntel rte_pktmbuf_free(m); 324af75078fSIntel return; 325af75078fSIntel } 326af75078fSIntel 327af75078fSIntel /* Calculate number of destination ports. */ 328af75078fSIntel port_num = bitcnt(port_mask); 329af75078fSIntel 330af75078fSIntel /* Should we use rte_pktmbuf_clone() or not. */ 331af75078fSIntel use_clone = (port_num <= MCAST_CLONE_PORTS && 332ea672a8bSOlivier Matz m->nb_segs <= MCAST_CLONE_SEGS); 333af75078fSIntel 334af75078fSIntel /* Mark all packet's segments as referenced port_num times */ 335af75078fSIntel if (use_clone == 0) 336af75078fSIntel rte_pktmbuf_refcnt_update(m, (uint16_t)port_num); 337af75078fSIntel 338af75078fSIntel /* construct destination ethernet address */ 339af75078fSIntel dst_eth_addr.as_int = ETHER_ADDR_FOR_IPV4_MCAST(dest_addr); 340af75078fSIntel 341af75078fSIntel for (port = 0; use_clone != port_mask; port_mask >>= 1, port++) { 342af75078fSIntel 343af75078fSIntel /* Prepare output packet and send it out. */ 344af75078fSIntel if ((port_mask & 1) != 0) { 345af75078fSIntel if (likely ((mc = mcast_out_pkt(m, use_clone)) != NULL)) 346af75078fSIntel mcast_send_pkt(mc, &dst_eth_addr.as_addr, 347af75078fSIntel qconf, port); 348af75078fSIntel else if (use_clone == 0) 349af75078fSIntel rte_pktmbuf_free(m); 350af75078fSIntel } 351af75078fSIntel } 352af75078fSIntel 353af75078fSIntel /* 354af75078fSIntel * If we making clone packets, then, for the last destination port, 355af75078fSIntel * we can overwrite input packet's metadata. 356af75078fSIntel */ 357af75078fSIntel if (use_clone != 0) 358af75078fSIntel mcast_send_pkt(m, &dst_eth_addr.as_addr, qconf, port); 359af75078fSIntel else 360af75078fSIntel rte_pktmbuf_free(m); 361af75078fSIntel } 362af75078fSIntel 363af75078fSIntel /* Send burst of outgoing packet, if timeout expires. */ 364af75078fSIntel static inline void 365af75078fSIntel send_timeout_burst(struct lcore_queue_conf *qconf) 366af75078fSIntel { 367af75078fSIntel uint64_t cur_tsc; 368f8244c63SZhiyong Yang uint16_t portid; 3695c95261dSIntel const uint64_t drain_tsc = (rte_get_tsc_hz() + US_PER_S - 1) / US_PER_S * BURST_TX_DRAIN_US; 370af75078fSIntel 371af75078fSIntel cur_tsc = rte_rdtsc(); 3725c95261dSIntel if (likely (cur_tsc < qconf->tx_tsc + drain_tsc)) 373af75078fSIntel return; 374af75078fSIntel 375af75078fSIntel for (portid = 0; portid < MAX_PORTS; portid++) { 376af75078fSIntel if (qconf->tx_mbufs[portid].len != 0) 377af75078fSIntel send_burst(qconf, portid); 378af75078fSIntel } 379af75078fSIntel qconf->tx_tsc = cur_tsc; 380af75078fSIntel } 381af75078fSIntel 382af75078fSIntel /* main processing loop */ 383cdfd5dbbSIntel static int 384af75078fSIntel main_loop(__rte_unused void *dummy) 385af75078fSIntel { 386af75078fSIntel struct rte_mbuf *pkts_burst[MAX_PKT_BURST]; 3876441b9f6SIntel unsigned lcore_id; 388af75078fSIntel int i, j, nb_rx; 389f8244c63SZhiyong Yang uint16_t portid; 390af75078fSIntel struct lcore_queue_conf *qconf; 391af75078fSIntel 392af75078fSIntel lcore_id = rte_lcore_id(); 393af75078fSIntel qconf = &lcore_queue_conf[lcore_id]; 394af75078fSIntel 395af75078fSIntel 396af75078fSIntel if (qconf->n_rx_queue == 0) { 397af75078fSIntel RTE_LOG(INFO, IPv4_MULTICAST, "lcore %u has nothing to do\n", 398af75078fSIntel lcore_id); 399cdfd5dbbSIntel return 0; 400af75078fSIntel } 401af75078fSIntel 402af75078fSIntel RTE_LOG(INFO, IPv4_MULTICAST, "entering main loop on lcore %u\n", 403af75078fSIntel lcore_id); 404af75078fSIntel 405af75078fSIntel for (i = 0; i < qconf->n_rx_queue; i++) { 406af75078fSIntel 407af75078fSIntel portid = qconf->rx_queue_list[i]; 408af75078fSIntel RTE_LOG(INFO, IPv4_MULTICAST, " -- lcoreid=%u portid=%d\n", 409f8244c63SZhiyong Yang lcore_id, portid); 410af75078fSIntel } 411af75078fSIntel 412af75078fSIntel while (1) { 413af75078fSIntel 414af75078fSIntel /* 415af75078fSIntel * Read packet from RX queues 416af75078fSIntel */ 417af75078fSIntel for (i = 0; i < qconf->n_rx_queue; i++) { 418af75078fSIntel 419af75078fSIntel portid = qconf->rx_queue_list[i]; 420af75078fSIntel nb_rx = rte_eth_rx_burst(portid, 0, pkts_burst, 421af75078fSIntel MAX_PKT_BURST); 422af75078fSIntel 423af75078fSIntel /* Prefetch first packets */ 424af75078fSIntel for (j = 0; j < PREFETCH_OFFSET && j < nb_rx; j++) { 425af75078fSIntel rte_prefetch0(rte_pktmbuf_mtod( 426af75078fSIntel pkts_burst[j], void *)); 427af75078fSIntel } 428af75078fSIntel 429af75078fSIntel /* Prefetch and forward already prefetched packets */ 430af75078fSIntel for (j = 0; j < (nb_rx - PREFETCH_OFFSET); j++) { 431af75078fSIntel rte_prefetch0(rte_pktmbuf_mtod(pkts_burst[ 432af75078fSIntel j + PREFETCH_OFFSET], void *)); 433af75078fSIntel mcast_forward(pkts_burst[j], qconf); 434af75078fSIntel } 435af75078fSIntel 436af75078fSIntel /* Forward remaining prefetched packets */ 437af75078fSIntel for (; j < nb_rx; j++) { 438af75078fSIntel mcast_forward(pkts_burst[j], qconf); 439af75078fSIntel } 440af75078fSIntel } 441af75078fSIntel 442af75078fSIntel /* Send out packets from TX queues */ 443af75078fSIntel send_timeout_burst(qconf); 444af75078fSIntel } 445af75078fSIntel } 446af75078fSIntel 447af75078fSIntel /* display usage */ 448af75078fSIntel static void 449af75078fSIntel print_usage(const char *prgname) 450af75078fSIntel { 451af75078fSIntel printf("%s [EAL options] -- -p PORTMASK [-q NQ]\n" 452af75078fSIntel " -p PORTMASK: hexadecimal bitmask of ports to configure\n" 453af75078fSIntel " -q NQ: number of queue (=ports) per lcore (default is 1)\n", 454af75078fSIntel prgname); 455af75078fSIntel } 456af75078fSIntel 457af75078fSIntel static uint32_t 458af75078fSIntel parse_portmask(const char *portmask) 459af75078fSIntel { 460af75078fSIntel char *end = NULL; 461af75078fSIntel unsigned long pm; 462af75078fSIntel 463af75078fSIntel /* parse hexadecimal string */ 464af75078fSIntel pm = strtoul(portmask, &end, 16); 465af75078fSIntel if ((portmask[0] == '\0') || (end == NULL) || (*end != '\0')) 466af75078fSIntel return 0; 467af75078fSIntel 468693f715dSHuawei Xie return (uint32_t)pm; 469af75078fSIntel } 470af75078fSIntel 471af75078fSIntel static int 472af75078fSIntel parse_nqueue(const char *q_arg) 473af75078fSIntel { 474af75078fSIntel char *end = NULL; 475af75078fSIntel unsigned long n; 476af75078fSIntel 477af75078fSIntel /* parse numerical string */ 478af75078fSIntel errno = 0; 479af75078fSIntel n = strtoul(q_arg, &end, 0); 480af75078fSIntel if (errno != 0 || end == NULL || *end != '\0' || 481af75078fSIntel n == 0 || n >= MAX_RX_QUEUE_PER_LCORE) 482693f715dSHuawei Xie return -1; 483af75078fSIntel 484693f715dSHuawei Xie return n; 485af75078fSIntel } 486af75078fSIntel 487af75078fSIntel /* Parse the argument given in the command line of the application */ 488af75078fSIntel static int 489af75078fSIntel parse_args(int argc, char **argv) 490af75078fSIntel { 491af75078fSIntel int opt, ret; 492af75078fSIntel char **argvopt; 493af75078fSIntel int option_index; 494af75078fSIntel char *prgname = argv[0]; 495af75078fSIntel static struct option lgopts[] = { 496af75078fSIntel {NULL, 0, 0, 0} 497af75078fSIntel }; 498af75078fSIntel 499af75078fSIntel argvopt = argv; 500af75078fSIntel 501af75078fSIntel while ((opt = getopt_long(argc, argvopt, "p:q:", 502af75078fSIntel lgopts, &option_index)) != EOF) { 503af75078fSIntel 504af75078fSIntel switch (opt) { 505af75078fSIntel /* portmask */ 506af75078fSIntel case 'p': 507af75078fSIntel enabled_port_mask = parse_portmask(optarg); 508af75078fSIntel if (enabled_port_mask == 0) { 509af75078fSIntel printf("invalid portmask\n"); 510af75078fSIntel print_usage(prgname); 511af75078fSIntel return -1; 512af75078fSIntel } 513af75078fSIntel break; 514af75078fSIntel 515af75078fSIntel /* nqueue */ 516af75078fSIntel case 'q': 517af75078fSIntel rx_queue_per_lcore = parse_nqueue(optarg); 518af75078fSIntel if (rx_queue_per_lcore < 0) { 519af75078fSIntel printf("invalid queue number\n"); 520af75078fSIntel print_usage(prgname); 521af75078fSIntel return -1; 522af75078fSIntel } 523af75078fSIntel break; 524af75078fSIntel 525af75078fSIntel default: 526af75078fSIntel print_usage(prgname); 527af75078fSIntel return -1; 528af75078fSIntel } 529af75078fSIntel } 530af75078fSIntel 531af75078fSIntel if (optind >= 0) 532af75078fSIntel argv[optind-1] = prgname; 533af75078fSIntel 534af75078fSIntel ret = optind-1; 5359d5ca532SKeith Wiles optind = 1; /* reset getopt lib */ 536af75078fSIntel return ret; 537af75078fSIntel } 538af75078fSIntel 539af75078fSIntel static void 5406d13ea8eSOlivier Matz print_ethaddr(const char *name, struct rte_ether_addr *eth_addr) 541af75078fSIntel { 54235b2d13fSOlivier Matz char buf[RTE_ETHER_ADDR_FMT_SIZE]; 54335b2d13fSOlivier Matz rte_ether_format_addr(buf, RTE_ETHER_ADDR_FMT_SIZE, eth_addr); 544ec3d82dbSCunming Liang printf("%s%s", name, buf); 545af75078fSIntel } 546af75078fSIntel 547af75078fSIntel static int 548af75078fSIntel init_mcast_hash(void) 549af75078fSIntel { 550af75078fSIntel uint32_t i; 551af75078fSIntel 552e60f71ebSIntel mcast_hash_params.socket_id = rte_socket_id(); 553af75078fSIntel mcast_hash = rte_fbk_hash_create(&mcast_hash_params); 554af75078fSIntel if (mcast_hash == NULL){ 555af75078fSIntel return -1; 556af75078fSIntel } 557af75078fSIntel 558af75078fSIntel for (i = 0; i < N_MCAST_GROUPS; i ++){ 559af75078fSIntel if (rte_fbk_hash_add_key(mcast_hash, 560af75078fSIntel mcast_group_table[i].ip, 561af75078fSIntel mcast_group_table[i].port_mask) < 0) { 562af75078fSIntel return -1; 563af75078fSIntel } 564af75078fSIntel } 565af75078fSIntel 566af75078fSIntel return 0; 567af75078fSIntel } 568af75078fSIntel 569d3641ae8SIntel /* Check the link status of all ports in up to 9s, and print them finally */ 570d3641ae8SIntel static void 5718728ccf3SThomas Monjalon check_all_ports_link_status(uint32_t port_mask) 572d3641ae8SIntel { 573d3641ae8SIntel #define CHECK_INTERVAL 100 /* 100ms */ 574d3641ae8SIntel #define MAX_CHECK_TIME 90 /* 9s (90 * 100ms) in total */ 575f8244c63SZhiyong Yang uint16_t portid; 576f8244c63SZhiyong Yang uint8_t count, all_ports_up, print_flag = 0; 577d3641ae8SIntel struct rte_eth_link link; 578d3641ae8SIntel 579d3641ae8SIntel printf("\nChecking link status"); 580d3641ae8SIntel fflush(stdout); 581d3641ae8SIntel for (count = 0; count <= MAX_CHECK_TIME; count++) { 582d3641ae8SIntel all_ports_up = 1; 5838728ccf3SThomas Monjalon RTE_ETH_FOREACH_DEV(portid) { 584d3641ae8SIntel if ((port_mask & (1 << portid)) == 0) 585d3641ae8SIntel continue; 586d3641ae8SIntel memset(&link, 0, sizeof(link)); 587d3641ae8SIntel rte_eth_link_get_nowait(portid, &link); 588d3641ae8SIntel /* print link status if flag set */ 589d3641ae8SIntel if (print_flag == 1) { 590d3641ae8SIntel if (link.link_status) 591f8244c63SZhiyong Yang printf( 592f8244c63SZhiyong Yang "Port%d Link Up. Speed %u Mbps - %s\n", 593f8244c63SZhiyong Yang portid, link.link_speed, 594d3641ae8SIntel (link.link_duplex == ETH_LINK_FULL_DUPLEX) ? 595d3641ae8SIntel ("full-duplex") : ("half-duplex\n")); 596d3641ae8SIntel else 597f8244c63SZhiyong Yang printf("Port %d Link Down\n", portid); 598d3641ae8SIntel continue; 599d3641ae8SIntel } 600d3641ae8SIntel /* clear all_ports_up flag if any link down */ 60109419f23SThomas Monjalon if (link.link_status == ETH_LINK_DOWN) { 602d3641ae8SIntel all_ports_up = 0; 603d3641ae8SIntel break; 604d3641ae8SIntel } 605d3641ae8SIntel } 606d3641ae8SIntel /* after finally printing all link status, get out */ 607d3641ae8SIntel if (print_flag == 1) 608d3641ae8SIntel break; 609d3641ae8SIntel 610d3641ae8SIntel if (all_ports_up == 0) { 611d3641ae8SIntel printf("."); 612d3641ae8SIntel fflush(stdout); 613d3641ae8SIntel rte_delay_ms(CHECK_INTERVAL); 614d3641ae8SIntel } 615d3641ae8SIntel 616d3641ae8SIntel /* set the print_flag if all ports up or timeout */ 617d3641ae8SIntel if (all_ports_up == 1 || count == (MAX_CHECK_TIME - 1)) { 618d3641ae8SIntel print_flag = 1; 619d3641ae8SIntel printf("done\n"); 620d3641ae8SIntel } 621d3641ae8SIntel } 622d3641ae8SIntel } 623d3641ae8SIntel 624af75078fSIntel int 62598a16481SDavid Marchand main(int argc, char **argv) 626af75078fSIntel { 627af75078fSIntel struct lcore_queue_conf *qconf; 62881f7ecd9SPablo de Lara struct rte_eth_dev_info dev_info; 62981f7ecd9SPablo de Lara struct rte_eth_txconf *txconf; 630af75078fSIntel int ret; 631af75078fSIntel uint16_t queueid; 6329787d22fSIntel unsigned lcore_id = 0, rx_lcore_id = 0; 633af75078fSIntel uint32_t n_tx_queue, nb_lcores; 634f8244c63SZhiyong Yang uint16_t portid; 635af75078fSIntel 636af75078fSIntel /* init EAL */ 637af75078fSIntel ret = rte_eal_init(argc, argv); 638af75078fSIntel if (ret < 0) 639af75078fSIntel rte_exit(EXIT_FAILURE, "Invalid EAL parameters\n"); 640af75078fSIntel argc -= ret; 641af75078fSIntel argv += ret; 642af75078fSIntel 643af75078fSIntel /* parse application arguments (after the EAL ones) */ 644af75078fSIntel ret = parse_args(argc, argv); 645af75078fSIntel if (ret < 0) 646af75078fSIntel rte_exit(EXIT_FAILURE, "Invalid IPV4_MULTICAST parameters\n"); 647af75078fSIntel 648af75078fSIntel /* create the mbuf pools */ 649ea0c20eaSOlivier Matz packet_pool = rte_pktmbuf_pool_create("packet_pool", NB_PKT_MBUF, 32, 650ea0c20eaSOlivier Matz 0, PKT_MBUF_DATA_SIZE, rte_socket_id()); 651af75078fSIntel 652af75078fSIntel if (packet_pool == NULL) 653af75078fSIntel rte_exit(EXIT_FAILURE, "Cannot init packet mbuf pool\n"); 654af75078fSIntel 655ea0c20eaSOlivier Matz header_pool = rte_pktmbuf_pool_create("header_pool", NB_HDR_MBUF, 32, 656ea0c20eaSOlivier Matz 0, HDR_MBUF_DATA_SIZE, rte_socket_id()); 657af75078fSIntel 658af75078fSIntel if (header_pool == NULL) 659af75078fSIntel rte_exit(EXIT_FAILURE, "Cannot init header mbuf pool\n"); 660af75078fSIntel 661ea0c20eaSOlivier Matz clone_pool = rte_pktmbuf_pool_create("clone_pool", NB_CLONE_MBUF, 32, 662ea0c20eaSOlivier Matz 0, 0, rte_socket_id()); 663af75078fSIntel 664af75078fSIntel if (clone_pool == NULL) 665af75078fSIntel rte_exit(EXIT_FAILURE, "Cannot init clone mbuf pool\n"); 666af75078fSIntel 667d9a42a69SThomas Monjalon nb_ports = rte_eth_dev_count_avail(); 668af75078fSIntel if (nb_ports == 0) 669af75078fSIntel rte_exit(EXIT_FAILURE, "No physical ports!\n"); 670af75078fSIntel if (nb_ports > MAX_PORTS) 671af75078fSIntel nb_ports = MAX_PORTS; 672af75078fSIntel 673af75078fSIntel nb_lcores = rte_lcore_count(); 674af75078fSIntel 675af75078fSIntel /* initialize all ports */ 6768728ccf3SThomas Monjalon RTE_ETH_FOREACH_DEV(portid) { 6776b85f708SShahaf Shuler struct rte_eth_rxconf rxq_conf; 6786b85f708SShahaf Shuler struct rte_eth_conf local_port_conf = port_conf; 6796b85f708SShahaf Shuler 680af75078fSIntel /* skip ports that are not enabled */ 681af75078fSIntel if ((enabled_port_mask & (1 << portid)) == 0) { 682af75078fSIntel printf("Skipping disabled port %d\n", portid); 683af75078fSIntel continue; 684af75078fSIntel } 685af75078fSIntel 686af75078fSIntel qconf = &lcore_queue_conf[rx_lcore_id]; 687af75078fSIntel 6885e470a66SAndriy Berestovskyy /* limit the frame size to the maximum supported by NIC */ 6895e470a66SAndriy Berestovskyy rte_eth_dev_info_get(portid, &dev_info); 6906b85f708SShahaf Shuler local_port_conf.rxmode.max_rx_pkt_len = RTE_MIN( 6916b85f708SShahaf Shuler dev_info.max_rx_pktlen, 6926b85f708SShahaf Shuler local_port_conf.rxmode.max_rx_pkt_len); 6935e470a66SAndriy Berestovskyy 694af75078fSIntel /* get the lcore_id for this port */ 695af75078fSIntel while (rte_lcore_is_enabled(rx_lcore_id) == 0 || 696af75078fSIntel qconf->n_rx_queue == (unsigned)rx_queue_per_lcore) { 697af75078fSIntel 698af75078fSIntel rx_lcore_id ++; 699af75078fSIntel qconf = &lcore_queue_conf[rx_lcore_id]; 700af75078fSIntel 701af75078fSIntel if (rx_lcore_id >= RTE_MAX_LCORE) 702af75078fSIntel rte_exit(EXIT_FAILURE, "Not enough cores\n"); 703af75078fSIntel } 704af75078fSIntel qconf->rx_queue_list[qconf->n_rx_queue] = portid; 705af75078fSIntel qconf->n_rx_queue++; 706af75078fSIntel 707af75078fSIntel /* init port */ 708af75078fSIntel printf("Initializing port %d on lcore %u... ", portid, 709af75078fSIntel rx_lcore_id); 710af75078fSIntel fflush(stdout); 711af75078fSIntel 712af75078fSIntel n_tx_queue = nb_lcores; 713af75078fSIntel if (n_tx_queue > MAX_TX_QUEUE_PER_PORT) 714af75078fSIntel n_tx_queue = MAX_TX_QUEUE_PER_PORT; 7156b85f708SShahaf Shuler 716af75078fSIntel ret = rte_eth_dev_configure(portid, 1, (uint16_t)n_tx_queue, 7176b85f708SShahaf Shuler &local_port_conf); 718af75078fSIntel if (ret < 0) 719af75078fSIntel rte_exit(EXIT_FAILURE, "Cannot configure device: err=%d, port=%d\n", 720af75078fSIntel ret, portid); 721af75078fSIntel 72260efb44fSRoman Zhukov ret = rte_eth_dev_adjust_nb_rx_tx_desc(portid, &nb_rxd, 72360efb44fSRoman Zhukov &nb_txd); 72460efb44fSRoman Zhukov if (ret < 0) 72560efb44fSRoman Zhukov rte_exit(EXIT_FAILURE, 72660efb44fSRoman Zhukov "Cannot adjust number of descriptors: err=%d, port=%d\n", 72760efb44fSRoman Zhukov ret, portid); 72860efb44fSRoman Zhukov 729af75078fSIntel rte_eth_macaddr_get(portid, &ports_eth_addr[portid]); 730af75078fSIntel print_ethaddr(" Address:", &ports_eth_addr[portid]); 731af75078fSIntel printf(", "); 732af75078fSIntel 733af75078fSIntel /* init one RX queue */ 734af75078fSIntel queueid = 0; 735af75078fSIntel printf("rxq=%hu ", queueid); 736af75078fSIntel fflush(stdout); 7376b85f708SShahaf Shuler rxq_conf = dev_info.default_rxconf; 7386b85f708SShahaf Shuler rxq_conf.offloads = local_port_conf.rxmode.offloads; 739af75078fSIntel ret = rte_eth_rx_queue_setup(portid, queueid, nb_rxd, 74081f7ecd9SPablo de Lara rte_eth_dev_socket_id(portid), 7416b85f708SShahaf Shuler &rxq_conf, 742af75078fSIntel packet_pool); 743af75078fSIntel if (ret < 0) 744af75078fSIntel rte_exit(EXIT_FAILURE, "rte_eth_tx_queue_setup: err=%d, port=%d\n", 745af75078fSIntel ret, portid); 746af75078fSIntel 747af75078fSIntel /* init one TX queue per couple (lcore,port) */ 748af75078fSIntel queueid = 0; 749af75078fSIntel 750af75078fSIntel RTE_LCORE_FOREACH(lcore_id) { 751af75078fSIntel if (rte_lcore_is_enabled(lcore_id) == 0) 752af75078fSIntel continue; 753af75078fSIntel printf("txq=%u,%hu ", lcore_id, queueid); 754af75078fSIntel fflush(stdout); 75581f7ecd9SPablo de Lara 75681f7ecd9SPablo de Lara txconf = &dev_info.default_txconf; 7576b85f708SShahaf Shuler txconf->offloads = local_port_conf.txmode.offloads; 758af75078fSIntel ret = rte_eth_tx_queue_setup(portid, queueid, nb_txd, 75981f7ecd9SPablo de Lara rte_lcore_to_socket_id(lcore_id), txconf); 760af75078fSIntel if (ret < 0) 761af75078fSIntel rte_exit(EXIT_FAILURE, "rte_eth_tx_queue_setup: err=%d, " 762af75078fSIntel "port=%d\n", ret, portid); 763af75078fSIntel 764af75078fSIntel qconf = &lcore_queue_conf[lcore_id]; 765af75078fSIntel qconf->tx_queue_id[portid] = queueid; 766af75078fSIntel queueid++; 767af75078fSIntel } 76823021f1cSWei Zhao rte_eth_allmulticast_enable(portid); 769af75078fSIntel /* Start device */ 770af75078fSIntel ret = rte_eth_dev_start(portid); 771af75078fSIntel if (ret < 0) 772af75078fSIntel rte_exit(EXIT_FAILURE, "rte_eth_dev_start: err=%d, port=%d\n", 773af75078fSIntel ret, portid); 774af75078fSIntel 775d3641ae8SIntel printf("done:\n"); 776af75078fSIntel } 777af75078fSIntel 7788728ccf3SThomas Monjalon check_all_ports_link_status(enabled_port_mask); 779af75078fSIntel 780af75078fSIntel /* initialize the multicast hash */ 781af75078fSIntel int retval = init_mcast_hash(); 782af75078fSIntel if (retval != 0) 783af75078fSIntel rte_exit(EXIT_FAILURE, "Cannot build the multicast hash\n"); 784af75078fSIntel 785af75078fSIntel /* launch per-lcore init on every lcore */ 786af75078fSIntel rte_eal_mp_remote_launch(main_loop, NULL, CALL_MASTER); 787af75078fSIntel RTE_LCORE_FOREACH_SLAVE(lcore_id) { 788af75078fSIntel if (rte_eal_wait_lcore(lcore_id) < 0) 789af75078fSIntel return -1; 790af75078fSIntel } 791af75078fSIntel 792af75078fSIntel return 0; 793af75078fSIntel } 794