app/test-pmd/macswap.c

   1 /*-
   2  *   BSD LICENSE
   3  *
   4  *   Copyright(c) 2014 Tilera Corporation. All rights reserved.
   5  *
   6  *   Redistribution and use in source and binary forms, with or without
   7  *   modification, are permitted provided that the following conditions
   8  *   are met:
   9  *
  10  *     * Redistributions of source code must retain the above copyright
  11  *       notice, this list of conditions and the following disclaimer.
  12  *     * Redistributions in binary form must reproduce the above copyright
  13  *       notice, this list of conditions and the following disclaimer in
  14  *       the documentation and/or other materials provided with the
  15  *       distribution.
  16  *     * Neither the name of Tilera Corporation nor the names of its
  17  *       contributors may be used to endorse or promote products derived
  18  *       from this software without specific prior written permission.
  19  *
  20  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  21  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  22  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  23  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  24  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  25  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  26  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  27  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  28  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  29  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  30  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  31  *
  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_launch.h>
  53 #include <rte_eal.h>
  54 #include <rte_per_lcore.h>
  55 #include <rte_lcore.h>
  56 #include <rte_atomic.h>
  57 #include <rte_branch_prediction.h>
  58 #include <rte_mempool.h>
  59 #include <rte_mbuf.h>
  60 #include <rte_interrupts.h>
  61 #include <rte_pci.h>
  62 #include <rte_ether.h>
  63 #include <rte_ethdev.h>
  64 #include <rte_ip.h>
  65 #include <rte_string_fns.h>
  66 #include <rte_flow.h>
  67
  68 #include "testpmd.h"
  69
  70 /*
  71  * MAC swap forwarding mode: Swap the source and the destination Ethernet
  72  * addresses of packets before forwarding them.
  73  */
  74 static void
  75 pkt_burst_mac_swap(struct fwd_stream *fs)
  76 {
  77         struct rte_mbuf  *pkts_burst[MAX_PKT_BURST];
  78         struct rte_port  *txp;
  79         struct rte_mbuf  *mb;
  80         struct ether_hdr *eth_hdr;
  81         struct ether_addr addr;
  82         uint16_t nb_rx;
  83         uint16_t nb_tx;
  84         uint16_t i;
  85         uint32_t retry;
  86         uint64_t ol_flags = 0;
  87 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
  88         uint64_t start_tsc;
  89         uint64_t end_tsc;
  90         uint64_t core_cycles;
  91 #endif
  92
  93 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
  94         start_tsc = rte_rdtsc();
  95 #endif
  96
  97         /*
  98          * Receive a burst of packets and forward them.
  99          */
 100         nb_rx = rte_eth_rx_burst(fs->rx_port, fs->rx_queue, pkts_burst,
 101                                  nb_pkt_per_burst);
 102         if (unlikely(nb_rx == 0))
 103                 return;
 104
 105 #ifdef RTE_TEST_PMD_RECORD_BURST_STATS
 106         fs->rx_burst_stats.pkt_burst_spread[nb_rx]++;
 107 #endif
 108         fs->rx_packets += nb_rx;
 109         txp = &ports[fs->tx_port];
 110         if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_INSERT_VLAN)
 111                 ol_flags = PKT_TX_VLAN_PKT;
 112         if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_INSERT_QINQ)
 113                 ol_flags |= PKT_TX_QINQ_PKT;
 114         if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_MACSEC)
 115                 ol_flags |= PKT_TX_MACSEC;
 116         for (i = 0; i < nb_rx; i++) {
 117                 if (likely(i < nb_rx - 1))
 118                         rte_prefetch0(rte_pktmbuf_mtod(pkts_burst[i + 1],
 119                                                        void *));
 120                 mb = pkts_burst[i];
 121                 eth_hdr = rte_pktmbuf_mtod(mb, struct ether_hdr *);
 122
 123                 /* Swap dest and src mac addresses. */
 124                 ether_addr_copy(&eth_hdr->d_addr, &addr);
 125                 ether_addr_copy(&eth_hdr->s_addr, &eth_hdr->d_addr);
 126                 ether_addr_copy(&addr, &eth_hdr->s_addr);
 127
 128                 mb->ol_flags = ol_flags;
 129                 mb->l2_len = sizeof(struct ether_hdr);
 130                 mb->l3_len = sizeof(struct ipv4_hdr);
 131                 mb->vlan_tci = txp->tx_vlan_id;
 132                 mb->vlan_tci_outer = txp->tx_vlan_id_outer;
 133         }
 134         nb_tx = rte_eth_tx_burst(fs->tx_port, fs->tx_queue, pkts_burst, nb_rx);
 135         /*
 136          * Retry if necessary
 137          */
 138         if (unlikely(nb_tx < nb_rx) && fs->retry_enabled) {
 139                 retry = 0;
 140                 while (nb_tx < nb_rx && retry++ < burst_tx_retry_num) {
 141                         rte_delay_us(burst_tx_delay_time);
 142                         nb_tx += rte_eth_tx_burst(fs->tx_port, fs->tx_queue,
 143                                         &pkts_burst[nb_tx], nb_rx - nb_tx);
 144                 }
 145         }
 146         fs->tx_packets += nb_tx;
 147 #ifdef RTE_TEST_PMD_RECORD_BURST_STATS
 148         fs->tx_burst_stats.pkt_burst_spread[nb_tx]++;
 149 #endif
 150         if (unlikely(nb_tx < nb_rx)) {
 151                 fs->fwd_dropped += (nb_rx - nb_tx);
 152                 do {
 153                         rte_pktmbuf_free(pkts_burst[nb_tx]);
 154                 } while (++nb_tx < nb_rx);
 155         }
 156 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
 157         end_tsc = rte_rdtsc();
 158         core_cycles = (end_tsc - start_tsc);
 159         fs->core_cycles = (uint64_t) (fs->core_cycles + core_cycles);
 160 #endif
 161 }
 162
 163 struct fwd_engine mac_swap_engine = {
 164         .fwd_mode_name  = "macswap",
 165         .port_fwd_begin = NULL,
 166         .port_fwd_end   = NULL,
 167         .packet_fwd     = pkt_burst_mac_swap,
 168 };