1 /*- 2 * BSD LICENSE 3 * 4 * Copyright(c) 2010-2014 Intel Corporation. All rights reserved. 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 11 * * Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * * Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in 15 * the documentation and/or other materials provided with the 16 * distribution. 17 * * Neither the name of Intel Corporation nor the names of its 18 * contributors may be used to endorse or promote products derived 19 * from this software without specific prior written permission. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 22 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 23 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 24 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 25 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 26 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 27 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 28 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 29 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 30 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 31 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 32 */ 33 34 #include <stdarg.h> 35 #include <string.h> 36 #include <stdio.h> 37 #include <errno.h> 38 #include <stdint.h> 39 #include <unistd.h> 40 #include <inttypes.h> 41 42 #include <sys/queue.h> 43 #include <sys/stat.h> 44 45 #include <rte_common.h> 46 #include <rte_byteorder.h> 47 #include <rte_log.h> 48 #include <rte_debug.h> 49 #include <rte_cycles.h> 50 #include <rte_memory.h> 51 #include <rte_memcpy.h> 52 #include <rte_memzone.h> 53 #include <rte_launch.h> 54 #include <rte_eal.h> 55 #include <rte_per_lcore.h> 56 #include <rte_lcore.h> 57 #include <rte_atomic.h> 58 #include <rte_branch_prediction.h> 59 #include <rte_memory.h> 60 #include <rte_mempool.h> 61 #include <rte_mbuf.h> 62 #include <rte_memcpy.h> 63 #include <rte_interrupts.h> 64 #include <rte_pci.h> 65 #include <rte_ether.h> 66 #include <rte_ethdev.h> 67 #include <rte_ip.h> 68 #include <rte_tcp.h> 69 #include <rte_udp.h> 70 #include <rte_string_fns.h> 71 #include <rte_flow.h> 72 73 #include "testpmd.h" 74 75 #define UDP_SRC_PORT 1024 76 #define UDP_DST_PORT 1024 77 78 #define IP_SRC_ADDR ((192U << 24) | (168 << 16) | (0 << 8) | 1) 79 #define IP_DST_ADDR ((192U << 24) | (168 << 16) | (0 << 8) | 2) 80 81 #define IP_DEFTTL 64 /* from RFC 1340. */ 82 #define IP_VERSION 0x40 83 #define IP_HDRLEN 0x05 /* default IP header length == five 32-bits words. */ 84 #define IP_VHL_DEF (IP_VERSION | IP_HDRLEN) 85 86 static struct ipv4_hdr pkt_ip_hdr; /**< IP header of transmitted packets. */ 87 static struct udp_hdr pkt_udp_hdr; /**< UDP header of transmitted packets. */ 88 89 static void 90 copy_buf_to_pkt_segs(void* buf, unsigned len, struct rte_mbuf *pkt, 91 unsigned offset) 92 { 93 struct rte_mbuf *seg; 94 void *seg_buf; 95 unsigned copy_len; 96 97 seg = pkt; 98 while (offset >= seg->data_len) { 99 offset -= seg->data_len; 100 seg = seg->next; 101 } 102 copy_len = seg->data_len - offset; 103 seg_buf = rte_pktmbuf_mtod_offset(seg, char *, offset); 104 while (len > copy_len) { 105 rte_memcpy(seg_buf, buf, (size_t) copy_len); 106 len -= copy_len; 107 buf = ((char*) buf + copy_len); 108 seg = seg->next; 109 seg_buf = rte_pktmbuf_mtod(seg, char *); 110 } 111 rte_memcpy(seg_buf, buf, (size_t) len); 112 } 113 114 static inline void 115 copy_buf_to_pkt(void* buf, unsigned len, struct rte_mbuf *pkt, unsigned offset) 116 { 117 if (offset + len <= pkt->data_len) { 118 rte_memcpy(rte_pktmbuf_mtod_offset(pkt, char *, offset), 119 buf, (size_t) len); 120 return; 121 } 122 copy_buf_to_pkt_segs(buf, len, pkt, offset); 123 } 124 125 static void 126 setup_pkt_udp_ip_headers(struct ipv4_hdr *ip_hdr, 127 struct udp_hdr *udp_hdr, 128 uint16_t pkt_data_len) 129 { 130 uint16_t *ptr16; 131 uint32_t ip_cksum; 132 uint16_t pkt_len; 133 134 /* 135 * Initialize UDP header. 136 */ 137 pkt_len = (uint16_t) (pkt_data_len + sizeof(struct udp_hdr)); 138 udp_hdr->src_port = rte_cpu_to_be_16(UDP_SRC_PORT); 139 udp_hdr->dst_port = rte_cpu_to_be_16(UDP_DST_PORT); 140 udp_hdr->dgram_len = RTE_CPU_TO_BE_16(pkt_len); 141 udp_hdr->dgram_cksum = 0; /* No UDP checksum. */ 142 143 /* 144 * Initialize IP header. 145 */ 146 pkt_len = (uint16_t) (pkt_len + sizeof(struct ipv4_hdr)); 147 ip_hdr->version_ihl = IP_VHL_DEF; 148 ip_hdr->type_of_service = 0; 149 ip_hdr->fragment_offset = 0; 150 ip_hdr->time_to_live = IP_DEFTTL; 151 ip_hdr->next_proto_id = IPPROTO_UDP; 152 ip_hdr->packet_id = 0; 153 ip_hdr->total_length = RTE_CPU_TO_BE_16(pkt_len); 154 ip_hdr->src_addr = rte_cpu_to_be_32(IP_SRC_ADDR); 155 ip_hdr->dst_addr = rte_cpu_to_be_32(IP_DST_ADDR); 156 157 /* 158 * Compute IP header checksum. 159 */ 160 ptr16 = (unaligned_uint16_t*) ip_hdr; 161 ip_cksum = 0; 162 ip_cksum += ptr16[0]; ip_cksum += ptr16[1]; 163 ip_cksum += ptr16[2]; ip_cksum += ptr16[3]; 164 ip_cksum += ptr16[4]; 165 ip_cksum += ptr16[6]; ip_cksum += ptr16[7]; 166 ip_cksum += ptr16[8]; ip_cksum += ptr16[9]; 167 168 /* 169 * Reduce 32 bit checksum to 16 bits and complement it. 170 */ 171 ip_cksum = ((ip_cksum & 0xFFFF0000) >> 16) + 172 (ip_cksum & 0x0000FFFF); 173 if (ip_cksum > 65535) 174 ip_cksum -= 65535; 175 ip_cksum = (~ip_cksum) & 0x0000FFFF; 176 if (ip_cksum == 0) 177 ip_cksum = 0xFFFF; 178 ip_hdr->hdr_checksum = (uint16_t) ip_cksum; 179 } 180 181 /* 182 * Transmit a burst of multi-segments packets. 183 */ 184 static void 185 pkt_burst_transmit(struct fwd_stream *fs) 186 { 187 struct rte_mbuf *pkts_burst[MAX_PKT_BURST]; 188 struct rte_port *txp; 189 struct rte_mbuf *pkt; 190 struct rte_mbuf *pkt_seg; 191 struct rte_mempool *mbp; 192 struct ether_hdr eth_hdr; 193 uint16_t nb_tx; 194 uint16_t nb_pkt; 195 uint16_t vlan_tci, vlan_tci_outer; 196 uint32_t retry; 197 uint64_t ol_flags = 0; 198 uint8_t i; 199 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES 200 uint64_t start_tsc; 201 uint64_t end_tsc; 202 uint64_t core_cycles; 203 #endif 204 uint32_t nb_segs, pkt_len; 205 206 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES 207 start_tsc = rte_rdtsc(); 208 #endif 209 210 mbp = current_fwd_lcore()->mbp; 211 txp = &ports[fs->tx_port]; 212 vlan_tci = txp->tx_vlan_id; 213 vlan_tci_outer = txp->tx_vlan_id_outer; 214 if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_INSERT_VLAN) 215 ol_flags = PKT_TX_VLAN_PKT; 216 if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_INSERT_QINQ) 217 ol_flags |= PKT_TX_QINQ_PKT; 218 if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_MACSEC) 219 ol_flags |= PKT_TX_MACSEC; 220 for (nb_pkt = 0; nb_pkt < nb_pkt_per_burst; nb_pkt++) { 221 pkt = rte_mbuf_raw_alloc(mbp); 222 if (pkt == NULL) { 223 nomore_mbuf: 224 if (nb_pkt == 0) 225 return; 226 break; 227 } 228 229 /* 230 * Using raw alloc is good to improve performance, 231 * but some consumers may use the headroom and so 232 * decrement data_off. We need to make sure it is 233 * reset to default value. 234 */ 235 rte_pktmbuf_reset_headroom(pkt); 236 pkt->data_len = tx_pkt_seg_lengths[0]; 237 pkt_seg = pkt; 238 if (tx_pkt_split == TX_PKT_SPLIT_RND) 239 nb_segs = random() % tx_pkt_nb_segs + 1; 240 else 241 nb_segs = tx_pkt_nb_segs; 242 pkt_len = pkt->data_len; 243 for (i = 1; i < nb_segs; i++) { 244 pkt_seg->next = rte_mbuf_raw_alloc(mbp); 245 if (pkt_seg->next == NULL) { 246 pkt->nb_segs = i; 247 rte_pktmbuf_free(pkt); 248 goto nomore_mbuf; 249 } 250 pkt_seg = pkt_seg->next; 251 pkt_seg->data_len = tx_pkt_seg_lengths[i]; 252 pkt_len += pkt_seg->data_len; 253 } 254 pkt_seg->next = NULL; /* Last segment of packet. */ 255 256 /* 257 * Initialize Ethernet header. 258 */ 259 ether_addr_copy(&peer_eth_addrs[fs->peer_addr],ð_hdr.d_addr); 260 ether_addr_copy(&ports[fs->tx_port].eth_addr, ð_hdr.s_addr); 261 eth_hdr.ether_type = rte_cpu_to_be_16(ETHER_TYPE_IPv4); 262 263 /* 264 * Copy headers in first packet segment(s). 265 */ 266 copy_buf_to_pkt(ð_hdr, sizeof(eth_hdr), pkt, 0); 267 copy_buf_to_pkt(&pkt_ip_hdr, sizeof(pkt_ip_hdr), pkt, 268 sizeof(struct ether_hdr)); 269 copy_buf_to_pkt(&pkt_udp_hdr, sizeof(pkt_udp_hdr), pkt, 270 sizeof(struct ether_hdr) + 271 sizeof(struct ipv4_hdr)); 272 273 /* 274 * Complete first mbuf of packet and append it to the 275 * burst of packets to be transmitted. 276 */ 277 pkt->nb_segs = nb_segs; 278 pkt->pkt_len = pkt_len; 279 pkt->ol_flags = ol_flags; 280 pkt->vlan_tci = vlan_tci; 281 pkt->vlan_tci_outer = vlan_tci_outer; 282 pkt->l2_len = sizeof(struct ether_hdr); 283 pkt->l3_len = sizeof(struct ipv4_hdr); 284 pkts_burst[nb_pkt] = pkt; 285 } 286 nb_tx = rte_eth_tx_burst(fs->tx_port, fs->tx_queue, pkts_burst, nb_pkt); 287 /* 288 * Retry if necessary 289 */ 290 if (unlikely(nb_tx < nb_pkt) && fs->retry_enabled) { 291 retry = 0; 292 while (nb_tx < nb_pkt && retry++ < burst_tx_retry_num) { 293 rte_delay_us(burst_tx_delay_time); 294 nb_tx += rte_eth_tx_burst(fs->tx_port, fs->tx_queue, 295 &pkts_burst[nb_tx], nb_pkt - nb_tx); 296 } 297 } 298 fs->tx_packets += nb_tx; 299 300 #ifdef RTE_TEST_PMD_RECORD_BURST_STATS 301 fs->tx_burst_stats.pkt_burst_spread[nb_tx]++; 302 #endif 303 if (unlikely(nb_tx < nb_pkt)) { 304 if (verbose_level > 0 && fs->fwd_dropped == 0) 305 printf("port %d tx_queue %d - drop " 306 "(nb_pkt:%u - nb_tx:%u)=%u packets\n", 307 fs->tx_port, fs->tx_queue, 308 (unsigned) nb_pkt, (unsigned) nb_tx, 309 (unsigned) (nb_pkt - nb_tx)); 310 fs->fwd_dropped += (nb_pkt - nb_tx); 311 do { 312 rte_pktmbuf_free(pkts_burst[nb_tx]); 313 } while (++nb_tx < nb_pkt); 314 } 315 316 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES 317 end_tsc = rte_rdtsc(); 318 core_cycles = (end_tsc - start_tsc); 319 fs->core_cycles = (uint64_t) (fs->core_cycles + core_cycles); 320 #endif 321 } 322 323 static void 324 tx_only_begin(__attribute__((unused)) portid_t pi) 325 { 326 uint16_t pkt_data_len; 327 328 pkt_data_len = (uint16_t) (tx_pkt_length - (sizeof(struct ether_hdr) + 329 sizeof(struct ipv4_hdr) + 330 sizeof(struct udp_hdr))); 331 setup_pkt_udp_ip_headers(&pkt_ip_hdr, &pkt_udp_hdr, pkt_data_len); 332 } 333 334 struct fwd_engine tx_only_engine = { 335 .fwd_mode_name = "txonly", 336 .port_fwd_begin = tx_only_begin, 337 .port_fwd_end = NULL, 338 .packet_fwd = pkt_burst_transmit, 339 }; 340