2019-07-07 14:01:57 +00:00
|
|
|
// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
|
|
|
|
/* Copyright (C) 2019 Netronome Systems, Inc. */
|
|
|
|
|
Fixed updating of ethertype in function skb_mpls_pop
The skb_mpls_pop was not updating ethertype of an ethernet packet if the
packet was originally received from a non ARPHRD_ETHER device.
In the below OVS data path flow, since the device corresponding to port 7
is an l3 device (ARPHRD_NONE) the skb_mpls_pop function does not update
the ethertype of the packet even though the previous push_eth action had
added an ethernet header to the packet.
recirc_id(0),in_port(7),eth_type(0x8847),
mpls(label=12/0xfffff,tc=0/0,ttl=0/0x0,bos=1/1),
actions:push_eth(src=00:00:00:00:00:00,dst=00:00:00:00:00:00),
pop_mpls(eth_type=0x800),4
Fixes: ed246cee09b9 ("net: core: move pop MPLS functionality from OvS to core helper")
Signed-off-by: Martin Varghese <martin.varghese@nokia.com>
Acked-by: Pravin B Shelar <pshelar@ovn.org>
Signed-off-by: David S. Miller <davem@davemloft.net>
2019-12-02 05:19:51 +00:00
|
|
|
#include <linux/if_arp.h>
|
2019-07-07 14:01:57 +00:00
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/mpls.h>
|
|
|
|
#include <linux/rtnetlink.h>
|
|
|
|
#include <linux/skbuff.h>
|
|
|
|
#include <linux/tc_act/tc_mpls.h>
|
|
|
|
#include <net/mpls.h>
|
|
|
|
#include <net/netlink.h>
|
|
|
|
#include <net/pkt_sched.h>
|
|
|
|
#include <net/pkt_cls.h>
|
|
|
|
#include <net/tc_act/tc_mpls.h>
|
2022-12-06 13:55:12 +00:00
|
|
|
#include <net/tc_wrapper.h>
|
2019-07-07 14:01:57 +00:00
|
|
|
|
|
|
|
static struct tc_action_ops act_mpls_ops;
|
|
|
|
|
|
|
|
#define ACT_MPLS_TTL_DEFAULT 255
|
|
|
|
|
|
|
|
static __be32 tcf_mpls_get_lse(struct mpls_shim_hdr *lse,
|
|
|
|
struct tcf_mpls_params *p, bool set_bos)
|
|
|
|
{
|
|
|
|
u32 new_lse = 0;
|
|
|
|
|
|
|
|
if (lse)
|
|
|
|
new_lse = be32_to_cpu(lse->label_stack_entry);
|
|
|
|
|
|
|
|
if (p->tcfm_label != ACT_MPLS_LABEL_NOT_SET) {
|
|
|
|
new_lse &= ~MPLS_LS_LABEL_MASK;
|
|
|
|
new_lse |= p->tcfm_label << MPLS_LS_LABEL_SHIFT;
|
|
|
|
}
|
|
|
|
if (p->tcfm_ttl) {
|
|
|
|
new_lse &= ~MPLS_LS_TTL_MASK;
|
|
|
|
new_lse |= p->tcfm_ttl << MPLS_LS_TTL_SHIFT;
|
|
|
|
}
|
|
|
|
if (p->tcfm_tc != ACT_MPLS_TC_NOT_SET) {
|
|
|
|
new_lse &= ~MPLS_LS_TC_MASK;
|
|
|
|
new_lse |= p->tcfm_tc << MPLS_LS_TC_SHIFT;
|
|
|
|
}
|
|
|
|
if (p->tcfm_bos != ACT_MPLS_BOS_NOT_SET) {
|
|
|
|
new_lse &= ~MPLS_LS_S_MASK;
|
|
|
|
new_lse |= p->tcfm_bos << MPLS_LS_S_SHIFT;
|
|
|
|
} else if (set_bos) {
|
|
|
|
new_lse |= 1 << MPLS_LS_S_SHIFT;
|
|
|
|
}
|
|
|
|
|
|
|
|
return cpu_to_be32(new_lse);
|
|
|
|
}
|
|
|
|
|
2022-12-06 13:55:12 +00:00
|
|
|
TC_INDIRECT_SCOPE int tcf_mpls_act(struct sk_buff *skb,
|
|
|
|
const struct tc_action *a,
|
|
|
|
struct tcf_result *res)
|
2019-07-07 14:01:57 +00:00
|
|
|
{
|
|
|
|
struct tcf_mpls *m = to_mpls(a);
|
|
|
|
struct tcf_mpls_params *p;
|
|
|
|
__be32 new_lse;
|
2019-10-12 11:55:07 +00:00
|
|
|
int ret, mac_len;
|
2019-07-07 14:01:57 +00:00
|
|
|
|
|
|
|
tcf_lastuse_update(&m->tcf_tm);
|
2021-10-16 08:49:09 +00:00
|
|
|
bstats_update(this_cpu_ptr(m->common.cpu_bstats), skb);
|
2019-07-07 14:01:57 +00:00
|
|
|
|
|
|
|
/* Ensure 'data' points at mac_header prior calling mpls manipulating
|
|
|
|
* functions.
|
|
|
|
*/
|
2019-10-12 11:55:07 +00:00
|
|
|
if (skb_at_tc_ingress(skb)) {
|
2019-07-07 14:01:57 +00:00
|
|
|
skb_push_rcsum(skb, skb->mac_len);
|
2019-10-12 11:55:07 +00:00
|
|
|
mac_len = skb->mac_len;
|
|
|
|
} else {
|
2023-03-21 16:45:19 +00:00
|
|
|
mac_len = skb_network_offset(skb);
|
2019-10-12 11:55:07 +00:00
|
|
|
}
|
2019-07-07 14:01:57 +00:00
|
|
|
|
|
|
|
ret = READ_ONCE(m->tcf_action);
|
|
|
|
|
|
|
|
p = rcu_dereference_bh(m->mpls_p);
|
|
|
|
|
|
|
|
switch (p->tcfm_action) {
|
|
|
|
case TCA_MPLS_ACT_POP:
|
Fixed updating of ethertype in function skb_mpls_pop
The skb_mpls_pop was not updating ethertype of an ethernet packet if the
packet was originally received from a non ARPHRD_ETHER device.
In the below OVS data path flow, since the device corresponding to port 7
is an l3 device (ARPHRD_NONE) the skb_mpls_pop function does not update
the ethertype of the packet even though the previous push_eth action had
added an ethernet header to the packet.
recirc_id(0),in_port(7),eth_type(0x8847),
mpls(label=12/0xfffff,tc=0/0,ttl=0/0x0,bos=1/1),
actions:push_eth(src=00:00:00:00:00:00,dst=00:00:00:00:00:00),
pop_mpls(eth_type=0x800),4
Fixes: ed246cee09b9 ("net: core: move pop MPLS functionality from OvS to core helper")
Signed-off-by: Martin Varghese <martin.varghese@nokia.com>
Acked-by: Pravin B Shelar <pshelar@ovn.org>
Signed-off-by: David S. Miller <davem@davemloft.net>
2019-12-02 05:19:51 +00:00
|
|
|
if (skb_mpls_pop(skb, p->tcfm_proto, mac_len,
|
|
|
|
skb->dev && skb->dev->type == ARPHRD_ETHER))
|
2019-07-07 14:01:57 +00:00
|
|
|
goto drop;
|
|
|
|
break;
|
|
|
|
case TCA_MPLS_ACT_PUSH:
|
sched: consistently handle layer3 header accesses in the presence of VLANs
There are a couple of places in net/sched/ that check skb->protocol and act
on the value there. However, in the presence of VLAN tags, the value stored
in skb->protocol can be inconsistent based on whether VLAN acceleration is
enabled. The commit quoted in the Fixes tag below fixed the users of
skb->protocol to use a helper that will always see the VLAN ethertype.
However, most of the callers don't actually handle the VLAN ethertype, but
expect to find the IP header type in the protocol field. This means that
things like changing the ECN field, or parsing diffserv values, stops
working if there's a VLAN tag, or if there are multiple nested VLAN
tags (QinQ).
To fix this, change the helper to take an argument that indicates whether
the caller wants to skip the VLAN tags or not. When skipping VLAN tags, we
make sure to skip all of them, so behaviour is consistent even in QinQ
mode.
To make the helper usable from the ECN code, move it to if_vlan.h instead
of pkt_sched.h.
v3:
- Remove empty lines
- Move vlan variable definitions inside loop in skb_protocol()
- Also use skb_protocol() helper in IP{,6}_ECN_decapsulate() and
bpf_skb_ecn_set_ce()
v2:
- Use eth_type_vlan() helper in skb_protocol()
- Also fix code that reads skb->protocol directly
- Change a couple of 'if/else if' statements to switch constructs to avoid
calling the helper twice
Reported-by: Ilya Ponetayev <i.ponetaev@ndmsystems.com>
Fixes: d8b9605d2697 ("net: sched: fix skb->protocol use in case of accelerated vlan path")
Signed-off-by: Toke Høiland-Jørgensen <toke@redhat.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2020-07-03 20:26:43 +00:00
|
|
|
new_lse = tcf_mpls_get_lse(NULL, p, !eth_p_mpls(skb_protocol(skb, true)));
|
net: Fixed updating of ethertype in skb_mpls_push()
The skb_mpls_push was not updating ethertype of an ethernet packet if
the packet was originally received from a non ARPHRD_ETHER device.
In the below OVS data path flow, since the device corresponding to
port 7 is an l3 device (ARPHRD_NONE) the skb_mpls_push function does
not update the ethertype of the packet even though the previous
push_eth action had added an ethernet header to the packet.
recirc_id(0),in_port(7),eth_type(0x0800),ipv4(tos=0/0xfc,ttl=64,frag=no),
actions:push_eth(src=00:00:00:00:00:00,dst=00:00:00:00:00:00),
push_mpls(label=13,tc=0,ttl=64,bos=1,eth_type=0x8847),4
Fixes: 8822e270d697 ("net: core: move push MPLS functionality from OvS to core helper")
Signed-off-by: Martin Varghese <martin.varghese@nokia.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2019-12-05 00:27:22 +00:00
|
|
|
if (skb_mpls_push(skb, new_lse, p->tcfm_proto, mac_len,
|
|
|
|
skb->dev && skb->dev->type == ARPHRD_ETHER))
|
2019-07-07 14:01:57 +00:00
|
|
|
goto drop;
|
|
|
|
break;
|
2020-10-02 22:44:31 +00:00
|
|
|
case TCA_MPLS_ACT_MAC_PUSH:
|
|
|
|
if (skb_vlan_tag_present(skb)) {
|
|
|
|
if (__vlan_insert_inner_tag(skb, skb->vlan_proto,
|
|
|
|
skb_vlan_tag_get(skb),
|
|
|
|
ETH_HLEN) < 0)
|
|
|
|
goto drop;
|
|
|
|
|
|
|
|
skb->protocol = skb->vlan_proto;
|
|
|
|
__vlan_hwaccel_clear_tag(skb);
|
|
|
|
}
|
|
|
|
|
|
|
|
new_lse = tcf_mpls_get_lse(NULL, p, mac_len ||
|
|
|
|
!eth_p_mpls(skb->protocol));
|
|
|
|
|
|
|
|
if (skb_mpls_push(skb, new_lse, p->tcfm_proto, 0, false))
|
|
|
|
goto drop;
|
|
|
|
break;
|
2019-07-07 14:01:57 +00:00
|
|
|
case TCA_MPLS_ACT_MODIFY:
|
2020-12-03 09:37:52 +00:00
|
|
|
if (!pskb_may_pull(skb,
|
|
|
|
skb_network_offset(skb) + MPLS_HLEN))
|
|
|
|
goto drop;
|
2019-07-07 14:01:57 +00:00
|
|
|
new_lse = tcf_mpls_get_lse(mpls_hdr(skb), p, false);
|
|
|
|
if (skb_mpls_update_lse(skb, new_lse))
|
|
|
|
goto drop;
|
|
|
|
break;
|
|
|
|
case TCA_MPLS_ACT_DEC_TTL:
|
|
|
|
if (skb_mpls_dec_ttl(skb))
|
|
|
|
goto drop;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (skb_at_tc_ingress(skb))
|
|
|
|
skb_pull_rcsum(skb, skb->mac_len);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
drop:
|
|
|
|
qstats_drop_inc(this_cpu_ptr(m->common.cpu_qstats));
|
|
|
|
return TC_ACT_SHOT;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int valid_label(const struct nlattr *attr,
|
|
|
|
struct netlink_ext_ack *extack)
|
|
|
|
{
|
|
|
|
const u32 *label = nla_data(attr);
|
|
|
|
|
2023-01-07 17:10:04 +00:00
|
|
|
if (nla_len(attr) != sizeof(*label)) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Invalid MPLS label length");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2019-07-07 14:01:57 +00:00
|
|
|
if (*label & ~MPLS_LABEL_MASK || *label == MPLS_LABEL_IMPLNULL) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "MPLS label out of range");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct nla_policy mpls_policy[TCA_MPLS_MAX + 1] = {
|
|
|
|
[TCA_MPLS_PARMS] = NLA_POLICY_EXACT_LEN(sizeof(struct tc_mpls)),
|
|
|
|
[TCA_MPLS_PROTO] = { .type = NLA_U16 },
|
2023-01-07 17:10:04 +00:00
|
|
|
[TCA_MPLS_LABEL] = NLA_POLICY_VALIDATE_FN(NLA_BINARY,
|
|
|
|
valid_label),
|
2019-07-07 14:01:57 +00:00
|
|
|
[TCA_MPLS_TC] = NLA_POLICY_RANGE(NLA_U8, 0, 7),
|
|
|
|
[TCA_MPLS_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
|
|
|
|
[TCA_MPLS_BOS] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
|
|
|
|
};
|
|
|
|
|
|
|
|
static int tcf_mpls_init(struct net *net, struct nlattr *nla,
|
|
|
|
struct nlattr *est, struct tc_action **a,
|
2019-10-30 14:09:05 +00:00
|
|
|
struct tcf_proto *tp, u32 flags,
|
|
|
|
struct netlink_ext_ack *extack)
|
2019-07-07 14:01:57 +00:00
|
|
|
{
|
2022-09-08 04:14:33 +00:00
|
|
|
struct tc_action_net *tn = net_generic(net, act_mpls_ops.net_id);
|
2021-07-29 23:12:14 +00:00
|
|
|
bool bind = flags & TCA_ACT_FLAGS_BIND;
|
2019-07-07 14:01:57 +00:00
|
|
|
struct nlattr *tb[TCA_MPLS_MAX + 1];
|
|
|
|
struct tcf_chain *goto_ch = NULL;
|
|
|
|
struct tcf_mpls_params *p;
|
|
|
|
struct tc_mpls *parm;
|
|
|
|
bool exists = false;
|
|
|
|
struct tcf_mpls *m;
|
|
|
|
int ret = 0, err;
|
|
|
|
u8 mpls_ttl = 0;
|
2019-08-01 13:02:51 +00:00
|
|
|
u32 index;
|
2019-07-07 14:01:57 +00:00
|
|
|
|
|
|
|
if (!nla) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Missing netlink attributes");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
err = nla_parse_nested(tb, TCA_MPLS_MAX, nla, mpls_policy, extack);
|
|
|
|
if (err < 0)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
if (!tb[TCA_MPLS_PARMS]) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "No MPLS params");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
parm = nla_data(tb[TCA_MPLS_PARMS]);
|
2019-08-01 13:02:51 +00:00
|
|
|
index = parm->index;
|
2019-07-07 14:01:57 +00:00
|
|
|
|
2023-02-24 15:00:57 +00:00
|
|
|
err = tcf_idr_check_alloc(tn, &index, a, bind);
|
|
|
|
if (err < 0)
|
|
|
|
return err;
|
|
|
|
exists = err;
|
|
|
|
if (exists && bind)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
if (!exists) {
|
|
|
|
ret = tcf_idr_create(tn, index, est, a, &act_mpls_ops, bind,
|
|
|
|
true, flags);
|
|
|
|
if (ret) {
|
|
|
|
tcf_idr_cleanup(tn, index);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = ACT_P_CREATED;
|
|
|
|
} else if (!(flags & TCA_ACT_FLAGS_REPLACE)) {
|
|
|
|
tcf_idr_release(*a, bind);
|
|
|
|
return -EEXIST;
|
|
|
|
}
|
|
|
|
|
2019-07-07 14:01:57 +00:00
|
|
|
/* Verify parameters against action type. */
|
|
|
|
switch (parm->m_action) {
|
|
|
|
case TCA_MPLS_ACT_POP:
|
|
|
|
if (!tb[TCA_MPLS_PROTO]) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Protocol must be set for MPLS pop");
|
2023-02-24 15:00:57 +00:00
|
|
|
err = -EINVAL;
|
|
|
|
goto release_idr;
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
if (!eth_proto_is_802_3(nla_get_be16(tb[TCA_MPLS_PROTO]))) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Invalid protocol type for MPLS pop");
|
2023-02-24 15:00:57 +00:00
|
|
|
err = -EINVAL;
|
|
|
|
goto release_idr;
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
if (tb[TCA_MPLS_LABEL] || tb[TCA_MPLS_TTL] || tb[TCA_MPLS_TC] ||
|
|
|
|
tb[TCA_MPLS_BOS]) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Label, TTL, TC or BOS cannot be used with MPLS pop");
|
2023-02-24 15:00:57 +00:00
|
|
|
err = -EINVAL;
|
|
|
|
goto release_idr;
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
case TCA_MPLS_ACT_DEC_TTL:
|
|
|
|
if (tb[TCA_MPLS_PROTO] || tb[TCA_MPLS_LABEL] ||
|
|
|
|
tb[TCA_MPLS_TTL] || tb[TCA_MPLS_TC] || tb[TCA_MPLS_BOS]) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Label, TTL, TC, BOS or protocol cannot be used with MPLS dec_ttl");
|
2023-02-24 15:00:57 +00:00
|
|
|
err = -EINVAL;
|
|
|
|
goto release_idr;
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
case TCA_MPLS_ACT_PUSH:
|
2020-10-02 22:44:31 +00:00
|
|
|
case TCA_MPLS_ACT_MAC_PUSH:
|
2019-07-07 14:01:57 +00:00
|
|
|
if (!tb[TCA_MPLS_LABEL]) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Label is required for MPLS push");
|
2023-02-24 15:00:57 +00:00
|
|
|
err = -EINVAL;
|
|
|
|
goto release_idr;
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
if (tb[TCA_MPLS_PROTO] &&
|
|
|
|
!eth_p_mpls(nla_get_be16(tb[TCA_MPLS_PROTO]))) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Protocol must be an MPLS type for MPLS push");
|
2023-02-24 15:00:57 +00:00
|
|
|
err = -EPROTONOSUPPORT;
|
|
|
|
goto release_idr;
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
/* Push needs a TTL - if not specified, set a default value. */
|
|
|
|
if (!tb[TCA_MPLS_TTL]) {
|
|
|
|
#if IS_ENABLED(CONFIG_MPLS)
|
|
|
|
mpls_ttl = net->mpls.default_ttl ?
|
|
|
|
net->mpls.default_ttl : ACT_MPLS_TTL_DEFAULT;
|
|
|
|
#else
|
|
|
|
mpls_ttl = ACT_MPLS_TTL_DEFAULT;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case TCA_MPLS_ACT_MODIFY:
|
|
|
|
if (tb[TCA_MPLS_PROTO]) {
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Protocol cannot be used with MPLS modify");
|
2023-02-24 15:00:57 +00:00
|
|
|
err = -EINVAL;
|
|
|
|
goto release_idr;
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Unknown MPLS action");
|
2023-02-24 15:00:57 +00:00
|
|
|
err = -EINVAL;
|
|
|
|
goto release_idr;
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
err = tcf_action_check_ctrlact(parm->action, tp, &goto_ch, extack);
|
|
|
|
if (err < 0)
|
|
|
|
goto release_idr;
|
|
|
|
|
|
|
|
m = to_mpls(*a);
|
|
|
|
|
|
|
|
p = kzalloc(sizeof(*p), GFP_KERNEL);
|
|
|
|
if (!p) {
|
|
|
|
err = -ENOMEM;
|
|
|
|
goto put_chain;
|
|
|
|
}
|
|
|
|
|
|
|
|
p->tcfm_action = parm->m_action;
|
|
|
|
p->tcfm_label = tb[TCA_MPLS_LABEL] ? nla_get_u32(tb[TCA_MPLS_LABEL]) :
|
|
|
|
ACT_MPLS_LABEL_NOT_SET;
|
|
|
|
p->tcfm_tc = tb[TCA_MPLS_TC] ? nla_get_u8(tb[TCA_MPLS_TC]) :
|
|
|
|
ACT_MPLS_TC_NOT_SET;
|
|
|
|
p->tcfm_ttl = tb[TCA_MPLS_TTL] ? nla_get_u8(tb[TCA_MPLS_TTL]) :
|
|
|
|
mpls_ttl;
|
|
|
|
p->tcfm_bos = tb[TCA_MPLS_BOS] ? nla_get_u8(tb[TCA_MPLS_BOS]) :
|
|
|
|
ACT_MPLS_BOS_NOT_SET;
|
|
|
|
p->tcfm_proto = tb[TCA_MPLS_PROTO] ? nla_get_be16(tb[TCA_MPLS_PROTO]) :
|
|
|
|
htons(ETH_P_MPLS_UC);
|
|
|
|
|
|
|
|
spin_lock_bh(&m->tcf_lock);
|
|
|
|
goto_ch = tcf_action_set_ctrlact(*a, parm->action, goto_ch);
|
2019-09-23 23:09:18 +00:00
|
|
|
p = rcu_replace_pointer(m->mpls_p, p, lockdep_is_held(&m->tcf_lock));
|
2019-07-07 14:01:57 +00:00
|
|
|
spin_unlock_bh(&m->tcf_lock);
|
|
|
|
|
|
|
|
if (goto_ch)
|
|
|
|
tcf_chain_put_by_act(goto_ch);
|
|
|
|
if (p)
|
|
|
|
kfree_rcu(p, rcu);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
put_chain:
|
|
|
|
if (goto_ch)
|
|
|
|
tcf_chain_put_by_act(goto_ch);
|
|
|
|
release_idr:
|
|
|
|
tcf_idr_release(*a, bind);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void tcf_mpls_cleanup(struct tc_action *a)
|
|
|
|
{
|
|
|
|
struct tcf_mpls *m = to_mpls(a);
|
|
|
|
struct tcf_mpls_params *p;
|
|
|
|
|
|
|
|
p = rcu_dereference_protected(m->mpls_p, 1);
|
|
|
|
if (p)
|
|
|
|
kfree_rcu(p, rcu);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int tcf_mpls_dump(struct sk_buff *skb, struct tc_action *a,
|
|
|
|
int bind, int ref)
|
|
|
|
{
|
|
|
|
unsigned char *b = skb_tail_pointer(skb);
|
|
|
|
struct tcf_mpls *m = to_mpls(a);
|
|
|
|
struct tcf_mpls_params *p;
|
|
|
|
struct tc_mpls opt = {
|
|
|
|
.index = m->tcf_index,
|
|
|
|
.refcnt = refcount_read(&m->tcf_refcnt) - ref,
|
|
|
|
.bindcnt = atomic_read(&m->tcf_bindcnt) - bind,
|
|
|
|
};
|
|
|
|
struct tcf_t t;
|
|
|
|
|
|
|
|
spin_lock_bh(&m->tcf_lock);
|
|
|
|
opt.action = m->tcf_action;
|
|
|
|
p = rcu_dereference_protected(m->mpls_p, lockdep_is_held(&m->tcf_lock));
|
|
|
|
opt.m_action = p->tcfm_action;
|
|
|
|
|
|
|
|
if (nla_put(skb, TCA_MPLS_PARMS, sizeof(opt), &opt))
|
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
|
|
if (p->tcfm_label != ACT_MPLS_LABEL_NOT_SET &&
|
|
|
|
nla_put_u32(skb, TCA_MPLS_LABEL, p->tcfm_label))
|
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
|
|
if (p->tcfm_tc != ACT_MPLS_TC_NOT_SET &&
|
|
|
|
nla_put_u8(skb, TCA_MPLS_TC, p->tcfm_tc))
|
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
|
|
if (p->tcfm_ttl && nla_put_u8(skb, TCA_MPLS_TTL, p->tcfm_ttl))
|
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
|
|
if (p->tcfm_bos != ACT_MPLS_BOS_NOT_SET &&
|
|
|
|
nla_put_u8(skb, TCA_MPLS_BOS, p->tcfm_bos))
|
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
|
|
if (nla_put_be16(skb, TCA_MPLS_PROTO, p->tcfm_proto))
|
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
|
|
tcf_tm_dump(&t, &m->tcf_tm);
|
|
|
|
|
|
|
|
if (nla_put_64bit(skb, TCA_MPLS_TM, sizeof(t), &t, TCA_MPLS_PAD))
|
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
|
|
spin_unlock_bh(&m->tcf_lock);
|
|
|
|
|
|
|
|
return skb->len;
|
|
|
|
|
|
|
|
nla_put_failure:
|
|
|
|
spin_unlock_bh(&m->tcf_lock);
|
|
|
|
nlmsg_trim(skb, b);
|
|
|
|
return -EMSGSIZE;
|
|
|
|
}
|
|
|
|
|
2021-12-17 18:16:21 +00:00
|
|
|
static int tcf_mpls_offload_act_setup(struct tc_action *act, void *entry_data,
|
2022-04-07 07:35:22 +00:00
|
|
|
u32 *index_inc, bool bind,
|
|
|
|
struct netlink_ext_ack *extack)
|
2021-12-17 18:16:21 +00:00
|
|
|
{
|
|
|
|
if (bind) {
|
|
|
|
struct flow_action_entry *entry = entry_data;
|
|
|
|
|
|
|
|
switch (tcf_mpls_action(act)) {
|
|
|
|
case TCA_MPLS_ACT_PUSH:
|
|
|
|
entry->id = FLOW_ACTION_MPLS_PUSH;
|
|
|
|
entry->mpls_push.proto = tcf_mpls_proto(act);
|
|
|
|
entry->mpls_push.label = tcf_mpls_label(act);
|
|
|
|
entry->mpls_push.tc = tcf_mpls_tc(act);
|
|
|
|
entry->mpls_push.bos = tcf_mpls_bos(act);
|
|
|
|
entry->mpls_push.ttl = tcf_mpls_ttl(act);
|
|
|
|
break;
|
|
|
|
case TCA_MPLS_ACT_POP:
|
|
|
|
entry->id = FLOW_ACTION_MPLS_POP;
|
|
|
|
entry->mpls_pop.proto = tcf_mpls_proto(act);
|
|
|
|
break;
|
|
|
|
case TCA_MPLS_ACT_MODIFY:
|
|
|
|
entry->id = FLOW_ACTION_MPLS_MANGLE;
|
|
|
|
entry->mpls_mangle.label = tcf_mpls_label(act);
|
|
|
|
entry->mpls_mangle.tc = tcf_mpls_tc(act);
|
|
|
|
entry->mpls_mangle.bos = tcf_mpls_bos(act);
|
|
|
|
entry->mpls_mangle.ttl = tcf_mpls_ttl(act);
|
|
|
|
break;
|
2022-04-07 07:35:25 +00:00
|
|
|
case TCA_MPLS_ACT_DEC_TTL:
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Offload not supported when \"dec_ttl\" option is used");
|
|
|
|
return -EOPNOTSUPP;
|
|
|
|
case TCA_MPLS_ACT_MAC_PUSH:
|
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Offload not supported when \"mac_push\" option is used");
|
|
|
|
return -EOPNOTSUPP;
|
2021-12-17 18:16:21 +00:00
|
|
|
default:
|
2022-04-07 07:35:25 +00:00
|
|
|
NL_SET_ERR_MSG_MOD(extack, "Unsupported MPLS mode offload");
|
2021-12-17 18:16:21 +00:00
|
|
|
return -EOPNOTSUPP;
|
|
|
|
}
|
|
|
|
*index_inc = 1;
|
|
|
|
} else {
|
2021-12-17 18:16:22 +00:00
|
|
|
struct flow_offload_action *fl_action = entry_data;
|
|
|
|
|
|
|
|
switch (tcf_mpls_action(act)) {
|
|
|
|
case TCA_MPLS_ACT_PUSH:
|
|
|
|
fl_action->id = FLOW_ACTION_MPLS_PUSH;
|
|
|
|
break;
|
|
|
|
case TCA_MPLS_ACT_POP:
|
|
|
|
fl_action->id = FLOW_ACTION_MPLS_POP;
|
|
|
|
break;
|
|
|
|
case TCA_MPLS_ACT_MODIFY:
|
|
|
|
fl_action->id = FLOW_ACTION_MPLS_MANGLE;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -EOPNOTSUPP;
|
|
|
|
}
|
2021-12-17 18:16:21 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2019-07-07 14:01:57 +00:00
|
|
|
static struct tc_action_ops act_mpls_ops = {
|
|
|
|
.kind = "mpls",
|
|
|
|
.id = TCA_ID_MPLS,
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
.act = tcf_mpls_act,
|
|
|
|
.dump = tcf_mpls_dump,
|
|
|
|
.init = tcf_mpls_init,
|
|
|
|
.cleanup = tcf_mpls_cleanup,
|
2021-12-17 18:16:21 +00:00
|
|
|
.offload_act_setup = tcf_mpls_offload_act_setup,
|
2019-07-07 14:01:57 +00:00
|
|
|
.size = sizeof(struct tcf_mpls),
|
|
|
|
};
|
|
|
|
|
|
|
|
static __net_init int mpls_init_net(struct net *net)
|
|
|
|
{
|
2022-09-08 04:14:33 +00:00
|
|
|
struct tc_action_net *tn = net_generic(net, act_mpls_ops.net_id);
|
2019-07-07 14:01:57 +00:00
|
|
|
|
2019-08-25 17:01:32 +00:00
|
|
|
return tc_action_net_init(net, tn, &act_mpls_ops);
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static void __net_exit mpls_exit_net(struct list_head *net_list)
|
|
|
|
{
|
2022-09-08 04:14:33 +00:00
|
|
|
tc_action_net_exit(net_list, act_mpls_ops.net_id);
|
2019-07-07 14:01:57 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static struct pernet_operations mpls_net_ops = {
|
|
|
|
.init = mpls_init_net,
|
|
|
|
.exit_batch = mpls_exit_net,
|
2022-09-08 04:14:33 +00:00
|
|
|
.id = &act_mpls_ops.net_id,
|
2019-07-07 14:01:57 +00:00
|
|
|
.size = sizeof(struct tc_action_net),
|
|
|
|
};
|
|
|
|
|
|
|
|
static int __init mpls_init_module(void)
|
|
|
|
{
|
|
|
|
return tcf_register_action(&act_mpls_ops, &mpls_net_ops);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit mpls_cleanup_module(void)
|
|
|
|
{
|
|
|
|
tcf_unregister_action(&act_mpls_ops, &mpls_net_ops);
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(mpls_init_module);
|
|
|
|
module_exit(mpls_cleanup_module);
|
|
|
|
|
2020-10-26 10:29:45 +00:00
|
|
|
MODULE_SOFTDEP("post: mpls_gso");
|
2019-07-07 14:01:57 +00:00
|
|
|
MODULE_AUTHOR("Netronome Systems <oss-drivers@netronome.com>");
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
MODULE_DESCRIPTION("MPLS manipulation actions");
|