mirror of https://github.com/F-Stack/f-stack.git
131 lines
3.1 KiB
C
131 lines
3.1 KiB
C
/* SPDX-License-Identifier: BSD-3-Clause
|
|
* Copyright 2014-2020 Mellanox Technologies, Ltd
|
|
*/
|
|
|
|
#ifndef _5TSWAP_H_
|
|
#define _5TSWAP_H_
|
|
|
|
#include "macswap_common.h"
|
|
|
|
static inline void
|
|
swap_mac(struct rte_ether_hdr *eth_hdr)
|
|
{
|
|
struct rte_ether_addr addr;
|
|
|
|
/* Swap dest and src mac addresses. */
|
|
rte_ether_addr_copy(ð_hdr->dst_addr, &addr);
|
|
rte_ether_addr_copy(ð_hdr->src_addr, ð_hdr->dst_addr);
|
|
rte_ether_addr_copy(&addr, ð_hdr->src_addr);
|
|
}
|
|
|
|
static inline void
|
|
swap_ipv4(struct rte_ipv4_hdr *ipv4_hdr)
|
|
{
|
|
rte_be32_t addr;
|
|
|
|
/* Swap dest and src ipv4 addresses. */
|
|
addr = ipv4_hdr->src_addr;
|
|
ipv4_hdr->src_addr = ipv4_hdr->dst_addr;
|
|
ipv4_hdr->dst_addr = addr;
|
|
}
|
|
|
|
static inline void
|
|
swap_ipv6(struct rte_ipv6_hdr *ipv6_hdr)
|
|
{
|
|
uint8_t addr[16];
|
|
|
|
/* Swap dest and src ipv6 addresses. */
|
|
memcpy(&addr, &ipv6_hdr->src_addr, 16);
|
|
memcpy(&ipv6_hdr->src_addr, &ipv6_hdr->dst_addr, 16);
|
|
memcpy(&ipv6_hdr->dst_addr, &addr, 16);
|
|
}
|
|
|
|
static inline void
|
|
swap_tcp(struct rte_tcp_hdr *tcp_hdr)
|
|
{
|
|
rte_be16_t port;
|
|
|
|
/* Swap dest and src tcp port. */
|
|
port = tcp_hdr->src_port;
|
|
tcp_hdr->src_port = tcp_hdr->dst_port;
|
|
tcp_hdr->dst_port = port;
|
|
}
|
|
|
|
static inline void
|
|
swap_udp(struct rte_udp_hdr *udp_hdr)
|
|
{
|
|
rte_be16_t port;
|
|
|
|
/* Swap dest and src udp port */
|
|
port = udp_hdr->src_port;
|
|
udp_hdr->src_port = udp_hdr->dst_port;
|
|
udp_hdr->dst_port = port;
|
|
}
|
|
|
|
static inline void
|
|
do_5tswap(struct rte_mbuf *pkts_burst[], uint16_t nb_rx,
|
|
struct fwd_stream *fs)
|
|
{
|
|
struct rte_port *txp;
|
|
struct rte_mbuf *mb;
|
|
uint16_t next_proto;
|
|
uint64_t ol_flags;
|
|
uint16_t proto;
|
|
int i;
|
|
union {
|
|
struct rte_ether_hdr *eth;
|
|
struct rte_vlan_hdr *vlan;
|
|
struct rte_ipv4_hdr *ipv4;
|
|
struct rte_ipv6_hdr *ipv6;
|
|
struct rte_tcp_hdr *tcp;
|
|
struct rte_udp_hdr *udp;
|
|
uint8_t *byte;
|
|
} h;
|
|
|
|
txp = &ports[fs->tx_port];
|
|
ol_flags = ol_flags_init(txp->dev_conf.txmode.offloads);
|
|
vlan_qinq_set(pkts_burst, nb_rx, ol_flags,
|
|
txp->tx_vlan_id, txp->tx_vlan_id_outer);
|
|
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];
|
|
h.eth = rte_pktmbuf_mtod(mb, struct rte_ether_hdr *);
|
|
proto = h.eth->ether_type;
|
|
swap_mac(h.eth);
|
|
mb->l2_len = sizeof(struct rte_ether_hdr);
|
|
h.eth++;
|
|
while (proto == RTE_BE16(RTE_ETHER_TYPE_VLAN) ||
|
|
proto == RTE_BE16(RTE_ETHER_TYPE_QINQ)) {
|
|
proto = h.vlan->eth_proto;
|
|
h.vlan++;
|
|
mb->l2_len += sizeof(struct rte_vlan_hdr);
|
|
}
|
|
if (proto == RTE_BE16(RTE_ETHER_TYPE_IPV4)) {
|
|
swap_ipv4(h.ipv4);
|
|
next_proto = h.ipv4->next_proto_id;
|
|
mb->l3_len = rte_ipv4_hdr_len(h.ipv4);
|
|
h.byte += mb->l3_len;
|
|
} else if (proto == RTE_BE16(RTE_ETHER_TYPE_IPV6)) {
|
|
swap_ipv6(h.ipv6);
|
|
next_proto = h.ipv6->proto;
|
|
h.ipv6++;
|
|
mb->l3_len = sizeof(struct rte_ipv6_hdr);
|
|
} else {
|
|
mbuf_field_set(mb, ol_flags);
|
|
continue;
|
|
}
|
|
if (next_proto == IPPROTO_UDP) {
|
|
swap_udp(h.udp);
|
|
mb->l4_len = sizeof(struct rte_udp_hdr);
|
|
} else if (next_proto == IPPROTO_TCP) {
|
|
swap_tcp(h.tcp);
|
|
mb->l4_len = (h.tcp->data_off & 0xf0) >> 2;
|
|
}
|
|
mbuf_field_set(mb, ol_flags);
|
|
}
|
|
}
|
|
|
|
#endif /* _5TSWAP_H_ */
|