1e8f887acSAmir Vadai /*
2e8f887acSAmir Vadai  * Copyright (c) 2016, Mellanox Technologies. All rights reserved.
3e8f887acSAmir Vadai  *
4e8f887acSAmir Vadai  * This software is available to you under a choice of one of two
5e8f887acSAmir Vadai  * licenses.  You may choose to be licensed under the terms of the GNU
6e8f887acSAmir Vadai  * General Public License (GPL) Version 2, available from the file
7e8f887acSAmir Vadai  * COPYING in the main directory of this source tree, or the
8e8f887acSAmir Vadai  * OpenIB.org BSD license below:
9e8f887acSAmir Vadai  *
10e8f887acSAmir Vadai  *     Redistribution and use in source and binary forms, with or
11e8f887acSAmir Vadai  *     without modification, are permitted provided that the following
12e8f887acSAmir Vadai  *     conditions are met:
13e8f887acSAmir Vadai  *
14e8f887acSAmir Vadai  *      - Redistributions of source code must retain the above
15e8f887acSAmir Vadai  *        copyright notice, this list of conditions and the following
16e8f887acSAmir Vadai  *        disclaimer.
17e8f887acSAmir Vadai  *
18e8f887acSAmir Vadai  *      - Redistributions in binary form must reproduce the above
19e8f887acSAmir Vadai  *        copyright notice, this list of conditions and the following
20e8f887acSAmir Vadai  *        disclaimer in the documentation and/or other materials
21e8f887acSAmir Vadai  *        provided with the distribution.
22e8f887acSAmir Vadai  *
23e8f887acSAmir Vadai  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24e8f887acSAmir Vadai  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25e8f887acSAmir Vadai  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26e8f887acSAmir Vadai  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27e8f887acSAmir Vadai  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28e8f887acSAmir Vadai  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29e8f887acSAmir Vadai  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30e8f887acSAmir Vadai  * SOFTWARE.
31e8f887acSAmir Vadai  */
32e8f887acSAmir Vadai 
33e3a2b7edSAmir Vadai #include <net/flow_dissector.h>
343f7d0eb4SOr Gerlitz #include <net/sch_generic.h>
35e3a2b7edSAmir Vadai #include <net/pkt_cls.h>
36e3a2b7edSAmir Vadai #include <net/tc_act/tc_gact.h>
3712185a9fSAmir Vadai #include <net/tc_act/tc_skbedit.h>
38e8f887acSAmir Vadai #include <linux/mlx5/fs.h>
39e8f887acSAmir Vadai #include <linux/mlx5/device.h>
40e8f887acSAmir Vadai #include <linux/rhashtable.h>
4103a9d11eSOr Gerlitz #include <net/tc_act/tc_mirred.h>
42776b12b6SOr Gerlitz #include <net/tc_act/tc_vlan.h>
43bbd00f7eSHadar Hen Zion #include <net/tc_act/tc_tunnel_key.h>
44d79b6df6SOr Gerlitz #include <net/tc_act/tc_pedit.h>
4526c02749SOr Gerlitz #include <net/tc_act/tc_csum.h>
46f6dfb4c3SHadar Hen Zion #include <net/arp.h>
473616d08bSDavid Ahern #include <net/ipv6_stubs.h>
48e8f887acSAmir Vadai #include "en.h"
491d447a39SSaeed Mahameed #include "en_rep.h"
50232c0013SHadar Hen Zion #include "en_tc.h"
5103a9d11eSOr Gerlitz #include "eswitch.h"
523f6d08d1SOr Gerlitz #include "fs_core.h"
532c81bfd5SHuy Nguyen #include "en/port.h"
54101f4de9SOz Shlomo #include "en/tc_tun.h"
5504de7ddaSRoi Dayan #include "lib/devcom.h"
56e8f887acSAmir Vadai 
573bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr {
583bc4b7bfSOr Gerlitz 	u32 action;
593bc4b7bfSOr Gerlitz 	u32 flow_tag;
602f4fe4caSOr Gerlitz 	u32 mod_hdr_id;
615c65c564SOr Gerlitz 	u32 hairpin_tirn;
6238aa51c1SOr Gerlitz 	u8 match_level;
633f6d08d1SOr Gerlitz 	struct mlx5_flow_table	*hairpin_ft;
64b8aee822SMark Bloch 	struct mlx5_fc		*counter;
653bc4b7bfSOr Gerlitz };
663bc4b7bfSOr Gerlitz 
6760bd4af8SOr Gerlitz #define MLX5E_TC_FLOW_BASE (MLX5E_TC_LAST_EXPORTED_BIT + 1)
6860bd4af8SOr Gerlitz 
6965ba8fb7SOr Gerlitz enum {
7060bd4af8SOr Gerlitz 	MLX5E_TC_FLOW_INGRESS	= MLX5E_TC_INGRESS,
7160bd4af8SOr Gerlitz 	MLX5E_TC_FLOW_EGRESS	= MLX5E_TC_EGRESS,
72d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_ESWITCH	= MLX5E_TC_ESW_OFFLOAD,
73d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_NIC	= MLX5E_TC_NIC_OFFLOAD,
74d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_OFFLOADED	= BIT(MLX5E_TC_FLOW_BASE),
75d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_HAIRPIN	= BIT(MLX5E_TC_FLOW_BASE + 1),
76d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_HAIRPIN_RSS = BIT(MLX5E_TC_FLOW_BASE + 2),
77d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_SLOW	  = BIT(MLX5E_TC_FLOW_BASE + 3),
78d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_DUP         = BIT(MLX5E_TC_FLOW_BASE + 4),
79ef06c9eeSRoi Dayan 	MLX5E_TC_FLOW_NOT_READY   = BIT(MLX5E_TC_FLOW_BASE + 5),
8065ba8fb7SOr Gerlitz };
8165ba8fb7SOr Gerlitz 
82e4ad91f2SChris Mi #define MLX5E_TC_MAX_SPLITS 1
83e4ad91f2SChris Mi 
8479baaec7SEli Britstein /* Helper struct for accessing a struct containing list_head array.
8579baaec7SEli Britstein  * Containing struct
8679baaec7SEli Britstein  *   |- Helper array
8779baaec7SEli Britstein  *      [0] Helper item 0
8879baaec7SEli Britstein  *          |- list_head item 0
8979baaec7SEli Britstein  *          |- index (0)
9079baaec7SEli Britstein  *      [1] Helper item 1
9179baaec7SEli Britstein  *          |- list_head item 1
9279baaec7SEli Britstein  *          |- index (1)
9379baaec7SEli Britstein  * To access the containing struct from one of the list_head items:
9479baaec7SEli Britstein  * 1. Get the helper item from the list_head item using
9579baaec7SEli Britstein  *    helper item =
9679baaec7SEli Britstein  *        container_of(list_head item, helper struct type, list_head field)
9779baaec7SEli Britstein  * 2. Get the contining struct from the helper item and its index in the array:
9879baaec7SEli Britstein  *    containing struct =
9979baaec7SEli Britstein  *        container_of(helper item, containing struct type, helper field[index])
10079baaec7SEli Britstein  */
10179baaec7SEli Britstein struct encap_flow_item {
10279baaec7SEli Britstein 	struct list_head list;
10379baaec7SEli Britstein 	int index;
10479baaec7SEli Britstein };
10579baaec7SEli Britstein 
106e8f887acSAmir Vadai struct mlx5e_tc_flow {
107e8f887acSAmir Vadai 	struct rhash_head	node;
108655dc3d2SOr Gerlitz 	struct mlx5e_priv	*priv;
109e8f887acSAmir Vadai 	u64			cookie;
1105dbe906fSPaul Blakey 	u16			flags;
111e4ad91f2SChris Mi 	struct mlx5_flow_handle *rule[MLX5E_TC_MAX_SPLITS + 1];
11279baaec7SEli Britstein 	/* Flow can be associated with multiple encap IDs.
11379baaec7SEli Britstein 	 * The number of encaps is bounded by the number of supported
11479baaec7SEli Britstein 	 * destinations.
11579baaec7SEli Britstein 	 */
11679baaec7SEli Britstein 	struct encap_flow_item encaps[MLX5_MAX_FLOW_FWD_VPORTS];
11704de7ddaSRoi Dayan 	struct mlx5e_tc_flow    *peer_flow;
11811c9c548SOr Gerlitz 	struct list_head	mod_hdr; /* flows sharing the same mod hdr ID */
1195c65c564SOr Gerlitz 	struct list_head	hairpin; /* flows sharing the same hairpin */
12004de7ddaSRoi Dayan 	struct list_head	peer;    /* flows with peer flow */
121b4a23329SRoi Dayan 	struct list_head	unready; /* flows not ready to be offloaded (e.g due to missing route) */
1223bc4b7bfSOr Gerlitz 	union {
123ecf5bb79SOr Gerlitz 		struct mlx5_esw_flow_attr esw_attr[0];
1243bc4b7bfSOr Gerlitz 		struct mlx5_nic_flow_attr nic_attr[0];
1253bc4b7bfSOr Gerlitz 	};
126e8f887acSAmir Vadai };
127e8f887acSAmir Vadai 
12817091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr {
12998b66cb1SEli Britstein 	struct ip_tunnel_info tun_info[MLX5_MAX_FLOW_FWD_VPORTS];
130d11afc26SOz Shlomo 	struct net_device *filter_dev;
13117091853SOr Gerlitz 	struct mlx5_flow_spec spec;
132d79b6df6SOr Gerlitz 	int num_mod_hdr_actions;
133218d05ceSTonghao Zhang 	int max_mod_hdr_actions;
134d79b6df6SOr Gerlitz 	void *mod_hdr_actions;
13598b66cb1SEli Britstein 	int mirred_ifindex[MLX5_MAX_FLOW_FWD_VPORTS];
13617091853SOr Gerlitz };
13717091853SOr Gerlitz 
138acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4
139b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16)
140e8f887acSAmir Vadai 
14177ab67b7SOr Gerlitz struct mlx5e_hairpin {
14277ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
14377ab67b7SOr Gerlitz 
14477ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev;
1453f6d08d1SOr Gerlitz 	struct mlx5e_priv *func_priv;
14677ab67b7SOr Gerlitz 	u32 tdn;
14777ab67b7SOr Gerlitz 	u32 tirn;
1483f6d08d1SOr Gerlitz 
1493f6d08d1SOr Gerlitz 	int num_channels;
1503f6d08d1SOr Gerlitz 	struct mlx5e_rqt indir_rqt;
1513f6d08d1SOr Gerlitz 	u32 indir_tirn[MLX5E_NUM_INDIR_TIRS];
1523f6d08d1SOr Gerlitz 	struct mlx5e_ttc_table ttc;
15377ab67b7SOr Gerlitz };
15477ab67b7SOr Gerlitz 
1555c65c564SOr Gerlitz struct mlx5e_hairpin_entry {
1565c65c564SOr Gerlitz 	/* a node of a hash table which keeps all the  hairpin entries */
1575c65c564SOr Gerlitz 	struct hlist_node hairpin_hlist;
1585c65c564SOr Gerlitz 
1595c65c564SOr Gerlitz 	/* flows sharing the same hairpin */
1605c65c564SOr Gerlitz 	struct list_head flows;
1615c65c564SOr Gerlitz 
162d8822868SOr Gerlitz 	u16 peer_vhca_id;
163106be53bSOr Gerlitz 	u8 prio;
1645c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
1655c65c564SOr Gerlitz };
1665c65c564SOr Gerlitz 
16711c9c548SOr Gerlitz struct mod_hdr_key {
16811c9c548SOr Gerlitz 	int num_actions;
16911c9c548SOr Gerlitz 	void *actions;
17011c9c548SOr Gerlitz };
17111c9c548SOr Gerlitz 
17211c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry {
17311c9c548SOr Gerlitz 	/* a node of a hash table which keeps all the mod_hdr entries */
17411c9c548SOr Gerlitz 	struct hlist_node mod_hdr_hlist;
17511c9c548SOr Gerlitz 
17611c9c548SOr Gerlitz 	/* flows sharing the same mod_hdr entry */
17711c9c548SOr Gerlitz 	struct list_head flows;
17811c9c548SOr Gerlitz 
17911c9c548SOr Gerlitz 	struct mod_hdr_key key;
18011c9c548SOr Gerlitz 
18111c9c548SOr Gerlitz 	u32 mod_hdr_id;
18211c9c548SOr Gerlitz };
18311c9c548SOr Gerlitz 
18411c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto)
18511c9c548SOr Gerlitz 
18611c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key)
18711c9c548SOr Gerlitz {
18811c9c548SOr Gerlitz 	return jhash(key->actions,
18911c9c548SOr Gerlitz 		     key->num_actions * MLX5_MH_ACT_SZ, 0);
19011c9c548SOr Gerlitz }
19111c9c548SOr Gerlitz 
19211c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a,
19311c9c548SOr Gerlitz 				   struct mod_hdr_key *b)
19411c9c548SOr Gerlitz {
19511c9c548SOr Gerlitz 	if (a->num_actions != b->num_actions)
19611c9c548SOr Gerlitz 		return 1;
19711c9c548SOr Gerlitz 
19811c9c548SOr Gerlitz 	return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ);
19911c9c548SOr Gerlitz }
20011c9c548SOr Gerlitz 
20111c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv,
20211c9c548SOr Gerlitz 				struct mlx5e_tc_flow *flow,
20311c9c548SOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr)
20411c9c548SOr Gerlitz {
20511c9c548SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
20611c9c548SOr Gerlitz 	int num_actions, actions_size, namespace, err;
20711c9c548SOr Gerlitz 	struct mlx5e_mod_hdr_entry *mh;
20811c9c548SOr Gerlitz 	struct mod_hdr_key key;
20911c9c548SOr Gerlitz 	bool found = false;
21011c9c548SOr Gerlitz 	u32 hash_key;
21111c9c548SOr Gerlitz 
21211c9c548SOr Gerlitz 	num_actions  = parse_attr->num_mod_hdr_actions;
21311c9c548SOr Gerlitz 	actions_size = MLX5_MH_ACT_SZ * num_actions;
21411c9c548SOr Gerlitz 
21511c9c548SOr Gerlitz 	key.actions = parse_attr->mod_hdr_actions;
21611c9c548SOr Gerlitz 	key.num_actions = num_actions;
21711c9c548SOr Gerlitz 
21811c9c548SOr Gerlitz 	hash_key = hash_mod_hdr_info(&key);
21911c9c548SOr Gerlitz 
22011c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
22111c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_FDB;
22211c9c548SOr Gerlitz 		hash_for_each_possible(esw->offloads.mod_hdr_tbl, mh,
22311c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
22411c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
22511c9c548SOr Gerlitz 				found = true;
22611c9c548SOr Gerlitz 				break;
22711c9c548SOr Gerlitz 			}
22811c9c548SOr Gerlitz 		}
22911c9c548SOr Gerlitz 	} else {
23011c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_KERNEL;
23111c9c548SOr Gerlitz 		hash_for_each_possible(priv->fs.tc.mod_hdr_tbl, mh,
23211c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
23311c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
23411c9c548SOr Gerlitz 				found = true;
23511c9c548SOr Gerlitz 				break;
23611c9c548SOr Gerlitz 			}
23711c9c548SOr Gerlitz 		}
23811c9c548SOr Gerlitz 	}
23911c9c548SOr Gerlitz 
24011c9c548SOr Gerlitz 	if (found)
24111c9c548SOr Gerlitz 		goto attach_flow;
24211c9c548SOr Gerlitz 
24311c9c548SOr Gerlitz 	mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL);
24411c9c548SOr Gerlitz 	if (!mh)
24511c9c548SOr Gerlitz 		return -ENOMEM;
24611c9c548SOr Gerlitz 
24711c9c548SOr Gerlitz 	mh->key.actions = (void *)mh + sizeof(*mh);
24811c9c548SOr Gerlitz 	memcpy(mh->key.actions, key.actions, actions_size);
24911c9c548SOr Gerlitz 	mh->key.num_actions = num_actions;
25011c9c548SOr Gerlitz 	INIT_LIST_HEAD(&mh->flows);
25111c9c548SOr Gerlitz 
25211c9c548SOr Gerlitz 	err = mlx5_modify_header_alloc(priv->mdev, namespace,
25311c9c548SOr Gerlitz 				       mh->key.num_actions,
25411c9c548SOr Gerlitz 				       mh->key.actions,
25511c9c548SOr Gerlitz 				       &mh->mod_hdr_id);
25611c9c548SOr Gerlitz 	if (err)
25711c9c548SOr Gerlitz 		goto out_err;
25811c9c548SOr Gerlitz 
25911c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
26011c9c548SOr Gerlitz 		hash_add(esw->offloads.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
26111c9c548SOr Gerlitz 	else
26211c9c548SOr Gerlitz 		hash_add(priv->fs.tc.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
26311c9c548SOr Gerlitz 
26411c9c548SOr Gerlitz attach_flow:
26511c9c548SOr Gerlitz 	list_add(&flow->mod_hdr, &mh->flows);
26611c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
26711c9c548SOr Gerlitz 		flow->esw_attr->mod_hdr_id = mh->mod_hdr_id;
26811c9c548SOr Gerlitz 	else
26911c9c548SOr Gerlitz 		flow->nic_attr->mod_hdr_id = mh->mod_hdr_id;
27011c9c548SOr Gerlitz 
27111c9c548SOr Gerlitz 	return 0;
27211c9c548SOr Gerlitz 
27311c9c548SOr Gerlitz out_err:
27411c9c548SOr Gerlitz 	kfree(mh);
27511c9c548SOr Gerlitz 	return err;
27611c9c548SOr Gerlitz }
27711c9c548SOr Gerlitz 
27811c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv,
27911c9c548SOr Gerlitz 				 struct mlx5e_tc_flow *flow)
28011c9c548SOr Gerlitz {
28111c9c548SOr Gerlitz 	struct list_head *next = flow->mod_hdr.next;
28211c9c548SOr Gerlitz 
28311c9c548SOr Gerlitz 	list_del(&flow->mod_hdr);
28411c9c548SOr Gerlitz 
28511c9c548SOr Gerlitz 	if (list_empty(next)) {
28611c9c548SOr Gerlitz 		struct mlx5e_mod_hdr_entry *mh;
28711c9c548SOr Gerlitz 
28811c9c548SOr Gerlitz 		mh = list_entry(next, struct mlx5e_mod_hdr_entry, flows);
28911c9c548SOr Gerlitz 
29011c9c548SOr Gerlitz 		mlx5_modify_header_dealloc(priv->mdev, mh->mod_hdr_id);
29111c9c548SOr Gerlitz 		hash_del(&mh->mod_hdr_hlist);
29211c9c548SOr Gerlitz 		kfree(mh);
29311c9c548SOr Gerlitz 	}
29411c9c548SOr Gerlitz }
29511c9c548SOr Gerlitz 
29677ab67b7SOr Gerlitz static
29777ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex)
29877ab67b7SOr Gerlitz {
29977ab67b7SOr Gerlitz 	struct net_device *netdev;
30077ab67b7SOr Gerlitz 	struct mlx5e_priv *priv;
30177ab67b7SOr Gerlitz 
30277ab67b7SOr Gerlitz 	netdev = __dev_get_by_index(net, ifindex);
30377ab67b7SOr Gerlitz 	priv = netdev_priv(netdev);
30477ab67b7SOr Gerlitz 	return priv->mdev;
30577ab67b7SOr Gerlitz }
30677ab67b7SOr Gerlitz 
30777ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp)
30877ab67b7SOr Gerlitz {
30977ab67b7SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0};
31077ab67b7SOr Gerlitz 	void *tirc;
31177ab67b7SOr Gerlitz 	int err;
31277ab67b7SOr Gerlitz 
31377ab67b7SOr Gerlitz 	err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn);
31477ab67b7SOr Gerlitz 	if (err)
31577ab67b7SOr Gerlitz 		goto alloc_tdn_err;
31677ab67b7SOr Gerlitz 
31777ab67b7SOr Gerlitz 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
31877ab67b7SOr Gerlitz 
31977ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT);
320ddae74acSOr Gerlitz 	MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]);
32177ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
32277ab67b7SOr Gerlitz 
32377ab67b7SOr Gerlitz 	err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn);
32477ab67b7SOr Gerlitz 	if (err)
32577ab67b7SOr Gerlitz 		goto create_tir_err;
32677ab67b7SOr Gerlitz 
32777ab67b7SOr Gerlitz 	return 0;
32877ab67b7SOr Gerlitz 
32977ab67b7SOr Gerlitz create_tir_err:
33077ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
33177ab67b7SOr Gerlitz alloc_tdn_err:
33277ab67b7SOr Gerlitz 	return err;
33377ab67b7SOr Gerlitz }
33477ab67b7SOr Gerlitz 
33577ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp)
33677ab67b7SOr Gerlitz {
33777ab67b7SOr Gerlitz 	mlx5_core_destroy_tir(hp->func_mdev, hp->tirn);
33877ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
33977ab67b7SOr Gerlitz }
34077ab67b7SOr Gerlitz 
3413f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc)
3423f6d08d1SOr Gerlitz {
3433f6d08d1SOr Gerlitz 	u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn;
3443f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3453f6d08d1SOr Gerlitz 	int i, ix, sz = MLX5E_INDIR_RQT_SIZE;
3463f6d08d1SOr Gerlitz 
3473f6d08d1SOr Gerlitz 	mlx5e_build_default_indir_rqt(indirection_rqt, sz,
3483f6d08d1SOr Gerlitz 				      hp->num_channels);
3493f6d08d1SOr Gerlitz 
3503f6d08d1SOr Gerlitz 	for (i = 0; i < sz; i++) {
3513f6d08d1SOr Gerlitz 		ix = i;
352bbeb53b8SAya Levin 		if (priv->rss_params.hfunc == ETH_RSS_HASH_XOR)
3533f6d08d1SOr Gerlitz 			ix = mlx5e_bits_invert(i, ilog2(sz));
3543f6d08d1SOr Gerlitz 		ix = indirection_rqt[ix];
3553f6d08d1SOr Gerlitz 		rqn = hp->pair->rqn[ix];
3563f6d08d1SOr Gerlitz 		MLX5_SET(rqtc, rqtc, rq_num[i], rqn);
3573f6d08d1SOr Gerlitz 	}
3583f6d08d1SOr Gerlitz }
3593f6d08d1SOr Gerlitz 
3603f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp)
3613f6d08d1SOr Gerlitz {
3623f6d08d1SOr Gerlitz 	int inlen, err, sz = MLX5E_INDIR_RQT_SIZE;
3633f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3643f6d08d1SOr Gerlitz 	struct mlx5_core_dev *mdev = priv->mdev;
3653f6d08d1SOr Gerlitz 	void *rqtc;
3663f6d08d1SOr Gerlitz 	u32 *in;
3673f6d08d1SOr Gerlitz 
3683f6d08d1SOr Gerlitz 	inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz;
3693f6d08d1SOr Gerlitz 	in = kvzalloc(inlen, GFP_KERNEL);
3703f6d08d1SOr Gerlitz 	if (!in)
3713f6d08d1SOr Gerlitz 		return -ENOMEM;
3723f6d08d1SOr Gerlitz 
3733f6d08d1SOr Gerlitz 	rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context);
3743f6d08d1SOr Gerlitz 
3753f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_actual_size, sz);
3763f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_max_size, sz);
3773f6d08d1SOr Gerlitz 
3783f6d08d1SOr Gerlitz 	mlx5e_hairpin_fill_rqt_rqns(hp, rqtc);
3793f6d08d1SOr Gerlitz 
3803f6d08d1SOr Gerlitz 	err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn);
3813f6d08d1SOr Gerlitz 	if (!err)
3823f6d08d1SOr Gerlitz 		hp->indir_rqt.enabled = true;
3833f6d08d1SOr Gerlitz 
3843f6d08d1SOr Gerlitz 	kvfree(in);
3853f6d08d1SOr Gerlitz 	return err;
3863f6d08d1SOr Gerlitz }
3873f6d08d1SOr Gerlitz 
3883f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp)
3893f6d08d1SOr Gerlitz {
3903f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3913f6d08d1SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)];
3923f6d08d1SOr Gerlitz 	int tt, i, err;
3933f6d08d1SOr Gerlitz 	void *tirc;
3943f6d08d1SOr Gerlitz 
3953f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) {
396d930ac79SAya Levin 		struct mlx5e_tirc_config ttconfig = mlx5e_tirc_get_default_config(tt);
397d930ac79SAya Levin 
3983f6d08d1SOr Gerlitz 		memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in));
3993f6d08d1SOr Gerlitz 		tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
4003f6d08d1SOr Gerlitz 
4013f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
4023f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT);
4033f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn);
404bbeb53b8SAya Levin 		mlx5e_build_indir_tir_ctx_hash(&priv->rss_params, &ttconfig, tirc, false);
405bbeb53b8SAya Levin 
4063f6d08d1SOr Gerlitz 		err = mlx5_core_create_tir(hp->func_mdev, in,
4073f6d08d1SOr Gerlitz 					   MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]);
4083f6d08d1SOr Gerlitz 		if (err) {
4093f6d08d1SOr Gerlitz 			mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err);
4103f6d08d1SOr Gerlitz 			goto err_destroy_tirs;
4113f6d08d1SOr Gerlitz 		}
4123f6d08d1SOr Gerlitz 	}
4133f6d08d1SOr Gerlitz 	return 0;
4143f6d08d1SOr Gerlitz 
4153f6d08d1SOr Gerlitz err_destroy_tirs:
4163f6d08d1SOr Gerlitz 	for (i = 0; i < tt; i++)
4173f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]);
4183f6d08d1SOr Gerlitz 	return err;
4193f6d08d1SOr Gerlitz }
4203f6d08d1SOr Gerlitz 
4213f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp)
4223f6d08d1SOr Gerlitz {
4233f6d08d1SOr Gerlitz 	int tt;
4243f6d08d1SOr Gerlitz 
4253f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
4263f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]);
4273f6d08d1SOr Gerlitz }
4283f6d08d1SOr Gerlitz 
4293f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp,
4303f6d08d1SOr Gerlitz 					 struct ttc_params *ttc_params)
4313f6d08d1SOr Gerlitz {
4323f6d08d1SOr Gerlitz 	struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
4333f6d08d1SOr Gerlitz 	int tt;
4343f6d08d1SOr Gerlitz 
4353f6d08d1SOr Gerlitz 	memset(ttc_params, 0, sizeof(*ttc_params));
4363f6d08d1SOr Gerlitz 
4373f6d08d1SOr Gerlitz 	ttc_params->any_tt_tirn = hp->tirn;
4383f6d08d1SOr Gerlitz 
4393f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
4403f6d08d1SOr Gerlitz 		ttc_params->indir_tirn[tt] = hp->indir_tirn[tt];
4413f6d08d1SOr Gerlitz 
4423f6d08d1SOr Gerlitz 	ft_attr->max_fte = MLX5E_NUM_TT;
4433f6d08d1SOr Gerlitz 	ft_attr->level = MLX5E_TC_TTC_FT_LEVEL;
4443f6d08d1SOr Gerlitz 	ft_attr->prio = MLX5E_TC_PRIO;
4453f6d08d1SOr Gerlitz }
4463f6d08d1SOr Gerlitz 
4473f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp)
4483f6d08d1SOr Gerlitz {
4493f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4503f6d08d1SOr Gerlitz 	struct ttc_params ttc_params;
4513f6d08d1SOr Gerlitz 	int err;
4523f6d08d1SOr Gerlitz 
4533f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_rqt(hp);
4543f6d08d1SOr Gerlitz 	if (err)
4553f6d08d1SOr Gerlitz 		return err;
4563f6d08d1SOr Gerlitz 
4573f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_tirs(hp);
4583f6d08d1SOr Gerlitz 	if (err)
4593f6d08d1SOr Gerlitz 		goto err_create_indirect_tirs;
4603f6d08d1SOr Gerlitz 
4613f6d08d1SOr Gerlitz 	mlx5e_hairpin_set_ttc_params(hp, &ttc_params);
4623f6d08d1SOr Gerlitz 	err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc);
4633f6d08d1SOr Gerlitz 	if (err)
4643f6d08d1SOr Gerlitz 		goto err_create_ttc_table;
4653f6d08d1SOr Gerlitz 
4663f6d08d1SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n",
4673f6d08d1SOr Gerlitz 		   hp->num_channels, hp->ttc.ft.t->id);
4683f6d08d1SOr Gerlitz 
4693f6d08d1SOr Gerlitz 	return 0;
4703f6d08d1SOr Gerlitz 
4713f6d08d1SOr Gerlitz err_create_ttc_table:
4723f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
4733f6d08d1SOr Gerlitz err_create_indirect_tirs:
4743f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
4753f6d08d1SOr Gerlitz 
4763f6d08d1SOr Gerlitz 	return err;
4773f6d08d1SOr Gerlitz }
4783f6d08d1SOr Gerlitz 
4793f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp)
4803f6d08d1SOr Gerlitz {
4813f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4823f6d08d1SOr Gerlitz 
4833f6d08d1SOr Gerlitz 	mlx5e_destroy_ttc_table(priv, &hp->ttc);
4843f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
4853f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
4863f6d08d1SOr Gerlitz }
4873f6d08d1SOr Gerlitz 
48877ab67b7SOr Gerlitz static struct mlx5e_hairpin *
48977ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params,
49077ab67b7SOr Gerlitz 		     int peer_ifindex)
49177ab67b7SOr Gerlitz {
49277ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev, *peer_mdev;
49377ab67b7SOr Gerlitz 	struct mlx5e_hairpin *hp;
49477ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
49577ab67b7SOr Gerlitz 	int err;
49677ab67b7SOr Gerlitz 
49777ab67b7SOr Gerlitz 	hp = kzalloc(sizeof(*hp), GFP_KERNEL);
49877ab67b7SOr Gerlitz 	if (!hp)
49977ab67b7SOr Gerlitz 		return ERR_PTR(-ENOMEM);
50077ab67b7SOr Gerlitz 
50177ab67b7SOr Gerlitz 	func_mdev = priv->mdev;
50277ab67b7SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
50377ab67b7SOr Gerlitz 
50477ab67b7SOr Gerlitz 	pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params);
50577ab67b7SOr Gerlitz 	if (IS_ERR(pair)) {
50677ab67b7SOr Gerlitz 		err = PTR_ERR(pair);
50777ab67b7SOr Gerlitz 		goto create_pair_err;
50877ab67b7SOr Gerlitz 	}
50977ab67b7SOr Gerlitz 	hp->pair = pair;
51077ab67b7SOr Gerlitz 	hp->func_mdev = func_mdev;
5113f6d08d1SOr Gerlitz 	hp->func_priv = priv;
5123f6d08d1SOr Gerlitz 	hp->num_channels = params->num_channels;
51377ab67b7SOr Gerlitz 
51477ab67b7SOr Gerlitz 	err = mlx5e_hairpin_create_transport(hp);
51577ab67b7SOr Gerlitz 	if (err)
51677ab67b7SOr Gerlitz 		goto create_transport_err;
51777ab67b7SOr Gerlitz 
5183f6d08d1SOr Gerlitz 	if (hp->num_channels > 1) {
5193f6d08d1SOr Gerlitz 		err = mlx5e_hairpin_rss_init(hp);
5203f6d08d1SOr Gerlitz 		if (err)
5213f6d08d1SOr Gerlitz 			goto rss_init_err;
5223f6d08d1SOr Gerlitz 	}
5233f6d08d1SOr Gerlitz 
52477ab67b7SOr Gerlitz 	return hp;
52577ab67b7SOr Gerlitz 
5263f6d08d1SOr Gerlitz rss_init_err:
5273f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
52877ab67b7SOr Gerlitz create_transport_err:
52977ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
53077ab67b7SOr Gerlitz create_pair_err:
53177ab67b7SOr Gerlitz 	kfree(hp);
53277ab67b7SOr Gerlitz 	return ERR_PTR(err);
53377ab67b7SOr Gerlitz }
53477ab67b7SOr Gerlitz 
53577ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp)
53677ab67b7SOr Gerlitz {
5373f6d08d1SOr Gerlitz 	if (hp->num_channels > 1)
5383f6d08d1SOr Gerlitz 		mlx5e_hairpin_rss_cleanup(hp);
53977ab67b7SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
54077ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
54177ab67b7SOr Gerlitz 	kvfree(hp);
54277ab67b7SOr Gerlitz }
54377ab67b7SOr Gerlitz 
544106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio)
545106be53bSOr Gerlitz {
546106be53bSOr Gerlitz 	return (peer_vhca_id << 16 | prio);
547106be53bSOr Gerlitz }
548106be53bSOr Gerlitz 
5495c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv,
550106be53bSOr Gerlitz 						     u16 peer_vhca_id, u8 prio)
5515c65c564SOr Gerlitz {
5525c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
553106be53bSOr Gerlitz 	u32 hash_key = hash_hairpin_info(peer_vhca_id, prio);
5545c65c564SOr Gerlitz 
5555c65c564SOr Gerlitz 	hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe,
556106be53bSOr Gerlitz 			       hairpin_hlist, hash_key) {
557106be53bSOr Gerlitz 		if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio)
5585c65c564SOr Gerlitz 			return hpe;
5595c65c564SOr Gerlitz 	}
5605c65c564SOr Gerlitz 
5615c65c564SOr Gerlitz 	return NULL;
5625c65c564SOr Gerlitz }
5635c65c564SOr Gerlitz 
564106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8
565106be53bSOr Gerlitz 
566106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv,
567e98bedf5SEli Britstein 				  struct mlx5_flow_spec *spec, u8 *match_prio,
568e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
569106be53bSOr Gerlitz {
570106be53bSOr Gerlitz 	void *headers_c, *headers_v;
571106be53bSOr Gerlitz 	u8 prio_val, prio_mask = 0;
572106be53bSOr Gerlitz 	bool vlan_present;
573106be53bSOr Gerlitz 
574106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB
575106be53bSOr Gerlitz 	if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) {
576e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
577e98bedf5SEli Britstein 				   "only PCP trust state supported for hairpin");
578106be53bSOr Gerlitz 		return -EOPNOTSUPP;
579106be53bSOr Gerlitz 	}
580106be53bSOr Gerlitz #endif
581106be53bSOr Gerlitz 	headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers);
582106be53bSOr Gerlitz 	headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
583106be53bSOr Gerlitz 
584106be53bSOr Gerlitz 	vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag);
585106be53bSOr Gerlitz 	if (vlan_present) {
586106be53bSOr Gerlitz 		prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio);
587106be53bSOr Gerlitz 		prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio);
588106be53bSOr Gerlitz 	}
589106be53bSOr Gerlitz 
590106be53bSOr Gerlitz 	if (!vlan_present || !prio_mask) {
591106be53bSOr Gerlitz 		prio_val = UNKNOWN_MATCH_PRIO;
592106be53bSOr Gerlitz 	} else if (prio_mask != 0x7) {
593e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
594e98bedf5SEli Britstein 				   "masked priority match not supported for hairpin");
595106be53bSOr Gerlitz 		return -EOPNOTSUPP;
596106be53bSOr Gerlitz 	}
597106be53bSOr Gerlitz 
598106be53bSOr Gerlitz 	*match_prio = prio_val;
599106be53bSOr Gerlitz 	return 0;
600106be53bSOr Gerlitz }
601106be53bSOr Gerlitz 
6025c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv,
6035c65c564SOr Gerlitz 				  struct mlx5e_tc_flow *flow,
604e98bedf5SEli Britstein 				  struct mlx5e_tc_flow_parse_attr *parse_attr,
605e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
6065c65c564SOr Gerlitz {
60798b66cb1SEli Britstein 	int peer_ifindex = parse_attr->mirred_ifindex[0];
6085c65c564SOr Gerlitz 	struct mlx5_hairpin_params params;
609d8822868SOr Gerlitz 	struct mlx5_core_dev *peer_mdev;
6105c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
6115c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
6123f6d08d1SOr Gerlitz 	u64 link_speed64;
6133f6d08d1SOr Gerlitz 	u32 link_speed;
614106be53bSOr Gerlitz 	u8 match_prio;
615d8822868SOr Gerlitz 	u16 peer_id;
6165c65c564SOr Gerlitz 	int err;
6175c65c564SOr Gerlitz 
618d8822868SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
619d8822868SOr Gerlitz 	if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) {
620e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported");
6215c65c564SOr Gerlitz 		return -EOPNOTSUPP;
6225c65c564SOr Gerlitz 	}
6235c65c564SOr Gerlitz 
624d8822868SOr Gerlitz 	peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
625e98bedf5SEli Britstein 	err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio,
626e98bedf5SEli Britstein 				     extack);
627106be53bSOr Gerlitz 	if (err)
628106be53bSOr Gerlitz 		return err;
629106be53bSOr Gerlitz 	hpe = mlx5e_hairpin_get(priv, peer_id, match_prio);
6305c65c564SOr Gerlitz 	if (hpe)
6315c65c564SOr Gerlitz 		goto attach_flow;
6325c65c564SOr Gerlitz 
6335c65c564SOr Gerlitz 	hpe = kzalloc(sizeof(*hpe), GFP_KERNEL);
6345c65c564SOr Gerlitz 	if (!hpe)
6355c65c564SOr Gerlitz 		return -ENOMEM;
6365c65c564SOr Gerlitz 
6375c65c564SOr Gerlitz 	INIT_LIST_HEAD(&hpe->flows);
638d8822868SOr Gerlitz 	hpe->peer_vhca_id = peer_id;
639106be53bSOr Gerlitz 	hpe->prio = match_prio;
6405c65c564SOr Gerlitz 
6415c65c564SOr Gerlitz 	params.log_data_size = 15;
6425c65c564SOr Gerlitz 	params.log_data_size = min_t(u8, params.log_data_size,
6435c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz));
6445c65c564SOr Gerlitz 	params.log_data_size = max_t(u8, params.log_data_size,
6455c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz));
6465c65c564SOr Gerlitz 
647eb9180f7SOr Gerlitz 	params.log_num_packets = params.log_data_size -
648eb9180f7SOr Gerlitz 				 MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev);
649eb9180f7SOr Gerlitz 	params.log_num_packets = min_t(u8, params.log_num_packets,
650eb9180f7SOr Gerlitz 				       MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets));
651eb9180f7SOr Gerlitz 
652eb9180f7SOr Gerlitz 	params.q_counter = priv->q_counter;
6533f6d08d1SOr Gerlitz 	/* set hairpin pair per each 50Gbs share of the link */
6542c81bfd5SHuy Nguyen 	mlx5e_port_max_linkspeed(priv->mdev, &link_speed);
6553f6d08d1SOr Gerlitz 	link_speed = max_t(u32, link_speed, 50000);
6563f6d08d1SOr Gerlitz 	link_speed64 = link_speed;
6573f6d08d1SOr Gerlitz 	do_div(link_speed64, 50000);
6583f6d08d1SOr Gerlitz 	params.num_channels = link_speed64;
6593f6d08d1SOr Gerlitz 
6605c65c564SOr Gerlitz 	hp = mlx5e_hairpin_create(priv, &params, peer_ifindex);
6615c65c564SOr Gerlitz 	if (IS_ERR(hp)) {
6625c65c564SOr Gerlitz 		err = PTR_ERR(hp);
6635c65c564SOr Gerlitz 		goto create_hairpin_err;
6645c65c564SOr Gerlitz 	}
6655c65c564SOr Gerlitz 
666eb9180f7SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n",
667ddae74acSOr Gerlitz 		   hp->tirn, hp->pair->rqn[0], hp->pair->peer_mdev->priv.name,
668eb9180f7SOr Gerlitz 		   hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets);
6695c65c564SOr Gerlitz 
6705c65c564SOr Gerlitz 	hpe->hp = hp;
671106be53bSOr Gerlitz 	hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist,
672106be53bSOr Gerlitz 		 hash_hairpin_info(peer_id, match_prio));
6735c65c564SOr Gerlitz 
6745c65c564SOr Gerlitz attach_flow:
6753f6d08d1SOr Gerlitz 	if (hpe->hp->num_channels > 1) {
6763f6d08d1SOr Gerlitz 		flow->flags |= MLX5E_TC_FLOW_HAIRPIN_RSS;
6773f6d08d1SOr Gerlitz 		flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t;
6783f6d08d1SOr Gerlitz 	} else {
6795c65c564SOr Gerlitz 		flow->nic_attr->hairpin_tirn = hpe->hp->tirn;
6803f6d08d1SOr Gerlitz 	}
6815c65c564SOr Gerlitz 	list_add(&flow->hairpin, &hpe->flows);
6823f6d08d1SOr Gerlitz 
6835c65c564SOr Gerlitz 	return 0;
6845c65c564SOr Gerlitz 
6855c65c564SOr Gerlitz create_hairpin_err:
6865c65c564SOr Gerlitz 	kfree(hpe);
6875c65c564SOr Gerlitz 	return err;
6885c65c564SOr Gerlitz }
6895c65c564SOr Gerlitz 
6905c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv,
6915c65c564SOr Gerlitz 				   struct mlx5e_tc_flow *flow)
6925c65c564SOr Gerlitz {
6935c65c564SOr Gerlitz 	struct list_head *next = flow->hairpin.next;
6945c65c564SOr Gerlitz 
6955c65c564SOr Gerlitz 	list_del(&flow->hairpin);
6965c65c564SOr Gerlitz 
6975c65c564SOr Gerlitz 	/* no more hairpin flows for us, release the hairpin pair */
6985c65c564SOr Gerlitz 	if (list_empty(next)) {
6995c65c564SOr Gerlitz 		struct mlx5e_hairpin_entry *hpe;
7005c65c564SOr Gerlitz 
7015c65c564SOr Gerlitz 		hpe = list_entry(next, struct mlx5e_hairpin_entry, flows);
7025c65c564SOr Gerlitz 
7035c65c564SOr Gerlitz 		netdev_dbg(priv->netdev, "del hairpin: peer %s\n",
7045c65c564SOr Gerlitz 			   hpe->hp->pair->peer_mdev->priv.name);
7055c65c564SOr Gerlitz 
7065c65c564SOr Gerlitz 		mlx5e_hairpin_destroy(hpe->hp);
7075c65c564SOr Gerlitz 		hash_del(&hpe->hairpin_hlist);
7085c65c564SOr Gerlitz 		kfree(hpe);
7095c65c564SOr Gerlitz 	}
7105c65c564SOr Gerlitz }
7115c65c564SOr Gerlitz 
712c83954abSRabie Loulou static int
71374491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv,
71417091853SOr Gerlitz 		      struct mlx5e_tc_flow_parse_attr *parse_attr,
715e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
716e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
717e8f887acSAmir Vadai {
718aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
719aad7e08dSAmir Vadai 	struct mlx5_core_dev *dev = priv->mdev;
7205c65c564SOr Gerlitz 	struct mlx5_flow_destination dest[2] = {};
72166958ed9SHadar Hen Zion 	struct mlx5_flow_act flow_act = {
7223bc4b7bfSOr Gerlitz 		.action = attr->action,
7233bc4b7bfSOr Gerlitz 		.flow_tag = attr->flow_tag,
72460786f09SMark Bloch 		.reformat_id = 0,
72542f7ad67SPaul Blakey 		.flags    = FLOW_ACT_HAS_TAG | FLOW_ACT_NO_APPEND,
72666958ed9SHadar Hen Zion 	};
727aad7e08dSAmir Vadai 	struct mlx5_fc *counter = NULL;
728e8f887acSAmir Vadai 	bool table_created = false;
7295c65c564SOr Gerlitz 	int err, dest_ix = 0;
730e8f887acSAmir Vadai 
7315c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) {
732e98bedf5SEli Britstein 		err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack);
7335c65c564SOr Gerlitz 		if (err) {
7345c65c564SOr Gerlitz 			goto err_add_hairpin_flow;
7355c65c564SOr Gerlitz 		}
7363f6d08d1SOr Gerlitz 		if (flow->flags & MLX5E_TC_FLOW_HAIRPIN_RSS) {
7373f6d08d1SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
7383f6d08d1SOr Gerlitz 			dest[dest_ix].ft = attr->hairpin_ft;
7393f6d08d1SOr Gerlitz 		} else {
7405c65c564SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR;
7415c65c564SOr Gerlitz 			dest[dest_ix].tir_num = attr->hairpin_tirn;
7423f6d08d1SOr Gerlitz 		}
7433f6d08d1SOr Gerlitz 		dest_ix++;
7443f6d08d1SOr Gerlitz 	} else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
7455c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
7465c65c564SOr Gerlitz 		dest[dest_ix].ft = priv->fs.vlan.ft.t;
7475c65c564SOr Gerlitz 		dest_ix++;
7485c65c564SOr Gerlitz 	}
749aad7e08dSAmir Vadai 
7505c65c564SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
7515c65c564SOr Gerlitz 		counter = mlx5_fc_create(dev, true);
7525c65c564SOr Gerlitz 		if (IS_ERR(counter)) {
753c83954abSRabie Loulou 			err = PTR_ERR(counter);
7545c65c564SOr Gerlitz 			goto err_fc_create;
7555c65c564SOr Gerlitz 		}
7565c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
757171c7625SMark Bloch 		dest[dest_ix].counter_id = mlx5_fc_id(counter);
7585c65c564SOr Gerlitz 		dest_ix++;
759b8aee822SMark Bloch 		attr->counter = counter;
760aad7e08dSAmir Vadai 	}
761aad7e08dSAmir Vadai 
7622f4fe4caSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
7633099eb5aSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
764d7e75a32SOr Gerlitz 		flow_act.modify_id = attr->mod_hdr_id;
7652f4fe4caSOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
766c83954abSRabie Loulou 		if (err)
7672f4fe4caSOr Gerlitz 			goto err_create_mod_hdr_id;
7682f4fe4caSOr Gerlitz 	}
7692f4fe4caSOr Gerlitz 
770acff797cSMaor Gottlieb 	if (IS_ERR_OR_NULL(priv->fs.tc.t)) {
77121b9c144SOr Gerlitz 		int tc_grp_size, tc_tbl_size;
77221b9c144SOr Gerlitz 		u32 max_flow_counter;
77321b9c144SOr Gerlitz 
77421b9c144SOr Gerlitz 		max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) |
77521b9c144SOr Gerlitz 				    MLX5_CAP_GEN(dev, max_flow_counter_15_0);
77621b9c144SOr Gerlitz 
77721b9c144SOr Gerlitz 		tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE);
77821b9c144SOr Gerlitz 
77921b9c144SOr Gerlitz 		tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS,
78021b9c144SOr Gerlitz 				    BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size)));
78121b9c144SOr Gerlitz 
782acff797cSMaor Gottlieb 		priv->fs.tc.t =
783acff797cSMaor Gottlieb 			mlx5_create_auto_grouped_flow_table(priv->fs.ns,
784acff797cSMaor Gottlieb 							    MLX5E_TC_PRIO,
78521b9c144SOr Gerlitz 							    tc_tbl_size,
786acff797cSMaor Gottlieb 							    MLX5E_TC_TABLE_NUM_GROUPS,
7873f6d08d1SOr Gerlitz 							    MLX5E_TC_FT_LEVEL, 0);
788acff797cSMaor Gottlieb 		if (IS_ERR(priv->fs.tc.t)) {
789e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
790e98bedf5SEli Britstein 					   "Failed to create tc offload table\n");
791e8f887acSAmir Vadai 			netdev_err(priv->netdev,
792e8f887acSAmir Vadai 				   "Failed to create tc offload table\n");
793c83954abSRabie Loulou 			err = PTR_ERR(priv->fs.tc.t);
794aad7e08dSAmir Vadai 			goto err_create_ft;
795e8f887acSAmir Vadai 		}
796e8f887acSAmir Vadai 
797e8f887acSAmir Vadai 		table_created = true;
798e8f887acSAmir Vadai 	}
799e8f887acSAmir Vadai 
80038aa51c1SOr Gerlitz 	if (attr->match_level != MLX5_MATCH_NONE)
80117091853SOr Gerlitz 		parse_attr->spec.match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
80238aa51c1SOr Gerlitz 
803c83954abSRabie Loulou 	flow->rule[0] = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec,
8045c65c564SOr Gerlitz 					    &flow_act, dest, dest_ix);
805e8f887acSAmir Vadai 
806c83954abSRabie Loulou 	if (IS_ERR(flow->rule[0])) {
807c83954abSRabie Loulou 		err = PTR_ERR(flow->rule[0]);
808aad7e08dSAmir Vadai 		goto err_add_rule;
809c83954abSRabie Loulou 	}
810aad7e08dSAmir Vadai 
811c83954abSRabie Loulou 	return 0;
812aad7e08dSAmir Vadai 
813aad7e08dSAmir Vadai err_add_rule:
814aad7e08dSAmir Vadai 	if (table_created) {
815acff797cSMaor Gottlieb 		mlx5_destroy_flow_table(priv->fs.tc.t);
816acff797cSMaor Gottlieb 		priv->fs.tc.t = NULL;
817e8f887acSAmir Vadai 	}
818aad7e08dSAmir Vadai err_create_ft:
8192f4fe4caSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
8203099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
8212f4fe4caSOr Gerlitz err_create_mod_hdr_id:
822aad7e08dSAmir Vadai 	mlx5_fc_destroy(dev, counter);
8235c65c564SOr Gerlitz err_fc_create:
8245c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN)
8255c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
8265c65c564SOr Gerlitz err_add_hairpin_flow:
827c83954abSRabie Loulou 	return err;
828e8f887acSAmir Vadai }
829e8f887acSAmir Vadai 
830d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv,
831d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
832d85cdccbSOr Gerlitz {
833513f8f7fSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
834d85cdccbSOr Gerlitz 	struct mlx5_fc *counter = NULL;
835d85cdccbSOr Gerlitz 
836b8aee822SMark Bloch 	counter = attr->counter;
837e4ad91f2SChris Mi 	mlx5_del_flow_rules(flow->rule[0]);
838d85cdccbSOr Gerlitz 	mlx5_fc_destroy(priv->mdev, counter);
839d85cdccbSOr Gerlitz 
840d9ee0491SOr Gerlitz 	if (!mlx5e_tc_num_filters(priv, MLX5E_TC_NIC_OFFLOAD)  && priv->fs.tc.t) {
841d85cdccbSOr Gerlitz 		mlx5_destroy_flow_table(priv->fs.tc.t);
842d85cdccbSOr Gerlitz 		priv->fs.tc.t = NULL;
843d85cdccbSOr Gerlitz 	}
8442f4fe4caSOr Gerlitz 
845513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
8463099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
8475c65c564SOr Gerlitz 
8485c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN)
8495c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
850d85cdccbSOr Gerlitz }
851d85cdccbSOr Gerlitz 
852aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
8538c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index);
854aa0cbbaeSOr Gerlitz 
8553c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv,
856e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
857733d4f36SRoi Dayan 			      struct net_device *mirred_dev,
858733d4f36SRoi Dayan 			      int out_index,
8598c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
8600ad060eeSRoi Dayan 			      struct net_device **encap_dev,
8610ad060eeSRoi Dayan 			      bool *encap_valid);
8623c37745eSOr Gerlitz 
8636d2a3ed0SOr Gerlitz static struct mlx5_flow_handle *
8646d2a3ed0SOr Gerlitz mlx5e_tc_offload_fdb_rules(struct mlx5_eswitch *esw,
8656d2a3ed0SOr Gerlitz 			   struct mlx5e_tc_flow *flow,
8666d2a3ed0SOr Gerlitz 			   struct mlx5_flow_spec *spec,
8676d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
8686d2a3ed0SOr Gerlitz {
8696d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
8706d2a3ed0SOr Gerlitz 
8716d2a3ed0SOr Gerlitz 	rule = mlx5_eswitch_add_offloaded_rule(esw, spec, attr);
8726d2a3ed0SOr Gerlitz 	if (IS_ERR(rule))
8736d2a3ed0SOr Gerlitz 		return rule;
8746d2a3ed0SOr Gerlitz 
875e85e02baSEli Britstein 	if (attr->split_count) {
8766d2a3ed0SOr Gerlitz 		flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, spec, attr);
8776d2a3ed0SOr Gerlitz 		if (IS_ERR(flow->rule[1])) {
8786d2a3ed0SOr Gerlitz 			mlx5_eswitch_del_offloaded_rule(esw, rule, attr);
8796d2a3ed0SOr Gerlitz 			return flow->rule[1];
8806d2a3ed0SOr Gerlitz 		}
8816d2a3ed0SOr Gerlitz 	}
8826d2a3ed0SOr Gerlitz 
8836d2a3ed0SOr Gerlitz 	flow->flags |= MLX5E_TC_FLOW_OFFLOADED;
8846d2a3ed0SOr Gerlitz 	return rule;
8856d2a3ed0SOr Gerlitz }
8866d2a3ed0SOr Gerlitz 
8876d2a3ed0SOr Gerlitz static void
8886d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(struct mlx5_eswitch *esw,
8896d2a3ed0SOr Gerlitz 			     struct mlx5e_tc_flow *flow,
8906d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
8916d2a3ed0SOr Gerlitz {
8926d2a3ed0SOr Gerlitz 	flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED;
8936d2a3ed0SOr Gerlitz 
894e85e02baSEli Britstein 	if (attr->split_count)
8956d2a3ed0SOr Gerlitz 		mlx5_eswitch_del_fwd_rule(esw, flow->rule[1], attr);
8966d2a3ed0SOr Gerlitz 
8976d2a3ed0SOr Gerlitz 	mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr);
8986d2a3ed0SOr Gerlitz }
8996d2a3ed0SOr Gerlitz 
9005dbe906fSPaul Blakey static struct mlx5_flow_handle *
9015dbe906fSPaul Blakey mlx5e_tc_offload_to_slow_path(struct mlx5_eswitch *esw,
9025dbe906fSPaul Blakey 			      struct mlx5e_tc_flow *flow,
9035dbe906fSPaul Blakey 			      struct mlx5_flow_spec *spec,
9045dbe906fSPaul Blakey 			      struct mlx5_esw_flow_attr *slow_attr)
9055dbe906fSPaul Blakey {
9065dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
9075dbe906fSPaul Blakey 
9085dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
909154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9102be09de7SDavid S. Miller 	slow_attr->split_count = 0;
911154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
9125dbe906fSPaul Blakey 
9135dbe906fSPaul Blakey 	rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, slow_attr);
9145dbe906fSPaul Blakey 	if (!IS_ERR(rule))
9155dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_SLOW;
9165dbe906fSPaul Blakey 
9175dbe906fSPaul Blakey 	return rule;
9185dbe906fSPaul Blakey }
9195dbe906fSPaul Blakey 
9205dbe906fSPaul Blakey static void
9215dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(struct mlx5_eswitch *esw,
9225dbe906fSPaul Blakey 				  struct mlx5e_tc_flow *flow,
9235dbe906fSPaul Blakey 				  struct mlx5_esw_flow_attr *slow_attr)
9245dbe906fSPaul Blakey {
9255dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
926154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9272be09de7SDavid S. Miller 	slow_attr->split_count = 0;
928154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
9295dbe906fSPaul Blakey 	mlx5e_tc_unoffload_fdb_rules(esw, flow, slow_attr);
9305dbe906fSPaul Blakey 	flow->flags &= ~MLX5E_TC_FLOW_SLOW;
9315dbe906fSPaul Blakey }
9325dbe906fSPaul Blakey 
933b4a23329SRoi Dayan static void add_unready_flow(struct mlx5e_tc_flow *flow)
934b4a23329SRoi Dayan {
935b4a23329SRoi Dayan 	struct mlx5_rep_uplink_priv *uplink_priv;
936b4a23329SRoi Dayan 	struct mlx5e_rep_priv *rpriv;
937b4a23329SRoi Dayan 	struct mlx5_eswitch *esw;
938b4a23329SRoi Dayan 
939b4a23329SRoi Dayan 	esw = flow->priv->mdev->priv.eswitch;
940b4a23329SRoi Dayan 	rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
941b4a23329SRoi Dayan 	uplink_priv = &rpriv->uplink_priv;
942b4a23329SRoi Dayan 
943b4a23329SRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_NOT_READY;
944b4a23329SRoi Dayan 	list_add_tail(&flow->unready, &uplink_priv->unready_flows);
945b4a23329SRoi Dayan }
946b4a23329SRoi Dayan 
947b4a23329SRoi Dayan static void remove_unready_flow(struct mlx5e_tc_flow *flow)
948b4a23329SRoi Dayan {
949b4a23329SRoi Dayan 	list_del(&flow->unready);
950b4a23329SRoi Dayan 	flow->flags &= ~MLX5E_TC_FLOW_NOT_READY;
951b4a23329SRoi Dayan }
952b4a23329SRoi Dayan 
953c83954abSRabie Loulou static int
95474491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv,
955e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
956e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
957adb4c123SOr Gerlitz {
958adb4c123SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
959bf07aa73SPaul Blakey 	u32 max_chain = mlx5_eswitch_get_chain_range(esw);
960aa0cbbaeSOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
9617040632dSTonghao Zhang 	struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr;
962bf07aa73SPaul Blakey 	u16 max_prio = mlx5_eswitch_get_prio_range(esw);
9633c37745eSOr Gerlitz 	struct net_device *out_dev, *encap_dev = NULL;
964b8aee822SMark Bloch 	struct mlx5_fc *counter = NULL;
9653c37745eSOr Gerlitz 	struct mlx5e_rep_priv *rpriv;
9663c37745eSOr Gerlitz 	struct mlx5e_priv *out_priv;
9670ad060eeSRoi Dayan 	bool encap_valid = true;
9680ad060eeSRoi Dayan 	int err = 0;
969f493f155SEli Britstein 	int out_index;
9708b32580dSOr Gerlitz 
971d14f6f2aSOr Gerlitz 	if (!mlx5_eswitch_prios_supported(esw) && attr->prio != 1) {
972d14f6f2aSOr Gerlitz 		NL_SET_ERR_MSG(extack, "E-switch priorities unsupported, upgrade FW");
973d14f6f2aSOr Gerlitz 		return -EOPNOTSUPP;
974d14f6f2aSOr Gerlitz 	}
975e52c2802SPaul Blakey 
976bf07aa73SPaul Blakey 	if (attr->chain > max_chain) {
977bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested chain is out of supported range");
978bf07aa73SPaul Blakey 		err = -EOPNOTSUPP;
979bf07aa73SPaul Blakey 		goto err_max_prio_chain;
980bf07aa73SPaul Blakey 	}
981bf07aa73SPaul Blakey 
982bf07aa73SPaul Blakey 	if (attr->prio > max_prio) {
983bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested priority is out of supported range");
984bf07aa73SPaul Blakey 		err = -EOPNOTSUPP;
985bf07aa73SPaul Blakey 		goto err_max_prio_chain;
986bf07aa73SPaul Blakey 	}
987bf07aa73SPaul Blakey 
988f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) {
9898c4dc42bSEli Britstein 		int mirred_ifindex;
9908c4dc42bSEli Britstein 
991f493f155SEli Britstein 		if (!(attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP))
992f493f155SEli Britstein 			continue;
993f493f155SEli Britstein 
9947040632dSTonghao Zhang 		mirred_ifindex = parse_attr->mirred_ifindex[out_index];
9953c37745eSOr Gerlitz 		out_dev = __dev_get_by_index(dev_net(priv->netdev),
9968c4dc42bSEli Britstein 					     mirred_ifindex);
997733d4f36SRoi Dayan 		err = mlx5e_attach_encap(priv, flow, out_dev, out_index,
9980ad060eeSRoi Dayan 					 extack, &encap_dev, &encap_valid);
9990ad060eeSRoi Dayan 		if (err)
10003c37745eSOr Gerlitz 			goto err_attach_encap;
10010ad060eeSRoi Dayan 
10023c37745eSOr Gerlitz 		out_priv = netdev_priv(encap_dev);
10033c37745eSOr Gerlitz 		rpriv = out_priv->ppriv;
10041cc26d74SEli Britstein 		attr->dests[out_index].rep = rpriv->rep;
10051cc26d74SEli Britstein 		attr->dests[out_index].mdev = out_priv->mdev;
10063c37745eSOr Gerlitz 	}
10073c37745eSOr Gerlitz 
10088b32580dSOr Gerlitz 	err = mlx5_eswitch_add_vlan_action(esw, attr);
1009c83954abSRabie Loulou 	if (err)
1010aa0cbbaeSOr Gerlitz 		goto err_add_vlan;
1011adb4c123SOr Gerlitz 
1012d7e75a32SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
10131a9527bbSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
1014d7e75a32SOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
1015c83954abSRabie Loulou 		if (err)
1016d7e75a32SOr Gerlitz 			goto err_mod_hdr;
1017d7e75a32SOr Gerlitz 	}
1018d7e75a32SOr Gerlitz 
1019b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
1020f9392795SShahar Klein 		counter = mlx5_fc_create(attr->counter_dev, true);
1021b8aee822SMark Bloch 		if (IS_ERR(counter)) {
1022c83954abSRabie Loulou 			err = PTR_ERR(counter);
1023b8aee822SMark Bloch 			goto err_create_counter;
1024b8aee822SMark Bloch 		}
1025b8aee822SMark Bloch 
1026b8aee822SMark Bloch 		attr->counter = counter;
1027b8aee822SMark Bloch 	}
1028b8aee822SMark Bloch 
10290ad060eeSRoi Dayan 	/* we get here if one of the following takes place:
10300ad060eeSRoi Dayan 	 * (1) there's no error
10310ad060eeSRoi Dayan 	 * (2) there's an encap action and we don't have valid neigh
10323c37745eSOr Gerlitz 	 */
10330ad060eeSRoi Dayan 	if (!encap_valid) {
10345dbe906fSPaul Blakey 		/* continue with goto slow path rule instead */
10355dbe906fSPaul Blakey 		struct mlx5_esw_flow_attr slow_attr;
10365dbe906fSPaul Blakey 
10375dbe906fSPaul Blakey 		flow->rule[0] = mlx5e_tc_offload_to_slow_path(esw, flow, &parse_attr->spec, &slow_attr);
10385dbe906fSPaul Blakey 	} else {
10396d2a3ed0SOr Gerlitz 		flow->rule[0] = mlx5e_tc_offload_fdb_rules(esw, flow, &parse_attr->spec, attr);
10405dbe906fSPaul Blakey 	}
10415dbe906fSPaul Blakey 
1042c83954abSRabie Loulou 	if (IS_ERR(flow->rule[0])) {
1043c83954abSRabie Loulou 		err = PTR_ERR(flow->rule[0]);
1044aa0cbbaeSOr Gerlitz 		goto err_add_rule;
1045c83954abSRabie Loulou 	}
1046c83954abSRabie Loulou 
10475dbe906fSPaul Blakey 	return 0;
1048aa0cbbaeSOr Gerlitz 
1049aa0cbbaeSOr Gerlitz err_add_rule:
1050f9392795SShahar Klein 	mlx5_fc_destroy(attr->counter_dev, counter);
1051b8aee822SMark Bloch err_create_counter:
1052513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
10531a9527bbSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
1054d7e75a32SOr Gerlitz err_mod_hdr:
1055aa0cbbaeSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1056aa0cbbaeSOr Gerlitz err_add_vlan:
1057f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
10588c4dc42bSEli Britstein 		if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)
10598c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
10603c37745eSOr Gerlitz err_attach_encap:
1061bf07aa73SPaul Blakey err_max_prio_chain:
1062c83954abSRabie Loulou 	return err;
1063aa0cbbaeSOr Gerlitz }
1064d85cdccbSOr Gerlitz 
1065d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv,
1066d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
1067d85cdccbSOr Gerlitz {
1068d85cdccbSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
1069d7e75a32SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
10705dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
1071f493f155SEli Britstein 	int out_index;
1072d85cdccbSOr Gerlitz 
1073ef06c9eeSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_NOT_READY) {
1074b4a23329SRoi Dayan 		remove_unready_flow(flow);
1075ef06c9eeSRoi Dayan 		kvfree(attr->parse_attr);
1076ef06c9eeSRoi Dayan 		return;
1077ef06c9eeSRoi Dayan 	}
1078ef06c9eeSRoi Dayan 
10795dbe906fSPaul Blakey 	if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
10805dbe906fSPaul Blakey 		if (flow->flags & MLX5E_TC_FLOW_SLOW)
10815dbe906fSPaul Blakey 			mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
10825dbe906fSPaul Blakey 		else
10835dbe906fSPaul Blakey 			mlx5e_tc_unoffload_fdb_rules(esw, flow, attr);
10845dbe906fSPaul Blakey 	}
1085d85cdccbSOr Gerlitz 
1086513f8f7fSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1087d85cdccbSOr Gerlitz 
1088f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
10898c4dc42bSEli Britstein 		if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)
10908c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
1091f493f155SEli Britstein 	kvfree(attr->parse_attr);
1092d7e75a32SOr Gerlitz 
1093513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
10941a9527bbSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
1095b8aee822SMark Bloch 
1096b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT)
1097f9392795SShahar Klein 		mlx5_fc_destroy(attr->counter_dev, attr->counter);
1098d85cdccbSOr Gerlitz }
1099d85cdccbSOr Gerlitz 
1100232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv,
1101232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1102232c0013SHadar Hen Zion {
11033c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
11045dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr, *esw_attr;
11056d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
11066d2a3ed0SOr Gerlitz 	struct mlx5_flow_spec *spec;
110779baaec7SEli Britstein 	struct encap_flow_item *efi;
1108232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1109232c0013SHadar Hen Zion 	int err;
1110232c0013SHadar Hen Zion 
111154c177caSOz Shlomo 	err = mlx5_packet_reformat_alloc(priv->mdev,
111254c177caSOz Shlomo 					 e->reformat_type,
1113232c0013SHadar Hen Zion 					 e->encap_size, e->encap_header,
111431ca3648SMark Bloch 					 MLX5_FLOW_NAMESPACE_FDB,
1115232c0013SHadar Hen Zion 					 &e->encap_id);
1116232c0013SHadar Hen Zion 	if (err) {
1117232c0013SHadar Hen Zion 		mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n",
1118232c0013SHadar Hen Zion 			       err);
1119232c0013SHadar Hen Zion 		return;
1120232c0013SHadar Hen Zion 	}
1121232c0013SHadar Hen Zion 	e->flags |= MLX5_ENCAP_ENTRY_VALID;
1122f6dfb4c3SHadar Hen Zion 	mlx5e_rep_queue_neigh_stats_work(priv);
1123232c0013SHadar Hen Zion 
112479baaec7SEli Britstein 	list_for_each_entry(efi, &e->flows, list) {
11258c4dc42bSEli Britstein 		bool all_flow_encaps_valid = true;
11268c4dc42bSEli Britstein 		int i;
11278c4dc42bSEli Britstein 
112879baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
11293c37745eSOr Gerlitz 		esw_attr = flow->esw_attr;
11306d2a3ed0SOr Gerlitz 		spec = &esw_attr->parse_attr->spec;
11316d2a3ed0SOr Gerlitz 
11328c4dc42bSEli Britstein 		esw_attr->dests[efi->index].encap_id = e->encap_id;
11338c4dc42bSEli Britstein 		esw_attr->dests[efi->index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
11348c4dc42bSEli Britstein 		/* Flow can be associated with multiple encap entries.
11358c4dc42bSEli Britstein 		 * Before offloading the flow verify that all of them have
11368c4dc42bSEli Britstein 		 * a valid neighbour.
11378c4dc42bSEli Britstein 		 */
11388c4dc42bSEli Britstein 		for (i = 0; i < MLX5_MAX_FLOW_FWD_VPORTS; i++) {
11398c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP))
11408c4dc42bSEli Britstein 				continue;
11418c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP_VALID)) {
11428c4dc42bSEli Britstein 				all_flow_encaps_valid = false;
11438c4dc42bSEli Britstein 				break;
11448c4dc42bSEli Britstein 			}
11458c4dc42bSEli Britstein 		}
11468c4dc42bSEli Britstein 		/* Do not offload flows with unresolved neighbors */
11478c4dc42bSEli Britstein 		if (!all_flow_encaps_valid)
11488c4dc42bSEli Britstein 			continue;
11495dbe906fSPaul Blakey 		/* update from slow path rule to encap rule */
11506d2a3ed0SOr Gerlitz 		rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, esw_attr);
11516d2a3ed0SOr Gerlitz 		if (IS_ERR(rule)) {
11526d2a3ed0SOr Gerlitz 			err = PTR_ERR(rule);
1153232c0013SHadar Hen Zion 			mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n",
1154232c0013SHadar Hen Zion 				       err);
1155232c0013SHadar Hen Zion 			continue;
1156232c0013SHadar Hen Zion 		}
11575dbe906fSPaul Blakey 
11585dbe906fSPaul Blakey 		mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
11595dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when slow path rule removed */
11606d2a3ed0SOr Gerlitz 		flow->rule[0] = rule;
1161232c0013SHadar Hen Zion 	}
1162232c0013SHadar Hen Zion }
1163232c0013SHadar Hen Zion 
1164232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv,
1165232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1166232c0013SHadar Hen Zion {
11673c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
11685dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
11695dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
11705dbe906fSPaul Blakey 	struct mlx5_flow_spec *spec;
117179baaec7SEli Britstein 	struct encap_flow_item *efi;
1172232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
11735dbe906fSPaul Blakey 	int err;
1174232c0013SHadar Hen Zion 
117579baaec7SEli Britstein 	list_for_each_entry(efi, &e->flows, list) {
117679baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
11775dbe906fSPaul Blakey 		spec = &flow->esw_attr->parse_attr->spec;
11785dbe906fSPaul Blakey 
11795dbe906fSPaul Blakey 		/* update from encap rule to slow path rule */
11805dbe906fSPaul Blakey 		rule = mlx5e_tc_offload_to_slow_path(esw, flow, spec, &slow_attr);
11818c4dc42bSEli Britstein 		/* mark the flow's encap dest as non-valid */
11828c4dc42bSEli Britstein 		flow->esw_attr->dests[efi->index].flags &= ~MLX5_ESW_DEST_ENCAP_VALID;
11835dbe906fSPaul Blakey 
11845dbe906fSPaul Blakey 		if (IS_ERR(rule)) {
11855dbe906fSPaul Blakey 			err = PTR_ERR(rule);
11865dbe906fSPaul Blakey 			mlx5_core_warn(priv->mdev, "Failed to update slow path (encap) flow, %d\n",
11875dbe906fSPaul Blakey 				       err);
11885dbe906fSPaul Blakey 			continue;
11895dbe906fSPaul Blakey 		}
11905dbe906fSPaul Blakey 
11916d2a3ed0SOr Gerlitz 		mlx5e_tc_unoffload_fdb_rules(esw, flow, flow->esw_attr);
11925dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when fast path rule removed */
11935dbe906fSPaul Blakey 		flow->rule[0] = rule;
1194232c0013SHadar Hen Zion 	}
1195232c0013SHadar Hen Zion 
119661c806daSOr Gerlitz 	/* we know that the encap is valid */
1197232c0013SHadar Hen Zion 	e->flags &= ~MLX5_ENCAP_ENTRY_VALID;
119860786f09SMark Bloch 	mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1199232c0013SHadar Hen Zion }
1200232c0013SHadar Hen Zion 
1201b8aee822SMark Bloch static struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow)
1202b8aee822SMark Bloch {
1203b8aee822SMark Bloch 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
1204b8aee822SMark Bloch 		return flow->esw_attr->counter;
1205b8aee822SMark Bloch 	else
1206b8aee822SMark Bloch 		return flow->nic_attr->counter;
1207b8aee822SMark Bloch }
1208b8aee822SMark Bloch 
1209f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe)
1210f6dfb4c3SHadar Hen Zion {
1211f6dfb4c3SHadar Hen Zion 	struct mlx5e_neigh *m_neigh = &nhe->m_neigh;
1212f6dfb4c3SHadar Hen Zion 	u64 bytes, packets, lastuse = 0;
1213f6dfb4c3SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1214f6dfb4c3SHadar Hen Zion 	struct mlx5e_encap_entry *e;
1215f6dfb4c3SHadar Hen Zion 	struct mlx5_fc *counter;
1216f6dfb4c3SHadar Hen Zion 	struct neigh_table *tbl;
1217f6dfb4c3SHadar Hen Zion 	bool neigh_used = false;
1218f6dfb4c3SHadar Hen Zion 	struct neighbour *n;
1219f6dfb4c3SHadar Hen Zion 
1220f6dfb4c3SHadar Hen Zion 	if (m_neigh->family == AF_INET)
1221f6dfb4c3SHadar Hen Zion 		tbl = &arp_tbl;
1222f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6)
1223f6dfb4c3SHadar Hen Zion 	else if (m_neigh->family == AF_INET6)
1224423c9db2SOr Gerlitz 		tbl = &nd_tbl;
1225f6dfb4c3SHadar Hen Zion #endif
1226f6dfb4c3SHadar Hen Zion 	else
1227f6dfb4c3SHadar Hen Zion 		return;
1228f6dfb4c3SHadar Hen Zion 
1229f6dfb4c3SHadar Hen Zion 	list_for_each_entry(e, &nhe->encap_list, encap_list) {
123079baaec7SEli Britstein 		struct encap_flow_item *efi;
1231f6dfb4c3SHadar Hen Zion 		if (!(e->flags & MLX5_ENCAP_ENTRY_VALID))
1232f6dfb4c3SHadar Hen Zion 			continue;
123379baaec7SEli Britstein 		list_for_each_entry(efi, &e->flows, list) {
123479baaec7SEli Britstein 			flow = container_of(efi, struct mlx5e_tc_flow,
123579baaec7SEli Britstein 					    encaps[efi->index]);
1236f6dfb4c3SHadar Hen Zion 			if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
1237b8aee822SMark Bloch 				counter = mlx5e_tc_get_counter(flow);
1238f6dfb4c3SHadar Hen Zion 				mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
1239f6dfb4c3SHadar Hen Zion 				if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) {
1240f6dfb4c3SHadar Hen Zion 					neigh_used = true;
1241f6dfb4c3SHadar Hen Zion 					break;
1242f6dfb4c3SHadar Hen Zion 				}
1243f6dfb4c3SHadar Hen Zion 			}
1244f6dfb4c3SHadar Hen Zion 		}
1245e36d4810SRoi Dayan 		if (neigh_used)
1246e36d4810SRoi Dayan 			break;
1247f6dfb4c3SHadar Hen Zion 	}
1248f6dfb4c3SHadar Hen Zion 
1249f6dfb4c3SHadar Hen Zion 	if (neigh_used) {
1250f6dfb4c3SHadar Hen Zion 		nhe->reported_lastuse = jiffies;
1251f6dfb4c3SHadar Hen Zion 
1252f6dfb4c3SHadar Hen Zion 		/* find the relevant neigh according to the cached device and
1253f6dfb4c3SHadar Hen Zion 		 * dst ip pair
1254f6dfb4c3SHadar Hen Zion 		 */
1255f6dfb4c3SHadar Hen Zion 		n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev);
1256c7f7ba8dSRoi Dayan 		if (!n)
1257f6dfb4c3SHadar Hen Zion 			return;
1258f6dfb4c3SHadar Hen Zion 
1259f6dfb4c3SHadar Hen Zion 		neigh_event_send(n, NULL);
1260f6dfb4c3SHadar Hen Zion 		neigh_release(n);
1261f6dfb4c3SHadar Hen Zion 	}
1262f6dfb4c3SHadar Hen Zion }
1263f6dfb4c3SHadar Hen Zion 
1264d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
12658c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index)
1266d85cdccbSOr Gerlitz {
12678c4dc42bSEli Britstein 	struct list_head *next = flow->encaps[out_index].list.next;
12685067b602SRoi Dayan 
12698c4dc42bSEli Britstein 	list_del(&flow->encaps[out_index].list);
12705067b602SRoi Dayan 	if (list_empty(next)) {
1271c1ae1152SOr Gerlitz 		struct mlx5e_encap_entry *e;
12725067b602SRoi Dayan 
1273c1ae1152SOr Gerlitz 		e = list_entry(next, struct mlx5e_encap_entry, flows);
1274232c0013SHadar Hen Zion 		mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e);
1275232c0013SHadar Hen Zion 
1276232c0013SHadar Hen Zion 		if (e->flags & MLX5_ENCAP_ENTRY_VALID)
127760786f09SMark Bloch 			mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1278232c0013SHadar Hen Zion 
1279cdc5a7f3SOr Gerlitz 		hash_del_rcu(&e->encap_hlist);
1280232c0013SHadar Hen Zion 		kfree(e->encap_header);
12815067b602SRoi Dayan 		kfree(e);
12825067b602SRoi Dayan 	}
12835067b602SRoi Dayan }
12845067b602SRoi Dayan 
128504de7ddaSRoi Dayan static void __mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
128604de7ddaSRoi Dayan {
128704de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = flow->priv->mdev->priv.eswitch;
128804de7ddaSRoi Dayan 
128904de7ddaSRoi Dayan 	if (!(flow->flags & MLX5E_TC_FLOW_ESWITCH) ||
129004de7ddaSRoi Dayan 	    !(flow->flags & MLX5E_TC_FLOW_DUP))
129104de7ddaSRoi Dayan 		return;
129204de7ddaSRoi Dayan 
129304de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
129404de7ddaSRoi Dayan 	list_del(&flow->peer);
129504de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
129604de7ddaSRoi Dayan 
129704de7ddaSRoi Dayan 	flow->flags &= ~MLX5E_TC_FLOW_DUP;
129804de7ddaSRoi Dayan 
129904de7ddaSRoi Dayan 	mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow);
130004de7ddaSRoi Dayan 	kvfree(flow->peer_flow);
130104de7ddaSRoi Dayan 	flow->peer_flow = NULL;
130204de7ddaSRoi Dayan }
130304de7ddaSRoi Dayan 
130404de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
130504de7ddaSRoi Dayan {
130604de7ddaSRoi Dayan 	struct mlx5_core_dev *dev = flow->priv->mdev;
130704de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = dev->priv.devcom;
130804de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
130904de7ddaSRoi Dayan 
131004de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
131104de7ddaSRoi Dayan 	if (!peer_esw)
131204de7ddaSRoi Dayan 		return;
131304de7ddaSRoi Dayan 
131404de7ddaSRoi Dayan 	__mlx5e_tc_del_fdb_peer_flow(flow);
131504de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
131604de7ddaSRoi Dayan }
131704de7ddaSRoi Dayan 
1318e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv,
1319961e8979SRoi Dayan 			      struct mlx5e_tc_flow *flow)
1320e8f887acSAmir Vadai {
132104de7ddaSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
132204de7ddaSRoi Dayan 		mlx5e_tc_del_fdb_peer_flow(flow);
1323d85cdccbSOr Gerlitz 		mlx5e_tc_del_fdb_flow(priv, flow);
132404de7ddaSRoi Dayan 	} else {
1325d85cdccbSOr Gerlitz 		mlx5e_tc_del_nic_flow(priv, flow);
1326e8f887acSAmir Vadai 	}
132704de7ddaSRoi Dayan }
1328e8f887acSAmir Vadai 
1329bbd00f7eSHadar Hen Zion 
1330bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv,
1331bbd00f7eSHadar Hen Zion 			     struct mlx5_flow_spec *spec,
133254c177caSOz Shlomo 			     struct tc_cls_flower_offload *f,
13336363651dSOr Gerlitz 			     struct net_device *filter_dev, u8 *match_level)
1334bbd00f7eSHadar Hen Zion {
1335e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1336bbd00f7eSHadar Hen Zion 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1337bbd00f7eSHadar Hen Zion 				       outer_headers);
1338bbd00f7eSHadar Hen Zion 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1339bbd00f7eSHadar Hen Zion 				       outer_headers);
13408f256622SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
13418f256622SPablo Neira Ayuso 	struct flow_match_control enc_control;
13428f256622SPablo Neira Ayuso 	int err;
1343bbd00f7eSHadar Hen Zion 
1344101f4de9SOz Shlomo 	err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f,
13456363651dSOr Gerlitz 				 headers_c, headers_v, match_level);
134654c177caSOz Shlomo 	if (err) {
134754c177caSOz Shlomo 		NL_SET_ERR_MSG_MOD(extack,
134854c177caSOz Shlomo 				   "failed to parse tunnel attributes");
1349101f4de9SOz Shlomo 		return err;
1350bbd00f7eSHadar Hen Zion 	}
1351bbd00f7eSHadar Hen Zion 
13528f256622SPablo Neira Ayuso 	flow_rule_match_enc_control(rule, &enc_control);
13538f256622SPablo Neira Ayuso 
13548f256622SPablo Neira Ayuso 	if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
13558f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
13568f256622SPablo Neira Ayuso 
13578f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv4_addrs(rule, &match);
1358bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1359bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
13608f256622SPablo Neira Ayuso 			 ntohl(match.mask->src));
1361bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1362bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
13638f256622SPablo Neira Ayuso 			 ntohl(match.key->src));
1364bbd00f7eSHadar Hen Zion 
1365bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1366bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
13678f256622SPablo Neira Ayuso 			 ntohl(match.mask->dst));
1368bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1369bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
13708f256622SPablo Neira Ayuso 			 ntohl(match.key->dst));
1371bbd00f7eSHadar Hen Zion 
1372bbd00f7eSHadar Hen Zion 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
1373bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP);
13748f256622SPablo Neira Ayuso 	} else if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
13758f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
137619f44401SOr Gerlitz 
13778f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv6_addrs(rule, &match);
137819f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
137919f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
13808f256622SPablo Neira Ayuso 		       &match.mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
138119f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
138219f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
13838f256622SPablo Neira Ayuso 		       &match.key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
138419f44401SOr Gerlitz 
138519f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
138619f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
13878f256622SPablo Neira Ayuso 		       &match.mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
138819f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
138919f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
13908f256622SPablo Neira Ayuso 		       &match.key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
139119f44401SOr Gerlitz 
139219f44401SOr Gerlitz 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
139319f44401SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6);
13942e72eb43SOr Gerlitz 	}
1395bbd00f7eSHadar Hen Zion 
13968f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) {
13978f256622SPablo Neira Ayuso 		struct flow_match_ip match;
1398bcef735cSOr Gerlitz 
13998f256622SPablo Neira Ayuso 		flow_rule_match_enc_ip(rule, &match);
14008f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
14018f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
14028f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
14038f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
1404bcef735cSOr Gerlitz 
14058f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
14068f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
14078f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
14088f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
1409bcef735cSOr Gerlitz 
14108f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
14118f256622SPablo Neira Ayuso 			 match.mask->ttl);
14128f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
14138f256622SPablo Neira Ayuso 			 match.key->ttl);
1414e98bedf5SEli Britstein 
14158f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1416e98bedf5SEli Britstein 		    !MLX5_CAP_ESW_FLOWTABLE_FDB
1417e98bedf5SEli Britstein 			(priv->mdev,
1418e98bedf5SEli Britstein 			 ft_field_support.outer_ipv4_ttl)) {
1419e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1420e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
1421e98bedf5SEli Britstein 			return -EOPNOTSUPP;
1422e98bedf5SEli Britstein 		}
1423e98bedf5SEli Britstein 
1424bcef735cSOr Gerlitz 	}
1425bcef735cSOr Gerlitz 
1426bbd00f7eSHadar Hen Zion 	/* Enforce DMAC when offloading incoming tunneled flows.
1427bbd00f7eSHadar Hen Zion 	 * Flow counters require a match on the DMAC.
1428bbd00f7eSHadar Hen Zion 	 */
1429bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16);
1430bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0);
1431bbd00f7eSHadar Hen Zion 	ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1432bbd00f7eSHadar Hen Zion 				     dmac_47_16), priv->netdev->dev_addr);
1433bbd00f7eSHadar Hen Zion 
1434bbd00f7eSHadar Hen Zion 	/* let software handle IP fragments */
1435bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
1436bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0);
1437bbd00f7eSHadar Hen Zion 
1438bbd00f7eSHadar Hen Zion 	return 0;
1439bbd00f7eSHadar Hen Zion }
1440bbd00f7eSHadar Hen Zion 
14418377629eSEli Britstein static void *get_match_headers_criteria(u32 flags,
14428377629eSEli Britstein 					struct mlx5_flow_spec *spec)
14438377629eSEli Britstein {
14448377629eSEli Britstein 	return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ?
14458377629eSEli Britstein 		MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
14468377629eSEli Britstein 			     inner_headers) :
14478377629eSEli Britstein 		MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
14488377629eSEli Britstein 			     outer_headers);
14498377629eSEli Britstein }
14508377629eSEli Britstein 
14518377629eSEli Britstein static void *get_match_headers_value(u32 flags,
14528377629eSEli Britstein 				     struct mlx5_flow_spec *spec)
14538377629eSEli Britstein {
14548377629eSEli Britstein 	return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ?
14558377629eSEli Britstein 		MLX5_ADDR_OF(fte_match_param, spec->match_value,
14568377629eSEli Britstein 			     inner_headers) :
14578377629eSEli Britstein 		MLX5_ADDR_OF(fte_match_param, spec->match_value,
14588377629eSEli Britstein 			     outer_headers);
14598377629eSEli Britstein }
14608377629eSEli Britstein 
1461de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv,
1462de0af0bfSRoi Dayan 			      struct mlx5_flow_spec *spec,
1463de0af0bfSRoi Dayan 			      struct tc_cls_flower_offload *f,
146454c177caSOz Shlomo 			      struct net_device *filter_dev,
14656363651dSOr Gerlitz 			      u8 *match_level, u8 *tunnel_match_level)
1466e3a2b7edSAmir Vadai {
1467e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1468c5bb1730SMaor Gottlieb 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1469c5bb1730SMaor Gottlieb 				       outer_headers);
1470c5bb1730SMaor Gottlieb 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1471c5bb1730SMaor Gottlieb 				       outer_headers);
1472699e96ddSJianbo Liu 	void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1473699e96ddSJianbo Liu 				    misc_parameters);
1474699e96ddSJianbo Liu 	void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1475699e96ddSJianbo Liu 				    misc_parameters);
14768f256622SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
14778f256622SPablo Neira Ayuso 	struct flow_dissector *dissector = rule->match.dissector;
1478e3a2b7edSAmir Vadai 	u16 addr_type = 0;
1479e3a2b7edSAmir Vadai 	u8 ip_proto = 0;
1480e3a2b7edSAmir Vadai 
1481d708f902SOr Gerlitz 	*match_level = MLX5_MATCH_NONE;
1482de0af0bfSRoi Dayan 
14838f256622SPablo Neira Ayuso 	if (dissector->used_keys &
1484e3a2b7edSAmir Vadai 	    ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) |
1485e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_BASIC) |
1486e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) |
1487095b6cfdSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_VLAN) |
1488699e96ddSJianbo Liu 	      BIT(FLOW_DISSECTOR_KEY_CVLAN) |
1489e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) |
1490e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) |
1491bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_PORTS) |
1492bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) |
1493bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) |
1494bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) |
1495bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_PORTS)	|
1496e77834ecSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) |
1497fd7da28bSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_TCP) |
1498bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_IP)  |
1499bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_IP))) {
1500e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "Unsupported key");
1501e3a2b7edSAmir Vadai 		netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n",
15028f256622SPablo Neira Ayuso 			    dissector->used_keys);
1503e3a2b7edSAmir Vadai 		return -EOPNOTSUPP;
1504e3a2b7edSAmir Vadai 	}
1505e3a2b7edSAmir Vadai 
15068f256622SPablo Neira Ayuso 	if ((flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) ||
15078f256622SPablo Neira Ayuso 	     flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_KEYID) ||
15088f256622SPablo Neira Ayuso 	     flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_PORTS)) &&
15098f256622SPablo Neira Ayuso 	    flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_CONTROL)) {
15108f256622SPablo Neira Ayuso 		struct flow_match_control match;
15118f256622SPablo Neira Ayuso 
15128f256622SPablo Neira Ayuso 		flow_rule_match_enc_control(rule, &match);
15138f256622SPablo Neira Ayuso 		switch (match.key->addr_type) {
1514bbd00f7eSHadar Hen Zion 		case FLOW_DISSECTOR_KEY_IPV4_ADDRS:
151519f44401SOr Gerlitz 		case FLOW_DISSECTOR_KEY_IPV6_ADDRS:
15166363651dSOr Gerlitz 			if (parse_tunnel_attr(priv, spec, f, filter_dev, tunnel_match_level))
1517bbd00f7eSHadar Hen Zion 				return -EOPNOTSUPP;
1518bbd00f7eSHadar Hen Zion 			break;
1519bbd00f7eSHadar Hen Zion 		default:
1520bbd00f7eSHadar Hen Zion 			return -EOPNOTSUPP;
1521bbd00f7eSHadar Hen Zion 		}
1522bbd00f7eSHadar Hen Zion 
1523bbd00f7eSHadar Hen Zion 		/* In decap flow, header pointers should point to the inner
1524bbd00f7eSHadar Hen Zion 		 * headers, outer header were already set by parse_tunnel_attr
1525bbd00f7eSHadar Hen Zion 		 */
15268377629eSEli Britstein 		headers_c = get_match_headers_criteria(MLX5_FLOW_CONTEXT_ACTION_DECAP,
15278377629eSEli Britstein 						       spec);
15288377629eSEli Britstein 		headers_v = get_match_headers_value(MLX5_FLOW_CONTEXT_ACTION_DECAP,
15298377629eSEli Britstein 						    spec);
1530bbd00f7eSHadar Hen Zion 	}
1531bbd00f7eSHadar Hen Zion 
15328f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
15338f256622SPablo Neira Ayuso 		struct flow_match_basic match;
1534e3a2b7edSAmir Vadai 
15358f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
15368f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype,
15378f256622SPablo Neira Ayuso 			 ntohs(match.mask->n_proto));
15388f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype,
15398f256622SPablo Neira Ayuso 			 ntohs(match.key->n_proto));
15408f256622SPablo Neira Ayuso 
15418f256622SPablo Neira Ayuso 		if (match.mask->n_proto)
1542d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1543e3a2b7edSAmir Vadai 	}
1544e3a2b7edSAmir Vadai 
15458f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN)) {
15468f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
15478f256622SPablo Neira Ayuso 
15488f256622SPablo Neira Ayuso 		flow_rule_match_vlan(rule, &match);
15498f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
15508f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
15518f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
15528f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1553699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1554699e96ddSJianbo Liu 					 svlan_tag, 1);
1555699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1556699e96ddSJianbo Liu 					 svlan_tag, 1);
1557699e96ddSJianbo Liu 			} else {
1558699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1559699e96ddSJianbo Liu 					 cvlan_tag, 1);
1560699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1561699e96ddSJianbo Liu 					 cvlan_tag, 1);
1562699e96ddSJianbo Liu 			}
1563095b6cfdSOr Gerlitz 
15648f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid,
15658f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
15668f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid,
15678f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1568358d79a4SOr Gerlitz 
15698f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio,
15708f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
15718f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio,
15728f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
157354782900SOr Gerlitz 
1574d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1575095b6cfdSOr Gerlitz 		}
1576d3a80bb5SOr Gerlitz 	} else if (*match_level != MLX5_MATCH_NONE) {
1577cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, svlan_tag, 1);
1578cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1);
1579d3a80bb5SOr Gerlitz 		*match_level = MLX5_MATCH_L2;
1580095b6cfdSOr Gerlitz 	}
1581095b6cfdSOr Gerlitz 
15828f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) {
15838f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
15848f256622SPablo Neira Ayuso 
15858f256622SPablo Neira Ayuso 		flow_rule_match_vlan(rule, &match);
15868f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
15878f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
15888f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
15898f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1590699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1591699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1592699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1593699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1594699e96ddSJianbo Liu 			} else {
1595699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1596699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1597699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1598699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1599699e96ddSJianbo Liu 			}
1600699e96ddSJianbo Liu 
1601699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid,
16028f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
1603699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid,
16048f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1605699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio,
16068f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
1607699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio,
16088f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
1609699e96ddSJianbo Liu 
1610699e96ddSJianbo Liu 			*match_level = MLX5_MATCH_L2;
1611699e96ddSJianbo Liu 		}
1612699e96ddSJianbo Liu 	}
1613699e96ddSJianbo Liu 
16148f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) {
16158f256622SPablo Neira Ayuso 		struct flow_match_eth_addrs match;
161654782900SOr Gerlitz 
16178f256622SPablo Neira Ayuso 		flow_rule_match_eth_addrs(rule, &match);
1618d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1619d3a80bb5SOr Gerlitz 					     dmac_47_16),
16208f256622SPablo Neira Ayuso 				match.mask->dst);
1621d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1622d3a80bb5SOr Gerlitz 					     dmac_47_16),
16238f256622SPablo Neira Ayuso 				match.key->dst);
1624d3a80bb5SOr Gerlitz 
1625d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1626d3a80bb5SOr Gerlitz 					     smac_47_16),
16278f256622SPablo Neira Ayuso 				match.mask->src);
1628d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1629d3a80bb5SOr Gerlitz 					     smac_47_16),
16308f256622SPablo Neira Ayuso 				match.key->src);
1631d3a80bb5SOr Gerlitz 
16328f256622SPablo Neira Ayuso 		if (!is_zero_ether_addr(match.mask->src) ||
16338f256622SPablo Neira Ayuso 		    !is_zero_ether_addr(match.mask->dst))
1634d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
163554782900SOr Gerlitz 	}
163654782900SOr Gerlitz 
16378f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) {
16388f256622SPablo Neira Ayuso 		struct flow_match_control match;
163954782900SOr Gerlitz 
16408f256622SPablo Neira Ayuso 		flow_rule_match_control(rule, &match);
16418f256622SPablo Neira Ayuso 		addr_type = match.key->addr_type;
164254782900SOr Gerlitz 
164354782900SOr Gerlitz 		/* the HW doesn't support frag first/later */
16448f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_FIRST_FRAG)
164554782900SOr Gerlitz 			return -EOPNOTSUPP;
164654782900SOr Gerlitz 
16478f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) {
164854782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
164954782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag,
16508f256622SPablo Neira Ayuso 				 match.key->flags & FLOW_DIS_IS_FRAGMENT);
165154782900SOr Gerlitz 
165254782900SOr Gerlitz 			/* the HW doesn't need L3 inline to match on frag=no */
16538f256622SPablo Neira Ayuso 			if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT))
165483621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L2;
165554782900SOr Gerlitz 	/* ***  L2 attributes parsing up to here *** */
165654782900SOr Gerlitz 			else
165783621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L3;
165854782900SOr Gerlitz 		}
165954782900SOr Gerlitz 	}
166054782900SOr Gerlitz 
16618f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
16628f256622SPablo Neira Ayuso 		struct flow_match_basic match;
16638f256622SPablo Neira Ayuso 
16648f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
16658f256622SPablo Neira Ayuso 		ip_proto = match.key->ip_proto;
166654782900SOr Gerlitz 
166754782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
16688f256622SPablo Neira Ayuso 			 match.mask->ip_proto);
166954782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
16708f256622SPablo Neira Ayuso 			 match.key->ip_proto);
167154782900SOr Gerlitz 
16728f256622SPablo Neira Ayuso 		if (match.mask->ip_proto)
1673d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
167454782900SOr Gerlitz 	}
167554782900SOr Gerlitz 
1676e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
16778f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
1678e3a2b7edSAmir Vadai 
16798f256622SPablo Neira Ayuso 		flow_rule_match_ipv4_addrs(rule, &match);
1680e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1681e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
16828f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1683e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1684e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
16858f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1686e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1687e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
16888f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1689e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1690e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
16918f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1692de0af0bfSRoi Dayan 
16938f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1694d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1695e3a2b7edSAmir Vadai 	}
1696e3a2b7edSAmir Vadai 
1697e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
16988f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
1699e3a2b7edSAmir Vadai 
17008f256622SPablo Neira Ayuso 		flow_rule_match_ipv6_addrs(rule, &match);
1701e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1702e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
17038f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1704e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1705e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
17068f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1707e3a2b7edSAmir Vadai 
1708e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1709e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
17108f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1711e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1712e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
17138f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1714de0af0bfSRoi Dayan 
17158f256622SPablo Neira Ayuso 		if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY ||
17168f256622SPablo Neira Ayuso 		    ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY)
1717d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1718e3a2b7edSAmir Vadai 	}
1719e3a2b7edSAmir Vadai 
17208f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) {
17218f256622SPablo Neira Ayuso 		struct flow_match_ip match;
17221f97a526SOr Gerlitz 
17238f256622SPablo Neira Ayuso 		flow_rule_match_ip(rule, &match);
17248f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
17258f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
17268f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
17278f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
17281f97a526SOr Gerlitz 
17298f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
17308f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
17318f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
17328f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
17331f97a526SOr Gerlitz 
17348f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
17358f256622SPablo Neira Ayuso 			 match.mask->ttl);
17368f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
17378f256622SPablo Neira Ayuso 			 match.key->ttl);
17381f97a526SOr Gerlitz 
17398f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1740a8ade55fSOr Gerlitz 		    !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev,
1741e98bedf5SEli Britstein 						ft_field_support.outer_ipv4_ttl)) {
1742e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1743e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
17441f97a526SOr Gerlitz 			return -EOPNOTSUPP;
1745e98bedf5SEli Britstein 		}
1746a8ade55fSOr Gerlitz 
17478f256622SPablo Neira Ayuso 		if (match.mask->tos || match.mask->ttl)
1748d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
17491f97a526SOr Gerlitz 	}
17501f97a526SOr Gerlitz 
175154782900SOr Gerlitz 	/* ***  L3 attributes parsing up to here *** */
175254782900SOr Gerlitz 
17538f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) {
17548f256622SPablo Neira Ayuso 		struct flow_match_ports match;
17558f256622SPablo Neira Ayuso 
17568f256622SPablo Neira Ayuso 		flow_rule_match_ports(rule, &match);
1757e3a2b7edSAmir Vadai 		switch (ip_proto) {
1758e3a2b7edSAmir Vadai 		case IPPROTO_TCP:
1759e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17608f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.mask->src));
1761e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17628f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.key->src));
1763e3a2b7edSAmir Vadai 
1764e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17658f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.mask->dst));
1766e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17678f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.key->dst));
1768e3a2b7edSAmir Vadai 			break;
1769e3a2b7edSAmir Vadai 
1770e3a2b7edSAmir Vadai 		case IPPROTO_UDP:
1771e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17728f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.mask->src));
1773e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17748f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.key->src));
1775e3a2b7edSAmir Vadai 
1776e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17778f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.mask->dst));
1778e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17798f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.key->dst));
1780e3a2b7edSAmir Vadai 			break;
1781e3a2b7edSAmir Vadai 		default:
1782e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1783e98bedf5SEli Britstein 					   "Only UDP and TCP transports are supported for L4 matching");
1784e3a2b7edSAmir Vadai 			netdev_err(priv->netdev,
1785e3a2b7edSAmir Vadai 				   "Only UDP and TCP transport are supported\n");
1786e3a2b7edSAmir Vadai 			return -EINVAL;
1787e3a2b7edSAmir Vadai 		}
1788de0af0bfSRoi Dayan 
17898f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1790d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1791e3a2b7edSAmir Vadai 	}
1792e3a2b7edSAmir Vadai 
17938f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) {
17948f256622SPablo Neira Ayuso 		struct flow_match_tcp match;
1795e77834ecSOr Gerlitz 
17968f256622SPablo Neira Ayuso 		flow_rule_match_tcp(rule, &match);
1797e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags,
17988f256622SPablo Neira Ayuso 			 ntohs(match.mask->flags));
1799e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags,
18008f256622SPablo Neira Ayuso 			 ntohs(match.key->flags));
1801e77834ecSOr Gerlitz 
18028f256622SPablo Neira Ayuso 		if (match.mask->flags)
1803d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1804e77834ecSOr Gerlitz 	}
1805e77834ecSOr Gerlitz 
1806e3a2b7edSAmir Vadai 	return 0;
1807e3a2b7edSAmir Vadai }
1808e3a2b7edSAmir Vadai 
1809de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv,
181065ba8fb7SOr Gerlitz 			    struct mlx5e_tc_flow *flow,
1811de0af0bfSRoi Dayan 			    struct mlx5_flow_spec *spec,
181254c177caSOz Shlomo 			    struct tc_cls_flower_offload *f,
181354c177caSOz Shlomo 			    struct net_device *filter_dev)
1814de0af0bfSRoi Dayan {
1815e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1816de0af0bfSRoi Dayan 	struct mlx5_core_dev *dev = priv->mdev;
1817de0af0bfSRoi Dayan 	struct mlx5_eswitch *esw = dev->priv.eswitch;
18181d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
18196363651dSOr Gerlitz 	u8 match_level, tunnel_match_level = MLX5_MATCH_NONE;
18201d447a39SSaeed Mahameed 	struct mlx5_eswitch_rep *rep;
1821de0af0bfSRoi Dayan 	int err;
1822de0af0bfSRoi Dayan 
18236363651dSOr Gerlitz 	err = __parse_cls_flower(priv, spec, f, filter_dev, &match_level, &tunnel_match_level);
1824de0af0bfSRoi Dayan 
18251d447a39SSaeed Mahameed 	if (!err && (flow->flags & MLX5E_TC_FLOW_ESWITCH)) {
18261d447a39SSaeed Mahameed 		rep = rpriv->rep;
1827b05af6aaSBodong Wang 		if (rep->vport != MLX5_VPORT_UPLINK &&
18281d447a39SSaeed Mahameed 		    (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE &&
1829d708f902SOr Gerlitz 		    esw->offloads.inline_mode < match_level)) {
1830e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1831e98bedf5SEli Britstein 					   "Flow is not offloaded due to min inline setting");
1832de0af0bfSRoi Dayan 			netdev_warn(priv->netdev,
1833de0af0bfSRoi Dayan 				    "Flow is not offloaded due to min inline setting, required %d actual %d\n",
1834d708f902SOr Gerlitz 				    match_level, esw->offloads.inline_mode);
1835de0af0bfSRoi Dayan 			return -EOPNOTSUPP;
1836de0af0bfSRoi Dayan 		}
1837de0af0bfSRoi Dayan 	}
1838de0af0bfSRoi Dayan 
18396363651dSOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
184038aa51c1SOr Gerlitz 		flow->esw_attr->match_level = match_level;
18416363651dSOr Gerlitz 		flow->esw_attr->tunnel_match_level = tunnel_match_level;
18426363651dSOr Gerlitz 	} else {
184338aa51c1SOr Gerlitz 		flow->nic_attr->match_level = match_level;
18446363651dSOr Gerlitz 	}
184538aa51c1SOr Gerlitz 
1846de0af0bfSRoi Dayan 	return err;
1847de0af0bfSRoi Dayan }
1848de0af0bfSRoi Dayan 
1849d79b6df6SOr Gerlitz struct pedit_headers {
1850d79b6df6SOr Gerlitz 	struct ethhdr  eth;
18510eb69bb9SEli Britstein 	struct vlan_hdr vlan;
1852d79b6df6SOr Gerlitz 	struct iphdr   ip4;
1853d79b6df6SOr Gerlitz 	struct ipv6hdr ip6;
1854d79b6df6SOr Gerlitz 	struct tcphdr  tcp;
1855d79b6df6SOr Gerlitz 	struct udphdr  udp;
1856d79b6df6SOr Gerlitz };
1857d79b6df6SOr Gerlitz 
1858c500c86bSPablo Neira Ayuso struct pedit_headers_action {
1859c500c86bSPablo Neira Ayuso 	struct pedit_headers	vals;
1860c500c86bSPablo Neira Ayuso 	struct pedit_headers	masks;
1861c500c86bSPablo Neira Ayuso 	u32			pedits;
1862c500c86bSPablo Neira Ayuso };
1863c500c86bSPablo Neira Ayuso 
1864d79b6df6SOr Gerlitz static int pedit_header_offsets[] = {
186573867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth),
186673867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4),
186773867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6),
186873867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp),
186973867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp),
1870d79b6df6SOr Gerlitz };
1871d79b6df6SOr Gerlitz 
1872d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype])
1873d79b6df6SOr Gerlitz 
1874d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset,
1875c500c86bSPablo Neira Ayuso 			 struct pedit_headers_action *hdrs)
1876d79b6df6SOr Gerlitz {
1877d79b6df6SOr Gerlitz 	u32 *curr_pmask, *curr_pval;
1878d79b6df6SOr Gerlitz 
1879c500c86bSPablo Neira Ayuso 	curr_pmask = (u32 *)(pedit_header(&hdrs->masks, hdr_type) + offset);
1880c500c86bSPablo Neira Ayuso 	curr_pval  = (u32 *)(pedit_header(&hdrs->vals, hdr_type) + offset);
1881d79b6df6SOr Gerlitz 
1882d79b6df6SOr Gerlitz 	if (*curr_pmask & mask)  /* disallow acting twice on the same location */
1883d79b6df6SOr Gerlitz 		goto out_err;
1884d79b6df6SOr Gerlitz 
1885d79b6df6SOr Gerlitz 	*curr_pmask |= mask;
1886d79b6df6SOr Gerlitz 	*curr_pval  |= (val & mask);
1887d79b6df6SOr Gerlitz 
1888d79b6df6SOr Gerlitz 	return 0;
1889d79b6df6SOr Gerlitz 
1890d79b6df6SOr Gerlitz out_err:
1891d79b6df6SOr Gerlitz 	return -EOPNOTSUPP;
1892d79b6df6SOr Gerlitz }
1893d79b6df6SOr Gerlitz 
1894d79b6df6SOr Gerlitz struct mlx5_fields {
1895d79b6df6SOr Gerlitz 	u8  field;
1896d79b6df6SOr Gerlitz 	u8  size;
1897d79b6df6SOr Gerlitz 	u32 offset;
1898d79b6df6SOr Gerlitz };
1899d79b6df6SOr Gerlitz 
1900a8e4f0c4SOr Gerlitz #define OFFLOAD(fw_field, size, field, off) \
1901a8e4f0c4SOr Gerlitz 		{MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, size, offsetof(struct pedit_headers, field) + (off)}
1902a8e4f0c4SOr Gerlitz 
1903d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = {
1904a8e4f0c4SOr Gerlitz 	OFFLOAD(DMAC_47_16, 4, eth.h_dest[0], 0),
1905a8e4f0c4SOr Gerlitz 	OFFLOAD(DMAC_15_0,  2, eth.h_dest[4], 0),
1906a8e4f0c4SOr Gerlitz 	OFFLOAD(SMAC_47_16, 4, eth.h_source[0], 0),
1907a8e4f0c4SOr Gerlitz 	OFFLOAD(SMAC_15_0,  2, eth.h_source[4], 0),
1908a8e4f0c4SOr Gerlitz 	OFFLOAD(ETHERTYPE,  2, eth.h_proto, 0),
19090eb69bb9SEli Britstein 	OFFLOAD(FIRST_VID,  2, vlan.h_vlan_TCI, 0),
1910d79b6df6SOr Gerlitz 
1911a8e4f0c4SOr Gerlitz 	OFFLOAD(IP_TTL, 1, ip4.ttl,   0),
1912a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV4,  4, ip4.saddr, 0),
1913a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV4,  4, ip4.daddr, 0),
1914d79b6df6SOr Gerlitz 
1915a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_127_96, 4, ip6.saddr.s6_addr32[0], 0),
1916a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_95_64,  4, ip6.saddr.s6_addr32[1], 0),
1917a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_63_32,  4, ip6.saddr.s6_addr32[2], 0),
1918a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_31_0,   4, ip6.saddr.s6_addr32[3], 0),
1919a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_127_96, 4, ip6.daddr.s6_addr32[0], 0),
1920a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_95_64,  4, ip6.daddr.s6_addr32[1], 0),
1921a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_63_32,  4, ip6.daddr.s6_addr32[2], 0),
1922a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_31_0,   4, ip6.daddr.s6_addr32[3], 0),
19230c0316f5SOr Gerlitz 	OFFLOAD(IPV6_HOPLIMIT, 1, ip6.hop_limit, 0),
1924d79b6df6SOr Gerlitz 
1925a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_SPORT, 2, tcp.source,  0),
1926a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_DPORT, 2, tcp.dest,    0),
1927a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_FLAGS, 1, tcp.ack_seq, 5),
1928d79b6df6SOr Gerlitz 
1929a8e4f0c4SOr Gerlitz 	OFFLOAD(UDP_SPORT, 2, udp.source, 0),
1930a8e4f0c4SOr Gerlitz 	OFFLOAD(UDP_DPORT, 2, udp.dest,   0),
1931d79b6df6SOr Gerlitz };
1932d79b6df6SOr Gerlitz 
1933218d05ceSTonghao Zhang /* On input attr->max_mod_hdr_actions tells how many HW actions can be parsed at
1934218d05ceSTonghao Zhang  * max from the SW pedit action. On success, attr->num_mod_hdr_actions
1935218d05ceSTonghao Zhang  * says how many HW actions were actually parsed.
1936d79b6df6SOr Gerlitz  */
1937c500c86bSPablo Neira Ayuso static int offload_pedit_fields(struct pedit_headers_action *hdrs,
1938e98bedf5SEli Britstein 				struct mlx5e_tc_flow_parse_attr *parse_attr,
1939e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
1940d79b6df6SOr Gerlitz {
1941d79b6df6SOr Gerlitz 	struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals;
19422b64bebaSOr Gerlitz 	int i, action_size, nactions, max_actions, first, last, next_z;
1943d79b6df6SOr Gerlitz 	void *s_masks_p, *a_masks_p, *vals_p;
1944d79b6df6SOr Gerlitz 	struct mlx5_fields *f;
1945d79b6df6SOr Gerlitz 	u8 cmd, field_bsize;
1946e3ca4e05SOr Gerlitz 	u32 s_mask, a_mask;
1947d79b6df6SOr Gerlitz 	unsigned long mask;
19482b64bebaSOr Gerlitz 	__be32 mask_be32;
19492b64bebaSOr Gerlitz 	__be16 mask_be16;
1950d79b6df6SOr Gerlitz 	void *action;
1951d79b6df6SOr Gerlitz 
195273867881SPablo Neira Ayuso 	set_masks = &hdrs[0].masks;
195373867881SPablo Neira Ayuso 	add_masks = &hdrs[1].masks;
195473867881SPablo Neira Ayuso 	set_vals = &hdrs[0].vals;
195573867881SPablo Neira Ayuso 	add_vals = &hdrs[1].vals;
1956d79b6df6SOr Gerlitz 
1957d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
1958218d05ceSTonghao Zhang 	action = parse_attr->mod_hdr_actions +
1959218d05ceSTonghao Zhang 		 parse_attr->num_mod_hdr_actions * action_size;
1960218d05ceSTonghao Zhang 
1961218d05ceSTonghao Zhang 	max_actions = parse_attr->max_mod_hdr_actions;
1962218d05ceSTonghao Zhang 	nactions = parse_attr->num_mod_hdr_actions;
1963d79b6df6SOr Gerlitz 
1964d79b6df6SOr Gerlitz 	for (i = 0; i < ARRAY_SIZE(fields); i++) {
1965d79b6df6SOr Gerlitz 		f = &fields[i];
1966d79b6df6SOr Gerlitz 		/* avoid seeing bits set from previous iterations */
1967e3ca4e05SOr Gerlitz 		s_mask = 0;
1968e3ca4e05SOr Gerlitz 		a_mask = 0;
1969d79b6df6SOr Gerlitz 
1970d79b6df6SOr Gerlitz 		s_masks_p = (void *)set_masks + f->offset;
1971d79b6df6SOr Gerlitz 		a_masks_p = (void *)add_masks + f->offset;
1972d79b6df6SOr Gerlitz 
1973d79b6df6SOr Gerlitz 		memcpy(&s_mask, s_masks_p, f->size);
1974d79b6df6SOr Gerlitz 		memcpy(&a_mask, a_masks_p, f->size);
1975d79b6df6SOr Gerlitz 
1976d79b6df6SOr Gerlitz 		if (!s_mask && !a_mask) /* nothing to offload here */
1977d79b6df6SOr Gerlitz 			continue;
1978d79b6df6SOr Gerlitz 
1979d79b6df6SOr Gerlitz 		if (s_mask && a_mask) {
1980e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1981e98bedf5SEli Britstein 					   "can't set and add to the same HW field");
1982d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field);
1983d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1984d79b6df6SOr Gerlitz 		}
1985d79b6df6SOr Gerlitz 
1986d79b6df6SOr Gerlitz 		if (nactions == max_actions) {
1987e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1988e98bedf5SEli Britstein 					   "too many pedit actions, can't offload");
1989d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions);
1990d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1991d79b6df6SOr Gerlitz 		}
1992d79b6df6SOr Gerlitz 
1993d79b6df6SOr Gerlitz 		if (s_mask) {
1994d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_SET;
1995d79b6df6SOr Gerlitz 			mask = s_mask;
1996d79b6df6SOr Gerlitz 			vals_p = (void *)set_vals + f->offset;
1997d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
1998d79b6df6SOr Gerlitz 			memset(s_masks_p, 0, f->size);
1999d79b6df6SOr Gerlitz 		} else {
2000d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_ADD;
2001d79b6df6SOr Gerlitz 			mask = a_mask;
2002d79b6df6SOr Gerlitz 			vals_p = (void *)add_vals + f->offset;
2003d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
2004d79b6df6SOr Gerlitz 			memset(a_masks_p, 0, f->size);
2005d79b6df6SOr Gerlitz 		}
2006d79b6df6SOr Gerlitz 
2007d79b6df6SOr Gerlitz 		field_bsize = f->size * BITS_PER_BYTE;
2008e3ca4e05SOr Gerlitz 
20092b64bebaSOr Gerlitz 		if (field_bsize == 32) {
20102b64bebaSOr Gerlitz 			mask_be32 = *(__be32 *)&mask;
20112b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32));
20122b64bebaSOr Gerlitz 		} else if (field_bsize == 16) {
20132b64bebaSOr Gerlitz 			mask_be16 = *(__be16 *)&mask;
20142b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16));
20152b64bebaSOr Gerlitz 		}
20162b64bebaSOr Gerlitz 
2017d79b6df6SOr Gerlitz 		first = find_first_bit(&mask, field_bsize);
20182b64bebaSOr Gerlitz 		next_z = find_next_zero_bit(&mask, field_bsize, first);
2019d79b6df6SOr Gerlitz 		last  = find_last_bit(&mask, field_bsize);
20202b64bebaSOr Gerlitz 		if (first < next_z && next_z < last) {
2021e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2022e98bedf5SEli Britstein 					   "rewrite of few sub-fields isn't supported");
20232b64bebaSOr Gerlitz 			printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n",
2024d79b6df6SOr Gerlitz 			       mask);
2025d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
2026d79b6df6SOr Gerlitz 		}
2027d79b6df6SOr Gerlitz 
2028d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, action_type, cmd);
2029d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, field, f->field);
2030d79b6df6SOr Gerlitz 
2031d79b6df6SOr Gerlitz 		if (cmd == MLX5_ACTION_TYPE_SET) {
20322b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, offset, first);
2033d79b6df6SOr Gerlitz 			/* length is num of bits to be written, zero means length of 32 */
20342b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, length, (last - first + 1));
2035d79b6df6SOr Gerlitz 		}
2036d79b6df6SOr Gerlitz 
2037d79b6df6SOr Gerlitz 		if (field_bsize == 32)
20382b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first);
2039d79b6df6SOr Gerlitz 		else if (field_bsize == 16)
20402b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first);
2041d79b6df6SOr Gerlitz 		else if (field_bsize == 8)
20422b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first);
2043d79b6df6SOr Gerlitz 
2044d79b6df6SOr Gerlitz 		action += action_size;
2045d79b6df6SOr Gerlitz 		nactions++;
2046d79b6df6SOr Gerlitz 	}
2047d79b6df6SOr Gerlitz 
2048d79b6df6SOr Gerlitz 	parse_attr->num_mod_hdr_actions = nactions;
2049d79b6df6SOr Gerlitz 	return 0;
2050d79b6df6SOr Gerlitz }
2051d79b6df6SOr Gerlitz 
20522cc1cb1dSTonghao Zhang static int mlx5e_flow_namespace_max_modify_action(struct mlx5_core_dev *mdev,
20532cc1cb1dSTonghao Zhang 						  int namespace)
20542cc1cb1dSTonghao Zhang {
20552cc1cb1dSTonghao Zhang 	if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */
20562cc1cb1dSTonghao Zhang 		return MLX5_CAP_ESW_FLOWTABLE_FDB(mdev, max_modify_header_actions);
20572cc1cb1dSTonghao Zhang 	else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */
20582cc1cb1dSTonghao Zhang 		return MLX5_CAP_FLOWTABLE_NIC_RX(mdev, max_modify_header_actions);
20592cc1cb1dSTonghao Zhang }
20602cc1cb1dSTonghao Zhang 
2061d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv,
2062c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2063c500c86bSPablo Neira Ayuso 				 int namespace,
2064d79b6df6SOr Gerlitz 				 struct mlx5e_tc_flow_parse_attr *parse_attr)
2065d79b6df6SOr Gerlitz {
2066d79b6df6SOr Gerlitz 	int nkeys, action_size, max_actions;
2067d79b6df6SOr Gerlitz 
2068c500c86bSPablo Neira Ayuso 	nkeys = hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits +
2069c500c86bSPablo Neira Ayuso 		hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits;
2070d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
2071d79b6df6SOr Gerlitz 
20722cc1cb1dSTonghao Zhang 	max_actions = mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace);
2073d79b6df6SOr Gerlitz 	/* can get up to crazingly 16 HW actions in 32 bits pedit SW key */
2074d79b6df6SOr Gerlitz 	max_actions = min(max_actions, nkeys * 16);
2075d79b6df6SOr Gerlitz 
2076d79b6df6SOr Gerlitz 	parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL);
2077d79b6df6SOr Gerlitz 	if (!parse_attr->mod_hdr_actions)
2078d79b6df6SOr Gerlitz 		return -ENOMEM;
2079d79b6df6SOr Gerlitz 
2080218d05ceSTonghao Zhang 	parse_attr->max_mod_hdr_actions = max_actions;
2081d79b6df6SOr Gerlitz 	return 0;
2082d79b6df6SOr Gerlitz }
2083d79b6df6SOr Gerlitz 
2084d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {};
2085d79b6df6SOr Gerlitz 
2086d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv,
208773867881SPablo Neira Ayuso 				 const struct flow_action_entry *act, int namespace,
2088e98bedf5SEli Britstein 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2089c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2090e98bedf5SEli Britstein 				 struct netlink_ext_ack *extack)
2091d79b6df6SOr Gerlitz {
209273867881SPablo Neira Ayuso 	u8 cmd = (act->id == FLOW_ACTION_MANGLE) ? 0 : 1;
209373867881SPablo Neira Ayuso 	int err = -EOPNOTSUPP;
2094d79b6df6SOr Gerlitz 	u32 mask, val, offset;
209573867881SPablo Neira Ayuso 	u8 htype;
2096d79b6df6SOr Gerlitz 
209773867881SPablo Neira Ayuso 	htype = act->mangle.htype;
2098d79b6df6SOr Gerlitz 	err = -EOPNOTSUPP; /* can't be all optimistic */
2099d79b6df6SOr Gerlitz 
210073867881SPablo Neira Ayuso 	if (htype == FLOW_ACT_MANGLE_UNSPEC) {
210173867881SPablo Neira Ayuso 		NL_SET_ERR_MSG_MOD(extack, "legacy pedit isn't offloaded");
2102d79b6df6SOr Gerlitz 		goto out_err;
2103d79b6df6SOr Gerlitz 	}
2104d79b6df6SOr Gerlitz 
21052cc1cb1dSTonghao Zhang 	if (!mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace)) {
21062cc1cb1dSTonghao Zhang 		NL_SET_ERR_MSG_MOD(extack,
21072cc1cb1dSTonghao Zhang 				   "The pedit offload action is not supported");
21082cc1cb1dSTonghao Zhang 		goto out_err;
21092cc1cb1dSTonghao Zhang 	}
21102cc1cb1dSTonghao Zhang 
211173867881SPablo Neira Ayuso 	mask = act->mangle.mask;
211273867881SPablo Neira Ayuso 	val = act->mangle.val;
211373867881SPablo Neira Ayuso 	offset = act->mangle.offset;
2114d79b6df6SOr Gerlitz 
2115c500c86bSPablo Neira Ayuso 	err = set_pedit_val(htype, ~mask, val, offset, &hdrs[cmd]);
2116d79b6df6SOr Gerlitz 	if (err)
2117d79b6df6SOr Gerlitz 		goto out_err;
2118c500c86bSPablo Neira Ayuso 
2119c500c86bSPablo Neira Ayuso 	hdrs[cmd].pedits++;
2120d79b6df6SOr Gerlitz 
2121c500c86bSPablo Neira Ayuso 	return 0;
2122c500c86bSPablo Neira Ayuso out_err:
2123c500c86bSPablo Neira Ayuso 	return err;
2124c500c86bSPablo Neira Ayuso }
2125c500c86bSPablo Neira Ayuso 
2126c500c86bSPablo Neira Ayuso static int alloc_tc_pedit_action(struct mlx5e_priv *priv, int namespace,
2127c500c86bSPablo Neira Ayuso 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2128c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2129c500c86bSPablo Neira Ayuso 				 struct netlink_ext_ack *extack)
2130c500c86bSPablo Neira Ayuso {
2131c500c86bSPablo Neira Ayuso 	struct pedit_headers *cmd_masks;
2132c500c86bSPablo Neira Ayuso 	int err;
2133c500c86bSPablo Neira Ayuso 	u8 cmd;
2134c500c86bSPablo Neira Ayuso 
2135218d05ceSTonghao Zhang 	if (!parse_attr->mod_hdr_actions) {
2136c500c86bSPablo Neira Ayuso 		err = alloc_mod_hdr_actions(priv, hdrs, namespace, parse_attr);
2137d79b6df6SOr Gerlitz 		if (err)
2138d79b6df6SOr Gerlitz 			goto out_err;
2139218d05ceSTonghao Zhang 	}
2140d79b6df6SOr Gerlitz 
2141c500c86bSPablo Neira Ayuso 	err = offload_pedit_fields(hdrs, parse_attr, extack);
2142d79b6df6SOr Gerlitz 	if (err < 0)
2143d79b6df6SOr Gerlitz 		goto out_dealloc_parsed_actions;
2144d79b6df6SOr Gerlitz 
2145d79b6df6SOr Gerlitz 	for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) {
2146c500c86bSPablo Neira Ayuso 		cmd_masks = &hdrs[cmd].masks;
2147d79b6df6SOr Gerlitz 		if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) {
2148e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2149e98bedf5SEli Britstein 					   "attempt to offload an unsupported field");
2150b3a433deSOr Gerlitz 			netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd);
2151d79b6df6SOr Gerlitz 			print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS,
2152d79b6df6SOr Gerlitz 				       16, 1, cmd_masks, sizeof(zero_masks), true);
2153d79b6df6SOr Gerlitz 			err = -EOPNOTSUPP;
2154d79b6df6SOr Gerlitz 			goto out_dealloc_parsed_actions;
2155d79b6df6SOr Gerlitz 		}
2156d79b6df6SOr Gerlitz 	}
2157d79b6df6SOr Gerlitz 
2158d79b6df6SOr Gerlitz 	return 0;
2159d79b6df6SOr Gerlitz 
2160d79b6df6SOr Gerlitz out_dealloc_parsed_actions:
2161d79b6df6SOr Gerlitz 	kfree(parse_attr->mod_hdr_actions);
2162d79b6df6SOr Gerlitz out_err:
2163d79b6df6SOr Gerlitz 	return err;
2164d79b6df6SOr Gerlitz }
2165d79b6df6SOr Gerlitz 
2166e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv,
2167e98bedf5SEli Britstein 				   u32 action,
2168e98bedf5SEli Britstein 				   u32 update_flags,
2169e98bedf5SEli Britstein 				   struct netlink_ext_ack *extack)
217026c02749SOr Gerlitz {
217126c02749SOr Gerlitz 	u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP |
217226c02749SOr Gerlitz 			 TCA_CSUM_UPDATE_FLAG_UDP;
217326c02749SOr Gerlitz 
217426c02749SOr Gerlitz 	/*  The HW recalcs checksums only if re-writing headers */
217526c02749SOr Gerlitz 	if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) {
2176e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2177e98bedf5SEli Britstein 				   "TC csum action is only offloaded with pedit");
217826c02749SOr Gerlitz 		netdev_warn(priv->netdev,
217926c02749SOr Gerlitz 			    "TC csum action is only offloaded with pedit\n");
218026c02749SOr Gerlitz 		return false;
218126c02749SOr Gerlitz 	}
218226c02749SOr Gerlitz 
218326c02749SOr Gerlitz 	if (update_flags & ~prot_flags) {
2184e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2185e98bedf5SEli Britstein 				   "can't offload TC csum action for some header/s");
218626c02749SOr Gerlitz 		netdev_warn(priv->netdev,
218726c02749SOr Gerlitz 			    "can't offload TC csum action for some header/s - flags %#x\n",
218826c02749SOr Gerlitz 			    update_flags);
218926c02749SOr Gerlitz 		return false;
219026c02749SOr Gerlitz 	}
219126c02749SOr Gerlitz 
219226c02749SOr Gerlitz 	return true;
219326c02749SOr Gerlitz }
219426c02749SOr Gerlitz 
2195bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec,
219673867881SPablo Neira Ayuso 					  struct flow_action *flow_action,
21971651925dSGuy Shattah 					  u32 actions,
2198e98bedf5SEli Britstein 					  struct netlink_ext_ack *extack)
2199bdd66ac0SOr Gerlitz {
220073867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
2201bdd66ac0SOr Gerlitz 	bool modify_ip_header;
2202bdd66ac0SOr Gerlitz 	u8 htype, ip_proto;
2203bdd66ac0SOr Gerlitz 	void *headers_v;
2204bdd66ac0SOr Gerlitz 	u16 ethertype;
220573867881SPablo Neira Ayuso 	int i;
2206bdd66ac0SOr Gerlitz 
22078377629eSEli Britstein 	headers_v = get_match_headers_value(actions, spec);
2208bdd66ac0SOr Gerlitz 	ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype);
2209bdd66ac0SOr Gerlitz 
2210bdd66ac0SOr Gerlitz 	/* for non-IP we only re-write MACs, so we're okay */
2211bdd66ac0SOr Gerlitz 	if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6)
2212bdd66ac0SOr Gerlitz 		goto out_ok;
2213bdd66ac0SOr Gerlitz 
2214bdd66ac0SOr Gerlitz 	modify_ip_header = false;
221573867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
221673867881SPablo Neira Ayuso 		if (act->id != FLOW_ACTION_MANGLE &&
221773867881SPablo Neira Ayuso 		    act->id != FLOW_ACTION_ADD)
2218bdd66ac0SOr Gerlitz 			continue;
2219bdd66ac0SOr Gerlitz 
222073867881SPablo Neira Ayuso 		htype = act->mangle.htype;
222173867881SPablo Neira Ayuso 		if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP4 ||
222273867881SPablo Neira Ayuso 		    htype == FLOW_ACT_MANGLE_HDR_TYPE_IP6) {
2223bdd66ac0SOr Gerlitz 			modify_ip_header = true;
2224bdd66ac0SOr Gerlitz 			break;
2225bdd66ac0SOr Gerlitz 		}
2226bdd66ac0SOr Gerlitz 	}
2227bdd66ac0SOr Gerlitz 
2228bdd66ac0SOr Gerlitz 	ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol);
22291ccef350SJianbo Liu 	if (modify_ip_header && ip_proto != IPPROTO_TCP &&
22301ccef350SJianbo Liu 	    ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) {
2231e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2232e98bedf5SEli Britstein 				   "can't offload re-write of non TCP/UDP");
2233bdd66ac0SOr Gerlitz 		pr_info("can't offload re-write of ip proto %d\n", ip_proto);
2234bdd66ac0SOr Gerlitz 		return false;
2235bdd66ac0SOr Gerlitz 	}
2236bdd66ac0SOr Gerlitz 
2237bdd66ac0SOr Gerlitz out_ok:
2238bdd66ac0SOr Gerlitz 	return true;
2239bdd66ac0SOr Gerlitz }
2240bdd66ac0SOr Gerlitz 
2241bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv,
224273867881SPablo Neira Ayuso 				    struct flow_action *flow_action,
2243bdd66ac0SOr Gerlitz 				    struct mlx5e_tc_flow_parse_attr *parse_attr,
2244e98bedf5SEli Britstein 				    struct mlx5e_tc_flow *flow,
2245e98bedf5SEli Britstein 				    struct netlink_ext_ack *extack)
2246bdd66ac0SOr Gerlitz {
2247bdd66ac0SOr Gerlitz 	u32 actions;
2248bdd66ac0SOr Gerlitz 
2249bdd66ac0SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
2250bdd66ac0SOr Gerlitz 		actions = flow->esw_attr->action;
2251bdd66ac0SOr Gerlitz 	else
2252bdd66ac0SOr Gerlitz 		actions = flow->nic_attr->action;
2253bdd66ac0SOr Gerlitz 
22547e29392eSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_EGRESS &&
22557e29392eSRoi Dayan 	    !(actions & MLX5_FLOW_CONTEXT_ACTION_DECAP))
22567e29392eSRoi Dayan 		return false;
22577e29392eSRoi Dayan 
2258bdd66ac0SOr Gerlitz 	if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
225973867881SPablo Neira Ayuso 		return modify_header_match_supported(&parse_attr->spec,
2260a655fe9fSDavid S. Miller 						     flow_action, actions,
2261e98bedf5SEli Britstein 						     extack);
2262bdd66ac0SOr Gerlitz 
2263bdd66ac0SOr Gerlitz 	return true;
2264bdd66ac0SOr Gerlitz }
2265bdd66ac0SOr Gerlitz 
22665c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv)
22675c65c564SOr Gerlitz {
22685c65c564SOr Gerlitz 	struct mlx5_core_dev *fmdev, *pmdev;
2269816f6706SOr Gerlitz 	u64 fsystem_guid, psystem_guid;
22705c65c564SOr Gerlitz 
22715c65c564SOr Gerlitz 	fmdev = priv->mdev;
22725c65c564SOr Gerlitz 	pmdev = peer_priv->mdev;
22735c65c564SOr Gerlitz 
227459c9d35eSAlaa Hleihel 	fsystem_guid = mlx5_query_nic_system_image_guid(fmdev);
227559c9d35eSAlaa Hleihel 	psystem_guid = mlx5_query_nic_system_image_guid(pmdev);
22765c65c564SOr Gerlitz 
2277816f6706SOr Gerlitz 	return (fsystem_guid == psystem_guid);
22785c65c564SOr Gerlitz }
22795c65c564SOr Gerlitz 
2280bdc837eeSEli Britstein static int add_vlan_rewrite_action(struct mlx5e_priv *priv, int namespace,
2281bdc837eeSEli Britstein 				   const struct flow_action_entry *act,
2282bdc837eeSEli Britstein 				   struct mlx5e_tc_flow_parse_attr *parse_attr,
2283bdc837eeSEli Britstein 				   struct pedit_headers_action *hdrs,
2284bdc837eeSEli Britstein 				   u32 *action, struct netlink_ext_ack *extack)
2285bdc837eeSEli Britstein {
2286bdc837eeSEli Britstein 	u16 mask16 = VLAN_VID_MASK;
2287bdc837eeSEli Britstein 	u16 val16 = act->vlan.vid & VLAN_VID_MASK;
2288bdc837eeSEli Britstein 	const struct flow_action_entry pedit_act = {
2289bdc837eeSEli Britstein 		.id = FLOW_ACTION_MANGLE,
2290bdc837eeSEli Britstein 		.mangle.htype = FLOW_ACT_MANGLE_HDR_TYPE_ETH,
2291bdc837eeSEli Britstein 		.mangle.offset = offsetof(struct vlan_ethhdr, h_vlan_TCI),
2292bdc837eeSEli Britstein 		.mangle.mask = ~(u32)be16_to_cpu(*(__be16 *)&mask16),
2293bdc837eeSEli Britstein 		.mangle.val = (u32)be16_to_cpu(*(__be16 *)&val16),
2294bdc837eeSEli Britstein 	};
2295bf2f3bcaSEli Britstein 	void *headers_c, *headers_v;
2296bdc837eeSEli Britstein 	int err;
2297bdc837eeSEli Britstein 
2298bf2f3bcaSEli Britstein 	headers_c = get_match_headers_criteria(*action, &parse_attr->spec);
2299bf2f3bcaSEli Britstein 	headers_v = get_match_headers_value(*action, &parse_attr->spec);
2300bf2f3bcaSEli Britstein 
2301bf2f3bcaSEli Britstein 	if (!(MLX5_GET(fte_match_set_lyr_2_4, headers_c, cvlan_tag) &&
2302bf2f3bcaSEli Britstein 	      MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag))) {
2303bf2f3bcaSEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2304bf2f3bcaSEli Britstein 				   "VLAN rewrite action must have VLAN protocol match");
2305bf2f3bcaSEli Britstein 		return -EOPNOTSUPP;
2306bf2f3bcaSEli Britstein 	}
2307bf2f3bcaSEli Britstein 
2308bdc837eeSEli Britstein 	if (act->vlan.prio) {
2309bdc837eeSEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "Setting VLAN prio is not supported");
2310bdc837eeSEli Britstein 		return -EOPNOTSUPP;
2311bdc837eeSEli Britstein 	}
2312bdc837eeSEli Britstein 
2313bdc837eeSEli Britstein 	err = parse_tc_pedit_action(priv, &pedit_act, namespace, parse_attr,
2314bdc837eeSEli Britstein 				    hdrs, NULL);
2315bdc837eeSEli Britstein 	*action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
2316bdc837eeSEli Britstein 
2317bdc837eeSEli Britstein 	return err;
2318bdc837eeSEli Britstein }
2319bdc837eeSEli Britstein 
232073867881SPablo Neira Ayuso static int parse_tc_nic_actions(struct mlx5e_priv *priv,
232173867881SPablo Neira Ayuso 				struct flow_action *flow_action,
2322aa0cbbaeSOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr,
2323e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2324e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2325e3a2b7edSAmir Vadai {
2326aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
232773867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
232873867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
23291cab1cd7SOr Gerlitz 	u32 action = 0;
2330244cd96aSCong Wang 	int err, i;
2331e3a2b7edSAmir Vadai 
233273867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
2333e3a2b7edSAmir Vadai 		return -EINVAL;
2334e3a2b7edSAmir Vadai 
23353bc4b7bfSOr Gerlitz 	attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG;
2336e3a2b7edSAmir Vadai 
233773867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
233873867881SPablo Neira Ayuso 		switch (act->id) {
233973867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
23401cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP;
2341aad7e08dSAmir Vadai 			if (MLX5_CAP_FLOWTABLE(priv->mdev,
2342aad7e08dSAmir Vadai 					       flow_table_properties_nic_receive.flow_counter))
23431cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
234473867881SPablo Neira Ayuso 			break;
234573867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
234673867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
234773867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_KERNEL,
2348c500c86bSPablo Neira Ayuso 						    parse_attr, hdrs, extack);
23492f4fe4caSOr Gerlitz 			if (err)
23502f4fe4caSOr Gerlitz 				return err;
23512f4fe4caSOr Gerlitz 
23521cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR |
23532f4fe4caSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
235473867881SPablo Neira Ayuso 			break;
2355bdc837eeSEli Britstein 		case FLOW_ACTION_VLAN_MANGLE:
2356bdc837eeSEli Britstein 			err = add_vlan_rewrite_action(priv,
2357bdc837eeSEli Britstein 						      MLX5_FLOW_NAMESPACE_KERNEL,
2358bdc837eeSEli Britstein 						      act, parse_attr, hdrs,
2359bdc837eeSEli Britstein 						      &action, extack);
2360bdc837eeSEli Britstein 			if (err)
2361bdc837eeSEli Britstein 				return err;
2362bdc837eeSEli Britstein 
2363bdc837eeSEli Britstein 			break;
236473867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
23651cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
236673867881SPablo Neira Ayuso 						   act->csum_flags,
2367e98bedf5SEli Britstein 						   extack))
236873867881SPablo Neira Ayuso 				break;
236926c02749SOr Gerlitz 
237026c02749SOr Gerlitz 			return -EOPNOTSUPP;
237173867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT: {
237273867881SPablo Neira Ayuso 			struct net_device *peer_dev = act->dev;
23735c65c564SOr Gerlitz 
23745c65c564SOr Gerlitz 			if (priv->netdev->netdev_ops == peer_dev->netdev_ops &&
23755c65c564SOr Gerlitz 			    same_hw_devs(priv, netdev_priv(peer_dev))) {
237698b66cb1SEli Britstein 				parse_attr->mirred_ifindex[0] = peer_dev->ifindex;
23775c65c564SOr Gerlitz 				flow->flags |= MLX5E_TC_FLOW_HAIRPIN;
23781cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
23795c65c564SOr Gerlitz 					  MLX5_FLOW_CONTEXT_ACTION_COUNT;
23805c65c564SOr Gerlitz 			} else {
2381e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2382e98bedf5SEli Britstein 						   "device is not on same HW, can't offload");
23835c65c564SOr Gerlitz 				netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n",
23845c65c564SOr Gerlitz 					    peer_dev->name);
23855c65c564SOr Gerlitz 				return -EINVAL;
23865c65c564SOr Gerlitz 			}
23875c65c564SOr Gerlitz 			}
238873867881SPablo Neira Ayuso 			break;
238973867881SPablo Neira Ayuso 		case FLOW_ACTION_MARK: {
239073867881SPablo Neira Ayuso 			u32 mark = act->mark;
2391e3a2b7edSAmir Vadai 
2392e3a2b7edSAmir Vadai 			if (mark & ~MLX5E_TC_FLOW_ID_MASK) {
2393e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2394e98bedf5SEli Britstein 						   "Bad flow mark - only 16 bit is supported");
2395e3a2b7edSAmir Vadai 				return -EINVAL;
2396e3a2b7edSAmir Vadai 			}
2397e3a2b7edSAmir Vadai 
23983bc4b7bfSOr Gerlitz 			attr->flow_tag = mark;
23991cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
2400e3a2b7edSAmir Vadai 			}
240173867881SPablo Neira Ayuso 			break;
240273867881SPablo Neira Ayuso 		default:
24032cc1cb1dSTonghao Zhang 			NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported");
24042cc1cb1dSTonghao Zhang 			return -EOPNOTSUPP;
2405e3a2b7edSAmir Vadai 		}
240673867881SPablo Neira Ayuso 	}
2407e3a2b7edSAmir Vadai 
2408c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
2409c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
2410c500c86bSPablo Neira Ayuso 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL,
2411c500c86bSPablo Neira Ayuso 					    parse_attr, hdrs, extack);
2412c500c86bSPablo Neira Ayuso 		if (err)
2413c500c86bSPablo Neira Ayuso 			return err;
2414c500c86bSPablo Neira Ayuso 	}
2415c500c86bSPablo Neira Ayuso 
24161cab1cd7SOr Gerlitz 	attr->action = action;
241773867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
2418bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
2419bdd66ac0SOr Gerlitz 
2420e3a2b7edSAmir Vadai 	return 0;
2421e3a2b7edSAmir Vadai }
2422e3a2b7edSAmir Vadai 
242376f7444dSOr Gerlitz static inline int cmp_encap_info(struct ip_tunnel_key *a,
242476f7444dSOr Gerlitz 				 struct ip_tunnel_key *b)
2425a54e20b4SHadar Hen Zion {
2426a54e20b4SHadar Hen Zion 	return memcmp(a, b, sizeof(*a));
2427a54e20b4SHadar Hen Zion }
2428a54e20b4SHadar Hen Zion 
242976f7444dSOr Gerlitz static inline int hash_encap_info(struct ip_tunnel_key *key)
2430a54e20b4SHadar Hen Zion {
243176f7444dSOr Gerlitz 	return jhash(key, sizeof(*key), 0);
2432a54e20b4SHadar Hen Zion }
2433a54e20b4SHadar Hen Zion 
2434a54e20b4SHadar Hen Zion 
2435b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv,
2436b1d90e6bSRabie Loulou 				  struct net_device *peer_netdev)
2437b1d90e6bSRabie Loulou {
2438b1d90e6bSRabie Loulou 	struct mlx5e_priv *peer_priv;
2439b1d90e6bSRabie Loulou 
2440b1d90e6bSRabie Loulou 	peer_priv = netdev_priv(peer_netdev);
2441b1d90e6bSRabie Loulou 
2442b1d90e6bSRabie Loulou 	return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) &&
244368931c7dSRoi Dayan 		mlx5e_eswitch_rep(priv->netdev) &&
244468931c7dSRoi Dayan 		mlx5e_eswitch_rep(peer_netdev) &&
244568931c7dSRoi Dayan 		same_hw_devs(priv, peer_priv));
2446b1d90e6bSRabie Loulou }
2447b1d90e6bSRabie Loulou 
2448ce99f6b9SOr Gerlitz 
244954c177caSOz Shlomo 
2450a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv,
2451e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
2452733d4f36SRoi Dayan 			      struct net_device *mirred_dev,
2453733d4f36SRoi Dayan 			      int out_index,
24548c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
24550ad060eeSRoi Dayan 			      struct net_device **encap_dev,
24560ad060eeSRoi Dayan 			      bool *encap_valid)
245703a9d11eSOr Gerlitz {
2458a54e20b4SHadar Hen Zion 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
245945247bf2SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
2460733d4f36SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2461733d4f36SRoi Dayan 	struct ip_tunnel_info *tun_info;
2462733d4f36SRoi Dayan 	struct ip_tunnel_key *key;
2463c1ae1152SOr Gerlitz 	struct mlx5e_encap_entry *e;
2464733d4f36SRoi Dayan 	unsigned short family;
2465a54e20b4SHadar Hen Zion 	uintptr_t hash_key;
2466a54e20b4SHadar Hen Zion 	bool found = false;
246754c177caSOz Shlomo 	int err = 0;
2468a54e20b4SHadar Hen Zion 
2469733d4f36SRoi Dayan 	parse_attr = attr->parse_attr;
2470733d4f36SRoi Dayan 	tun_info = &parse_attr->tun_info[out_index];
2471733d4f36SRoi Dayan 	family = ip_tunnel_info_af(tun_info);
2472733d4f36SRoi Dayan 	key = &tun_info->key;
2473733d4f36SRoi Dayan 
247476f7444dSOr Gerlitz 	hash_key = hash_encap_info(key);
2475a54e20b4SHadar Hen Zion 
2476a54e20b4SHadar Hen Zion 	hash_for_each_possible_rcu(esw->offloads.encap_tbl, e,
2477a54e20b4SHadar Hen Zion 				   encap_hlist, hash_key) {
247876f7444dSOr Gerlitz 		if (!cmp_encap_info(&e->tun_info.key, key)) {
2479a54e20b4SHadar Hen Zion 			found = true;
2480a54e20b4SHadar Hen Zion 			break;
2481a54e20b4SHadar Hen Zion 		}
2482a54e20b4SHadar Hen Zion 	}
2483a54e20b4SHadar Hen Zion 
2484b2812089SVlad Buslov 	/* must verify if encap is valid or not */
248545247bf2SOr Gerlitz 	if (found)
248645247bf2SOr Gerlitz 		goto attach_flow;
2487a54e20b4SHadar Hen Zion 
2488a54e20b4SHadar Hen Zion 	e = kzalloc(sizeof(*e), GFP_KERNEL);
2489a54e20b4SHadar Hen Zion 	if (!e)
2490a54e20b4SHadar Hen Zion 		return -ENOMEM;
2491a54e20b4SHadar Hen Zion 
249276f7444dSOr Gerlitz 	e->tun_info = *tun_info;
2493101f4de9SOz Shlomo 	err = mlx5e_tc_tun_init_encap_attr(mirred_dev, priv, e, extack);
249454c177caSOz Shlomo 	if (err)
249554c177caSOz Shlomo 		goto out_err;
249654c177caSOz Shlomo 
2497a54e20b4SHadar Hen Zion 	INIT_LIST_HEAD(&e->flows);
2498a54e20b4SHadar Hen Zion 
2499ce99f6b9SOr Gerlitz 	if (family == AF_INET)
2500101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv4(priv, mirred_dev, e);
2501ce99f6b9SOr Gerlitz 	else if (family == AF_INET6)
2502101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv6(priv, mirred_dev, e);
2503ce99f6b9SOr Gerlitz 
25040ad060eeSRoi Dayan 	if (err)
2505a54e20b4SHadar Hen Zion 		goto out_err;
2506a54e20b4SHadar Hen Zion 
2507a54e20b4SHadar Hen Zion 	hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key);
2508a54e20b4SHadar Hen Zion 
250945247bf2SOr Gerlitz attach_flow:
25108c4dc42bSEli Britstein 	list_add(&flow->encaps[out_index].list, &e->flows);
25118c4dc42bSEli Britstein 	flow->encaps[out_index].index = out_index;
251245247bf2SOr Gerlitz 	*encap_dev = e->out_dev;
25138c4dc42bSEli Britstein 	if (e->flags & MLX5_ENCAP_ENTRY_VALID) {
25148c4dc42bSEli Britstein 		attr->dests[out_index].encap_id = e->encap_id;
25158c4dc42bSEli Britstein 		attr->dests[out_index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
25160ad060eeSRoi Dayan 		*encap_valid = true;
25178c4dc42bSEli Britstein 	} else {
25180ad060eeSRoi Dayan 		*encap_valid = false;
25198c4dc42bSEli Britstein 	}
252045247bf2SOr Gerlitz 
2521232c0013SHadar Hen Zion 	return err;
2522a54e20b4SHadar Hen Zion 
2523a54e20b4SHadar Hen Zion out_err:
2524a54e20b4SHadar Hen Zion 	kfree(e);
2525a54e20b4SHadar Hen Zion 	return err;
2526a54e20b4SHadar Hen Zion }
2527a54e20b4SHadar Hen Zion 
25281482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv,
252973867881SPablo Neira Ayuso 				const struct flow_action_entry *act,
25301482bd3dSJianbo Liu 				struct mlx5_esw_flow_attr *attr,
25311482bd3dSJianbo Liu 				u32 *action)
25321482bd3dSJianbo Liu {
2533cc495188SJianbo Liu 	u8 vlan_idx = attr->total_vlan;
2534cc495188SJianbo Liu 
2535cc495188SJianbo Liu 	if (vlan_idx >= MLX5_FS_VLAN_DEPTH)
25361482bd3dSJianbo Liu 		return -EOPNOTSUPP;
2537cc495188SJianbo Liu 
253873867881SPablo Neira Ayuso 	switch (act->id) {
253973867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_POP:
2540cc495188SJianbo Liu 		if (vlan_idx) {
2541cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2542cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2543cc495188SJianbo Liu 				return -EOPNOTSUPP;
2544cc495188SJianbo Liu 
2545cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2;
2546cc495188SJianbo Liu 		} else {
2547cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
2548cc495188SJianbo Liu 		}
254973867881SPablo Neira Ayuso 		break;
255073867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_PUSH:
255173867881SPablo Neira Ayuso 		attr->vlan_vid[vlan_idx] = act->vlan.vid;
255273867881SPablo Neira Ayuso 		attr->vlan_prio[vlan_idx] = act->vlan.prio;
255373867881SPablo Neira Ayuso 		attr->vlan_proto[vlan_idx] = act->vlan.proto;
2554cc495188SJianbo Liu 		if (!attr->vlan_proto[vlan_idx])
2555cc495188SJianbo Liu 			attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q);
2556cc495188SJianbo Liu 
2557cc495188SJianbo Liu 		if (vlan_idx) {
2558cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2559cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2560cc495188SJianbo Liu 				return -EOPNOTSUPP;
2561cc495188SJianbo Liu 
2562cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2;
2563cc495188SJianbo Liu 		} else {
2564cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) &&
256573867881SPablo Neira Ayuso 			    (act->vlan.proto != htons(ETH_P_8021Q) ||
256673867881SPablo Neira Ayuso 			     act->vlan.prio))
2567cc495188SJianbo Liu 				return -EOPNOTSUPP;
2568cc495188SJianbo Liu 
2569cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH;
25701482bd3dSJianbo Liu 		}
257173867881SPablo Neira Ayuso 		break;
257273867881SPablo Neira Ayuso 	default:
2573bdc837eeSEli Britstein 		return -EINVAL;
25741482bd3dSJianbo Liu 	}
25751482bd3dSJianbo Liu 
2576cc495188SJianbo Liu 	attr->total_vlan = vlan_idx + 1;
2577cc495188SJianbo Liu 
25781482bd3dSJianbo Liu 	return 0;
25791482bd3dSJianbo Liu }
25801482bd3dSJianbo Liu 
258173867881SPablo Neira Ayuso static int parse_tc_fdb_actions(struct mlx5e_priv *priv,
258273867881SPablo Neira Ayuso 				struct flow_action *flow_action,
2583e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2584e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2585a54e20b4SHadar Hen Zion {
258673867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
2587bf07aa73SPaul Blakey 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2588ecf5bb79SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
25896f9af8ffSTonghao Zhang 	struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr;
25901d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
259173867881SPablo Neira Ayuso 	const struct ip_tunnel_info *info = NULL;
259273867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
2593a54e20b4SHadar Hen Zion 	bool encap = false;
25941cab1cd7SOr Gerlitz 	u32 action = 0;
2595244cd96aSCong Wang 	int err, i;
259603a9d11eSOr Gerlitz 
259773867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
259803a9d11eSOr Gerlitz 		return -EINVAL;
259903a9d11eSOr Gerlitz 
26001d447a39SSaeed Mahameed 	attr->in_rep = rpriv->rep;
260110ff5359SShahar Klein 	attr->in_mdev = priv->mdev;
260203a9d11eSOr Gerlitz 
260373867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
260473867881SPablo Neira Ayuso 		switch (act->id) {
260573867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
26061cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP |
260703a9d11eSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
260873867881SPablo Neira Ayuso 			break;
260973867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
261073867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
261173867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_FDB,
2612c500c86bSPablo Neira Ayuso 						    parse_attr, hdrs, extack);
2613d7e75a32SOr Gerlitz 			if (err)
2614d7e75a32SOr Gerlitz 				return err;
2615d7e75a32SOr Gerlitz 
26161cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
2617e85e02baSEli Britstein 			attr->split_count = attr->out_count;
261873867881SPablo Neira Ayuso 			break;
261973867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
26201cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
262173867881SPablo Neira Ayuso 						   act->csum_flags, extack))
262273867881SPablo Neira Ayuso 				break;
262326c02749SOr Gerlitz 
262426c02749SOr Gerlitz 			return -EOPNOTSUPP;
262573867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT:
262673867881SPablo Neira Ayuso 		case FLOW_ACTION_MIRRED: {
262703a9d11eSOr Gerlitz 			struct mlx5e_priv *out_priv;
2628592d3651SChris Mi 			struct net_device *out_dev;
262903a9d11eSOr Gerlitz 
263073867881SPablo Neira Ayuso 			out_dev = act->dev;
2631ef381359SOz Shlomo 			if (!out_dev) {
2632ef381359SOz Shlomo 				/* out_dev is NULL when filters with
2633ef381359SOz Shlomo 				 * non-existing mirred device are replayed to
2634ef381359SOz Shlomo 				 * the driver.
2635ef381359SOz Shlomo 				 */
2636ef381359SOz Shlomo 				return -EINVAL;
2637ef381359SOz Shlomo 			}
263803a9d11eSOr Gerlitz 
2639592d3651SChris Mi 			if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) {
2640e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2641e98bedf5SEli Britstein 						   "can't support more output ports, can't offload forwarding");
2642592d3651SChris Mi 				pr_err("can't support more than %d output ports, can't offload forwarding\n",
2643592d3651SChris Mi 				       attr->out_count);
2644592d3651SChris Mi 				return -EOPNOTSUPP;
2645592d3651SChris Mi 			}
2646592d3651SChris Mi 
2647f493f155SEli Britstein 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
2648f493f155SEli Britstein 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
26496dcfa234SFlorian Fainelli 			if (netdev_port_same_parent_id(priv->netdev,
2650b1d90e6bSRabie Loulou 						       out_dev) ||
2651b1d90e6bSRabie Loulou 			    is_merged_eswitch_dev(priv, out_dev)) {
26527ba58ba7SRabie Loulou 				struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
26537ba58ba7SRabie Loulou 				struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH);
26547ba58ba7SRabie Loulou 				struct net_device *uplink_upper = netdev_master_upper_dev_get(uplink_dev);
26557ba58ba7SRabie Loulou 
26567ba58ba7SRabie Loulou 				if (uplink_upper &&
26577ba58ba7SRabie Loulou 				    netif_is_lag_master(uplink_upper) &&
26587ba58ba7SRabie Loulou 				    uplink_upper == out_dev)
26597ba58ba7SRabie Loulou 					out_dev = uplink_dev;
26607ba58ba7SRabie Loulou 
2661a0646c88SEli Britstein 				if (!mlx5e_eswitch_rep(out_dev))
2662a0646c88SEli Britstein 					return -EOPNOTSUPP;
2663a0646c88SEli Britstein 
266403a9d11eSOr Gerlitz 				out_priv = netdev_priv(out_dev);
26651d447a39SSaeed Mahameed 				rpriv = out_priv->ppriv;
2666df65a573SEli Britstein 				attr->dests[attr->out_count].rep = rpriv->rep;
2667df65a573SEli Britstein 				attr->dests[attr->out_count].mdev = out_priv->mdev;
2668df65a573SEli Britstein 				attr->out_count++;
2669a54e20b4SHadar Hen Zion 			} else if (encap) {
26708c4dc42bSEli Britstein 				parse_attr->mirred_ifindex[attr->out_count] =
26718c4dc42bSEli Britstein 					out_dev->ifindex;
26728c4dc42bSEli Britstein 				parse_attr->tun_info[attr->out_count] = *info;
26738c4dc42bSEli Britstein 				encap = false;
2674f493f155SEli Britstein 				attr->dests[attr->out_count].flags |=
2675f493f155SEli Britstein 					MLX5_ESW_DEST_ENCAP;
26761cc26d74SEli Britstein 				attr->out_count++;
2677df65a573SEli Britstein 				/* attr->dests[].rep is resolved when we
2678df65a573SEli Britstein 				 * handle encap
2679df65a573SEli Britstein 				 */
2680ef381359SOz Shlomo 			} else if (parse_attr->filter_dev != priv->netdev) {
2681ef381359SOz Shlomo 				/* All mlx5 devices are called to configure
2682ef381359SOz Shlomo 				 * high level device filters. Therefore, the
2683ef381359SOz Shlomo 				 * *attempt* to  install a filter on invalid
2684ef381359SOz Shlomo 				 * eswitch should not trigger an explicit error
2685ef381359SOz Shlomo 				 */
2686ef381359SOz Shlomo 				return -EINVAL;
2687a54e20b4SHadar Hen Zion 			} else {
2688e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2689e98bedf5SEli Britstein 						   "devices are not on same switch HW, can't offload forwarding");
2690a54e20b4SHadar Hen Zion 				pr_err("devices %s %s not on same switch HW, can't offload forwarding\n",
2691a54e20b4SHadar Hen Zion 				       priv->netdev->name, out_dev->name);
2692a54e20b4SHadar Hen Zion 				return -EINVAL;
2693a54e20b4SHadar Hen Zion 			}
2694a54e20b4SHadar Hen Zion 			}
269573867881SPablo Neira Ayuso 			break;
269673867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_ENCAP:
269773867881SPablo Neira Ayuso 			info = act->tunnel;
2698a54e20b4SHadar Hen Zion 			if (info)
2699a54e20b4SHadar Hen Zion 				encap = true;
2700a54e20b4SHadar Hen Zion 			else
2701a54e20b4SHadar Hen Zion 				return -EOPNOTSUPP;
270203a9d11eSOr Gerlitz 
270373867881SPablo Neira Ayuso 			break;
270473867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_PUSH:
270573867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_POP:
270676b496b1SEli Britstein 			if (act->id == FLOW_ACTION_VLAN_PUSH &&
270776b496b1SEli Britstein 			    (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP)) {
270876b496b1SEli Britstein 				/* Replace vlan pop+push with vlan modify */
270976b496b1SEli Britstein 				action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
271076b496b1SEli Britstein 				err = add_vlan_rewrite_action(priv,
271176b496b1SEli Britstein 							      MLX5_FLOW_NAMESPACE_FDB,
271276b496b1SEli Britstein 							      act, parse_attr, hdrs,
271376b496b1SEli Britstein 							      &action, extack);
271476b496b1SEli Britstein 			} else {
271573867881SPablo Neira Ayuso 				err = parse_tc_vlan_action(priv, act, attr, &action);
271676b496b1SEli Britstein 			}
27171482bd3dSJianbo Liu 			if (err)
27181482bd3dSJianbo Liu 				return err;
27191482bd3dSJianbo Liu 
2720e85e02baSEli Britstein 			attr->split_count = attr->out_count;
272173867881SPablo Neira Ayuso 			break;
2722bdc837eeSEli Britstein 		case FLOW_ACTION_VLAN_MANGLE:
2723bdc837eeSEli Britstein 			err = add_vlan_rewrite_action(priv,
2724bdc837eeSEli Britstein 						      MLX5_FLOW_NAMESPACE_FDB,
2725bdc837eeSEli Britstein 						      act, parse_attr, hdrs,
2726bdc837eeSEli Britstein 						      &action, extack);
2727bdc837eeSEli Britstein 			if (err)
2728bdc837eeSEli Britstein 				return err;
2729bdc837eeSEli Britstein 
2730bdc837eeSEli Britstein 			attr->split_count = attr->out_count;
2731bdc837eeSEli Britstein 			break;
273273867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_DECAP:
27331cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DECAP;
273473867881SPablo Neira Ayuso 			break;
273573867881SPablo Neira Ayuso 		case FLOW_ACTION_GOTO: {
273673867881SPablo Neira Ayuso 			u32 dest_chain = act->chain_index;
2737bf07aa73SPaul Blakey 			u32 max_chain = mlx5_eswitch_get_chain_range(esw);
2738bf07aa73SPaul Blakey 
2739bf07aa73SPaul Blakey 			if (dest_chain <= attr->chain) {
2740bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Goto earlier chain isn't supported");
2741bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
2742bf07aa73SPaul Blakey 			}
2743bf07aa73SPaul Blakey 			if (dest_chain > max_chain) {
2744bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Requested destination chain is out of supported range");
2745bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
2746bf07aa73SPaul Blakey 			}
2747e88afe75SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
2748bf07aa73SPaul Blakey 			attr->dest_chain = dest_chain;
274973867881SPablo Neira Ayuso 			break;
2750bf07aa73SPaul Blakey 			}
275173867881SPablo Neira Ayuso 		default:
27522cc1cb1dSTonghao Zhang 			NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported");
27532cc1cb1dSTonghao Zhang 			return -EOPNOTSUPP;
275403a9d11eSOr Gerlitz 		}
275573867881SPablo Neira Ayuso 	}
2756bdd66ac0SOr Gerlitz 
2757c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
2758c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
2759c500c86bSPablo Neira Ayuso 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL,
2760c500c86bSPablo Neira Ayuso 					    parse_attr, hdrs, extack);
2761c500c86bSPablo Neira Ayuso 		if (err)
2762c500c86bSPablo Neira Ayuso 			return err;
2763c500c86bSPablo Neira Ayuso 	}
2764c500c86bSPablo Neira Ayuso 
27651cab1cd7SOr Gerlitz 	attr->action = action;
276673867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
2767bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
2768bdd66ac0SOr Gerlitz 
2769e88afe75SOr Gerlitz 	if (attr->dest_chain) {
2770e88afe75SOr Gerlitz 		if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
2771e88afe75SOr Gerlitz 			NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported");
2772e88afe75SOr Gerlitz 			return -EOPNOTSUPP;
2773e88afe75SOr Gerlitz 		}
2774e88afe75SOr Gerlitz 		attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
2775e88afe75SOr Gerlitz 	}
2776e88afe75SOr Gerlitz 
2777e85e02baSEli Britstein 	if (attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) {
2778e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2779e98bedf5SEli Britstein 				   "current firmware doesn't support split rule for port mirroring");
2780592d3651SChris Mi 		netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n");
2781592d3651SChris Mi 		return -EOPNOTSUPP;
2782592d3651SChris Mi 	}
2783592d3651SChris Mi 
278431c8eba5SOr Gerlitz 	return 0;
278503a9d11eSOr Gerlitz }
278603a9d11eSOr Gerlitz 
27875dbe906fSPaul Blakey static void get_flags(int flags, u16 *flow_flags)
278860bd4af8SOr Gerlitz {
27895dbe906fSPaul Blakey 	u16 __flow_flags = 0;
279060bd4af8SOr Gerlitz 
279160bd4af8SOr Gerlitz 	if (flags & MLX5E_TC_INGRESS)
279260bd4af8SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_INGRESS;
279360bd4af8SOr Gerlitz 	if (flags & MLX5E_TC_EGRESS)
279460bd4af8SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_EGRESS;
279560bd4af8SOr Gerlitz 
2796d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_ESW_OFFLOAD)
2797d9ee0491SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_ESWITCH;
2798d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_NIC_OFFLOAD)
2799d9ee0491SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_NIC;
2800d9ee0491SOr Gerlitz 
280160bd4af8SOr Gerlitz 	*flow_flags = __flow_flags;
280260bd4af8SOr Gerlitz }
280360bd4af8SOr Gerlitz 
280405866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = {
280505866c82SOr Gerlitz 	.head_offset = offsetof(struct mlx5e_tc_flow, node),
280605866c82SOr Gerlitz 	.key_offset = offsetof(struct mlx5e_tc_flow, cookie),
280705866c82SOr Gerlitz 	.key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie),
280805866c82SOr Gerlitz 	.automatic_shrinking = true,
280905866c82SOr Gerlitz };
281005866c82SOr Gerlitz 
2811d9ee0491SOr Gerlitz static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv, int flags)
281205866c82SOr Gerlitz {
2813655dc3d2SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2814655dc3d2SOr Gerlitz 	struct mlx5e_rep_priv *uplink_rpriv;
2815655dc3d2SOr Gerlitz 
2816d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_ESW_OFFLOAD) {
2817655dc3d2SOr Gerlitz 		uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
2818ec1366c2SOz Shlomo 		return &uplink_rpriv->uplink_priv.tc_ht;
2819d9ee0491SOr Gerlitz 	} else /* NIC offload */
282005866c82SOr Gerlitz 		return &priv->fs.tc.ht;
282105866c82SOr Gerlitz }
282205866c82SOr Gerlitz 
282304de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow)
282404de7ddaSRoi Dayan {
28251418ddd9SAviv Heller 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
2826b05af6aaSBodong Wang 	bool is_rep_ingress = attr->in_rep->vport != MLX5_VPORT_UPLINK &&
28271418ddd9SAviv Heller 			      flow->flags & MLX5E_TC_FLOW_INGRESS;
28281418ddd9SAviv Heller 	bool act_is_encap = !!(attr->action &
28291418ddd9SAviv Heller 			       MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT);
28301418ddd9SAviv Heller 	bool esw_paired = mlx5_devcom_is_paired(attr->in_mdev->priv.devcom,
28311418ddd9SAviv Heller 						MLX5_DEVCOM_ESW_OFFLOADS);
28321418ddd9SAviv Heller 
283310fbb1cdSRoi Dayan 	if (!esw_paired)
283410fbb1cdSRoi Dayan 		return false;
283510fbb1cdSRoi Dayan 
283610fbb1cdSRoi Dayan 	if ((mlx5_lag_is_sriov(attr->in_mdev) ||
283710fbb1cdSRoi Dayan 	     mlx5_lag_is_multipath(attr->in_mdev)) &&
283810fbb1cdSRoi Dayan 	    (is_rep_ingress || act_is_encap))
283910fbb1cdSRoi Dayan 		return true;
284010fbb1cdSRoi Dayan 
284110fbb1cdSRoi Dayan 	return false;
284204de7ddaSRoi Dayan }
284304de7ddaSRoi Dayan 
2844a88780a9SRoi Dayan static int
2845a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size,
28465dbe906fSPaul Blakey 		 struct tc_cls_flower_offload *f, u16 flow_flags,
2847a88780a9SRoi Dayan 		 struct mlx5e_tc_flow_parse_attr **__parse_attr,
2848a88780a9SRoi Dayan 		 struct mlx5e_tc_flow **__flow)
2849e3a2b7edSAmir Vadai {
285017091853SOr Gerlitz 	struct mlx5e_tc_flow_parse_attr *parse_attr;
28513bc4b7bfSOr Gerlitz 	struct mlx5e_tc_flow *flow;
2852a88780a9SRoi Dayan 	int err;
2853776b12b6SOr Gerlitz 
285465ba8fb7SOr Gerlitz 	flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL);
28551b9a07eeSLeon Romanovsky 	parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL);
285617091853SOr Gerlitz 	if (!parse_attr || !flow) {
2857e3a2b7edSAmir Vadai 		err = -ENOMEM;
2858e3a2b7edSAmir Vadai 		goto err_free;
2859e3a2b7edSAmir Vadai 	}
2860e3a2b7edSAmir Vadai 
2861e3a2b7edSAmir Vadai 	flow->cookie = f->cookie;
286265ba8fb7SOr Gerlitz 	flow->flags = flow_flags;
2863655dc3d2SOr Gerlitz 	flow->priv = priv;
2864e3a2b7edSAmir Vadai 
2865a88780a9SRoi Dayan 	*__flow = flow;
2866a88780a9SRoi Dayan 	*__parse_attr = parse_attr;
2867a88780a9SRoi Dayan 
2868a88780a9SRoi Dayan 	return 0;
2869a88780a9SRoi Dayan 
2870a88780a9SRoi Dayan err_free:
2871a88780a9SRoi Dayan 	kfree(flow);
2872a88780a9SRoi Dayan 	kvfree(parse_attr);
2873a88780a9SRoi Dayan 	return err;
2874adb4c123SOr Gerlitz }
2875adb4c123SOr Gerlitz 
2876988ab9c7STonghao Zhang static void
2877988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(struct mlx5_esw_flow_attr *esw_attr,
2878988ab9c7STonghao Zhang 			 struct mlx5e_priv *priv,
2879988ab9c7STonghao Zhang 			 struct mlx5e_tc_flow_parse_attr *parse_attr,
2880988ab9c7STonghao Zhang 			 struct tc_cls_flower_offload *f,
2881988ab9c7STonghao Zhang 			 struct mlx5_eswitch_rep *in_rep,
2882988ab9c7STonghao Zhang 			 struct mlx5_core_dev *in_mdev)
2883988ab9c7STonghao Zhang {
2884988ab9c7STonghao Zhang 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2885988ab9c7STonghao Zhang 
2886988ab9c7STonghao Zhang 	esw_attr->parse_attr = parse_attr;
2887988ab9c7STonghao Zhang 	esw_attr->chain = f->common.chain_index;
2888988ab9c7STonghao Zhang 	esw_attr->prio = TC_H_MAJ(f->common.prio) >> 16;
2889988ab9c7STonghao Zhang 
2890988ab9c7STonghao Zhang 	esw_attr->in_rep = in_rep;
2891988ab9c7STonghao Zhang 	esw_attr->in_mdev = in_mdev;
2892988ab9c7STonghao Zhang 
2893988ab9c7STonghao Zhang 	if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) ==
2894988ab9c7STonghao Zhang 	    MLX5_COUNTER_SOURCE_ESWITCH)
2895988ab9c7STonghao Zhang 		esw_attr->counter_dev = in_mdev;
2896988ab9c7STonghao Zhang 	else
2897988ab9c7STonghao Zhang 		esw_attr->counter_dev = priv->mdev;
2898988ab9c7STonghao Zhang }
2899988ab9c7STonghao Zhang 
290071129676SJason Gunthorpe static struct mlx5e_tc_flow *
290104de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
2902a88780a9SRoi Dayan 		     struct tc_cls_flower_offload *f,
29035dbe906fSPaul Blakey 		     u16 flow_flags,
2904d11afc26SOz Shlomo 		     struct net_device *filter_dev,
290504de7ddaSRoi Dayan 		     struct mlx5_eswitch_rep *in_rep,
290671129676SJason Gunthorpe 		     struct mlx5_core_dev *in_mdev)
2907a88780a9SRoi Dayan {
290873867881SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
2909a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
2910a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2911a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
2912a88780a9SRoi Dayan 	int attr_size, err;
2913a88780a9SRoi Dayan 
2914a88780a9SRoi Dayan 	flow_flags |= MLX5E_TC_FLOW_ESWITCH;
2915a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_esw_flow_attr);
2916a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
2917a88780a9SRoi Dayan 			       &parse_attr, &flow);
2918a88780a9SRoi Dayan 	if (err)
2919a88780a9SRoi Dayan 		goto out;
2920988ab9c7STonghao Zhang 
2921d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
2922988ab9c7STonghao Zhang 	mlx5e_flow_esw_attr_init(flow->esw_attr,
2923988ab9c7STonghao Zhang 				 priv, parse_attr,
2924988ab9c7STonghao Zhang 				 f, in_rep, in_mdev);
2925988ab9c7STonghao Zhang 
292654c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
292754c177caSOz Shlomo 			       f, filter_dev);
2928d11afc26SOz Shlomo 	if (err)
2929d11afc26SOz Shlomo 		goto err_free;
2930a88780a9SRoi Dayan 
29316f9af8ffSTonghao Zhang 	err = parse_tc_fdb_actions(priv, &rule->action, flow, extack);
2932a88780a9SRoi Dayan 	if (err)
2933a88780a9SRoi Dayan 		goto err_free;
2934a88780a9SRoi Dayan 
29357040632dSTonghao Zhang 	err = mlx5e_tc_add_fdb_flow(priv, flow, extack);
2936ef06c9eeSRoi Dayan 	if (err) {
2937ef06c9eeSRoi Dayan 		if (!(err == -ENETUNREACH && mlx5_lag_is_multipath(in_mdev)))
2938aa0cbbaeSOr Gerlitz 			goto err_free;
29395c40348cSOr Gerlitz 
2940b4a23329SRoi Dayan 		add_unready_flow(flow);
2941ef06c9eeSRoi Dayan 	}
2942ef06c9eeSRoi Dayan 
294371129676SJason Gunthorpe 	return flow;
2944e3a2b7edSAmir Vadai 
2945e3a2b7edSAmir Vadai err_free:
2946232c0013SHadar Hen Zion 	kfree(flow);
2947a88780a9SRoi Dayan 	kvfree(parse_attr);
2948a88780a9SRoi Dayan out:
294971129676SJason Gunthorpe 	return ERR_PTR(err);
2950a88780a9SRoi Dayan }
2951a88780a9SRoi Dayan 
295204de7ddaSRoi Dayan static int mlx5e_tc_add_fdb_peer_flow(struct tc_cls_flower_offload *f,
295395dc1902SRoi Dayan 				      struct mlx5e_tc_flow *flow,
295495dc1902SRoi Dayan 				      u16 flow_flags)
295504de7ddaSRoi Dayan {
295604de7ddaSRoi Dayan 	struct mlx5e_priv *priv = flow->priv, *peer_priv;
295704de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw;
295804de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
295904de7ddaSRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
296004de7ddaSRoi Dayan 	struct mlx5e_rep_priv *peer_urpriv;
296104de7ddaSRoi Dayan 	struct mlx5e_tc_flow *peer_flow;
296204de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev;
296304de7ddaSRoi Dayan 	int err = 0;
296404de7ddaSRoi Dayan 
296504de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
296604de7ddaSRoi Dayan 	if (!peer_esw)
296704de7ddaSRoi Dayan 		return -ENODEV;
296804de7ddaSRoi Dayan 
296904de7ddaSRoi Dayan 	peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH);
297004de7ddaSRoi Dayan 	peer_priv = netdev_priv(peer_urpriv->netdev);
297104de7ddaSRoi Dayan 
297204de7ddaSRoi Dayan 	/* in_mdev is assigned of which the packet originated from.
297304de7ddaSRoi Dayan 	 * So packets redirected to uplink use the same mdev of the
297404de7ddaSRoi Dayan 	 * original flow and packets redirected from uplink use the
297504de7ddaSRoi Dayan 	 * peer mdev.
297604de7ddaSRoi Dayan 	 */
2977b05af6aaSBodong Wang 	if (flow->esw_attr->in_rep->vport == MLX5_VPORT_UPLINK)
297804de7ddaSRoi Dayan 		in_mdev = peer_priv->mdev;
297904de7ddaSRoi Dayan 	else
298004de7ddaSRoi Dayan 		in_mdev = priv->mdev;
298104de7ddaSRoi Dayan 
298204de7ddaSRoi Dayan 	parse_attr = flow->esw_attr->parse_attr;
298395dc1902SRoi Dayan 	peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow_flags,
298404de7ddaSRoi Dayan 					 parse_attr->filter_dev,
298571129676SJason Gunthorpe 					 flow->esw_attr->in_rep, in_mdev);
298671129676SJason Gunthorpe 	if (IS_ERR(peer_flow)) {
298771129676SJason Gunthorpe 		err = PTR_ERR(peer_flow);
298804de7ddaSRoi Dayan 		goto out;
298971129676SJason Gunthorpe 	}
299004de7ddaSRoi Dayan 
299104de7ddaSRoi Dayan 	flow->peer_flow = peer_flow;
299204de7ddaSRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_DUP;
299304de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
299404de7ddaSRoi Dayan 	list_add_tail(&flow->peer, &esw->offloads.peer_flows);
299504de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
299604de7ddaSRoi Dayan 
299704de7ddaSRoi Dayan out:
299804de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
299904de7ddaSRoi Dayan 	return err;
300004de7ddaSRoi Dayan }
300104de7ddaSRoi Dayan 
300204de7ddaSRoi Dayan static int
300304de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
300404de7ddaSRoi Dayan 		   struct tc_cls_flower_offload *f,
300504de7ddaSRoi Dayan 		   u16 flow_flags,
300604de7ddaSRoi Dayan 		   struct net_device *filter_dev,
300704de7ddaSRoi Dayan 		   struct mlx5e_tc_flow **__flow)
300804de7ddaSRoi Dayan {
300904de7ddaSRoi Dayan 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
301004de7ddaSRoi Dayan 	struct mlx5_eswitch_rep *in_rep = rpriv->rep;
301104de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev = priv->mdev;
301204de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow;
301304de7ddaSRoi Dayan 	int err;
301404de7ddaSRoi Dayan 
301571129676SJason Gunthorpe 	flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep,
301671129676SJason Gunthorpe 				    in_mdev);
301771129676SJason Gunthorpe 	if (IS_ERR(flow))
301871129676SJason Gunthorpe 		return PTR_ERR(flow);
301904de7ddaSRoi Dayan 
302004de7ddaSRoi Dayan 	if (is_peer_flow_needed(flow)) {
302195dc1902SRoi Dayan 		err = mlx5e_tc_add_fdb_peer_flow(f, flow, flow_flags);
302204de7ddaSRoi Dayan 		if (err) {
302304de7ddaSRoi Dayan 			mlx5e_tc_del_fdb_flow(priv, flow);
302404de7ddaSRoi Dayan 			goto out;
302504de7ddaSRoi Dayan 		}
302604de7ddaSRoi Dayan 	}
302704de7ddaSRoi Dayan 
302804de7ddaSRoi Dayan 	*__flow = flow;
302904de7ddaSRoi Dayan 
303004de7ddaSRoi Dayan 	return 0;
303104de7ddaSRoi Dayan 
303204de7ddaSRoi Dayan out:
303304de7ddaSRoi Dayan 	return err;
303404de7ddaSRoi Dayan }
303504de7ddaSRoi Dayan 
3036a88780a9SRoi Dayan static int
3037a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv,
3038a88780a9SRoi Dayan 		   struct tc_cls_flower_offload *f,
30395dbe906fSPaul Blakey 		   u16 flow_flags,
3040d11afc26SOz Shlomo 		   struct net_device *filter_dev,
3041a88780a9SRoi Dayan 		   struct mlx5e_tc_flow **__flow)
3042a88780a9SRoi Dayan {
304373867881SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
3044a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
3045a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
3046a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
3047a88780a9SRoi Dayan 	int attr_size, err;
3048a88780a9SRoi Dayan 
3049bf07aa73SPaul Blakey 	/* multi-chain not supported for NIC rules */
3050bf07aa73SPaul Blakey 	if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common))
3051bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
3052bf07aa73SPaul Blakey 
3053a88780a9SRoi Dayan 	flow_flags |= MLX5E_TC_FLOW_NIC;
3054a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_nic_flow_attr);
3055a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
3056a88780a9SRoi Dayan 			       &parse_attr, &flow);
3057a88780a9SRoi Dayan 	if (err)
3058a88780a9SRoi Dayan 		goto out;
3059a88780a9SRoi Dayan 
3060d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
306154c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
306254c177caSOz Shlomo 			       f, filter_dev);
3063d11afc26SOz Shlomo 	if (err)
3064d11afc26SOz Shlomo 		goto err_free;
3065d11afc26SOz Shlomo 
306673867881SPablo Neira Ayuso 	err = parse_tc_nic_actions(priv, &rule->action, parse_attr, flow, extack);
3067a88780a9SRoi Dayan 	if (err)
3068a88780a9SRoi Dayan 		goto err_free;
3069a88780a9SRoi Dayan 
3070a88780a9SRoi Dayan 	err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack);
3071a88780a9SRoi Dayan 	if (err)
3072a88780a9SRoi Dayan 		goto err_free;
3073a88780a9SRoi Dayan 
3074a88780a9SRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_OFFLOADED;
3075a88780a9SRoi Dayan 	kvfree(parse_attr);
3076a88780a9SRoi Dayan 	*__flow = flow;
3077a88780a9SRoi Dayan 
3078a88780a9SRoi Dayan 	return 0;
3079a88780a9SRoi Dayan 
3080a88780a9SRoi Dayan err_free:
3081a88780a9SRoi Dayan 	kfree(flow);
3082a88780a9SRoi Dayan 	kvfree(parse_attr);
3083a88780a9SRoi Dayan out:
3084a88780a9SRoi Dayan 	return err;
3085a88780a9SRoi Dayan }
3086a88780a9SRoi Dayan 
3087a88780a9SRoi Dayan static int
3088a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv,
3089a88780a9SRoi Dayan 		  struct tc_cls_flower_offload *f,
3090a88780a9SRoi Dayan 		  int flags,
3091d11afc26SOz Shlomo 		  struct net_device *filter_dev,
3092a88780a9SRoi Dayan 		  struct mlx5e_tc_flow **flow)
3093a88780a9SRoi Dayan {
3094a88780a9SRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
30955dbe906fSPaul Blakey 	u16 flow_flags;
3096a88780a9SRoi Dayan 	int err;
3097a88780a9SRoi Dayan 
3098a88780a9SRoi Dayan 	get_flags(flags, &flow_flags);
3099a88780a9SRoi Dayan 
3100bf07aa73SPaul Blakey 	if (!tc_can_offload_extack(priv->netdev, f->common.extack))
3101bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
3102bf07aa73SPaul Blakey 
3103a88780a9SRoi Dayan 	if (esw && esw->mode == SRIOV_OFFLOADS)
3104d11afc26SOz Shlomo 		err = mlx5e_add_fdb_flow(priv, f, flow_flags,
3105d11afc26SOz Shlomo 					 filter_dev, flow);
3106a88780a9SRoi Dayan 	else
3107d11afc26SOz Shlomo 		err = mlx5e_add_nic_flow(priv, f, flow_flags,
3108d11afc26SOz Shlomo 					 filter_dev, flow);
3109a88780a9SRoi Dayan 
3110a88780a9SRoi Dayan 	return err;
3111a88780a9SRoi Dayan }
3112a88780a9SRoi Dayan 
311371d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv,
3114a88780a9SRoi Dayan 			   struct tc_cls_flower_offload *f, int flags)
3115a88780a9SRoi Dayan {
3116a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
3117d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
3118a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
3119a88780a9SRoi Dayan 	int err = 0;
3120a88780a9SRoi Dayan 
3121a88780a9SRoi Dayan 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
3122a88780a9SRoi Dayan 	if (flow) {
3123a88780a9SRoi Dayan 		NL_SET_ERR_MSG_MOD(extack,
3124a88780a9SRoi Dayan 				   "flow cookie already exists, ignoring");
3125a88780a9SRoi Dayan 		netdev_warn_once(priv->netdev,
3126a88780a9SRoi Dayan 				 "flow cookie %lx already exists, ignoring\n",
3127a88780a9SRoi Dayan 				 f->cookie);
3128a88780a9SRoi Dayan 		goto out;
3129a88780a9SRoi Dayan 	}
3130a88780a9SRoi Dayan 
3131d11afc26SOz Shlomo 	err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow);
3132a88780a9SRoi Dayan 	if (err)
3133a88780a9SRoi Dayan 		goto out;
3134a88780a9SRoi Dayan 
3135a88780a9SRoi Dayan 	err = rhashtable_insert_fast(tc_ht, &flow->node, tc_ht_params);
3136a88780a9SRoi Dayan 	if (err)
3137a88780a9SRoi Dayan 		goto err_free;
3138a88780a9SRoi Dayan 
3139a88780a9SRoi Dayan 	return 0;
3140a88780a9SRoi Dayan 
3141a88780a9SRoi Dayan err_free:
3142a88780a9SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3143a88780a9SRoi Dayan 	kfree(flow);
3144a88780a9SRoi Dayan out:
3145e3a2b7edSAmir Vadai 	return err;
3146e3a2b7edSAmir Vadai }
3147e3a2b7edSAmir Vadai 
31488f8ae895SOr Gerlitz #define DIRECTION_MASK (MLX5E_TC_INGRESS | MLX5E_TC_EGRESS)
31498f8ae895SOr Gerlitz #define FLOW_DIRECTION_MASK (MLX5E_TC_FLOW_INGRESS | MLX5E_TC_FLOW_EGRESS)
31508f8ae895SOr Gerlitz 
31518f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags)
31528f8ae895SOr Gerlitz {
31538f8ae895SOr Gerlitz 	if ((flow->flags & FLOW_DIRECTION_MASK) == (flags & DIRECTION_MASK))
31548f8ae895SOr Gerlitz 		return true;
31558f8ae895SOr Gerlitz 
31568f8ae895SOr Gerlitz 	return false;
31578f8ae895SOr Gerlitz }
31588f8ae895SOr Gerlitz 
315971d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv,
316060bd4af8SOr Gerlitz 			struct tc_cls_flower_offload *f, int flags)
3161e3a2b7edSAmir Vadai {
3162d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
3163e3a2b7edSAmir Vadai 	struct mlx5e_tc_flow *flow;
3164e3a2b7edSAmir Vadai 
316505866c82SOr Gerlitz 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
31668f8ae895SOr Gerlitz 	if (!flow || !same_flow_direction(flow, flags))
3167e3a2b7edSAmir Vadai 		return -EINVAL;
3168e3a2b7edSAmir Vadai 
316905866c82SOr Gerlitz 	rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params);
3170e3a2b7edSAmir Vadai 
3171961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3172e3a2b7edSAmir Vadai 
3173e3a2b7edSAmir Vadai 	kfree(flow);
3174e3a2b7edSAmir Vadai 
3175e3a2b7edSAmir Vadai 	return 0;
3176e3a2b7edSAmir Vadai }
3177e3a2b7edSAmir Vadai 
317871d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv,
317960bd4af8SOr Gerlitz 		       struct tc_cls_flower_offload *f, int flags)
3180aad7e08dSAmir Vadai {
318104de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
3182d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
318304de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
3184aad7e08dSAmir Vadai 	struct mlx5e_tc_flow *flow;
3185aad7e08dSAmir Vadai 	struct mlx5_fc *counter;
3186316d5f72SRoi Dayan 	u64 lastuse = 0;
3187316d5f72SRoi Dayan 	u64 packets = 0;
3188316d5f72SRoi Dayan 	u64 bytes = 0;
3189aad7e08dSAmir Vadai 
319005866c82SOr Gerlitz 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
31918f8ae895SOr Gerlitz 	if (!flow || !same_flow_direction(flow, flags))
3192aad7e08dSAmir Vadai 		return -EINVAL;
3193aad7e08dSAmir Vadai 
3194316d5f72SRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
3195b8aee822SMark Bloch 		counter = mlx5e_tc_get_counter(flow);
3196aad7e08dSAmir Vadai 		if (!counter)
3197aad7e08dSAmir Vadai 			return 0;
3198aad7e08dSAmir Vadai 
3199aad7e08dSAmir Vadai 		mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
3200316d5f72SRoi Dayan 	}
3201aad7e08dSAmir Vadai 
3202316d5f72SRoi Dayan 	/* Under multipath it's possible for one rule to be currently
3203316d5f72SRoi Dayan 	 * un-offloaded while the other rule is offloaded.
3204316d5f72SRoi Dayan 	 */
320504de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
320604de7ddaSRoi Dayan 	if (!peer_esw)
320704de7ddaSRoi Dayan 		goto out;
320804de7ddaSRoi Dayan 
320904de7ddaSRoi Dayan 	if ((flow->flags & MLX5E_TC_FLOW_DUP) &&
321004de7ddaSRoi Dayan 	    (flow->peer_flow->flags & MLX5E_TC_FLOW_OFFLOADED)) {
321104de7ddaSRoi Dayan 		u64 bytes2;
321204de7ddaSRoi Dayan 		u64 packets2;
321304de7ddaSRoi Dayan 		u64 lastuse2;
321404de7ddaSRoi Dayan 
321504de7ddaSRoi Dayan 		counter = mlx5e_tc_get_counter(flow->peer_flow);
3216316d5f72SRoi Dayan 		if (!counter)
3217316d5f72SRoi Dayan 			goto no_peer_counter;
321804de7ddaSRoi Dayan 		mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2);
321904de7ddaSRoi Dayan 
322004de7ddaSRoi Dayan 		bytes += bytes2;
322104de7ddaSRoi Dayan 		packets += packets2;
322204de7ddaSRoi Dayan 		lastuse = max_t(u64, lastuse, lastuse2);
322304de7ddaSRoi Dayan 	}
322404de7ddaSRoi Dayan 
3225316d5f72SRoi Dayan no_peer_counter:
322604de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
322704de7ddaSRoi Dayan out:
32283b1903efSPablo Neira Ayuso 	flow_stats_update(&f->stats, bytes, packets, lastuse);
3229fed06ee8SOr Gerlitz 
3230aad7e08dSAmir Vadai 	return 0;
3231aad7e08dSAmir Vadai }
3232aad7e08dSAmir Vadai 
32334d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv,
32344d8fcf21SAlaa Hleihel 					      struct mlx5e_priv *peer_priv)
32354d8fcf21SAlaa Hleihel {
32364d8fcf21SAlaa Hleihel 	struct mlx5_core_dev *peer_mdev = peer_priv->mdev;
32374d8fcf21SAlaa Hleihel 	struct mlx5e_hairpin_entry *hpe;
32384d8fcf21SAlaa Hleihel 	u16 peer_vhca_id;
32394d8fcf21SAlaa Hleihel 	int bkt;
32404d8fcf21SAlaa Hleihel 
32414d8fcf21SAlaa Hleihel 	if (!same_hw_devs(priv, peer_priv))
32424d8fcf21SAlaa Hleihel 		return;
32434d8fcf21SAlaa Hleihel 
32444d8fcf21SAlaa Hleihel 	peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
32454d8fcf21SAlaa Hleihel 
32464d8fcf21SAlaa Hleihel 	hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) {
32474d8fcf21SAlaa Hleihel 		if (hpe->peer_vhca_id == peer_vhca_id)
32484d8fcf21SAlaa Hleihel 			hpe->hp->pair->peer_gone = true;
32494d8fcf21SAlaa Hleihel 	}
32504d8fcf21SAlaa Hleihel }
32514d8fcf21SAlaa Hleihel 
32524d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this,
32534d8fcf21SAlaa Hleihel 				 unsigned long event, void *ptr)
32544d8fcf21SAlaa Hleihel {
32554d8fcf21SAlaa Hleihel 	struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
32564d8fcf21SAlaa Hleihel 	struct mlx5e_flow_steering *fs;
32574d8fcf21SAlaa Hleihel 	struct mlx5e_priv *peer_priv;
32584d8fcf21SAlaa Hleihel 	struct mlx5e_tc_table *tc;
32594d8fcf21SAlaa Hleihel 	struct mlx5e_priv *priv;
32604d8fcf21SAlaa Hleihel 
32614d8fcf21SAlaa Hleihel 	if (ndev->netdev_ops != &mlx5e_netdev_ops ||
32624d8fcf21SAlaa Hleihel 	    event != NETDEV_UNREGISTER ||
32634d8fcf21SAlaa Hleihel 	    ndev->reg_state == NETREG_REGISTERED)
32644d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
32654d8fcf21SAlaa Hleihel 
32664d8fcf21SAlaa Hleihel 	tc = container_of(this, struct mlx5e_tc_table, netdevice_nb);
32674d8fcf21SAlaa Hleihel 	fs = container_of(tc, struct mlx5e_flow_steering, tc);
32684d8fcf21SAlaa Hleihel 	priv = container_of(fs, struct mlx5e_priv, fs);
32694d8fcf21SAlaa Hleihel 	peer_priv = netdev_priv(ndev);
32704d8fcf21SAlaa Hleihel 	if (priv == peer_priv ||
32714d8fcf21SAlaa Hleihel 	    !(priv->netdev->features & NETIF_F_HW_TC))
32724d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
32734d8fcf21SAlaa Hleihel 
32744d8fcf21SAlaa Hleihel 	mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv);
32754d8fcf21SAlaa Hleihel 
32764d8fcf21SAlaa Hleihel 	return NOTIFY_DONE;
32774d8fcf21SAlaa Hleihel }
32784d8fcf21SAlaa Hleihel 
3279655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv)
3280e8f887acSAmir Vadai {
3281acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
32824d8fcf21SAlaa Hleihel 	int err;
3283e8f887acSAmir Vadai 
328411c9c548SOr Gerlitz 	hash_init(tc->mod_hdr_tbl);
32855c65c564SOr Gerlitz 	hash_init(tc->hairpin_tbl);
328611c9c548SOr Gerlitz 
32874d8fcf21SAlaa Hleihel 	err = rhashtable_init(&tc->ht, &tc_ht_params);
32884d8fcf21SAlaa Hleihel 	if (err)
32894d8fcf21SAlaa Hleihel 		return err;
32904d8fcf21SAlaa Hleihel 
32914d8fcf21SAlaa Hleihel 	tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event;
32924d8fcf21SAlaa Hleihel 	if (register_netdevice_notifier(&tc->netdevice_nb)) {
32934d8fcf21SAlaa Hleihel 		tc->netdevice_nb.notifier_call = NULL;
32944d8fcf21SAlaa Hleihel 		mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n");
32954d8fcf21SAlaa Hleihel 	}
32964d8fcf21SAlaa Hleihel 
32974d8fcf21SAlaa Hleihel 	return err;
3298e8f887acSAmir Vadai }
3299e8f887acSAmir Vadai 
3300e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg)
3301e8f887acSAmir Vadai {
3302e8f887acSAmir Vadai 	struct mlx5e_tc_flow *flow = ptr;
3303655dc3d2SOr Gerlitz 	struct mlx5e_priv *priv = flow->priv;
3304e8f887acSAmir Vadai 
3305961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3306e8f887acSAmir Vadai 	kfree(flow);
3307e8f887acSAmir Vadai }
3308e8f887acSAmir Vadai 
3309655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv)
3310e8f887acSAmir Vadai {
3311acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
3312e8f887acSAmir Vadai 
33134d8fcf21SAlaa Hleihel 	if (tc->netdevice_nb.notifier_call)
33144d8fcf21SAlaa Hleihel 		unregister_netdevice_notifier(&tc->netdevice_nb);
33154d8fcf21SAlaa Hleihel 
3316d9ee0491SOr Gerlitz 	rhashtable_destroy(&tc->ht);
3317e8f887acSAmir Vadai 
3318acff797cSMaor Gottlieb 	if (!IS_ERR_OR_NULL(tc->t)) {
3319acff797cSMaor Gottlieb 		mlx5_destroy_flow_table(tc->t);
3320acff797cSMaor Gottlieb 		tc->t = NULL;
3321e8f887acSAmir Vadai 	}
3322e8f887acSAmir Vadai }
3323655dc3d2SOr Gerlitz 
3324655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht)
3325655dc3d2SOr Gerlitz {
3326655dc3d2SOr Gerlitz 	return rhashtable_init(tc_ht, &tc_ht_params);
3327655dc3d2SOr Gerlitz }
3328655dc3d2SOr Gerlitz 
3329655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht)
3330655dc3d2SOr Gerlitz {
3331655dc3d2SOr Gerlitz 	rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL);
3332655dc3d2SOr Gerlitz }
333301252a27SOr Gerlitz 
3334d9ee0491SOr Gerlitz int mlx5e_tc_num_filters(struct mlx5e_priv *priv, int flags)
333501252a27SOr Gerlitz {
3336d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
333701252a27SOr Gerlitz 
333801252a27SOr Gerlitz 	return atomic_read(&tc_ht->nelems);
333901252a27SOr Gerlitz }
334004de7ddaSRoi Dayan 
334104de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw)
334204de7ddaSRoi Dayan {
334304de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
334404de7ddaSRoi Dayan 
334504de7ddaSRoi Dayan 	list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer)
334604de7ddaSRoi Dayan 		__mlx5e_tc_del_fdb_peer_flow(flow);
334704de7ddaSRoi Dayan }
3348b4a23329SRoi Dayan 
3349b4a23329SRoi Dayan void mlx5e_tc_reoffload_flows_work(struct work_struct *work)
3350b4a23329SRoi Dayan {
3351b4a23329SRoi Dayan 	struct mlx5_rep_uplink_priv *rpriv =
3352b4a23329SRoi Dayan 		container_of(work, struct mlx5_rep_uplink_priv,
3353b4a23329SRoi Dayan 			     reoffload_flows_work);
3354b4a23329SRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
3355b4a23329SRoi Dayan 
3356b4a23329SRoi Dayan 	rtnl_lock();
3357b4a23329SRoi Dayan 	list_for_each_entry_safe(flow, tmp, &rpriv->unready_flows, unready) {
3358b4a23329SRoi Dayan 		if (!mlx5e_tc_add_fdb_flow(flow->priv, flow, NULL))
3359b4a23329SRoi Dayan 			remove_unready_flow(flow);
3360b4a23329SRoi Dayan 	}
3361b4a23329SRoi Dayan 	rtnl_unlock();
3362b4a23329SRoi Dayan }
3363