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_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_mempool.h>
  60 #include <rte_mbuf.h>
  61 #include <rte_interrupts.h>
  62 #include <rte_pci.h>
  63 #include <rte_ether.h>
  64 #include <rte_ethdev.h>
  65 #include <rte_ip.h>
  66 #include <rte_string_fns.h>
  67 #include <rte_flow.h>
  68
  69 #include "testpmd.h"
  70
  71 /*
  72  * MAC swap forwarding mode: Swap the source and the destination Ethernet
  73  * addresses of packets before forwarding them.
  74  */
  75 static void
  76 pkt_burst_mac_swap(struct fwd_stream *fs)
  77 {
  78         struct rte_mbuf  *pkts_burst[MAX_PKT_BURST];
  79         struct rte_port  *txp;
  80         struct rte_mbuf  *mb;
  81         struct ether_hdr *eth_hdr;
  82         struct ether_addr addr;
  83         uint16_t nb_rx;
  84         uint16_t nb_tx;
  85         uint16_t i;
  86         uint32_t retry;
  87         uint64_t ol_flags = 0;
  88 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
  89         uint64_t start_tsc;
  90         uint64_t end_tsc;
  91         uint64_t core_cycles;
  92 #endif
  93
  94 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
  95         start_tsc = rte_rdtsc();
  96 #endif
  97
  98         /*
  99          * Receive a burst of packets and forward them.
 100          */
 101         nb_rx = rte_eth_rx_burst(fs->rx_port, fs->rx_queue, pkts_burst,
 102                                  nb_pkt_per_burst);
 103         if (unlikely(nb_rx == 0))
 104                 return;
 105
 106 #ifdef RTE_TEST_PMD_RECORD_BURST_STATS
 107         fs->rx_burst_stats.pkt_burst_spread[nb_rx]++;
 108 #endif
 109         fs->rx_packets += nb_rx;
 110         txp = &ports[fs->tx_port];
 111         if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_INSERT_VLAN)
 112                 ol_flags = PKT_TX_VLAN_PKT;
 113         if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_INSERT_QINQ)
 114                 ol_flags |= PKT_TX_QINQ_PKT;
 115         if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_MACSEC)
 116                 ol_flags |= PKT_TX_MACSEC;
 117         for (i = 0; i < nb_rx; i++) {
 118                 if (likely(i < nb_rx - 1))
 119                         rte_prefetch0(rte_pktmbuf_mtod(pkts_burst[i + 1],
 120                                                        void *));
 121                 mb = pkts_burst[i];
 122                 eth_hdr = rte_pktmbuf_mtod(mb, struct ether_hdr *);
 123
 124                 /* Swap dest and src mac addresses. */
 125                 ether_addr_copy(&eth_hdr->d_addr, &addr);
 126                 ether_addr_copy(&eth_hdr->s_addr, &eth_hdr->d_addr);
 127                 ether_addr_copy(&addr, &eth_hdr->s_addr);
 128
 129                 mb->ol_flags = ol_flags;
 130                 mb->l2_len = sizeof(struct ether_hdr);
 131                 mb->l3_len = sizeof(struct ipv4_hdr);
 132                 mb->vlan_tci = txp->tx_vlan_id;
 133                 mb->vlan_tci_outer = txp->tx_vlan_id_outer;
 134         }
 135         nb_tx = rte_eth_tx_burst(fs->tx_port, fs->tx_queue, pkts_burst, nb_rx);
 136         /*
 137          * Retry if necessary
 138          */
 139         if (unlikely(nb_tx < nb_rx) && fs->retry_enabled) {
 140                 retry = 0;
 141                 while (nb_tx < nb_rx && retry++ < burst_tx_retry_num) {
 142                         rte_delay_us(burst_tx_delay_time);
 143                         nb_tx += rte_eth_tx_burst(fs->tx_port, fs->tx_queue,
 144                                         &pkts_burst[nb_tx], nb_rx - nb_tx);
 145                 }
 146         }
 147         fs->tx_packets += nb_tx;
 148 #ifdef RTE_TEST_PMD_RECORD_BURST_STATS
 149         fs->tx_burst_stats.pkt_burst_spread[nb_tx]++;
 150 #endif
 151         if (unlikely(nb_tx < nb_rx)) {
 152                 fs->fwd_dropped += (nb_rx - nb_tx);
 153                 do {
 154                         rte_pktmbuf_free(pkts_burst[nb_tx]);
 155                 } while (++nb_tx < nb_rx);
 156         }
 157 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
 158         end_tsc = rte_rdtsc();
 159         core_cycles = (end_tsc - start_tsc);
 160         fs->core_cycles = (uint64_t) (fs->core_cycles + core_cycles);
 161 #endif
 162 }
 163
 164 struct fwd_engine mac_swap_engine = {
 165         .fwd_mode_name  = "macswap",
 166         .port_fwd_begin = NULL,
 167         .port_fwd_end   = NULL,
 168         .packet_fwd     = pkt_burst_mac_swap,
 169 };