[ceph.git] / ceph / src / dpdk / app / test-pmd / macswap.c

/*-
 *   BSD LICENSE
 *
 *   Copyright(c) 2014 Tilera Corporation. All rights reserved.
 *
 *   Redistribution and use in source and binary forms, with or without
 *   modification, are permitted provided that the following conditions
 *   are met:
 *
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above copyright
 *       notice, this list of conditions and the following disclaimer in
 *       the documentation and/or other materials provided with the
 *       distribution.
 *     * Neither the name of Tilera Corporation nor the names of its
 *       contributors may be used to endorse or promote products derived
 *       from this software without specific prior written permission.
 *
 *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 */

#include <stdarg.h>
#include <string.h>
#include <stdio.h>
#include <errno.h>
#include <stdint.h>
#include <unistd.h>
#include <inttypes.h>

#include <sys/queue.h>
#include <sys/stat.h>

#include <rte_common.h>
#include <rte_byteorder.h>
#include <rte_log.h>
#include <rte_debug.h>
#include <rte_cycles.h>
#include <rte_memory.h>
#include <rte_memcpy.h>
#include <rte_memzone.h>
#include <rte_launch.h>
#include <rte_eal.h>
#include <rte_per_lcore.h>
#include <rte_lcore.h>
#include <rte_atomic.h>
#include <rte_branch_prediction.h>
#include <rte_memory.h>
#include <rte_mempool.h>
#include <rte_mbuf.h>
#include <rte_interrupts.h>
#include <rte_pci.h>
#include <rte_ether.h>
#include <rte_ethdev.h>
#include <rte_ip.h>
#include <rte_string_fns.h>

#include "testpmd.h"

/*
 * MAC swap forwarding mode: Swap the source and the destination Ethernet
 * addresses of packets before forwarding them.
 */
static void
pkt_burst_mac_swap(struct fwd_stream *fs)
{
	struct rte_mbuf  *pkts_burst[MAX_PKT_BURST];
	struct rte_port  *txp;
	struct rte_mbuf  *mb;
	struct ether_hdr *eth_hdr;
	struct ether_addr addr;
	uint16_t nb_rx;
	uint16_t nb_tx;
	uint16_t i;
	uint32_t retry;
	uint64_t ol_flags = 0;
#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
	uint64_t start_tsc;
	uint64_t end_tsc;
	uint64_t core_cycles;
#endif

#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
	start_tsc = rte_rdtsc();
#endif

	/*
	 * Receive a burst of packets and forward them.
	 */
	nb_rx = rte_eth_rx_burst(fs->rx_port, fs->rx_queue, pkts_burst,
				 nb_pkt_per_burst);
	if (unlikely(nb_rx == 0))
		return;

#ifdef RTE_TEST_PMD_RECORD_BURST_STATS
	fs->rx_burst_stats.pkt_burst_spread[nb_rx]++;
#endif
	fs->rx_packets += nb_rx;
	txp = &ports[fs->tx_port];
	if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_INSERT_VLAN)
		ol_flags = PKT_TX_VLAN_PKT;
	if (txp->tx_ol_flags & TESTPMD_TX_OFFLOAD_INSERT_QINQ)
		ol_flags |= PKT_TX_QINQ_PKT;
	for (i = 0; i < nb_rx; i++) {
		if (likely(i < nb_rx - 1))
			rte_prefetch0(rte_pktmbuf_mtod(pkts_burst[i + 1],
						       void *));
		mb = pkts_burst[i];
		eth_hdr = rte_pktmbuf_mtod(mb, struct ether_hdr *);

		/* Swap dest and src mac addresses. */
		ether_addr_copy(&eth_hdr->d_addr, &addr);
		ether_addr_copy(&eth_hdr->s_addr, &eth_hdr->d_addr);
		ether_addr_copy(&addr, &eth_hdr->s_addr);

		mb->ol_flags = ol_flags;
		mb->l2_len = sizeof(struct ether_hdr);
		mb->l3_len = sizeof(struct ipv4_hdr);
		mb->vlan_tci = txp->tx_vlan_id;
		mb->vlan_tci_outer = txp->tx_vlan_id_outer;
	}
	nb_tx = rte_eth_tx_burst(fs->tx_port, fs->tx_queue, pkts_burst, nb_rx);
	/*
	 * Retry if necessary
	 */
	if (unlikely(nb_tx < nb_rx) && fs->retry_enabled) {
		retry = 0;
		while (nb_tx < nb_rx && retry++ < burst_tx_retry_num) {
			rte_delay_us(burst_tx_delay_time);
			nb_tx += rte_eth_tx_burst(fs->tx_port, fs->tx_queue,
					&pkts_burst[nb_tx], nb_rx - nb_tx);
		}
	}
	fs->tx_packets += nb_tx;
#ifdef RTE_TEST_PMD_RECORD_BURST_STATS
	fs->tx_burst_stats.pkt_burst_spread[nb_tx]++;
#endif
	if (unlikely(nb_tx < nb_rx)) {
		fs->fwd_dropped += (nb_rx - nb_tx);
		do {
			rte_pktmbuf_free(pkts_burst[nb_tx]);
		} while (++nb_tx < nb_rx);
	}
#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
	end_tsc = rte_rdtsc();
	core_cycles = (end_tsc - start_tsc);
	fs->core_cycles = (uint64_t) (fs->core_cycles + core_cycles);
#endif
}

struct fwd_engine mac_swap_engine = {
	.fwd_mode_name  = "macswap",
	.port_fwd_begin = NULL,
	.port_fwd_end   = NULL,
	.packet_fwd     = pkt_burst_mac_swap,
};
Commit	Line	Data
7c673cae FG	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_memory.h>
	60	#include <rte_mempool.h>
	61	#include <rte_mbuf.h>
	62	#include <rte_interrupts.h>
	63	#include <rte_pci.h>
	64	#include <rte_ether.h>
65	#include <rte_ethdev.h>
66	#include <rte_ip.h>
67	#include <rte_string_fns.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	for (i = 0; i < nb_rx; i++) {
116	if (likely(i < nb_rx - 1))
117	rte_prefetch0(rte_pktmbuf_mtod(pkts_burst[i + 1],
118	void *));
119	mb = pkts_burst[i];
120	eth_hdr = rte_pktmbuf_mtod(mb, struct ether_hdr *);
121
122	/* Swap dest and src mac addresses. */
123	ether_addr_copy(&eth_hdr->d_addr, &addr);
124	ether_addr_copy(&eth_hdr->s_addr, &eth_hdr->d_addr);
125	ether_addr_copy(&addr, &eth_hdr->s_addr);
126
127	mb->ol_flags = ol_flags;
128	mb->l2_len = sizeof(struct ether_hdr);
129	mb->l3_len = sizeof(struct ipv4_hdr);
130	mb->vlan_tci = txp->tx_vlan_id;
131	mb->vlan_tci_outer = txp->tx_vlan_id_outer;
132	}
133	nb_tx = rte_eth_tx_burst(fs->tx_port, fs->tx_queue, pkts_burst, nb_rx);
134	/*
135	* Retry if necessary
136	*/
137	if (unlikely(nb_tx < nb_rx) && fs->retry_enabled) {
138	retry = 0;
139	while (nb_tx < nb_rx && retry++ < burst_tx_retry_num) {
140	rte_delay_us(burst_tx_delay_time);
141	nb_tx += rte_eth_tx_burst(fs->tx_port, fs->tx_queue,
142	&pkts_burst[nb_tx], nb_rx - nb_tx);
143	}
144	}
145	fs->tx_packets += nb_tx;
146	#ifdef RTE_TEST_PMD_RECORD_BURST_STATS
147	fs->tx_burst_stats.pkt_burst_spread[nb_tx]++;
148	#endif
149	if (unlikely(nb_tx < nb_rx)) {
150	fs->fwd_dropped += (nb_rx - nb_tx);
151	do {
152	rte_pktmbuf_free(pkts_burst[nb_tx]);
153	} while (++nb_tx < nb_rx);
154	}
155	#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
156	end_tsc = rte_rdtsc();
157	core_cycles = (end_tsc - start_tsc);
158	fs->core_cycles = (uint64_t) (fs->core_cycles + core_cycles);
159	#endif
160	}
161
162	struct fwd_engine mac_swap_engine = {
163	.fwd_mode_name = "macswap",
164	.port_fwd_begin = NULL,
165	.port_fwd_end = NULL,
166	.packet_fwd = pkt_burst_mac_swap,
167	};