cmhi
/
f-stack
mirror of https://github.com/F-Stack/f-stack.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity
f-stack/dpdk/examples/ipsec-secgw/ipsec_worker.c

1871 lines
45 KiB
C
Raw Blame History

/* SPDX-License-Identifier: BSD-3-Clause
* Copyright(c) 2010-2016 Intel Corporation
* Copyright (C) 2020 Marvell International Ltd.
*/
#include <rte_acl.h>
#include <rte_event_crypto_adapter.h>
#include <rte_event_eth_tx_adapter.h>
#include <rte_lpm.h>
#include <rte_lpm6.h>
#include "event_helper.h"
#include "ipsec.h"
#include "ipsec-secgw.h"
#include "ipsec_worker.h"
#include "sad.h"
#if defined(__ARM_NEON)
#include "ipsec_lpm_neon.h"
#endif
struct port_drv_mode_data {
void *sess;
struct rte_security_ctx *ctx;
};
typedef void (*ipsec_worker_fn_t)(void);
int ip_reassembly_dynfield_offset = -1;
uint64_t ip_reassembly_dynflag;
static inline enum pkt_type
process_ipsec_get_pkt_type(struct rte_mbuf *pkt, uint8_t **nlp)
{
struct rte_ether_hdr *eth;
uint32_t ptype = pkt->packet_type;
eth = rte_pktmbuf_mtod(pkt, struct rte_ether_hdr *);
rte_prefetch0(eth);
if (RTE_ETH_IS_IPV4_HDR(ptype)) {
*nlp = RTE_PTR_ADD(eth, RTE_ETHER_HDR_LEN +
offsetof(struct ip, ip_p));
if ((ptype & RTE_PTYPE_TUNNEL_MASK) == RTE_PTYPE_TUNNEL_ESP)
return PKT_TYPE_IPSEC_IPV4;
else
return PKT_TYPE_PLAIN_IPV4;
} else if (RTE_ETH_IS_IPV6_HDR(ptype)) {
*nlp = RTE_PTR_ADD(eth, RTE_ETHER_HDR_LEN +
offsetof(struct ip6_hdr, ip6_nxt));
if ((ptype & RTE_PTYPE_TUNNEL_MASK) == RTE_PTYPE_TUNNEL_ESP)
return PKT_TYPE_IPSEC_IPV6;
else
return PKT_TYPE_PLAIN_IPV6;
}
/* Unknown/Unsupported type */
return PKT_TYPE_INVALID;
}
static inline void
update_mac_addrs(struct rte_ether_hdr *ethhdr, uint16_t portid)
{
memcpy(&ethhdr->src_addr, &ethaddr_tbl[portid].src, RTE_ETHER_ADDR_LEN);
memcpy(&ethhdr->dst_addr, &ethaddr_tbl[portid].dst, RTE_ETHER_ADDR_LEN);
}
static inline void
ipsec_event_pre_forward(struct rte_mbuf *m, unsigned int port_id)
{
/* Save the destination port in the mbuf */
m->port = port_id;
/* Save eth queue for Tx */
rte_event_eth_tx_adapter_txq_set(m, 0);
}
static inline void
ev_vector_attr_init(struct rte_event_vector *vec)
{
vec->attr_valid = 1;
vec->port = 0xFFFF;
vec->queue = 0;
}
static inline void
ev_vector_attr_update(struct rte_event_vector *vec, struct rte_mbuf *pkt)
{
if (vec->port == 0xFFFF) {
vec->port = pkt->port;
return;
}
if (vec->attr_valid && (vec->port != pkt->port))
vec->attr_valid = 0;
}
static inline void
prepare_out_sessions_tbl(struct sa_ctx *sa_out,
struct port_drv_mode_data *data,
uint16_t size)
{
struct rte_ipsec_session *pri_sess;
struct ipsec_sa *sa;
uint32_t i;
if (!sa_out)
return;
for (i = 0; i < sa_out->nb_sa; i++) {
sa = &sa_out->sa[i];
if (!sa)
continue;
pri_sess = ipsec_get_primary_session(sa);
if (!pri_sess)
continue;
if (pri_sess->type !=
RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL) {
RTE_LOG(ERR, IPSEC, "Invalid session type %d\n",
pri_sess->type);
continue;
}
if (sa->portid >= size) {
RTE_LOG(ERR, IPSEC,
"Port id >= than table size %d, %d\n",
sa->portid, size);
continue;
}
/* Use only first inline session found for a given port */
if (data[sa->portid].sess)
continue;
data[sa->portid].sess = pri_sess->security.ses;
data[sa->portid].ctx = pri_sess->security.ctx;
}
}
static inline int
check_sp(struct sp_ctx *sp, const uint8_t *nlp, uint32_t *sa_idx)
{
uint32_t res;
if (unlikely(sp == NULL))
return 0;
rte_acl_classify((struct rte_acl_ctx *)sp, &nlp, &res, 1,
DEFAULT_MAX_CATEGORIES);
if (unlikely(res == DISCARD))
return 0;
else if (res == BYPASS) {
*sa_idx = -1;
return 1;
}
*sa_idx = res - 1;
return 1;
}
static inline void
check_sp_bulk(struct sp_ctx *sp, struct traffic_type *ip,
struct traffic_type *ipsec)
{
uint32_t i, j, res;
struct rte_mbuf *m;
if (unlikely(sp == NULL || ip->num == 0))
return;
rte_acl_classify((struct rte_acl_ctx *)sp, ip->data, ip->res, ip->num,
DEFAULT_MAX_CATEGORIES);
j = 0;
for (i = 0; i < ip->num; i++) {
m = ip->pkts[i];
res = ip->res[i];
if (unlikely(res == DISCARD))
free_pkts(&m, 1);
else if (res == BYPASS)
ip->pkts[j++] = m;
else {
ipsec->res[ipsec->num] = res - 1;
ipsec->pkts[ipsec->num++] = m;
}
}
ip->num = j;
}
static inline void
check_sp_sa_bulk(struct sp_ctx *sp, struct sa_ctx *sa_ctx,
struct traffic_type *ip)
{
struct ipsec_sa *sa;
uint32_t i, j, res;
struct rte_mbuf *m;
if (unlikely(sp == NULL || ip->num == 0))
return;
rte_acl_classify((struct rte_acl_ctx *)sp, ip->data, ip->res, ip->num,
DEFAULT_MAX_CATEGORIES);
j = 0;
for (i = 0; i < ip->num; i++) {
m = ip->pkts[i];
res = ip->res[i];
if (unlikely(res == DISCARD))
free_pkts(&m, 1);
else if (res == BYPASS)
ip->pkts[j++] = m;
else {
sa = *(struct ipsec_sa **)rte_security_dynfield(m);
if (sa == NULL) {
free_pkts(&m, 1);
continue;
}
/* SPI on the packet should match with the one in SA */
if (unlikely(sa->spi != sa_ctx->sa[res - 1].spi)) {
free_pkts(&m, 1);
continue;
}
ip->pkts[j++] = m;
}
}
ip->num = j;
}
static inline void
ipv4_pkt_l3_len_set(struct rte_mbuf *pkt)
{
struct rte_ipv4_hdr *ipv4;
ipv4 = rte_pktmbuf_mtod(pkt, struct rte_ipv4_hdr *);
pkt->l3_len = ipv4->ihl * 4;
}
static inline int
ipv6_pkt_l3_len_set(struct rte_mbuf *pkt)
{
struct rte_ipv6_hdr *ipv6;
size_t l3_len, ext_len;
uint32_t l3_type;
int next_proto;
uint8_t *p;
ipv6 = rte_pktmbuf_mtod(pkt, struct rte_ipv6_hdr *);
l3_len = sizeof(struct rte_ipv6_hdr);
l3_type = pkt->packet_type & RTE_PTYPE_L3_MASK;
if (l3_type == RTE_PTYPE_L3_IPV6_EXT ||
l3_type == RTE_PTYPE_L3_IPV6_EXT_UNKNOWN) {
p = rte_pktmbuf_mtod(pkt, uint8_t *);
next_proto = ipv6->proto;
while (next_proto != IPPROTO_ESP &&
l3_len < pkt->data_len &&
(next_proto = rte_ipv6_get_next_ext(p + l3_len,
next_proto, &ext_len)) >= 0)
l3_len += ext_len;
/* Drop pkt when IPv6 header exceeds first seg size */
if (unlikely(l3_len > pkt->data_len))
return -EINVAL;
}
pkt->l3_len = l3_len;
return 0;
}
static inline uint16_t
route4_pkt(struct rte_mbuf *pkt, struct rt_ctx *rt_ctx)
{
uint32_t dst_ip;
uint16_t offset;
uint32_t hop;
int ret;
offset = RTE_ETHER_HDR_LEN + offsetof(struct ip, ip_dst);
dst_ip = *rte_pktmbuf_mtod_offset(pkt, uint32_t *, offset);
dst_ip = rte_be_to_cpu_32(dst_ip);
ret = rte_lpm_lookup((struct rte_lpm *)rt_ctx, dst_ip, &hop);
if (ret == 0) {
/* We have a hit */
return hop;
}
/* else */
return RTE_MAX_ETHPORTS;
}
/* TODO: To be tested */
static inline uint16_t
route6_pkt(struct rte_mbuf *pkt, struct rt_ctx *rt_ctx)
{
uint8_t dst_ip[16];
uint8_t *ip6_dst;
uint16_t offset;
uint32_t hop;
int ret;
offset = RTE_ETHER_HDR_LEN + offsetof(struct ip6_hdr, ip6_dst);
ip6_dst = rte_pktmbuf_mtod_offset(pkt, uint8_t *, offset);
memcpy(&dst_ip[0], ip6_dst, 16);
ret = rte_lpm6_lookup((struct rte_lpm6 *)rt_ctx, dst_ip, &hop);
if (ret == 0) {
/* We have a hit */
return hop;
}
/* else */
return RTE_MAX_ETHPORTS;
}
static inline uint16_t
get_route(struct rte_mbuf *pkt, struct route_table *rt, enum pkt_type type)
{
if (type == PKT_TYPE_PLAIN_IPV4 || type == PKT_TYPE_IPSEC_IPV4)
return route4_pkt(pkt, rt->rt4_ctx);
else if (type == PKT_TYPE_PLAIN_IPV6 || type == PKT_TYPE_IPSEC_IPV6)
return route6_pkt(pkt, rt->rt6_ctx);
return RTE_MAX_ETHPORTS;
}
static inline void
crypto_op_reset(const struct rte_ipsec_session *ss, struct rte_mbuf *mb[],
struct rte_crypto_op *cop[], uint16_t num)
{
struct rte_crypto_sym_op *sop;
uint32_t i;
const struct rte_crypto_op unproc_cop = {
.type = RTE_CRYPTO_OP_TYPE_SYMMETRIC,
.status = RTE_CRYPTO_OP_STATUS_NOT_PROCESSED,
.sess_type = RTE_CRYPTO_OP_SECURITY_SESSION,
};
for (i = 0; i != num; i++) {
cop[i]->raw = unproc_cop.raw;
sop = cop[i]->sym;
sop->m_src = mb[i];
sop->m_dst = NULL;
__rte_security_attach_session(sop, ss->security.ses);
}
}
static inline void
crypto_prepare_event(struct rte_mbuf *pkt, struct rte_ipsec_session *sess, struct rte_event *ev)
{
struct ipsec_mbuf_metadata *priv;
struct rte_crypto_op *cop;
/* Get pkt private data */
priv = get_priv(pkt);
cop = &priv->cop;
/* Reset crypto operation data */
crypto_op_reset(sess, &pkt, &cop, 1);
/* Update event_ptr with rte_crypto_op */
ev->event = 0;
ev->event_ptr = cop;
}
static inline void
free_pkts_from_events(struct rte_event events[], uint16_t count)
{
struct rte_crypto_op *cop;
int i;
for (i = 0; i < count; i++) {
cop = events[i].event_ptr;
free_pkts(&cop->sym->m_src, 1);
}
}
static inline int
event_crypto_enqueue(struct rte_mbuf *pkt,
struct ipsec_sa *sa, const struct eh_event_link_info *ev_link)
{
struct rte_ipsec_session *sess;
struct rte_event ev;
int ret;
/* Get IPsec session */
sess = ipsec_get_primary_session(sa);
crypto_prepare_event(pkt, sess, &ev);
/* Enqueue event to crypto adapter */
ret = rte_event_crypto_adapter_enqueue(ev_link->eventdev_id,
ev_link->event_port_id, &ev, 1);
if (unlikely(ret != 1)) {
/* pkt will be freed by the caller */
RTE_LOG_DP(DEBUG, IPSEC, "Cannot enqueue event: %i (errno: %i)\n", ret, rte_errno);
return rte_errno;
}
return 0;
}
static inline int
process_ipsec_ev_inbound(struct ipsec_ctx *ctx, struct route_table *rt,
const struct eh_event_link_info *ev_link, struct rte_event *ev)
{
struct ipsec_sa *sa = NULL;
struct rte_mbuf *pkt;
uint16_t port_id = 0;
enum pkt_type type;
uint32_t sa_idx;
uint8_t *nlp;
/* Get pkt from event */
pkt = ev->mbuf;
if (is_ip_reassembly_incomplete(pkt) > 0) {
free_reassembly_fail_pkt(pkt);
return PKT_DROPPED;
}
/* Check the packet type */
type = process_ipsec_get_pkt_type(pkt, &nlp);
switch (type) {
case PKT_TYPE_PLAIN_IPV4:
if (pkt->ol_flags & RTE_MBUF_F_RX_SEC_OFFLOAD) {
if (unlikely(pkt->ol_flags &
RTE_MBUF_F_RX_SEC_OFFLOAD_FAILED)) {
RTE_LOG(ERR, IPSEC,
"Inbound security offload failed\n");
goto drop_pkt_and_exit;
}
sa = *(struct ipsec_sa **)rte_security_dynfield(pkt);
}
/* Check if we have a match */
if (check_sp(ctx->sp4_ctx, nlp, &sa_idx) == 0) {
/* No valid match */
goto drop_pkt_and_exit;
}
break;
case PKT_TYPE_PLAIN_IPV6:
if (pkt->ol_flags & RTE_MBUF_F_RX_SEC_OFFLOAD) {
if (unlikely(pkt->ol_flags &
RTE_MBUF_F_RX_SEC_OFFLOAD_FAILED)) {
RTE_LOG(ERR, IPSEC,
"Inbound security offload failed\n");
goto drop_pkt_and_exit;
}
sa = *(struct ipsec_sa **)rte_security_dynfield(pkt);
}
/* Check if we have a match */
if (check_sp(ctx->sp6_ctx, nlp, &sa_idx) == 0) {
/* No valid match */
goto drop_pkt_and_exit;
}
break;
case PKT_TYPE_IPSEC_IPV4:
rte_pktmbuf_adj(pkt, RTE_ETHER_HDR_LEN);
ipv4_pkt_l3_len_set(pkt);
sad_lookup(&ctx->sa_ctx->sad, &pkt, (void **)&sa, 1);
sa = ipsec_mask_saptr(sa);
if (unlikely(sa == NULL)) {
RTE_LOG_DP(DEBUG, IPSEC, "Cannot find sa\n");
goto drop_pkt_and_exit;
}
if (unlikely(event_crypto_enqueue(pkt, sa, ev_link)))
goto drop_pkt_and_exit;
return PKT_POSTED;
case PKT_TYPE_IPSEC_IPV6:
rte_pktmbuf_adj(pkt, RTE_ETHER_HDR_LEN);
if (unlikely(ipv6_pkt_l3_len_set(pkt) != 0))
goto drop_pkt_and_exit;
sad_lookup(&ctx->sa_ctx->sad, &pkt, (void **)&sa, 1);
sa = ipsec_mask_saptr(sa);
if (unlikely(sa == NULL)) {
RTE_LOG_DP(DEBUG, IPSEC, "Cannot find sa\n");
goto drop_pkt_and_exit;
}
if (unlikely(event_crypto_enqueue(pkt, sa, ev_link)))
goto drop_pkt_and_exit;
return PKT_POSTED;
default:
RTE_LOG_DP(DEBUG, IPSEC_ESP, "Unsupported packet type = %d\n",
type);
goto drop_pkt_and_exit;
}
/* Check if the packet has to be bypassed */
if (sa_idx == BYPASS)
goto route_and_send_pkt;
/* Validate sa_idx */
if (sa_idx >= ctx->sa_ctx->nb_sa)
goto drop_pkt_and_exit;
/* Else the packet has to be protected with SA */
/* If the packet was IPsec processed, then SA pointer should be set */
if (sa == NULL)
goto drop_pkt_and_exit;
/* SPI on the packet should match with the one in SA */
if (unlikely(sa->spi != ctx->sa_ctx->sa[sa_idx].spi))
goto drop_pkt_and_exit;
route_and_send_pkt:
port_id = get_route(pkt, rt, type);
if (unlikely(port_id == RTE_MAX_ETHPORTS)) {
/* no match */
goto drop_pkt_and_exit;
}
/* else, we have a matching route */
/* Update mac addresses */
update_mac_addrs(rte_pktmbuf_mtod(pkt, struct rte_ether_hdr *), port_id);
/* Update the event with the dest port */
ipsec_event_pre_forward(pkt, port_id);
return PKT_FORWARDED;
drop_pkt_and_exit:
free_pkts(&pkt, 1);
ev->mbuf = NULL;
return PKT_DROPPED;
}
static inline int
process_ipsec_ev_outbound(struct ipsec_ctx *ctx, struct route_table *rt,
const struct eh_event_link_info *ev_link, struct rte_event *ev)
{
struct rte_ipsec_session *sess;
struct rte_ether_hdr *ethhdr;
struct sa_ctx *sa_ctx;
struct rte_mbuf *pkt;
uint16_t port_id = 0;
struct ipsec_sa *sa;
enum pkt_type type;
uint32_t sa_idx;
uint8_t *nlp;
/* Get pkt from event */
pkt = ev->mbuf;
/* Check the packet type */
type = process_ipsec_get_pkt_type(pkt, &nlp);
switch (type) {
case PKT_TYPE_PLAIN_IPV4:
/* Check if we have a match */
if (check_sp(ctx->sp4_ctx, nlp, &sa_idx) == 0) {
/* No valid match */
goto drop_pkt_and_exit;
}
break;
case PKT_TYPE_PLAIN_IPV6:
/* Check if we have a match */
if (check_sp(ctx->sp6_ctx, nlp, &sa_idx) == 0) {
/* No valid match */
goto drop_pkt_and_exit;
}
break;
default:
/*
* Only plain IPv4 & IPv6 packets are allowed
* on protected port. Drop the rest.
*/
RTE_LOG(ERR, IPSEC, "Unsupported packet type = %d\n", type);
goto drop_pkt_and_exit;
}
ethhdr = rte_pktmbuf_mtod(pkt, struct rte_ether_hdr *);
/* Check if the packet has to be bypassed */
if (sa_idx == BYPASS) {
port_id = get_route(pkt, rt, type);
if (unlikely(port_id == RTE_MAX_ETHPORTS)) {
/* no match */
goto drop_pkt_and_exit;
}
/* else, we have a matching route */
goto send_pkt;
}
/* Validate sa_idx */
if (unlikely(sa_idx >= ctx->sa_ctx->nb_sa))
goto drop_pkt_and_exit;
/* Else the packet has to be protected */
/* Get SA ctx*/
sa_ctx = ctx->sa_ctx;
/* Get SA */
sa = &(sa_ctx->sa[sa_idx]);
/* Get IPsec session */
sess = ipsec_get_primary_session(sa);
/* Determine protocol type */
if (sess->type == RTE_SECURITY_ACTION_TYPE_LOOKASIDE_PROTOCOL)
goto lookaside;
rte_security_set_pkt_metadata(sess->security.ctx,
sess->security.ses, pkt, NULL);
/* Mark the packet for Tx security offload */
pkt->ol_flags |= RTE_MBUF_F_TX_SEC_OFFLOAD;
/* Update ether type */
ethhdr->ether_type = (IS_IP4(sa->flags) ? rte_cpu_to_be_16(RTE_ETHER_TYPE_IPV4) :
rte_cpu_to_be_16(RTE_ETHER_TYPE_IPV6));
/* Get the port to which this pkt need to be submitted */
port_id = sa->portid;
send_pkt:
/* Provide L2 len for Outbound processing */
pkt->l2_len = RTE_ETHER_HDR_LEN;
/* Update mac addresses */
update_mac_addrs(ethhdr, port_id);
/* Update the event with the dest port */
ipsec_event_pre_forward(pkt, port_id);
return PKT_FORWARDED;
lookaside:
/* prepare pkt - advance start to L3 */
rte_pktmbuf_adj(pkt, RTE_ETHER_HDR_LEN);
if (likely(event_crypto_enqueue(pkt, sa, ev_link) == 0))
return PKT_POSTED;
drop_pkt_and_exit:
RTE_LOG(ERR, IPSEC, "Outbound packet dropped\n");
free_pkts(&pkt, 1);
ev->mbuf = NULL;
return PKT_DROPPED;
}
static inline int
ipsec_ev_route_ip_pkts(struct rte_event_vector *vec, struct route_table *rt,
struct ipsec_traffic *t)
{
struct rte_ether_hdr *ethhdr;
struct rte_mbuf *pkt;
uint16_t port_id = 0;
uint32_t i, j = 0;
/* Route IPv4 packets */
for (i = 0; i < t->ip4.num; i++) {
pkt = t->ip4.pkts[i];
port_id = route4_pkt(pkt, rt->rt4_ctx);
if (port_id != RTE_MAX_ETHPORTS) {
/* Update mac addresses */
ethhdr = rte_pktmbuf_mtod(pkt, struct rte_ether_hdr *);
update_mac_addrs(ethhdr, port_id);
/* Update the event with the dest port */
ipsec_event_pre_forward(pkt, port_id);
ev_vector_attr_update(vec, pkt);
vec->mbufs[j++] = pkt;
} else
free_pkts(&pkt, 1);
}
/* Route IPv6 packets */
for (i = 0; i < t->ip6.num; i++) {
pkt = t->ip6.pkts[i];
port_id = route6_pkt(pkt, rt->rt6_ctx);
if (port_id != RTE_MAX_ETHPORTS) {
/* Update mac addresses */
ethhdr = rte_pktmbuf_mtod(pkt, struct rte_ether_hdr *);
update_mac_addrs(ethhdr, port_id);
/* Update the event with the dest port */
ipsec_event_pre_forward(pkt, port_id);
ev_vector_attr_update(vec, pkt);
vec->mbufs[j++] = pkt;
} else
free_pkts(&pkt, 1);
}
return j;
}
static inline int
ipsec_ev_inbound_route_pkts(struct rte_event_vector *vec,
struct route_table *rt,
struct ipsec_traffic *t,
const struct eh_event_link_info *ev_link)
{
uint32_t ret, i, j, ev_len = 0;
struct rte_event events[MAX_PKTS];
struct rte_ipsec_session *sess;
struct rte_mbuf *pkt;
struct ipsec_sa *sa;
j = ipsec_ev_route_ip_pkts(vec, rt, t);
/* Route ESP packets */
for (i = 0; i < t->ipsec.num; i++) {
pkt = t->ipsec.pkts[i];
sa = ipsec_mask_saptr(t->ipsec.saptr[i]);
if (unlikely(sa == NULL)) {
free_pkts(&pkt, 1);
continue;
}
sess = ipsec_get_primary_session(sa);
crypto_prepare_event(pkt, sess, &events[ev_len]);
ev_len++;
}
if (ev_len) {
ret = rte_event_crypto_adapter_enqueue(ev_link->eventdev_id,
ev_link->event_port_id, events, ev_len);
if (ret < ev_len) {
RTE_LOG_DP(DEBUG, IPSEC, "Cannot enqueue events: %i (errno: %i)\n",
ev_len, rte_errno);
free_pkts_from_events(&events[ret], ev_len - ret);
return -rte_errno;
}
}
return j;
}
static inline int
ipsec_ev_outbound_route_pkts(struct rte_event_vector *vec, struct route_table *rt,
struct ipsec_traffic *t, struct sa_ctx *sa_ctx,
const struct eh_event_link_info *ev_link)
{
uint32_t sa_idx, ret, i, j, ev_len = 0;
struct rte_event events[MAX_PKTS];
struct rte_ipsec_session *sess;
struct rte_ether_hdr *ethhdr;
uint16_t port_id = 0;
struct rte_mbuf *pkt;
struct ipsec_sa *sa;
j = ipsec_ev_route_ip_pkts(vec, rt, t);
/* Handle IPsec packets.
* For lookaside IPsec packets, submit to cryptodev queue.
* For inline IPsec packets, route the packet.
*/
for (i = 0; i < t->ipsec.num; i++) {
/* Validate sa_idx */
sa_idx = t->ipsec.res[i];
pkt = t->ipsec.pkts[i];
if (unlikely(sa_idx >= sa_ctx->nb_sa)) {
free_pkts(&pkt, 1);
continue;
}
/* Else the packet has to be protected */
sa = &(sa_ctx->sa[sa_idx]);
/* Get IPsec session */
sess = ipsec_get_primary_session(sa);
switch (sess->type) {
case RTE_SECURITY_ACTION_TYPE_LOOKASIDE_PROTOCOL:
rte_pktmbuf_adj(pkt, RTE_ETHER_HDR_LEN);
crypto_prepare_event(pkt, sess, &events[ev_len]);
ev_len++;
break;
case RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL:
rte_security_set_pkt_metadata(sess->security.ctx,
sess->security.ses, pkt, NULL);
pkt->ol_flags |= RTE_MBUF_F_TX_SEC_OFFLOAD;
port_id = sa->portid;
/* Fetch outer ip type and update */
ethhdr = rte_pktmbuf_mtod(pkt, struct rte_ether_hdr *);
ethhdr->ether_type = (IS_IP4(sa->flags) ?
rte_cpu_to_be_16(RTE_ETHER_TYPE_IPV4) :
rte_cpu_to_be_16(RTE_ETHER_TYPE_IPV6));
update_mac_addrs(ethhdr, port_id);
ipsec_event_pre_forward(pkt, port_id);
ev_vector_attr_update(vec, pkt);
vec->mbufs[j++] = pkt;
break;
default:
RTE_LOG(ERR, IPSEC, "SA type not supported\n");
free_pkts(&pkt, 1);
break;
}
}
if (ev_len) {
ret = rte_event_crypto_adapter_enqueue(ev_link->eventdev_id,
ev_link->event_port_id, events, ev_len);
if (ret < ev_len) {
RTE_LOG_DP(DEBUG, IPSEC, "Cannot enqueue events: %i (errno: %i)\n",
ev_len, rte_errno);
free_pkts_from_events(&events[ret], ev_len - ret);
return -rte_errno;
}
}
return j;
}
static inline void
classify_pkt(struct rte_mbuf *pkt, struct ipsec_traffic *t)
{
enum pkt_type type;
uint8_t *nlp;
/* Check the packet type */
type = process_ipsec_get_pkt_type(pkt, &nlp);
switch (type) {
case PKT_TYPE_PLAIN_IPV4:
t->ip4.data[t->ip4.num] = nlp;
t->ip4.pkts[(t->ip4.num)++] = pkt;
break;
case PKT_TYPE_PLAIN_IPV6:
t->ip6.data[t->ip6.num] = nlp;
t->ip6.pkts[(t->ip6.num)++] = pkt;
break;
case PKT_TYPE_IPSEC_IPV4:
rte_pktmbuf_adj(pkt, RTE_ETHER_HDR_LEN);
ipv4_pkt_l3_len_set(pkt);
t->ipsec.pkts[(t->ipsec.num)++] = pkt;
break;
case PKT_TYPE_IPSEC_IPV6:
rte_pktmbuf_adj(pkt, RTE_ETHER_HDR_LEN);
if (ipv6_pkt_l3_len_set(pkt) != 0) {
free_pkts(&pkt, 1);
return;
}
t->ipsec.pkts[(t->ipsec.num)++] = pkt;
break;
default:
RTE_LOG_DP(DEBUG, IPSEC_ESP, "Unsupported packet type = %d\n",
type);
free_pkts(&pkt, 1);
break;
}
}
static inline int
process_ipsec_ev_inbound_vector(struct ipsec_ctx *ctx, struct route_table *rt,
struct rte_event_vector *vec,
const struct eh_event_link_info *ev_link)
{
struct ipsec_traffic t;
struct rte_mbuf *pkt;
int i;
t.ip4.num = 0;
t.ip6.num = 0;
t.ipsec.num = 0;
for (i = 0; i < vec->nb_elem; i++) {
/* Get pkt from event */
pkt = vec->mbufs[i];
if (is_ip_reassembly_incomplete(pkt) > 0) {
free_reassembly_fail_pkt(pkt);
continue;
}
if (pkt->ol_flags & RTE_MBUF_F_RX_SEC_OFFLOAD) {
if (unlikely(pkt->ol_flags &
RTE_MBUF_F_RX_SEC_OFFLOAD_FAILED)) {
RTE_LOG(ERR, IPSEC,
"Inbound security offload failed\n");
free_pkts(&pkt, 1);
continue;
}
}
classify_pkt(pkt, &t);
}
check_sp_sa_bulk(ctx->sp4_ctx, ctx->sa_ctx, &t.ip4);
check_sp_sa_bulk(ctx->sp6_ctx, ctx->sa_ctx, &t.ip6);
if (t.ipsec.num != 0)
sad_lookup(&ctx->sa_ctx->sad, t.ipsec.pkts, t.ipsec.saptr, t.ipsec.num);
return ipsec_ev_inbound_route_pkts(vec, rt, &t, ev_link);
}
static inline int
process_ipsec_ev_outbound_vector(struct ipsec_ctx *ctx, struct route_table *rt,
struct rte_event_vector *vec,
const struct eh_event_link_info *ev_link)
{
struct ipsec_traffic t;
struct rte_mbuf *pkt;
uint32_t i;
t.ip4.num = 0;
t.ip6.num = 0;
t.ipsec.num = 0;
for (i = 0; i < vec->nb_elem; i++) {
/* Get pkt from event */
pkt = vec->mbufs[i];
classify_pkt(pkt, &t);
/* Provide L2 len for Outbound processing */
pkt->l2_len = RTE_ETHER_HDR_LEN;
}
check_sp_bulk(ctx->sp4_ctx, &t.ip4, &t.ipsec);
check_sp_bulk(ctx->sp6_ctx, &t.ip6, &t.ipsec);
return ipsec_ev_outbound_route_pkts(vec, rt, &t, ctx->sa_ctx, ev_link);
}
static inline int
process_ipsec_ev_drv_mode_outbound_vector(struct rte_event_vector *vec,
struct port_drv_mode_data *data)
{
struct rte_mbuf *pkt;
int16_t port_id;
uint32_t i;
int j = 0;
for (i = 0; i < vec->nb_elem; i++) {
pkt = vec->mbufs[i];
port_id = pkt->port;
if (unlikely(!data[port_id].sess)) {
free_pkts(&pkt, 1);
continue;
}
ipsec_event_pre_forward(pkt, port_id);
/* Save security session */
rte_security_set_pkt_metadata(data[port_id].ctx,
data[port_id].sess, pkt,
NULL);
/* Mark the packet for Tx security offload */
pkt->ol_flags |= RTE_MBUF_F_TX_SEC_OFFLOAD;
/* Provide L2 len for Outbound processing */
pkt->l2_len = RTE_ETHER_HDR_LEN;
vec->mbufs[j++] = pkt;
}
return j;
}
static void
ipsec_event_vector_free(struct rte_event *ev)
{
struct rte_event_vector *vec = ev->vec;
rte_pktmbuf_free_bulk(vec->mbufs + vec->elem_offset, vec->nb_elem);
rte_mempool_put(rte_mempool_from_obj(vec), vec);
}
static inline void
ipsec_ev_vector_process(struct lcore_conf_ev_tx_int_port_wrkr *lconf,
struct eh_event_link_info *links,
struct rte_event *ev)
{
struct rte_event_vector *vec = ev->vec;
struct rte_mbuf *pkt;
int ret;
pkt = vec->mbufs[0];
ev_vector_attr_init(vec);
core_stats_update_rx(vec->nb_elem);
if (is_unprotected_port(pkt->port))
ret = process_ipsec_ev_inbound_vector(&lconf->inbound,
&lconf->rt, vec, links);
else
ret = process_ipsec_ev_outbound_vector(&lconf->outbound,
&lconf->rt, vec, links);
if (likely(ret > 0)) {
core_stats_update_tx(vec->nb_elem);
vec->nb_elem = ret;
ret = rte_event_eth_tx_adapter_enqueue(links[0].eventdev_id,
links[0].event_port_id, ev, 1, 0);
if (unlikely(ret == 0))
ipsec_event_vector_free(ev);
} else {
rte_mempool_put(rte_mempool_from_obj(vec), vec);
}
}
static inline void
ipsec_ev_vector_drv_mode_process(struct eh_event_link_info *links,
struct rte_event *ev,
struct port_drv_mode_data *data)
{
struct rte_event_vector *vec = ev->vec;
struct rte_mbuf *pkt;
uint16_t ret;
pkt = vec->mbufs[0];
vec->attr_valid = 1;
vec->port = pkt->port;
if (!is_unprotected_port(pkt->port))
vec->nb_elem = process_ipsec_ev_drv_mode_outbound_vector(vec,
data);
if (likely(vec->nb_elem > 0)) {
ret = rte_event_eth_tx_adapter_enqueue(links[0].eventdev_id,
links[0].event_port_id, ev, 1, 0);
if (unlikely(ret == 0))
ipsec_event_vector_free(ev);
} else
rte_mempool_put(rte_mempool_from_obj(vec), vec);
}
static inline int
ipsec_ev_cryptodev_process_one_pkt(
const struct lcore_conf_ev_tx_int_port_wrkr *lconf,
const struct rte_crypto_op *cop, struct rte_mbuf *pkt)
{
struct rte_ether_hdr *ethhdr;
uint16_t port_id;
struct ip *ip;
/* If operation was not successful, free the packet */
if (unlikely(cop->status != RTE_CRYPTO_OP_STATUS_SUCCESS)) {
RTE_LOG_DP(INFO, IPSEC, "Crypto operation failed\n");
free_pkts(&pkt, 1);
return -1;
}
ip = rte_pktmbuf_mtod(pkt, struct ip *);
/* Prepend Ether layer */
ethhdr = (struct rte_ether_hdr *)rte_pktmbuf_prepend(pkt, RTE_ETHER_HDR_LEN);
/* Route pkt and update required fields */
if (ip->ip_v == IPVERSION) {
pkt->ol_flags |= lconf->outbound.ipv4_offloads;
pkt->l3_len = sizeof(struct ip);
pkt->l2_len = RTE_ETHER_HDR_LEN;
ethhdr->ether_type = rte_cpu_to_be_16(RTE_ETHER_TYPE_IPV4);
port_id = route4_pkt(pkt, lconf->rt.rt4_ctx);
} else {
pkt->ol_flags |= lconf->outbound.ipv6_offloads;
pkt->l3_len = sizeof(struct ip6_hdr);
pkt->l2_len = RTE_ETHER_HDR_LEN;
ethhdr->ether_type = rte_cpu_to_be_16(RTE_ETHER_TYPE_IPV6);
port_id = route6_pkt(pkt, lconf->rt.rt6_ctx);
}
if (unlikely(port_id == RTE_MAX_ETHPORTS)) {
RTE_LOG_DP(DEBUG, IPSEC, "Cannot route processed packet\n");
free_pkts(&pkt, 1);
return -1;
}
/* Update Ether with port's MAC addresses */
memcpy(&ethhdr->src_addr, &ethaddr_tbl[port_id].src, sizeof(struct rte_ether_addr));
memcpy(&ethhdr->dst_addr, &ethaddr_tbl[port_id].dst, sizeof(struct rte_ether_addr));
ipsec_event_pre_forward(pkt, port_id);
return 0;
}
static inline void
ipsec_ev_cryptodev_vector_process(
const struct lcore_conf_ev_tx_int_port_wrkr *lconf,
const struct eh_event_link_info *links,
struct rte_event *ev)
{
struct rte_event_vector *vec = ev->vec;
const uint16_t nb_events = 1;
struct rte_crypto_op *cop;
struct rte_mbuf *pkt;
uint16_t enqueued;
int i, n = 0;
ev_vector_attr_init(vec);
/* Transform cop vec into pkt vec */
for (i = 0; i < vec->nb_elem; i++) {
/* Get pkt data */
cop = vec->ptrs[i];
pkt = cop->sym->m_src;
if (ipsec_ev_cryptodev_process_one_pkt(lconf, cop, pkt))
continue;
vec->mbufs[n++] = pkt;
ev_vector_attr_update(vec, pkt);
}
if (n == 0) {
rte_mempool_put(rte_mempool_from_obj(vec), vec);
return;
}
vec->nb_elem = n;
enqueued = rte_event_eth_tx_adapter_enqueue(links[0].eventdev_id,
links[0].event_port_id, ev, nb_events, 0);
if (enqueued != nb_events) {
RTE_LOG_DP(DEBUG, IPSEC, "Failed to enqueue to tx, ret = %u,"
" errno = %i\n", enqueued, rte_errno);
free_pkts(vec->mbufs, vec->nb_elem);
rte_mempool_put(rte_mempool_from_obj(vec), vec);
} else {
core_stats_update_tx(n);
}
}
static inline int
ipsec_ev_cryptodev_process(const struct lcore_conf_ev_tx_int_port_wrkr *lconf,
struct rte_event *ev)
{
struct rte_crypto_op *cop;
struct rte_mbuf *pkt;
/* Get pkt data */
cop = ev->event_ptr;
pkt = cop->sym->m_src;
if (ipsec_ev_cryptodev_process_one_pkt(lconf, cop, pkt))
return PKT_DROPPED;
/* Update event */
ev->mbuf = pkt;
return PKT_FORWARDED;
}
/*
* Event mode exposes various operating modes depending on the
* capabilities of the event device and the operating mode
* selected.
*/
static void
ipsec_event_port_flush(uint8_t eventdev_id __rte_unused, struct rte_event ev,
void *args __rte_unused)
{
if (ev.event_type & RTE_EVENT_TYPE_VECTOR)
ipsec_event_vector_free(&ev);
else
rte_pktmbuf_free(ev.mbuf);
}
/* Workers registered */
#define IPSEC_EVENTMODE_WORKERS 2
static void
ipsec_ip_reassembly_dyn_offset_get(void)
{
/* Retrieve reassembly dynfield offset if available */
if (ip_reassembly_dynfield_offset < 0)
ip_reassembly_dynfield_offset = rte_mbuf_dynfield_lookup(
RTE_MBUF_DYNFIELD_IP_REASSEMBLY_NAME, NULL);
if (ip_reassembly_dynflag == 0) {
int ip_reassembly_dynflag_offset;
ip_reassembly_dynflag_offset = rte_mbuf_dynflag_lookup(
RTE_MBUF_DYNFLAG_IP_REASSEMBLY_INCOMPLETE_NAME, NULL);
if (ip_reassembly_dynflag_offset >= 0)
ip_reassembly_dynflag = RTE_BIT64(ip_reassembly_dynflag_offset);
}
}
/*
* Event mode worker
* Operating parameters : non-burst - Tx internal port - driver mode
*/
static void
ipsec_wrkr_non_burst_int_port_drv_mode(struct eh_event_link_info *links,
uint8_t nb_links)
{
struct port_drv_mode_data data[RTE_MAX_ETHPORTS];
unsigned int nb_rx = 0, nb_tx;
struct rte_mbuf *pkt;
struct rte_event ev;
uint32_t lcore_id;
int32_t socket_id;
int16_t port_id;
/* Check if we have links registered for this lcore */
if (nb_links == 0) {
/* No links registered - exit */
return;
}
memset(&data, 0, sizeof(struct port_drv_mode_data));
/* Get core ID */
lcore_id = rte_lcore_id();
/* Get socket ID */
socket_id = rte_lcore_to_socket_id(lcore_id);
/*
* Prepare security sessions table. In outbound driver mode
* we always use first session configured for a given port
*/
prepare_out_sessions_tbl(socket_ctx[socket_id].sa_out, data,
RTE_MAX_ETHPORTS);
RTE_LOG(INFO, IPSEC,
"Launching event mode worker (non-burst - Tx internal port - "
"driver mode) on lcore %d\n", lcore_id);
/* We have valid links */
/* Check if it's single link */
if (nb_links != 1) {
RTE_LOG(INFO, IPSEC,
"Multiple links not supported. Using first link\n");
}
RTE_LOG(INFO, IPSEC, " -- lcoreid=%u event_port_id=%u\n", lcore_id,
links[0].event_port_id);
while (!force_quit) {
/* Read packet from event queues */
nb_rx = rte_event_dequeue_burst(links[0].eventdev_id,
links[0].event_port_id,
&ev, /* events */
1, /* nb_events */
0 /* timeout_ticks */);
if (nb_rx == 0)
continue;
switch (ev.event_type) {
case RTE_EVENT_TYPE_ETH_RX_ADAPTER_VECTOR:
case RTE_EVENT_TYPE_ETHDEV_VECTOR:
ipsec_ev_vector_drv_mode_process(links, &ev, data);
continue;
case RTE_EVENT_TYPE_ETHDEV:
break;
default:
RTE_LOG(ERR, IPSEC, "Invalid event type %u",
ev.event_type);
continue;
}
pkt = ev.mbuf;
port_id = pkt->port;
rte_prefetch0(rte_pktmbuf_mtod(pkt, void *));
/* Process packet */
ipsec_event_pre_forward(pkt, port_id);
if (!is_unprotected_port(port_id)) {
if (unlikely(!data[port_id].sess)) {
rte_pktmbuf_free(pkt);
continue;
}
/* Save security session */
rte_security_set_pkt_metadata(data[port_id].ctx,
data[port_id].sess, pkt,
NULL);
/* Mark the packet for Tx security offload */
pkt->ol_flags |= RTE_MBUF_F_TX_SEC_OFFLOAD;
/* Provide L2 len for Outbound processing */
pkt->l2_len = RTE_ETHER_HDR_LEN;
}
/*
* Since tx internal port is available, events can be
* directly enqueued to the adapter and it would be
* internally submitted to the eth device.
*/
nb_tx = rte_event_eth_tx_adapter_enqueue(links[0].eventdev_id,
links[0].event_port_id,
&ev, /* events */
1, /* nb_events */
0 /* flags */);
if (!nb_tx)
rte_pktmbuf_free(ev.mbuf);
}
if (ev.u64) {
ev.op = RTE_EVENT_OP_RELEASE;
rte_event_enqueue_burst(links[0].eventdev_id,
links[0].event_port_id, &ev, 1);
}
rte_event_port_quiesce(links[0].eventdev_id, links[0].event_port_id,
ipsec_event_port_flush, NULL);
}
/*
* Event mode worker
* Operating parameters : non-burst - Tx internal port - app mode
*/
static void
ipsec_wrkr_non_burst_int_port_app_mode(struct eh_event_link_info *links,
uint8_t nb_links)
{
struct lcore_conf_ev_tx_int_port_wrkr lconf;
unsigned int nb_rx = 0, nb_tx;
struct rte_event ev;
uint32_t lcore_id;
int32_t socket_id;
int ret;
/* Check if we have links registered for this lcore */
if (nb_links == 0) {
/* No links registered - exit */
return;
}
/* We have valid links */
/* Get core ID */
lcore_id = rte_lcore_id();
/* Get socket ID */
socket_id = rte_lcore_to_socket_id(lcore_id);
/* Save routing table */
lconf.rt.rt4_ctx = socket_ctx[socket_id].rt_ip4;
lconf.rt.rt6_ctx = socket_ctx[socket_id].rt_ip6;
lconf.inbound.sp4_ctx = socket_ctx[socket_id].sp_ip4_in;
lconf.inbound.sp6_ctx = socket_ctx[socket_id].sp_ip6_in;
lconf.inbound.sa_ctx = socket_ctx[socket_id].sa_in;
lconf.inbound.lcore_id = lcore_id;
lconf.outbound.sp4_ctx = socket_ctx[socket_id].sp_ip4_out;
lconf.outbound.sp6_ctx = socket_ctx[socket_id].sp_ip6_out;
lconf.outbound.sa_ctx = socket_ctx[socket_id].sa_out;
lconf.outbound.ipv4_offloads = tx_offloads.ipv4_offloads;
lconf.outbound.ipv6_offloads = tx_offloads.ipv6_offloads;
lconf.outbound.lcore_id = lcore_id;
RTE_LOG(INFO, IPSEC,
"Launching event mode worker (non-burst - Tx internal port - "
"app mode) on lcore %d\n", lcore_id);
ret = ipsec_sad_lcore_cache_init(app_sa_prm.cache_sz);
if (ret != 0) {
RTE_LOG(ERR, IPSEC,
"SAD cache init on lcore %u, failed with code: %d\n",
lcore_id, ret);
return;
}
/* Check if it's single link */
if (nb_links != 1) {
RTE_LOG(INFO, IPSEC,
"Multiple links not supported. Using first link\n");
}
RTE_LOG(INFO, IPSEC, " -- lcoreid=%u event_port_id=%u\n", lcore_id,
links[0].event_port_id);
ipsec_ip_reassembly_dyn_offset_get();
while (!force_quit) {
/* Read packet from event queues */
nb_rx = rte_event_dequeue_burst(links[0].eventdev_id,
links[0].event_port_id,
&ev, /* events */
1, /* nb_events */
0 /* timeout_ticks */);
if (nb_rx == 0)
continue;
switch (ev.event_type) {
case RTE_EVENT_TYPE_ETH_RX_ADAPTER_VECTOR:
case RTE_EVENT_TYPE_ETHDEV_VECTOR:
ipsec_ev_vector_process(&lconf, links, &ev);
continue;
case RTE_EVENT_TYPE_ETHDEV:
core_stats_update_rx(1);
if (is_unprotected_port(ev.mbuf->port))
ret = process_ipsec_ev_inbound(&lconf.inbound,
&lconf.rt, links, &ev);
else
ret = process_ipsec_ev_outbound(&lconf.outbound,
&lconf.rt, links, &ev);
if (ret != 1)
/* The pkt has been dropped or posted */
continue;
break;
case RTE_EVENT_TYPE_CRYPTODEV:
ret = ipsec_ev_cryptodev_process(&lconf, &ev);
if (unlikely(ret != PKT_FORWARDED))
continue;
break;
case RTE_EVENT_TYPE_CRYPTODEV_VECTOR:
ipsec_ev_cryptodev_vector_process(&lconf, links, &ev);
continue;
default:
RTE_LOG(ERR, IPSEC, "Invalid event type %u",
ev.event_type);
continue;
}
core_stats_update_tx(1);
/*
* Since tx internal port is available, events can be
* directly enqueued to the adapter and it would be
* internally submitted to the eth device.
*/
nb_tx = rte_event_eth_tx_adapter_enqueue(links[0].eventdev_id,
links[0].event_port_id,
&ev, /* events */
1, /* nb_events */
0 /* flags */);
if (!nb_tx)
rte_pktmbuf_free(ev.mbuf);
}
if (ev.u64) {
ev.op = RTE_EVENT_OP_RELEASE;
rte_event_enqueue_burst(links[0].eventdev_id,
links[0].event_port_id, &ev, 1);
}
rte_event_port_quiesce(links[0].eventdev_id, links[0].event_port_id,
ipsec_event_port_flush, NULL);
}
static uint8_t
ipsec_eventmode_populate_wrkr_params(struct eh_app_worker_params *wrkrs)
{
struct eh_app_worker_params *wrkr;
uint8_t nb_wrkr_param = 0;
/* Save workers */
wrkr = wrkrs;
/* Non-burst - Tx internal port - driver mode */
wrkr->cap.burst = EH_RX_TYPE_NON_BURST;
wrkr->cap.tx_internal_port = EH_TX_TYPE_INTERNAL_PORT;
wrkr->cap.ipsec_mode = EH_IPSEC_MODE_TYPE_DRIVER;
wrkr->worker_thread = ipsec_wrkr_non_burst_int_port_drv_mode;
wrkr++;
nb_wrkr_param++;
/* Non-burst - Tx internal port - app mode */
wrkr->cap.burst = EH_RX_TYPE_NON_BURST;
wrkr->cap.tx_internal_port = EH_TX_TYPE_INTERNAL_PORT;
wrkr->cap.ipsec_mode = EH_IPSEC_MODE_TYPE_APP;
wrkr->worker_thread = ipsec_wrkr_non_burst_int_port_app_mode;
nb_wrkr_param++;
return nb_wrkr_param;
}
static void
ipsec_eventmode_worker(struct eh_conf *conf)
{
struct eh_app_worker_params ipsec_wrkr[IPSEC_EVENTMODE_WORKERS] = {
{{{0} }, NULL } };
uint8_t nb_wrkr_param;
/* Populate l2fwd_wrkr params */
nb_wrkr_param = ipsec_eventmode_populate_wrkr_params(ipsec_wrkr);
/*
* Launch correct worker after checking
* the event device's capabilities.
*/
eh_launch_worker(conf, ipsec_wrkr, nb_wrkr_param);
}
static __rte_always_inline void
outb_inl_pro_spd_process(struct sp_ctx *sp,
struct sa_ctx *sa_ctx,
struct traffic_type *ip,
struct traffic_type *match,
struct traffic_type *mismatch,
bool match_flag,
struct ipsec_spd_stats *stats)
{
uint32_t prev_sa_idx = UINT32_MAX;
struct rte_mbuf *ipsec[MAX_PKT_BURST];
struct rte_ipsec_session *ips;
uint32_t i, j, j_mis, sa_idx;
struct ipsec_sa *sa = NULL;
uint32_t ipsec_num = 0;
struct rte_mbuf *m;
uint64_t satp;
if (ip->num == 0 || sp == NULL)
return;
rte_acl_classify((struct rte_acl_ctx *)sp, ip->data, ip->res,
ip->num, DEFAULT_MAX_CATEGORIES);
j = match->num;
j_mis = mismatch->num;
for (i = 0; i < ip->num; i++) {
m = ip->pkts[i];
sa_idx = ip->res[i] - 1;
if (unlikely(ip->res[i] == DISCARD)) {
free_pkts(&m, 1);
stats->discard++;
} else if (unlikely(ip->res[i] == BYPASS)) {
match->pkts[j++] = m;
stats->bypass++;
} else {
if (prev_sa_idx == UINT32_MAX) {
prev_sa_idx = sa_idx;
sa = &sa_ctx->sa[sa_idx];
ips = ipsec_get_primary_session(sa);
satp = rte_ipsec_sa_type(ips->sa);
}
if (sa_idx != prev_sa_idx) {
prep_process_group(sa, ipsec, ipsec_num);
/* Prepare packets for outbound */
rte_ipsec_pkt_process(ips, ipsec, ipsec_num);
/* Copy to current tr or a different tr */
if (SATP_OUT_IPV4(satp) == match_flag) {
memcpy(&match->pkts[j], ipsec,
ipsec_num * sizeof(void *));
j += ipsec_num;
} else {
memcpy(&mismatch->pkts[j_mis], ipsec,
ipsec_num * sizeof(void *));
j_mis += ipsec_num;
}
/* Update to new SA */
sa = &sa_ctx->sa[sa_idx];
ips = ipsec_get_primary_session(sa);
satp = rte_ipsec_sa_type(ips->sa);
ipsec_num = 0;
}
ipsec[ipsec_num++] = m;
stats->protect++;
}
}
if (ipsec_num) {
prep_process_group(sa, ipsec, ipsec_num);
/* Prepare pacekts for outbound */
rte_ipsec_pkt_process(ips, ipsec, ipsec_num);
/* Copy to current tr or a different tr */
if (SATP_OUT_IPV4(satp) == match_flag) {
memcpy(&match->pkts[j], ipsec,
ipsec_num * sizeof(void *));
j += ipsec_num;
} else {
memcpy(&mismatch->pkts[j_mis], ipsec,
ipsec_num * sizeof(void *));
j_mis += ipsec_num;
}
}
match->num = j;
mismatch->num = j_mis;
}
/* Poll mode worker when all SA's are of type inline protocol */
void
ipsec_poll_mode_wrkr_inl_pr(void)
{
const uint64_t drain_tsc = (rte_get_tsc_hz() + US_PER_S - 1)
/ US_PER_S * BURST_TX_DRAIN_US;
struct sp_ctx *sp4_in, *sp6_in, *sp4_out, *sp6_out;
struct rte_mbuf *pkts[MAX_PKT_BURST];
uint64_t prev_tsc, diff_tsc, cur_tsc;
struct ipsec_core_statistics *stats;
struct rt_ctx *rt4_ctx, *rt6_ctx;
struct sa_ctx *sa_in, *sa_out;
struct traffic_type ip4, ip6;
struct lcore_rx_queue *rxql;
struct rte_mbuf **v4, **v6;
struct ipsec_traffic trf;
struct lcore_conf *qconf;
uint16_t v4_num, v6_num;
int32_t socket_id;
uint32_t lcore_id;
int32_t i, nb_rx;
uint16_t portid, queueid;
prev_tsc = 0;
lcore_id = rte_lcore_id();
qconf = &lcore_conf[lcore_id];
rxql = qconf->rx_queue_list;
socket_id = rte_lcore_to_socket_id(lcore_id);
stats = &core_statistics[lcore_id];
rt4_ctx = socket_ctx[socket_id].rt_ip4;
rt6_ctx = socket_ctx[socket_id].rt_ip6;
sp4_in = socket_ctx[socket_id].sp_ip4_in;
sp6_in = socket_ctx[socket_id].sp_ip6_in;
sa_in = socket_ctx[socket_id].sa_in;
sp4_out = socket_ctx[socket_id].sp_ip4_out;
sp6_out = socket_ctx[socket_id].sp_ip6_out;
sa_out = socket_ctx[socket_id].sa_out;
qconf->frag.pool_indir = socket_ctx[socket_id].mbuf_pool_indir;
if (qconf->nb_rx_queue == 0) {
RTE_LOG(DEBUG, IPSEC, "lcore %u has nothing to do\n",
lcore_id);
return;
}
RTE_LOG(INFO, IPSEC, "entering main loop on lcore %u\n", lcore_id);
for (i = 0; i < qconf->nb_rx_queue; i++) {
portid = rxql[i].port_id;
queueid = rxql[i].queue_id;
RTE_LOG(INFO, IPSEC,
" -- lcoreid=%u portid=%u rxqueueid=%" PRIu16 "\n",
lcore_id, portid, queueid);
}
ipsec_ip_reassembly_dyn_offset_get();
while (!force_quit) {
cur_tsc = rte_rdtsc();
/* TX queue buffer drain */
diff_tsc = cur_tsc - prev_tsc;
if (unlikely(diff_tsc > drain_tsc)) {
drain_tx_buffers(qconf);
prev_tsc = cur_tsc;
}
for (i = 0; i < qconf->nb_rx_queue; ++i) {
/* Read packets from RX queues */
portid = rxql[i].port_id;
queueid = rxql[i].queue_id;
nb_rx = rte_eth_rx_burst(portid, queueid,
pkts, MAX_PKT_BURST);
if (nb_rx <= 0)
continue;
core_stats_update_rx(nb_rx);
prepare_traffic(rxql[i].sec_ctx, pkts, &trf, nb_rx);
/* Drop any IPsec traffic */
free_pkts(trf.ipsec.pkts, trf.ipsec.num);
if (is_unprotected_port(portid)) {
inbound_sp_sa(sp4_in, sa_in, &trf.ip4,
trf.ip4.num,
&stats->inbound.spd4);
inbound_sp_sa(sp6_in, sa_in, &trf.ip6,
trf.ip6.num,
&stats->inbound.spd6);
v4 = trf.ip4.pkts;
v4_num = trf.ip4.num;
v6 = trf.ip6.pkts;
v6_num = trf.ip6.num;
} else {
ip4.num = 0;
ip6.num = 0;
outb_inl_pro_spd_process(sp4_out, sa_out,
&trf.ip4, &ip4, &ip6,
true,
&stats->outbound.spd4);
outb_inl_pro_spd_process(sp6_out, sa_out,
&trf.ip6, &ip6, &ip4,
false,
&stats->outbound.spd6);
v4 = ip4.pkts;
v4_num = ip4.num;
v6 = ip6.pkts;
v6_num = ip6.num;
}
#if defined __ARM_NEON
route4_pkts_neon(rt4_ctx, v4, v4_num, 0, false);
route6_pkts_neon(rt6_ctx, v6, v6_num);
#else
route4_pkts(rt4_ctx, v4, v4_num, 0, false);
route6_pkts(rt6_ctx, v6, v6_num);
#endif
}
}
}
/* Poll mode worker when all SA's are of type inline protocol
* and single sa mode is enabled.
*/
void
ipsec_poll_mode_wrkr_inl_pr_ss(void)
{
const uint64_t drain_tsc = (rte_get_tsc_hz() + US_PER_S - 1)
/ US_PER_S * BURST_TX_DRAIN_US;
uint16_t sa_out_portid = 0, sa_out_proto = 0;
struct rte_mbuf *pkts[MAX_PKT_BURST], *pkt;
uint64_t prev_tsc, diff_tsc, cur_tsc;
struct rte_ipsec_session *ips = NULL;
struct lcore_rx_queue *rxql;
struct ipsec_sa *sa = NULL;
struct lcore_conf *qconf;
struct sa_ctx *sa_out;
uint32_t i, nb_rx, j;
int32_t socket_id;
uint32_t lcore_id;
uint16_t portid, queueid;
prev_tsc = 0;
lcore_id = rte_lcore_id();
qconf = &lcore_conf[lcore_id];
rxql = qconf->rx_queue_list;
socket_id = rte_lcore_to_socket_id(lcore_id);
/* Get SA info */
sa_out = socket_ctx[socket_id].sa_out;
if (sa_out && single_sa_idx < sa_out->nb_sa) {
sa = &sa_out->sa[single_sa_idx];
ips = ipsec_get_primary_session(sa);
sa_out_portid = sa->portid;
if (sa->flags & IP6_TUNNEL)
sa_out_proto = IPPROTO_IPV6;
else
sa_out_proto = IPPROTO_IP;
}
qconf->frag.pool_indir = socket_ctx[socket_id].mbuf_pool_indir;
if (qconf->nb_rx_queue == 0) {
RTE_LOG(DEBUG, IPSEC, "lcore %u has nothing to do\n",
lcore_id);
return;
}
RTE_LOG(INFO, IPSEC, "entering main loop on lcore %u\n", lcore_id);
for (i = 0; i < qconf->nb_rx_queue; i++) {
portid = rxql[i].port_id;
queueid = rxql[i].queue_id;
RTE_LOG(INFO, IPSEC,
" -- lcoreid=%u portid=%u rxqueueid=%" PRIu16 "\n",
lcore_id, portid, queueid);
}
while (!force_quit) {
cur_tsc = rte_rdtsc();
/* TX queue buffer drain */
diff_tsc = cur_tsc - prev_tsc;
if (unlikely(diff_tsc > drain_tsc)) {
drain_tx_buffers(qconf);
prev_tsc = cur_tsc;
}
for (i = 0; i < qconf->nb_rx_queue; ++i) {
/* Read packets from RX queues */
portid = rxql[i].port_id;
queueid = rxql[i].queue_id;
nb_rx = rte_eth_rx_burst(portid, queueid,
pkts, MAX_PKT_BURST);
if (nb_rx <= 0)
continue;
core_stats_update_rx(nb_rx);
if (is_unprotected_port(portid)) {
/* Nothing much to do for inbound inline
* decrypted traffic.
*/
for (j = 0; j < nb_rx; j++) {
uint32_t ptype, proto;
pkt = pkts[j];
ptype = pkt->packet_type &
RTE_PTYPE_L3_MASK;
if (ptype == RTE_PTYPE_L3_IPV4)
proto = IPPROTO_IP;
else
proto = IPPROTO_IPV6;
send_single_packet(pkt, portid, proto);
}
continue;
}
/* Free packets if there are no outbound sessions */
if (unlikely(!ips)) {
rte_pktmbuf_free_bulk(pkts, nb_rx);
continue;
}
rte_ipsec_pkt_process(ips, pkts, nb_rx);
/* Send pkts out */
for (j = 0; j < nb_rx; j++) {
pkt = pkts[j];
pkt->l2_len = RTE_ETHER_HDR_LEN;
send_single_packet(pkt, sa_out_portid,
sa_out_proto);
}
}
}
}
static void
ipsec_poll_mode_wrkr_launch(void)
{
static ipsec_worker_fn_t poll_mode_wrkrs[MAX_F] = {
[INL_PR_F] = ipsec_poll_mode_wrkr_inl_pr,
[INL_PR_F | SS_F] = ipsec_poll_mode_wrkr_inl_pr_ss,
};
ipsec_worker_fn_t fn;
if (!app_sa_prm.enable) {
fn = ipsec_poll_mode_worker;
} else {
fn = poll_mode_wrkrs[wrkr_flags];
/* Always default to all mode worker */
if (!fn)
fn = ipsec_poll_mode_worker;
}
/* Launch worker */
(*fn)();
}
int ipsec_launch_one_lcore(void *args)
{
struct eh_conf *conf;
conf = (struct eh_conf *)args;
if (conf->mode == EH_PKT_TRANSFER_MODE_POLL) {
/* Run in poll mode */
ipsec_poll_mode_wrkr_launch();
} else if (conf->mode == EH_PKT_TRANSFER_MODE_EVENT) {
/* Run in event mode */
ipsec_eventmode_worker(conf);
}
return 0;
}
Reference in New Issue View Git Blame Copy Permalink