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         uint64_t tx_offloads;
  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         tx_offloads = txp->dev_conf.txmode.offloads;
 112         if (tx_offloads & DEV_TX_OFFLOAD_VLAN_INSERT)
 113                 ol_flags = PKT_TX_VLAN_PKT;
 114         if (tx_offloads & DEV_TX_OFFLOAD_QINQ_INSERT)
 115                 ol_flags |= PKT_TX_QINQ_PKT;
 116         if (tx_offloads & DEV_TX_OFFLOAD_MACSEC_INSERT)
 117                 ol_flags |= PKT_TX_MACSEC;
 118         for (i = 0; i < nb_rx; i++) {
 119                 if (likely(i < nb_rx - 1))
 120                         rte_prefetch0(rte_pktmbuf_mtod(pkts_burst[i + 1],
 121                                                        void *));
 122                 mb = pkts_burst[i];
 123                 eth_hdr = rte_pktmbuf_mtod(mb, struct ether_hdr *);
 124
 125                 /* Swap dest and src mac addresses. */
 126                 ether_addr_copy(&eth_hdr->d_addr, &addr);
 127                 ether_addr_copy(&eth_hdr->s_addr, &eth_hdr->d_addr);
 128                 ether_addr_copy(&addr, &eth_hdr->s_addr);
 129
 130                 mb->ol_flags = ol_flags;
 131                 mb->l2_len = sizeof(struct ether_hdr);
 132                 mb->l3_len = sizeof(struct ipv4_hdr);
 133                 mb->vlan_tci = txp->tx_vlan_id;
 134                 mb->vlan_tci_outer = txp->tx_vlan_id_outer;
 135         }
 136         nb_tx = rte_eth_tx_burst(fs->tx_port, fs->tx_queue, pkts_burst, nb_rx);
 137         /*
 138          * Retry if necessary
 139          */
 140         if (unlikely(nb_tx < nb_rx) && fs->retry_enabled) {
 141                 retry = 0;
 142                 while (nb_tx < nb_rx && retry++ < burst_tx_retry_num) {
 143                         rte_delay_us(burst_tx_delay_time);
 144                         nb_tx += rte_eth_tx_burst(fs->tx_port, fs->tx_queue,
 145                                         &pkts_burst[nb_tx], nb_rx - nb_tx);
 146                 }
 147         }
 148         fs->tx_packets += nb_tx;
 149 #ifdef RTE_TEST_PMD_RECORD_BURST_STATS
 150         fs->tx_burst_stats.pkt_burst_spread[nb_tx]++;
 151 #endif
 152         if (unlikely(nb_tx < nb_rx)) {
 153                 fs->fwd_dropped += (nb_rx - nb_tx);
 154                 do {
 155                         rte_pktmbuf_free(pkts_burst[nb_tx]);
 156                 } while (++nb_tx < nb_rx);
 157         }
 158 #ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
 159         end_tsc = rte_rdtsc();
 160         core_cycles = (end_tsc - start_tsc);
 161         fs->core_cycles = (uint64_t) (fs->core_cycles + core_cycles);
 162 #endif
 163 }
 164
 165 struct fwd_engine mac_swap_engine = {
 166         .fwd_mode_name  = "macswap",
 167         .port_fwd_begin = NULL,
 168         .port_fwd_end   = NULL,
 169         .packet_fwd     = pkt_burst_mac_swap,
 170 };