app/test-pmd/txonly.c

   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],&eth_hdr.d_addr);
 260                 ether_addr_copy(&ports[fs->tx_port].eth_addr, &eth_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(&eth_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 };