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>
415a7e5bcbSVlad Buslov #include <linux/refcount.h>
4203a9d11eSOr Gerlitz #include <net/tc_act/tc_mirred.h>
43776b12b6SOr Gerlitz #include <net/tc_act/tc_vlan.h>
44bbd00f7eSHadar Hen Zion #include <net/tc_act/tc_tunnel_key.h>
45d79b6df6SOr Gerlitz #include <net/tc_act/tc_pedit.h>
4626c02749SOr Gerlitz #include <net/tc_act/tc_csum.h>
47f6dfb4c3SHadar Hen Zion #include <net/arp.h>
483616d08bSDavid Ahern #include <net/ipv6_stubs.h>
49e8f887acSAmir Vadai #include "en.h"
501d447a39SSaeed Mahameed #include "en_rep.h"
51232c0013SHadar Hen Zion #include "en_tc.h"
5203a9d11eSOr Gerlitz #include "eswitch.h"
533f6d08d1SOr Gerlitz #include "fs_core.h"
542c81bfd5SHuy Nguyen #include "en/port.h"
55101f4de9SOz Shlomo #include "en/tc_tun.h"
5604de7ddaSRoi Dayan #include "lib/devcom.h"
579272e3dfSYevgeny Kliteynik #include "lib/geneve.h"
58e8f887acSAmir Vadai 
593bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr {
603bc4b7bfSOr Gerlitz 	u32 action;
613bc4b7bfSOr Gerlitz 	u32 flow_tag;
622f4fe4caSOr Gerlitz 	u32 mod_hdr_id;
635c65c564SOr Gerlitz 	u32 hairpin_tirn;
6438aa51c1SOr Gerlitz 	u8 match_level;
653f6d08d1SOr Gerlitz 	struct mlx5_flow_table	*hairpin_ft;
66b8aee822SMark Bloch 	struct mlx5_fc		*counter;
673bc4b7bfSOr Gerlitz };
683bc4b7bfSOr Gerlitz 
69226f2ca3SVlad Buslov #define MLX5E_TC_FLOW_BASE (MLX5E_TC_FLAG_LAST_EXPORTED_BIT + 1)
7060bd4af8SOr Gerlitz 
7165ba8fb7SOr Gerlitz enum {
72226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_INGRESS	= MLX5E_TC_FLAG_INGRESS_BIT,
73226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_EGRESS	= MLX5E_TC_FLAG_EGRESS_BIT,
74226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_ESWITCH	= MLX5E_TC_FLAG_ESW_OFFLOAD_BIT,
75226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_NIC		= MLX5E_TC_FLAG_NIC_OFFLOAD_BIT,
76226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_OFFLOADED	= MLX5E_TC_FLOW_BASE,
77226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_HAIRPIN	= MLX5E_TC_FLOW_BASE + 1,
78226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_HAIRPIN_RSS	= MLX5E_TC_FLOW_BASE + 2,
79226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_SLOW		= MLX5E_TC_FLOW_BASE + 3,
80226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_DUP		= MLX5E_TC_FLOW_BASE + 4,
81226f2ca3SVlad Buslov 	MLX5E_TC_FLOW_FLAG_NOT_READY	= MLX5E_TC_FLOW_BASE + 5,
82c5d326b2SVlad Buslov 	MLX5E_TC_FLOW_FLAG_DELETED	= MLX5E_TC_FLOW_BASE + 6,
8365ba8fb7SOr Gerlitz };
8465ba8fb7SOr Gerlitz 
85e4ad91f2SChris Mi #define MLX5E_TC_MAX_SPLITS 1
86e4ad91f2SChris Mi 
8779baaec7SEli Britstein /* Helper struct for accessing a struct containing list_head array.
8879baaec7SEli Britstein  * Containing struct
8979baaec7SEli Britstein  *   |- Helper array
9079baaec7SEli Britstein  *      [0] Helper item 0
9179baaec7SEli Britstein  *          |- list_head item 0
9279baaec7SEli Britstein  *          |- index (0)
9379baaec7SEli Britstein  *      [1] Helper item 1
9479baaec7SEli Britstein  *          |- list_head item 1
9579baaec7SEli Britstein  *          |- index (1)
9679baaec7SEli Britstein  * To access the containing struct from one of the list_head items:
9779baaec7SEli Britstein  * 1. Get the helper item from the list_head item using
9879baaec7SEli Britstein  *    helper item =
9979baaec7SEli Britstein  *        container_of(list_head item, helper struct type, list_head field)
10079baaec7SEli Britstein  * 2. Get the contining struct from the helper item and its index in the array:
10179baaec7SEli Britstein  *    containing struct =
10279baaec7SEli Britstein  *        container_of(helper item, containing struct type, helper field[index])
10379baaec7SEli Britstein  */
10479baaec7SEli Britstein struct encap_flow_item {
10579baaec7SEli Britstein 	struct list_head list;
10679baaec7SEli Britstein 	int index;
10779baaec7SEli Britstein };
10879baaec7SEli Britstein 
109e8f887acSAmir Vadai struct mlx5e_tc_flow {
110e8f887acSAmir Vadai 	struct rhash_head	node;
111655dc3d2SOr Gerlitz 	struct mlx5e_priv	*priv;
112e8f887acSAmir Vadai 	u64			cookie;
113226f2ca3SVlad Buslov 	unsigned long		flags;
114e4ad91f2SChris Mi 	struct mlx5_flow_handle *rule[MLX5E_TC_MAX_SPLITS + 1];
11579baaec7SEli Britstein 	/* Flow can be associated with multiple encap IDs.
11679baaec7SEli Britstein 	 * The number of encaps is bounded by the number of supported
11779baaec7SEli Britstein 	 * destinations.
11879baaec7SEli Britstein 	 */
11979baaec7SEli Britstein 	struct encap_flow_item encaps[MLX5_MAX_FLOW_FWD_VPORTS];
12004de7ddaSRoi Dayan 	struct mlx5e_tc_flow    *peer_flow;
12111c9c548SOr Gerlitz 	struct list_head	mod_hdr; /* flows sharing the same mod hdr ID */
1225c65c564SOr Gerlitz 	struct list_head	hairpin; /* flows sharing the same hairpin */
12304de7ddaSRoi Dayan 	struct list_head	peer;    /* flows with peer flow */
124b4a23329SRoi Dayan 	struct list_head	unready; /* flows not ready to be offloaded (e.g due to missing route) */
1255a7e5bcbSVlad Buslov 	refcount_t		refcnt;
126c5d326b2SVlad Buslov 	struct rcu_head		rcu_head;
1273bc4b7bfSOr Gerlitz 	union {
128ecf5bb79SOr Gerlitz 		struct mlx5_esw_flow_attr esw_attr[0];
1293bc4b7bfSOr Gerlitz 		struct mlx5_nic_flow_attr nic_attr[0];
1303bc4b7bfSOr Gerlitz 	};
131e8f887acSAmir Vadai };
132e8f887acSAmir Vadai 
13317091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr {
1341f6da306SYevgeny Kliteynik 	const struct ip_tunnel_info *tun_info[MLX5_MAX_FLOW_FWD_VPORTS];
135d11afc26SOz Shlomo 	struct net_device *filter_dev;
13617091853SOr Gerlitz 	struct mlx5_flow_spec spec;
137d79b6df6SOr Gerlitz 	int num_mod_hdr_actions;
138218d05ceSTonghao Zhang 	int max_mod_hdr_actions;
139d79b6df6SOr Gerlitz 	void *mod_hdr_actions;
14098b66cb1SEli Britstein 	int mirred_ifindex[MLX5_MAX_FLOW_FWD_VPORTS];
14117091853SOr Gerlitz };
14217091853SOr Gerlitz 
143acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4
144b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16)
145e8f887acSAmir Vadai 
14677ab67b7SOr Gerlitz struct mlx5e_hairpin {
14777ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
14877ab67b7SOr Gerlitz 
14977ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev;
1503f6d08d1SOr Gerlitz 	struct mlx5e_priv *func_priv;
15177ab67b7SOr Gerlitz 	u32 tdn;
15277ab67b7SOr Gerlitz 	u32 tirn;
1533f6d08d1SOr Gerlitz 
1543f6d08d1SOr Gerlitz 	int num_channels;
1553f6d08d1SOr Gerlitz 	struct mlx5e_rqt indir_rqt;
1563f6d08d1SOr Gerlitz 	u32 indir_tirn[MLX5E_NUM_INDIR_TIRS];
1573f6d08d1SOr Gerlitz 	struct mlx5e_ttc_table ttc;
15877ab67b7SOr Gerlitz };
15977ab67b7SOr Gerlitz 
1605c65c564SOr Gerlitz struct mlx5e_hairpin_entry {
1615c65c564SOr Gerlitz 	/* a node of a hash table which keeps all the  hairpin entries */
1625c65c564SOr Gerlitz 	struct hlist_node hairpin_hlist;
1635c65c564SOr Gerlitz 
1645c65c564SOr Gerlitz 	/* flows sharing the same hairpin */
1655c65c564SOr Gerlitz 	struct list_head flows;
1665c65c564SOr Gerlitz 
167d8822868SOr Gerlitz 	u16 peer_vhca_id;
168106be53bSOr Gerlitz 	u8 prio;
1695c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
1705c65c564SOr Gerlitz };
1715c65c564SOr Gerlitz 
17211c9c548SOr Gerlitz struct mod_hdr_key {
17311c9c548SOr Gerlitz 	int num_actions;
17411c9c548SOr Gerlitz 	void *actions;
17511c9c548SOr Gerlitz };
17611c9c548SOr Gerlitz 
17711c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry {
17811c9c548SOr Gerlitz 	/* a node of a hash table which keeps all the mod_hdr entries */
17911c9c548SOr Gerlitz 	struct hlist_node mod_hdr_hlist;
18011c9c548SOr Gerlitz 
18111c9c548SOr Gerlitz 	/* flows sharing the same mod_hdr entry */
18211c9c548SOr Gerlitz 	struct list_head flows;
18311c9c548SOr Gerlitz 
18411c9c548SOr Gerlitz 	struct mod_hdr_key key;
18511c9c548SOr Gerlitz 
18611c9c548SOr Gerlitz 	u32 mod_hdr_id;
18711c9c548SOr Gerlitz };
18811c9c548SOr Gerlitz 
18911c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto)
19011c9c548SOr Gerlitz 
1915a7e5bcbSVlad Buslov static void mlx5e_tc_del_flow(struct mlx5e_priv *priv,
1925a7e5bcbSVlad Buslov 			      struct mlx5e_tc_flow *flow);
1935a7e5bcbSVlad Buslov 
1945a7e5bcbSVlad Buslov static struct mlx5e_tc_flow *mlx5e_flow_get(struct mlx5e_tc_flow *flow)
1955a7e5bcbSVlad Buslov {
1965a7e5bcbSVlad Buslov 	if (!flow || !refcount_inc_not_zero(&flow->refcnt))
1975a7e5bcbSVlad Buslov 		return ERR_PTR(-EINVAL);
1985a7e5bcbSVlad Buslov 	return flow;
1995a7e5bcbSVlad Buslov }
2005a7e5bcbSVlad Buslov 
2015a7e5bcbSVlad Buslov static void mlx5e_flow_put(struct mlx5e_priv *priv,
2025a7e5bcbSVlad Buslov 			   struct mlx5e_tc_flow *flow)
2035a7e5bcbSVlad Buslov {
2045a7e5bcbSVlad Buslov 	if (refcount_dec_and_test(&flow->refcnt)) {
2055a7e5bcbSVlad Buslov 		mlx5e_tc_del_flow(priv, flow);
206c5d326b2SVlad Buslov 		kfree_rcu(flow, rcu_head);
2075a7e5bcbSVlad Buslov 	}
2085a7e5bcbSVlad Buslov }
2095a7e5bcbSVlad Buslov 
210226f2ca3SVlad Buslov static void __flow_flag_set(struct mlx5e_tc_flow *flow, unsigned long flag)
211226f2ca3SVlad Buslov {
212226f2ca3SVlad Buslov 	/* Complete all memory stores before setting bit. */
213226f2ca3SVlad Buslov 	smp_mb__before_atomic();
214226f2ca3SVlad Buslov 	set_bit(flag, &flow->flags);
215226f2ca3SVlad Buslov }
216226f2ca3SVlad Buslov 
217226f2ca3SVlad Buslov #define flow_flag_set(flow, flag) __flow_flag_set(flow, MLX5E_TC_FLOW_FLAG_##flag)
218226f2ca3SVlad Buslov 
219c5d326b2SVlad Buslov static bool __flow_flag_test_and_set(struct mlx5e_tc_flow *flow,
220c5d326b2SVlad Buslov 				     unsigned long flag)
221c5d326b2SVlad Buslov {
222c5d326b2SVlad Buslov 	/* test_and_set_bit() provides all necessary barriers */
223c5d326b2SVlad Buslov 	return test_and_set_bit(flag, &flow->flags);
224c5d326b2SVlad Buslov }
225c5d326b2SVlad Buslov 
226c5d326b2SVlad Buslov #define flow_flag_test_and_set(flow, flag)			\
227c5d326b2SVlad Buslov 	__flow_flag_test_and_set(flow,				\
228c5d326b2SVlad Buslov 				 MLX5E_TC_FLOW_FLAG_##flag)
229c5d326b2SVlad Buslov 
230226f2ca3SVlad Buslov static void __flow_flag_clear(struct mlx5e_tc_flow *flow, unsigned long flag)
231226f2ca3SVlad Buslov {
232226f2ca3SVlad Buslov 	/* Complete all memory stores before clearing bit. */
233226f2ca3SVlad Buslov 	smp_mb__before_atomic();
234226f2ca3SVlad Buslov 	clear_bit(flag, &flow->flags);
235226f2ca3SVlad Buslov }
236226f2ca3SVlad Buslov 
237226f2ca3SVlad Buslov #define flow_flag_clear(flow, flag) __flow_flag_clear(flow, \
238226f2ca3SVlad Buslov 						      MLX5E_TC_FLOW_FLAG_##flag)
239226f2ca3SVlad Buslov 
240226f2ca3SVlad Buslov static bool __flow_flag_test(struct mlx5e_tc_flow *flow, unsigned long flag)
241226f2ca3SVlad Buslov {
242226f2ca3SVlad Buslov 	bool ret = test_bit(flag, &flow->flags);
243226f2ca3SVlad Buslov 
244226f2ca3SVlad Buslov 	/* Read fields of flow structure only after checking flags. */
245226f2ca3SVlad Buslov 	smp_mb__after_atomic();
246226f2ca3SVlad Buslov 	return ret;
247226f2ca3SVlad Buslov }
248226f2ca3SVlad Buslov 
249226f2ca3SVlad Buslov #define flow_flag_test(flow, flag) __flow_flag_test(flow, \
250226f2ca3SVlad Buslov 						    MLX5E_TC_FLOW_FLAG_##flag)
251226f2ca3SVlad Buslov 
252226f2ca3SVlad Buslov static bool mlx5e_is_eswitch_flow(struct mlx5e_tc_flow *flow)
253226f2ca3SVlad Buslov {
254226f2ca3SVlad Buslov 	return flow_flag_test(flow, ESWITCH);
255226f2ca3SVlad Buslov }
256226f2ca3SVlad Buslov 
257226f2ca3SVlad Buslov static bool mlx5e_is_offloaded_flow(struct mlx5e_tc_flow *flow)
258226f2ca3SVlad Buslov {
259226f2ca3SVlad Buslov 	return flow_flag_test(flow, OFFLOADED);
260226f2ca3SVlad Buslov }
261226f2ca3SVlad Buslov 
26211c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key)
26311c9c548SOr Gerlitz {
26411c9c548SOr Gerlitz 	return jhash(key->actions,
26511c9c548SOr Gerlitz 		     key->num_actions * MLX5_MH_ACT_SZ, 0);
26611c9c548SOr Gerlitz }
26711c9c548SOr Gerlitz 
26811c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a,
26911c9c548SOr Gerlitz 				   struct mod_hdr_key *b)
27011c9c548SOr Gerlitz {
27111c9c548SOr Gerlitz 	if (a->num_actions != b->num_actions)
27211c9c548SOr Gerlitz 		return 1;
27311c9c548SOr Gerlitz 
27411c9c548SOr Gerlitz 	return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ);
27511c9c548SOr Gerlitz }
27611c9c548SOr Gerlitz 
27711c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv,
27811c9c548SOr Gerlitz 				struct mlx5e_tc_flow *flow,
27911c9c548SOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr)
28011c9c548SOr Gerlitz {
28111c9c548SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
28211c9c548SOr Gerlitz 	int num_actions, actions_size, namespace, err;
283226f2ca3SVlad Buslov 	bool found = false, is_eswitch_flow;
28411c9c548SOr Gerlitz 	struct mlx5e_mod_hdr_entry *mh;
28511c9c548SOr Gerlitz 	struct mod_hdr_key key;
28611c9c548SOr Gerlitz 	u32 hash_key;
28711c9c548SOr Gerlitz 
28811c9c548SOr Gerlitz 	num_actions  = parse_attr->num_mod_hdr_actions;
28911c9c548SOr Gerlitz 	actions_size = MLX5_MH_ACT_SZ * num_actions;
29011c9c548SOr Gerlitz 
29111c9c548SOr Gerlitz 	key.actions = parse_attr->mod_hdr_actions;
29211c9c548SOr Gerlitz 	key.num_actions = num_actions;
29311c9c548SOr Gerlitz 
29411c9c548SOr Gerlitz 	hash_key = hash_mod_hdr_info(&key);
29511c9c548SOr Gerlitz 
296226f2ca3SVlad Buslov 	is_eswitch_flow = mlx5e_is_eswitch_flow(flow);
297226f2ca3SVlad Buslov 	if (is_eswitch_flow) {
29811c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_FDB;
29911c9c548SOr Gerlitz 		hash_for_each_possible(esw->offloads.mod_hdr_tbl, mh,
30011c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
30111c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
30211c9c548SOr Gerlitz 				found = true;
30311c9c548SOr Gerlitz 				break;
30411c9c548SOr Gerlitz 			}
30511c9c548SOr Gerlitz 		}
30611c9c548SOr Gerlitz 	} else {
30711c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_KERNEL;
30811c9c548SOr Gerlitz 		hash_for_each_possible(priv->fs.tc.mod_hdr_tbl, mh,
30911c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
31011c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
31111c9c548SOr Gerlitz 				found = true;
31211c9c548SOr Gerlitz 				break;
31311c9c548SOr Gerlitz 			}
31411c9c548SOr Gerlitz 		}
31511c9c548SOr Gerlitz 	}
31611c9c548SOr Gerlitz 
31711c9c548SOr Gerlitz 	if (found)
31811c9c548SOr Gerlitz 		goto attach_flow;
31911c9c548SOr Gerlitz 
32011c9c548SOr Gerlitz 	mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL);
32111c9c548SOr Gerlitz 	if (!mh)
32211c9c548SOr Gerlitz 		return -ENOMEM;
32311c9c548SOr Gerlitz 
32411c9c548SOr Gerlitz 	mh->key.actions = (void *)mh + sizeof(*mh);
32511c9c548SOr Gerlitz 	memcpy(mh->key.actions, key.actions, actions_size);
32611c9c548SOr Gerlitz 	mh->key.num_actions = num_actions;
32711c9c548SOr Gerlitz 	INIT_LIST_HEAD(&mh->flows);
32811c9c548SOr Gerlitz 
32911c9c548SOr Gerlitz 	err = mlx5_modify_header_alloc(priv->mdev, namespace,
33011c9c548SOr Gerlitz 				       mh->key.num_actions,
33111c9c548SOr Gerlitz 				       mh->key.actions,
33211c9c548SOr Gerlitz 				       &mh->mod_hdr_id);
33311c9c548SOr Gerlitz 	if (err)
33411c9c548SOr Gerlitz 		goto out_err;
33511c9c548SOr Gerlitz 
336226f2ca3SVlad Buslov 	if (is_eswitch_flow)
33711c9c548SOr Gerlitz 		hash_add(esw->offloads.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
33811c9c548SOr Gerlitz 	else
33911c9c548SOr Gerlitz 		hash_add(priv->fs.tc.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
34011c9c548SOr Gerlitz 
34111c9c548SOr Gerlitz attach_flow:
34211c9c548SOr Gerlitz 	list_add(&flow->mod_hdr, &mh->flows);
343226f2ca3SVlad Buslov 	if (is_eswitch_flow)
34411c9c548SOr Gerlitz 		flow->esw_attr->mod_hdr_id = mh->mod_hdr_id;
34511c9c548SOr Gerlitz 	else
34611c9c548SOr Gerlitz 		flow->nic_attr->mod_hdr_id = mh->mod_hdr_id;
34711c9c548SOr Gerlitz 
34811c9c548SOr Gerlitz 	return 0;
34911c9c548SOr Gerlitz 
35011c9c548SOr Gerlitz out_err:
35111c9c548SOr Gerlitz 	kfree(mh);
35211c9c548SOr Gerlitz 	return err;
35311c9c548SOr Gerlitz }
35411c9c548SOr Gerlitz 
35511c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv,
35611c9c548SOr Gerlitz 				 struct mlx5e_tc_flow *flow)
35711c9c548SOr Gerlitz {
35811c9c548SOr Gerlitz 	struct list_head *next = flow->mod_hdr.next;
35911c9c548SOr Gerlitz 
3605a7e5bcbSVlad Buslov 	/* flow wasn't fully initialized */
3615a7e5bcbSVlad Buslov 	if (list_empty(&flow->mod_hdr))
3625a7e5bcbSVlad Buslov 		return;
3635a7e5bcbSVlad Buslov 
36411c9c548SOr Gerlitz 	list_del(&flow->mod_hdr);
36511c9c548SOr Gerlitz 
36611c9c548SOr Gerlitz 	if (list_empty(next)) {
36711c9c548SOr Gerlitz 		struct mlx5e_mod_hdr_entry *mh;
36811c9c548SOr Gerlitz 
36911c9c548SOr Gerlitz 		mh = list_entry(next, struct mlx5e_mod_hdr_entry, flows);
37011c9c548SOr Gerlitz 
37111c9c548SOr Gerlitz 		mlx5_modify_header_dealloc(priv->mdev, mh->mod_hdr_id);
37211c9c548SOr Gerlitz 		hash_del(&mh->mod_hdr_hlist);
37311c9c548SOr Gerlitz 		kfree(mh);
37411c9c548SOr Gerlitz 	}
37511c9c548SOr Gerlitz }
37611c9c548SOr Gerlitz 
37777ab67b7SOr Gerlitz static
37877ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex)
37977ab67b7SOr Gerlitz {
38077ab67b7SOr Gerlitz 	struct net_device *netdev;
38177ab67b7SOr Gerlitz 	struct mlx5e_priv *priv;
38277ab67b7SOr Gerlitz 
38377ab67b7SOr Gerlitz 	netdev = __dev_get_by_index(net, ifindex);
38477ab67b7SOr Gerlitz 	priv = netdev_priv(netdev);
38577ab67b7SOr Gerlitz 	return priv->mdev;
38677ab67b7SOr Gerlitz }
38777ab67b7SOr Gerlitz 
38877ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp)
38977ab67b7SOr Gerlitz {
39077ab67b7SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0};
39177ab67b7SOr Gerlitz 	void *tirc;
39277ab67b7SOr Gerlitz 	int err;
39377ab67b7SOr Gerlitz 
39477ab67b7SOr Gerlitz 	err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn);
39577ab67b7SOr Gerlitz 	if (err)
39677ab67b7SOr Gerlitz 		goto alloc_tdn_err;
39777ab67b7SOr Gerlitz 
39877ab67b7SOr Gerlitz 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
39977ab67b7SOr Gerlitz 
40077ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT);
401ddae74acSOr Gerlitz 	MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]);
40277ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
40377ab67b7SOr Gerlitz 
40477ab67b7SOr Gerlitz 	err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn);
40577ab67b7SOr Gerlitz 	if (err)
40677ab67b7SOr Gerlitz 		goto create_tir_err;
40777ab67b7SOr Gerlitz 
40877ab67b7SOr Gerlitz 	return 0;
40977ab67b7SOr Gerlitz 
41077ab67b7SOr Gerlitz create_tir_err:
41177ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
41277ab67b7SOr Gerlitz alloc_tdn_err:
41377ab67b7SOr Gerlitz 	return err;
41477ab67b7SOr Gerlitz }
41577ab67b7SOr Gerlitz 
41677ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp)
41777ab67b7SOr Gerlitz {
41877ab67b7SOr Gerlitz 	mlx5_core_destroy_tir(hp->func_mdev, hp->tirn);
41977ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
42077ab67b7SOr Gerlitz }
42177ab67b7SOr Gerlitz 
4223f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc)
4233f6d08d1SOr Gerlitz {
4243f6d08d1SOr Gerlitz 	u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn;
4253f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4263f6d08d1SOr Gerlitz 	int i, ix, sz = MLX5E_INDIR_RQT_SIZE;
4273f6d08d1SOr Gerlitz 
4283f6d08d1SOr Gerlitz 	mlx5e_build_default_indir_rqt(indirection_rqt, sz,
4293f6d08d1SOr Gerlitz 				      hp->num_channels);
4303f6d08d1SOr Gerlitz 
4313f6d08d1SOr Gerlitz 	for (i = 0; i < sz; i++) {
4323f6d08d1SOr Gerlitz 		ix = i;
433bbeb53b8SAya Levin 		if (priv->rss_params.hfunc == ETH_RSS_HASH_XOR)
4343f6d08d1SOr Gerlitz 			ix = mlx5e_bits_invert(i, ilog2(sz));
4353f6d08d1SOr Gerlitz 		ix = indirection_rqt[ix];
4363f6d08d1SOr Gerlitz 		rqn = hp->pair->rqn[ix];
4373f6d08d1SOr Gerlitz 		MLX5_SET(rqtc, rqtc, rq_num[i], rqn);
4383f6d08d1SOr Gerlitz 	}
4393f6d08d1SOr Gerlitz }
4403f6d08d1SOr Gerlitz 
4413f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp)
4423f6d08d1SOr Gerlitz {
4433f6d08d1SOr Gerlitz 	int inlen, err, sz = MLX5E_INDIR_RQT_SIZE;
4443f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4453f6d08d1SOr Gerlitz 	struct mlx5_core_dev *mdev = priv->mdev;
4463f6d08d1SOr Gerlitz 	void *rqtc;
4473f6d08d1SOr Gerlitz 	u32 *in;
4483f6d08d1SOr Gerlitz 
4493f6d08d1SOr Gerlitz 	inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz;
4503f6d08d1SOr Gerlitz 	in = kvzalloc(inlen, GFP_KERNEL);
4513f6d08d1SOr Gerlitz 	if (!in)
4523f6d08d1SOr Gerlitz 		return -ENOMEM;
4533f6d08d1SOr Gerlitz 
4543f6d08d1SOr Gerlitz 	rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context);
4553f6d08d1SOr Gerlitz 
4563f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_actual_size, sz);
4573f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_max_size, sz);
4583f6d08d1SOr Gerlitz 
4593f6d08d1SOr Gerlitz 	mlx5e_hairpin_fill_rqt_rqns(hp, rqtc);
4603f6d08d1SOr Gerlitz 
4613f6d08d1SOr Gerlitz 	err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn);
4623f6d08d1SOr Gerlitz 	if (!err)
4633f6d08d1SOr Gerlitz 		hp->indir_rqt.enabled = true;
4643f6d08d1SOr Gerlitz 
4653f6d08d1SOr Gerlitz 	kvfree(in);
4663f6d08d1SOr Gerlitz 	return err;
4673f6d08d1SOr Gerlitz }
4683f6d08d1SOr Gerlitz 
4693f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp)
4703f6d08d1SOr Gerlitz {
4713f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4723f6d08d1SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)];
4733f6d08d1SOr Gerlitz 	int tt, i, err;
4743f6d08d1SOr Gerlitz 	void *tirc;
4753f6d08d1SOr Gerlitz 
4763f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) {
477d930ac79SAya Levin 		struct mlx5e_tirc_config ttconfig = mlx5e_tirc_get_default_config(tt);
478d930ac79SAya Levin 
4793f6d08d1SOr Gerlitz 		memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in));
4803f6d08d1SOr Gerlitz 		tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
4813f6d08d1SOr Gerlitz 
4823f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
4833f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT);
4843f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn);
485bbeb53b8SAya Levin 		mlx5e_build_indir_tir_ctx_hash(&priv->rss_params, &ttconfig, tirc, false);
486bbeb53b8SAya Levin 
4873f6d08d1SOr Gerlitz 		err = mlx5_core_create_tir(hp->func_mdev, in,
4883f6d08d1SOr Gerlitz 					   MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]);
4893f6d08d1SOr Gerlitz 		if (err) {
4903f6d08d1SOr Gerlitz 			mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err);
4913f6d08d1SOr Gerlitz 			goto err_destroy_tirs;
4923f6d08d1SOr Gerlitz 		}
4933f6d08d1SOr Gerlitz 	}
4943f6d08d1SOr Gerlitz 	return 0;
4953f6d08d1SOr Gerlitz 
4963f6d08d1SOr Gerlitz err_destroy_tirs:
4973f6d08d1SOr Gerlitz 	for (i = 0; i < tt; i++)
4983f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]);
4993f6d08d1SOr Gerlitz 	return err;
5003f6d08d1SOr Gerlitz }
5013f6d08d1SOr Gerlitz 
5023f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp)
5033f6d08d1SOr Gerlitz {
5043f6d08d1SOr Gerlitz 	int tt;
5053f6d08d1SOr Gerlitz 
5063f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
5073f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]);
5083f6d08d1SOr Gerlitz }
5093f6d08d1SOr Gerlitz 
5103f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp,
5113f6d08d1SOr Gerlitz 					 struct ttc_params *ttc_params)
5123f6d08d1SOr Gerlitz {
5133f6d08d1SOr Gerlitz 	struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
5143f6d08d1SOr Gerlitz 	int tt;
5153f6d08d1SOr Gerlitz 
5163f6d08d1SOr Gerlitz 	memset(ttc_params, 0, sizeof(*ttc_params));
5173f6d08d1SOr Gerlitz 
5183f6d08d1SOr Gerlitz 	ttc_params->any_tt_tirn = hp->tirn;
5193f6d08d1SOr Gerlitz 
5203f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
5213f6d08d1SOr Gerlitz 		ttc_params->indir_tirn[tt] = hp->indir_tirn[tt];
5223f6d08d1SOr Gerlitz 
5233f6d08d1SOr Gerlitz 	ft_attr->max_fte = MLX5E_NUM_TT;
5243f6d08d1SOr Gerlitz 	ft_attr->level = MLX5E_TC_TTC_FT_LEVEL;
5253f6d08d1SOr Gerlitz 	ft_attr->prio = MLX5E_TC_PRIO;
5263f6d08d1SOr Gerlitz }
5273f6d08d1SOr Gerlitz 
5283f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp)
5293f6d08d1SOr Gerlitz {
5303f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
5313f6d08d1SOr Gerlitz 	struct ttc_params ttc_params;
5323f6d08d1SOr Gerlitz 	int err;
5333f6d08d1SOr Gerlitz 
5343f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_rqt(hp);
5353f6d08d1SOr Gerlitz 	if (err)
5363f6d08d1SOr Gerlitz 		return err;
5373f6d08d1SOr Gerlitz 
5383f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_tirs(hp);
5393f6d08d1SOr Gerlitz 	if (err)
5403f6d08d1SOr Gerlitz 		goto err_create_indirect_tirs;
5413f6d08d1SOr Gerlitz 
5423f6d08d1SOr Gerlitz 	mlx5e_hairpin_set_ttc_params(hp, &ttc_params);
5433f6d08d1SOr Gerlitz 	err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc);
5443f6d08d1SOr Gerlitz 	if (err)
5453f6d08d1SOr Gerlitz 		goto err_create_ttc_table;
5463f6d08d1SOr Gerlitz 
5473f6d08d1SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n",
5483f6d08d1SOr Gerlitz 		   hp->num_channels, hp->ttc.ft.t->id);
5493f6d08d1SOr Gerlitz 
5503f6d08d1SOr Gerlitz 	return 0;
5513f6d08d1SOr Gerlitz 
5523f6d08d1SOr Gerlitz err_create_ttc_table:
5533f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
5543f6d08d1SOr Gerlitz err_create_indirect_tirs:
5553f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
5563f6d08d1SOr Gerlitz 
5573f6d08d1SOr Gerlitz 	return err;
5583f6d08d1SOr Gerlitz }
5593f6d08d1SOr Gerlitz 
5603f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp)
5613f6d08d1SOr Gerlitz {
5623f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
5633f6d08d1SOr Gerlitz 
5643f6d08d1SOr Gerlitz 	mlx5e_destroy_ttc_table(priv, &hp->ttc);
5653f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
5663f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
5673f6d08d1SOr Gerlitz }
5683f6d08d1SOr Gerlitz 
56977ab67b7SOr Gerlitz static struct mlx5e_hairpin *
57077ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params,
57177ab67b7SOr Gerlitz 		     int peer_ifindex)
57277ab67b7SOr Gerlitz {
57377ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev, *peer_mdev;
57477ab67b7SOr Gerlitz 	struct mlx5e_hairpin *hp;
57577ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
57677ab67b7SOr Gerlitz 	int err;
57777ab67b7SOr Gerlitz 
57877ab67b7SOr Gerlitz 	hp = kzalloc(sizeof(*hp), GFP_KERNEL);
57977ab67b7SOr Gerlitz 	if (!hp)
58077ab67b7SOr Gerlitz 		return ERR_PTR(-ENOMEM);
58177ab67b7SOr Gerlitz 
58277ab67b7SOr Gerlitz 	func_mdev = priv->mdev;
58377ab67b7SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
58477ab67b7SOr Gerlitz 
58577ab67b7SOr Gerlitz 	pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params);
58677ab67b7SOr Gerlitz 	if (IS_ERR(pair)) {
58777ab67b7SOr Gerlitz 		err = PTR_ERR(pair);
58877ab67b7SOr Gerlitz 		goto create_pair_err;
58977ab67b7SOr Gerlitz 	}
59077ab67b7SOr Gerlitz 	hp->pair = pair;
59177ab67b7SOr Gerlitz 	hp->func_mdev = func_mdev;
5923f6d08d1SOr Gerlitz 	hp->func_priv = priv;
5933f6d08d1SOr Gerlitz 	hp->num_channels = params->num_channels;
59477ab67b7SOr Gerlitz 
59577ab67b7SOr Gerlitz 	err = mlx5e_hairpin_create_transport(hp);
59677ab67b7SOr Gerlitz 	if (err)
59777ab67b7SOr Gerlitz 		goto create_transport_err;
59877ab67b7SOr Gerlitz 
5993f6d08d1SOr Gerlitz 	if (hp->num_channels > 1) {
6003f6d08d1SOr Gerlitz 		err = mlx5e_hairpin_rss_init(hp);
6013f6d08d1SOr Gerlitz 		if (err)
6023f6d08d1SOr Gerlitz 			goto rss_init_err;
6033f6d08d1SOr Gerlitz 	}
6043f6d08d1SOr Gerlitz 
60577ab67b7SOr Gerlitz 	return hp;
60677ab67b7SOr Gerlitz 
6073f6d08d1SOr Gerlitz rss_init_err:
6083f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
60977ab67b7SOr Gerlitz create_transport_err:
61077ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
61177ab67b7SOr Gerlitz create_pair_err:
61277ab67b7SOr Gerlitz 	kfree(hp);
61377ab67b7SOr Gerlitz 	return ERR_PTR(err);
61477ab67b7SOr Gerlitz }
61577ab67b7SOr Gerlitz 
61677ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp)
61777ab67b7SOr Gerlitz {
6183f6d08d1SOr Gerlitz 	if (hp->num_channels > 1)
6193f6d08d1SOr Gerlitz 		mlx5e_hairpin_rss_cleanup(hp);
62077ab67b7SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
62177ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
62277ab67b7SOr Gerlitz 	kvfree(hp);
62377ab67b7SOr Gerlitz }
62477ab67b7SOr Gerlitz 
625106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio)
626106be53bSOr Gerlitz {
627106be53bSOr Gerlitz 	return (peer_vhca_id << 16 | prio);
628106be53bSOr Gerlitz }
629106be53bSOr Gerlitz 
6305c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv,
631106be53bSOr Gerlitz 						     u16 peer_vhca_id, u8 prio)
6325c65c564SOr Gerlitz {
6335c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
634106be53bSOr Gerlitz 	u32 hash_key = hash_hairpin_info(peer_vhca_id, prio);
6355c65c564SOr Gerlitz 
6365c65c564SOr Gerlitz 	hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe,
637106be53bSOr Gerlitz 			       hairpin_hlist, hash_key) {
638106be53bSOr Gerlitz 		if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio)
6395c65c564SOr Gerlitz 			return hpe;
6405c65c564SOr Gerlitz 	}
6415c65c564SOr Gerlitz 
6425c65c564SOr Gerlitz 	return NULL;
6435c65c564SOr Gerlitz }
6445c65c564SOr Gerlitz 
645106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8
646106be53bSOr Gerlitz 
647106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv,
648e98bedf5SEli Britstein 				  struct mlx5_flow_spec *spec, u8 *match_prio,
649e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
650106be53bSOr Gerlitz {
651106be53bSOr Gerlitz 	void *headers_c, *headers_v;
652106be53bSOr Gerlitz 	u8 prio_val, prio_mask = 0;
653106be53bSOr Gerlitz 	bool vlan_present;
654106be53bSOr Gerlitz 
655106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB
656106be53bSOr Gerlitz 	if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) {
657e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
658e98bedf5SEli Britstein 				   "only PCP trust state supported for hairpin");
659106be53bSOr Gerlitz 		return -EOPNOTSUPP;
660106be53bSOr Gerlitz 	}
661106be53bSOr Gerlitz #endif
662106be53bSOr Gerlitz 	headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers);
663106be53bSOr Gerlitz 	headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
664106be53bSOr Gerlitz 
665106be53bSOr Gerlitz 	vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag);
666106be53bSOr Gerlitz 	if (vlan_present) {
667106be53bSOr Gerlitz 		prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio);
668106be53bSOr Gerlitz 		prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio);
669106be53bSOr Gerlitz 	}
670106be53bSOr Gerlitz 
671106be53bSOr Gerlitz 	if (!vlan_present || !prio_mask) {
672106be53bSOr Gerlitz 		prio_val = UNKNOWN_MATCH_PRIO;
673106be53bSOr Gerlitz 	} else if (prio_mask != 0x7) {
674e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
675e98bedf5SEli Britstein 				   "masked priority match not supported for hairpin");
676106be53bSOr Gerlitz 		return -EOPNOTSUPP;
677106be53bSOr Gerlitz 	}
678106be53bSOr Gerlitz 
679106be53bSOr Gerlitz 	*match_prio = prio_val;
680106be53bSOr Gerlitz 	return 0;
681106be53bSOr Gerlitz }
682106be53bSOr Gerlitz 
6835c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv,
6845c65c564SOr Gerlitz 				  struct mlx5e_tc_flow *flow,
685e98bedf5SEli Britstein 				  struct mlx5e_tc_flow_parse_attr *parse_attr,
686e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
6875c65c564SOr Gerlitz {
68898b66cb1SEli Britstein 	int peer_ifindex = parse_attr->mirred_ifindex[0];
6895c65c564SOr Gerlitz 	struct mlx5_hairpin_params params;
690d8822868SOr Gerlitz 	struct mlx5_core_dev *peer_mdev;
6915c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
6925c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
6933f6d08d1SOr Gerlitz 	u64 link_speed64;
6943f6d08d1SOr Gerlitz 	u32 link_speed;
695106be53bSOr Gerlitz 	u8 match_prio;
696d8822868SOr Gerlitz 	u16 peer_id;
6975c65c564SOr Gerlitz 	int err;
6985c65c564SOr Gerlitz 
699d8822868SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
700d8822868SOr Gerlitz 	if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) {
701e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported");
7025c65c564SOr Gerlitz 		return -EOPNOTSUPP;
7035c65c564SOr Gerlitz 	}
7045c65c564SOr Gerlitz 
705d8822868SOr Gerlitz 	peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
706e98bedf5SEli Britstein 	err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio,
707e98bedf5SEli Britstein 				     extack);
708106be53bSOr Gerlitz 	if (err)
709106be53bSOr Gerlitz 		return err;
710106be53bSOr Gerlitz 	hpe = mlx5e_hairpin_get(priv, peer_id, match_prio);
7115c65c564SOr Gerlitz 	if (hpe)
7125c65c564SOr Gerlitz 		goto attach_flow;
7135c65c564SOr Gerlitz 
7145c65c564SOr Gerlitz 	hpe = kzalloc(sizeof(*hpe), GFP_KERNEL);
7155c65c564SOr Gerlitz 	if (!hpe)
7165c65c564SOr Gerlitz 		return -ENOMEM;
7175c65c564SOr Gerlitz 
7185c65c564SOr Gerlitz 	INIT_LIST_HEAD(&hpe->flows);
719d8822868SOr Gerlitz 	hpe->peer_vhca_id = peer_id;
720106be53bSOr Gerlitz 	hpe->prio = match_prio;
7215c65c564SOr Gerlitz 
7225c65c564SOr Gerlitz 	params.log_data_size = 15;
7235c65c564SOr Gerlitz 	params.log_data_size = min_t(u8, params.log_data_size,
7245c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz));
7255c65c564SOr Gerlitz 	params.log_data_size = max_t(u8, params.log_data_size,
7265c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz));
7275c65c564SOr Gerlitz 
728eb9180f7SOr Gerlitz 	params.log_num_packets = params.log_data_size -
729eb9180f7SOr Gerlitz 				 MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev);
730eb9180f7SOr Gerlitz 	params.log_num_packets = min_t(u8, params.log_num_packets,
731eb9180f7SOr Gerlitz 				       MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets));
732eb9180f7SOr Gerlitz 
733eb9180f7SOr Gerlitz 	params.q_counter = priv->q_counter;
7343f6d08d1SOr Gerlitz 	/* set hairpin pair per each 50Gbs share of the link */
7352c81bfd5SHuy Nguyen 	mlx5e_port_max_linkspeed(priv->mdev, &link_speed);
7363f6d08d1SOr Gerlitz 	link_speed = max_t(u32, link_speed, 50000);
7373f6d08d1SOr Gerlitz 	link_speed64 = link_speed;
7383f6d08d1SOr Gerlitz 	do_div(link_speed64, 50000);
7393f6d08d1SOr Gerlitz 	params.num_channels = link_speed64;
7403f6d08d1SOr Gerlitz 
7415c65c564SOr Gerlitz 	hp = mlx5e_hairpin_create(priv, &params, peer_ifindex);
7425c65c564SOr Gerlitz 	if (IS_ERR(hp)) {
7435c65c564SOr Gerlitz 		err = PTR_ERR(hp);
7445c65c564SOr Gerlitz 		goto create_hairpin_err;
7455c65c564SOr Gerlitz 	}
7465c65c564SOr Gerlitz 
747eb9180f7SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n",
74827b942fbSParav Pandit 		   hp->tirn, hp->pair->rqn[0],
74927b942fbSParav Pandit 		   dev_name(hp->pair->peer_mdev->device),
750eb9180f7SOr Gerlitz 		   hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets);
7515c65c564SOr Gerlitz 
7525c65c564SOr Gerlitz 	hpe->hp = hp;
753106be53bSOr Gerlitz 	hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist,
754106be53bSOr Gerlitz 		 hash_hairpin_info(peer_id, match_prio));
7555c65c564SOr Gerlitz 
7565c65c564SOr Gerlitz attach_flow:
7573f6d08d1SOr Gerlitz 	if (hpe->hp->num_channels > 1) {
758226f2ca3SVlad Buslov 		flow_flag_set(flow, HAIRPIN_RSS);
7593f6d08d1SOr Gerlitz 		flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t;
7603f6d08d1SOr Gerlitz 	} else {
7615c65c564SOr Gerlitz 		flow->nic_attr->hairpin_tirn = hpe->hp->tirn;
7623f6d08d1SOr Gerlitz 	}
7635c65c564SOr Gerlitz 	list_add(&flow->hairpin, &hpe->flows);
7643f6d08d1SOr Gerlitz 
7655c65c564SOr Gerlitz 	return 0;
7665c65c564SOr Gerlitz 
7675c65c564SOr Gerlitz create_hairpin_err:
7685c65c564SOr Gerlitz 	kfree(hpe);
7695c65c564SOr Gerlitz 	return err;
7705c65c564SOr Gerlitz }
7715c65c564SOr Gerlitz 
7725c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv,
7735c65c564SOr Gerlitz 				   struct mlx5e_tc_flow *flow)
7745c65c564SOr Gerlitz {
7755c65c564SOr Gerlitz 	struct list_head *next = flow->hairpin.next;
7765c65c564SOr Gerlitz 
7775a7e5bcbSVlad Buslov 	/* flow wasn't fully initialized */
7785a7e5bcbSVlad Buslov 	if (list_empty(&flow->hairpin))
7795a7e5bcbSVlad Buslov 		return;
7805a7e5bcbSVlad Buslov 
7815c65c564SOr Gerlitz 	list_del(&flow->hairpin);
7825c65c564SOr Gerlitz 
7835c65c564SOr Gerlitz 	/* no more hairpin flows for us, release the hairpin pair */
7845c65c564SOr Gerlitz 	if (list_empty(next)) {
7855c65c564SOr Gerlitz 		struct mlx5e_hairpin_entry *hpe;
7865c65c564SOr Gerlitz 
7875c65c564SOr Gerlitz 		hpe = list_entry(next, struct mlx5e_hairpin_entry, flows);
7885c65c564SOr Gerlitz 
7895c65c564SOr Gerlitz 		netdev_dbg(priv->netdev, "del hairpin: peer %s\n",
79027b942fbSParav Pandit 			   dev_name(hpe->hp->pair->peer_mdev->device));
7915c65c564SOr Gerlitz 
7925c65c564SOr Gerlitz 		mlx5e_hairpin_destroy(hpe->hp);
7935c65c564SOr Gerlitz 		hash_del(&hpe->hairpin_hlist);
7945c65c564SOr Gerlitz 		kfree(hpe);
7955c65c564SOr Gerlitz 	}
7965c65c564SOr Gerlitz }
7975c65c564SOr Gerlitz 
798c83954abSRabie Loulou static int
79974491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv,
80017091853SOr Gerlitz 		      struct mlx5e_tc_flow_parse_attr *parse_attr,
801e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
802e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
803e8f887acSAmir Vadai {
804bb0ee7dcSJianbo Liu 	struct mlx5_flow_context *flow_context = &parse_attr->spec.flow_context;
805aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
806aad7e08dSAmir Vadai 	struct mlx5_core_dev *dev = priv->mdev;
8075c65c564SOr Gerlitz 	struct mlx5_flow_destination dest[2] = {};
80866958ed9SHadar Hen Zion 	struct mlx5_flow_act flow_act = {
8093bc4b7bfSOr Gerlitz 		.action = attr->action,
81060786f09SMark Bloch 		.reformat_id = 0,
811bb0ee7dcSJianbo Liu 		.flags    = FLOW_ACT_NO_APPEND,
81266958ed9SHadar Hen Zion 	};
813aad7e08dSAmir Vadai 	struct mlx5_fc *counter = NULL;
8145c65c564SOr Gerlitz 	int err, dest_ix = 0;
815e8f887acSAmir Vadai 
816bb0ee7dcSJianbo Liu 	flow_context->flags |= FLOW_CONTEXT_HAS_TAG;
817bb0ee7dcSJianbo Liu 	flow_context->flow_tag = attr->flow_tag;
818bb0ee7dcSJianbo Liu 
819226f2ca3SVlad Buslov 	if (flow_flag_test(flow, HAIRPIN)) {
820e98bedf5SEli Britstein 		err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack);
8215a7e5bcbSVlad Buslov 		if (err)
8225a7e5bcbSVlad Buslov 			return err;
8235a7e5bcbSVlad Buslov 
824226f2ca3SVlad Buslov 		if (flow_flag_test(flow, HAIRPIN_RSS)) {
8253f6d08d1SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
8263f6d08d1SOr Gerlitz 			dest[dest_ix].ft = attr->hairpin_ft;
8273f6d08d1SOr Gerlitz 		} else {
8285c65c564SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR;
8295c65c564SOr Gerlitz 			dest[dest_ix].tir_num = attr->hairpin_tirn;
8303f6d08d1SOr Gerlitz 		}
8313f6d08d1SOr Gerlitz 		dest_ix++;
8323f6d08d1SOr Gerlitz 	} else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
8335c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
8345c65c564SOr Gerlitz 		dest[dest_ix].ft = priv->fs.vlan.ft.t;
8355c65c564SOr Gerlitz 		dest_ix++;
8365c65c564SOr Gerlitz 	}
837aad7e08dSAmir Vadai 
8385c65c564SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
8395c65c564SOr Gerlitz 		counter = mlx5_fc_create(dev, true);
8405a7e5bcbSVlad Buslov 		if (IS_ERR(counter))
8415a7e5bcbSVlad Buslov 			return PTR_ERR(counter);
8425a7e5bcbSVlad Buslov 
8435c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
844171c7625SMark Bloch 		dest[dest_ix].counter_id = mlx5_fc_id(counter);
8455c65c564SOr Gerlitz 		dest_ix++;
846b8aee822SMark Bloch 		attr->counter = counter;
847aad7e08dSAmir Vadai 	}
848aad7e08dSAmir Vadai 
8492f4fe4caSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
8503099eb5aSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
851d7e75a32SOr Gerlitz 		flow_act.modify_id = attr->mod_hdr_id;
8522f4fe4caSOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
853c83954abSRabie Loulou 		if (err)
8545a7e5bcbSVlad Buslov 			return err;
8552f4fe4caSOr Gerlitz 	}
8562f4fe4caSOr Gerlitz 
857b6fac0b4SVlad Buslov 	mutex_lock(&priv->fs.tc.t_lock);
858acff797cSMaor Gottlieb 	if (IS_ERR_OR_NULL(priv->fs.tc.t)) {
85921b9c144SOr Gerlitz 		int tc_grp_size, tc_tbl_size;
86021b9c144SOr Gerlitz 		u32 max_flow_counter;
86121b9c144SOr Gerlitz 
86221b9c144SOr Gerlitz 		max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) |
86321b9c144SOr Gerlitz 				    MLX5_CAP_GEN(dev, max_flow_counter_15_0);
86421b9c144SOr Gerlitz 
86521b9c144SOr Gerlitz 		tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE);
86621b9c144SOr Gerlitz 
86721b9c144SOr Gerlitz 		tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS,
86821b9c144SOr Gerlitz 				    BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size)));
86921b9c144SOr Gerlitz 
870acff797cSMaor Gottlieb 		priv->fs.tc.t =
871acff797cSMaor Gottlieb 			mlx5_create_auto_grouped_flow_table(priv->fs.ns,
872acff797cSMaor Gottlieb 							    MLX5E_TC_PRIO,
87321b9c144SOr Gerlitz 							    tc_tbl_size,
874acff797cSMaor Gottlieb 							    MLX5E_TC_TABLE_NUM_GROUPS,
8753f6d08d1SOr Gerlitz 							    MLX5E_TC_FT_LEVEL, 0);
876acff797cSMaor Gottlieb 		if (IS_ERR(priv->fs.tc.t)) {
877b6fac0b4SVlad Buslov 			mutex_unlock(&priv->fs.tc.t_lock);
878e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
879e98bedf5SEli Britstein 					   "Failed to create tc offload table\n");
880e8f887acSAmir Vadai 			netdev_err(priv->netdev,
881e8f887acSAmir Vadai 				   "Failed to create tc offload table\n");
8825a7e5bcbSVlad Buslov 			return PTR_ERR(priv->fs.tc.t);
883e8f887acSAmir Vadai 		}
884e8f887acSAmir Vadai 	}
885e8f887acSAmir Vadai 
88638aa51c1SOr Gerlitz 	if (attr->match_level != MLX5_MATCH_NONE)
887d4a18e16SYevgeny Kliteynik 		parse_attr->spec.match_criteria_enable |= MLX5_MATCH_OUTER_HEADERS;
88838aa51c1SOr Gerlitz 
889c83954abSRabie Loulou 	flow->rule[0] = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec,
8905c65c564SOr Gerlitz 					    &flow_act, dest, dest_ix);
891b6fac0b4SVlad Buslov 	mutex_unlock(&priv->fs.tc.t_lock);
892e8f887acSAmir Vadai 
8935a7e5bcbSVlad Buslov 	if (IS_ERR(flow->rule[0]))
8945a7e5bcbSVlad Buslov 		return PTR_ERR(flow->rule[0]);
895aad7e08dSAmir Vadai 
896c83954abSRabie Loulou 	return 0;
897e8f887acSAmir Vadai }
898e8f887acSAmir Vadai 
899d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv,
900d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
901d85cdccbSOr Gerlitz {
902513f8f7fSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
903d85cdccbSOr Gerlitz 	struct mlx5_fc *counter = NULL;
904d85cdccbSOr Gerlitz 
905b8aee822SMark Bloch 	counter = attr->counter;
9065a7e5bcbSVlad Buslov 	if (!IS_ERR_OR_NULL(flow->rule[0]))
907e4ad91f2SChris Mi 		mlx5_del_flow_rules(flow->rule[0]);
908d85cdccbSOr Gerlitz 	mlx5_fc_destroy(priv->mdev, counter);
909d85cdccbSOr Gerlitz 
910b6fac0b4SVlad Buslov 	mutex_lock(&priv->fs.tc.t_lock);
911226f2ca3SVlad Buslov 	if (!mlx5e_tc_num_filters(priv, MLX5_TC_FLAG(NIC_OFFLOAD)) && priv->fs.tc.t) {
912d85cdccbSOr Gerlitz 		mlx5_destroy_flow_table(priv->fs.tc.t);
913d85cdccbSOr Gerlitz 		priv->fs.tc.t = NULL;
914d85cdccbSOr Gerlitz 	}
915b6fac0b4SVlad Buslov 	mutex_unlock(&priv->fs.tc.t_lock);
9162f4fe4caSOr Gerlitz 
917513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
9183099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
9195c65c564SOr Gerlitz 
920226f2ca3SVlad Buslov 	if (flow_flag_test(flow, HAIRPIN))
9215c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
922d85cdccbSOr Gerlitz }
923d85cdccbSOr Gerlitz 
924aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
9258c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index);
926aa0cbbaeSOr Gerlitz 
9273c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv,
928e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
929733d4f36SRoi Dayan 			      struct net_device *mirred_dev,
930733d4f36SRoi Dayan 			      int out_index,
9318c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
9320ad060eeSRoi Dayan 			      struct net_device **encap_dev,
9330ad060eeSRoi Dayan 			      bool *encap_valid);
9343c37745eSOr Gerlitz 
9356d2a3ed0SOr Gerlitz static struct mlx5_flow_handle *
9366d2a3ed0SOr Gerlitz mlx5e_tc_offload_fdb_rules(struct mlx5_eswitch *esw,
9376d2a3ed0SOr Gerlitz 			   struct mlx5e_tc_flow *flow,
9386d2a3ed0SOr Gerlitz 			   struct mlx5_flow_spec *spec,
9396d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
9406d2a3ed0SOr Gerlitz {
9416d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
9426d2a3ed0SOr Gerlitz 
9436d2a3ed0SOr Gerlitz 	rule = mlx5_eswitch_add_offloaded_rule(esw, spec, attr);
9446d2a3ed0SOr Gerlitz 	if (IS_ERR(rule))
9456d2a3ed0SOr Gerlitz 		return rule;
9466d2a3ed0SOr Gerlitz 
947e85e02baSEli Britstein 	if (attr->split_count) {
9486d2a3ed0SOr Gerlitz 		flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, spec, attr);
9496d2a3ed0SOr Gerlitz 		if (IS_ERR(flow->rule[1])) {
9506d2a3ed0SOr Gerlitz 			mlx5_eswitch_del_offloaded_rule(esw, rule, attr);
9516d2a3ed0SOr Gerlitz 			return flow->rule[1];
9526d2a3ed0SOr Gerlitz 		}
9536d2a3ed0SOr Gerlitz 	}
9546d2a3ed0SOr Gerlitz 
9556d2a3ed0SOr Gerlitz 	return rule;
9566d2a3ed0SOr Gerlitz }
9576d2a3ed0SOr Gerlitz 
9586d2a3ed0SOr Gerlitz static void
9596d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(struct mlx5_eswitch *esw,
9606d2a3ed0SOr Gerlitz 			     struct mlx5e_tc_flow *flow,
9616d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
9626d2a3ed0SOr Gerlitz {
963226f2ca3SVlad Buslov 	flow_flag_clear(flow, OFFLOADED);
9646d2a3ed0SOr Gerlitz 
965e85e02baSEli Britstein 	if (attr->split_count)
9666d2a3ed0SOr Gerlitz 		mlx5_eswitch_del_fwd_rule(esw, flow->rule[1], attr);
9676d2a3ed0SOr Gerlitz 
9686d2a3ed0SOr Gerlitz 	mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr);
9696d2a3ed0SOr Gerlitz }
9706d2a3ed0SOr Gerlitz 
9715dbe906fSPaul Blakey static struct mlx5_flow_handle *
9725dbe906fSPaul Blakey mlx5e_tc_offload_to_slow_path(struct mlx5_eswitch *esw,
9735dbe906fSPaul Blakey 			      struct mlx5e_tc_flow *flow,
9745dbe906fSPaul Blakey 			      struct mlx5_flow_spec *spec,
9755dbe906fSPaul Blakey 			      struct mlx5_esw_flow_attr *slow_attr)
9765dbe906fSPaul Blakey {
9775dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
9785dbe906fSPaul Blakey 
9795dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
980154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9812be09de7SDavid S. Miller 	slow_attr->split_count = 0;
982154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
9835dbe906fSPaul Blakey 
9845dbe906fSPaul Blakey 	rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, slow_attr);
9855dbe906fSPaul Blakey 	if (!IS_ERR(rule))
986226f2ca3SVlad Buslov 		flow_flag_set(flow, SLOW);
9875dbe906fSPaul Blakey 
9885dbe906fSPaul Blakey 	return rule;
9895dbe906fSPaul Blakey }
9905dbe906fSPaul Blakey 
9915dbe906fSPaul Blakey static void
9925dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(struct mlx5_eswitch *esw,
9935dbe906fSPaul Blakey 				  struct mlx5e_tc_flow *flow,
9945dbe906fSPaul Blakey 				  struct mlx5_esw_flow_attr *slow_attr)
9955dbe906fSPaul Blakey {
9965dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
997154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9982be09de7SDavid S. Miller 	slow_attr->split_count = 0;
999154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
10005dbe906fSPaul Blakey 	mlx5e_tc_unoffload_fdb_rules(esw, flow, slow_attr);
1001226f2ca3SVlad Buslov 	flow_flag_clear(flow, SLOW);
10025dbe906fSPaul Blakey }
10035dbe906fSPaul Blakey 
1004ad86755bSVlad Buslov /* Caller must obtain uplink_priv->unready_flows_lock mutex before calling this
1005ad86755bSVlad Buslov  * function.
1006ad86755bSVlad Buslov  */
1007ad86755bSVlad Buslov static void unready_flow_add(struct mlx5e_tc_flow *flow,
1008ad86755bSVlad Buslov 			     struct list_head *unready_flows)
1009ad86755bSVlad Buslov {
1010ad86755bSVlad Buslov 	flow_flag_set(flow, NOT_READY);
1011ad86755bSVlad Buslov 	list_add_tail(&flow->unready, unready_flows);
1012ad86755bSVlad Buslov }
1013ad86755bSVlad Buslov 
1014ad86755bSVlad Buslov /* Caller must obtain uplink_priv->unready_flows_lock mutex before calling this
1015ad86755bSVlad Buslov  * function.
1016ad86755bSVlad Buslov  */
1017ad86755bSVlad Buslov static void unready_flow_del(struct mlx5e_tc_flow *flow)
1018ad86755bSVlad Buslov {
1019ad86755bSVlad Buslov 	list_del(&flow->unready);
1020ad86755bSVlad Buslov 	flow_flag_clear(flow, NOT_READY);
1021ad86755bSVlad Buslov }
1022ad86755bSVlad Buslov 
1023b4a23329SRoi Dayan static void add_unready_flow(struct mlx5e_tc_flow *flow)
1024b4a23329SRoi Dayan {
1025b4a23329SRoi Dayan 	struct mlx5_rep_uplink_priv *uplink_priv;
1026b4a23329SRoi Dayan 	struct mlx5e_rep_priv *rpriv;
1027b4a23329SRoi Dayan 	struct mlx5_eswitch *esw;
1028b4a23329SRoi Dayan 
1029b4a23329SRoi Dayan 	esw = flow->priv->mdev->priv.eswitch;
1030b4a23329SRoi Dayan 	rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
1031b4a23329SRoi Dayan 	uplink_priv = &rpriv->uplink_priv;
1032b4a23329SRoi Dayan 
1033ad86755bSVlad Buslov 	mutex_lock(&uplink_priv->unready_flows_lock);
1034ad86755bSVlad Buslov 	unready_flow_add(flow, &uplink_priv->unready_flows);
1035ad86755bSVlad Buslov 	mutex_unlock(&uplink_priv->unready_flows_lock);
1036b4a23329SRoi Dayan }
1037b4a23329SRoi Dayan 
1038b4a23329SRoi Dayan static void remove_unready_flow(struct mlx5e_tc_flow *flow)
1039b4a23329SRoi Dayan {
1040ad86755bSVlad Buslov 	struct mlx5_rep_uplink_priv *uplink_priv;
1041ad86755bSVlad Buslov 	struct mlx5e_rep_priv *rpriv;
1042ad86755bSVlad Buslov 	struct mlx5_eswitch *esw;
1043ad86755bSVlad Buslov 
1044ad86755bSVlad Buslov 	esw = flow->priv->mdev->priv.eswitch;
1045ad86755bSVlad Buslov 	rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
1046ad86755bSVlad Buslov 	uplink_priv = &rpriv->uplink_priv;
1047ad86755bSVlad Buslov 
1048ad86755bSVlad Buslov 	mutex_lock(&uplink_priv->unready_flows_lock);
1049ad86755bSVlad Buslov 	unready_flow_del(flow);
1050ad86755bSVlad Buslov 	mutex_unlock(&uplink_priv->unready_flows_lock);
1051b4a23329SRoi Dayan }
1052b4a23329SRoi Dayan 
1053c83954abSRabie Loulou static int
105474491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv,
1055e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
1056e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
1057adb4c123SOr Gerlitz {
1058adb4c123SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
1059bf07aa73SPaul Blakey 	u32 max_chain = mlx5_eswitch_get_chain_range(esw);
1060aa0cbbaeSOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
10617040632dSTonghao Zhang 	struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr;
1062bf07aa73SPaul Blakey 	u16 max_prio = mlx5_eswitch_get_prio_range(esw);
10633c37745eSOr Gerlitz 	struct net_device *out_dev, *encap_dev = NULL;
1064b8aee822SMark Bloch 	struct mlx5_fc *counter = NULL;
10653c37745eSOr Gerlitz 	struct mlx5e_rep_priv *rpriv;
10663c37745eSOr Gerlitz 	struct mlx5e_priv *out_priv;
10670ad060eeSRoi Dayan 	bool encap_valid = true;
10680ad060eeSRoi Dayan 	int err = 0;
1069f493f155SEli Britstein 	int out_index;
10708b32580dSOr Gerlitz 
1071d14f6f2aSOr Gerlitz 	if (!mlx5_eswitch_prios_supported(esw) && attr->prio != 1) {
1072d14f6f2aSOr Gerlitz 		NL_SET_ERR_MSG(extack, "E-switch priorities unsupported, upgrade FW");
1073d14f6f2aSOr Gerlitz 		return -EOPNOTSUPP;
1074d14f6f2aSOr Gerlitz 	}
1075e52c2802SPaul Blakey 
1076bf07aa73SPaul Blakey 	if (attr->chain > max_chain) {
1077bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested chain is out of supported range");
10785a7e5bcbSVlad Buslov 		return -EOPNOTSUPP;
1079bf07aa73SPaul Blakey 	}
1080bf07aa73SPaul Blakey 
1081bf07aa73SPaul Blakey 	if (attr->prio > max_prio) {
1082bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested priority is out of supported range");
10835a7e5bcbSVlad Buslov 		return -EOPNOTSUPP;
1084bf07aa73SPaul Blakey 	}
1085bf07aa73SPaul Blakey 
1086f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) {
10878c4dc42bSEli Britstein 		int mirred_ifindex;
10888c4dc42bSEli Britstein 
1089f493f155SEli Britstein 		if (!(attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP))
1090f493f155SEli Britstein 			continue;
1091f493f155SEli Britstein 
10927040632dSTonghao Zhang 		mirred_ifindex = parse_attr->mirred_ifindex[out_index];
10933c37745eSOr Gerlitz 		out_dev = __dev_get_by_index(dev_net(priv->netdev),
10948c4dc42bSEli Britstein 					     mirred_ifindex);
1095733d4f36SRoi Dayan 		err = mlx5e_attach_encap(priv, flow, out_dev, out_index,
10960ad060eeSRoi Dayan 					 extack, &encap_dev, &encap_valid);
10970ad060eeSRoi Dayan 		if (err)
10985a7e5bcbSVlad Buslov 			return err;
10990ad060eeSRoi Dayan 
11003c37745eSOr Gerlitz 		out_priv = netdev_priv(encap_dev);
11013c37745eSOr Gerlitz 		rpriv = out_priv->ppriv;
11021cc26d74SEli Britstein 		attr->dests[out_index].rep = rpriv->rep;
11031cc26d74SEli Britstein 		attr->dests[out_index].mdev = out_priv->mdev;
11043c37745eSOr Gerlitz 	}
11053c37745eSOr Gerlitz 
11068b32580dSOr Gerlitz 	err = mlx5_eswitch_add_vlan_action(esw, attr);
1107c83954abSRabie Loulou 	if (err)
11085a7e5bcbSVlad Buslov 		return err;
1109adb4c123SOr Gerlitz 
1110d7e75a32SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
11111a9527bbSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
1112d7e75a32SOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
1113c83954abSRabie Loulou 		if (err)
11145a7e5bcbSVlad Buslov 			return err;
1115d7e75a32SOr Gerlitz 	}
1116d7e75a32SOr Gerlitz 
1117b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
1118f9392795SShahar Klein 		counter = mlx5_fc_create(attr->counter_dev, true);
11195a7e5bcbSVlad Buslov 		if (IS_ERR(counter))
11205a7e5bcbSVlad Buslov 			return PTR_ERR(counter);
1121b8aee822SMark Bloch 
1122b8aee822SMark Bloch 		attr->counter = counter;
1123b8aee822SMark Bloch 	}
1124b8aee822SMark Bloch 
11250ad060eeSRoi Dayan 	/* we get here if one of the following takes place:
11260ad060eeSRoi Dayan 	 * (1) there's no error
11270ad060eeSRoi Dayan 	 * (2) there's an encap action and we don't have valid neigh
11283c37745eSOr Gerlitz 	 */
11290ad060eeSRoi Dayan 	if (!encap_valid) {
11305dbe906fSPaul Blakey 		/* continue with goto slow path rule instead */
11315dbe906fSPaul Blakey 		struct mlx5_esw_flow_attr slow_attr;
11325dbe906fSPaul Blakey 
11335dbe906fSPaul Blakey 		flow->rule[0] = mlx5e_tc_offload_to_slow_path(esw, flow, &parse_attr->spec, &slow_attr);
11345dbe906fSPaul Blakey 	} else {
11356d2a3ed0SOr Gerlitz 		flow->rule[0] = mlx5e_tc_offload_fdb_rules(esw, flow, &parse_attr->spec, attr);
11365dbe906fSPaul Blakey 	}
11375dbe906fSPaul Blakey 
11385a7e5bcbSVlad Buslov 	if (IS_ERR(flow->rule[0]))
11395a7e5bcbSVlad Buslov 		return PTR_ERR(flow->rule[0]);
1140226f2ca3SVlad Buslov 	else
1141226f2ca3SVlad Buslov 		flow_flag_set(flow, OFFLOADED);
1142c83954abSRabie Loulou 
11435dbe906fSPaul Blakey 	return 0;
1144aa0cbbaeSOr Gerlitz }
1145d85cdccbSOr Gerlitz 
11469272e3dfSYevgeny Kliteynik static bool mlx5_flow_has_geneve_opt(struct mlx5e_tc_flow *flow)
11479272e3dfSYevgeny Kliteynik {
11489272e3dfSYevgeny Kliteynik 	struct mlx5_flow_spec *spec = &flow->esw_attr->parse_attr->spec;
11499272e3dfSYevgeny Kliteynik 	void *headers_v = MLX5_ADDR_OF(fte_match_param,
11509272e3dfSYevgeny Kliteynik 				       spec->match_value,
11519272e3dfSYevgeny Kliteynik 				       misc_parameters_3);
11529272e3dfSYevgeny Kliteynik 	u32 geneve_tlv_opt_0_data = MLX5_GET(fte_match_set_misc3,
11539272e3dfSYevgeny Kliteynik 					     headers_v,
11549272e3dfSYevgeny Kliteynik 					     geneve_tlv_option_0_data);
11559272e3dfSYevgeny Kliteynik 
11569272e3dfSYevgeny Kliteynik 	return !!geneve_tlv_opt_0_data;
11579272e3dfSYevgeny Kliteynik }
11589272e3dfSYevgeny Kliteynik 
1159d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv,
1160d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
1161d85cdccbSOr Gerlitz {
1162d85cdccbSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
1163d7e75a32SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
11645dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
1165f493f155SEli Britstein 	int out_index;
1166d85cdccbSOr Gerlitz 
1167226f2ca3SVlad Buslov 	if (flow_flag_test(flow, NOT_READY)) {
1168b4a23329SRoi Dayan 		remove_unready_flow(flow);
1169ef06c9eeSRoi Dayan 		kvfree(attr->parse_attr);
1170ef06c9eeSRoi Dayan 		return;
1171ef06c9eeSRoi Dayan 	}
1172ef06c9eeSRoi Dayan 
1173226f2ca3SVlad Buslov 	if (mlx5e_is_offloaded_flow(flow)) {
1174226f2ca3SVlad Buslov 		if (flow_flag_test(flow, SLOW))
11755dbe906fSPaul Blakey 			mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
11765dbe906fSPaul Blakey 		else
11775dbe906fSPaul Blakey 			mlx5e_tc_unoffload_fdb_rules(esw, flow, attr);
11785dbe906fSPaul Blakey 	}
1179d85cdccbSOr Gerlitz 
11809272e3dfSYevgeny Kliteynik 	if (mlx5_flow_has_geneve_opt(flow))
11819272e3dfSYevgeny Kliteynik 		mlx5_geneve_tlv_option_del(priv->mdev->geneve);
11829272e3dfSYevgeny Kliteynik 
1183513f8f7fSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1184d85cdccbSOr Gerlitz 
1185f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
11868c4dc42bSEli Britstein 		if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)
11878c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
1188f493f155SEli Britstein 	kvfree(attr->parse_attr);
1189d7e75a32SOr Gerlitz 
1190513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
11911a9527bbSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
1192b8aee822SMark Bloch 
1193b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT)
1194f9392795SShahar Klein 		mlx5_fc_destroy(attr->counter_dev, attr->counter);
1195d85cdccbSOr Gerlitz }
1196d85cdccbSOr Gerlitz 
1197232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv,
1198232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1199232c0013SHadar Hen Zion {
12003c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
12015dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr, *esw_attr;
12025a7e5bcbSVlad Buslov 	struct encap_flow_item *efi, *tmp;
12036d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
12046d2a3ed0SOr Gerlitz 	struct mlx5_flow_spec *spec;
1205232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1206232c0013SHadar Hen Zion 	int err;
1207232c0013SHadar Hen Zion 
120854c177caSOz Shlomo 	err = mlx5_packet_reformat_alloc(priv->mdev,
120954c177caSOz Shlomo 					 e->reformat_type,
1210232c0013SHadar Hen Zion 					 e->encap_size, e->encap_header,
121131ca3648SMark Bloch 					 MLX5_FLOW_NAMESPACE_FDB,
1212232c0013SHadar Hen Zion 					 &e->encap_id);
1213232c0013SHadar Hen Zion 	if (err) {
1214232c0013SHadar Hen Zion 		mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n",
1215232c0013SHadar Hen Zion 			       err);
1216232c0013SHadar Hen Zion 		return;
1217232c0013SHadar Hen Zion 	}
1218232c0013SHadar Hen Zion 	e->flags |= MLX5_ENCAP_ENTRY_VALID;
1219f6dfb4c3SHadar Hen Zion 	mlx5e_rep_queue_neigh_stats_work(priv);
1220232c0013SHadar Hen Zion 
12215a7e5bcbSVlad Buslov 	list_for_each_entry_safe(efi, tmp, &e->flows, list) {
12228c4dc42bSEli Britstein 		bool all_flow_encaps_valid = true;
12238c4dc42bSEli Britstein 		int i;
12248c4dc42bSEli Britstein 
122579baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
12265a7e5bcbSVlad Buslov 		if (IS_ERR(mlx5e_flow_get(flow)))
12275a7e5bcbSVlad Buslov 			continue;
12285a7e5bcbSVlad Buslov 
12293c37745eSOr Gerlitz 		esw_attr = flow->esw_attr;
12306d2a3ed0SOr Gerlitz 		spec = &esw_attr->parse_attr->spec;
12316d2a3ed0SOr Gerlitz 
12328c4dc42bSEli Britstein 		esw_attr->dests[efi->index].encap_id = e->encap_id;
12338c4dc42bSEli Britstein 		esw_attr->dests[efi->index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
12348c4dc42bSEli Britstein 		/* Flow can be associated with multiple encap entries.
12358c4dc42bSEli Britstein 		 * Before offloading the flow verify that all of them have
12368c4dc42bSEli Britstein 		 * a valid neighbour.
12378c4dc42bSEli Britstein 		 */
12388c4dc42bSEli Britstein 		for (i = 0; i < MLX5_MAX_FLOW_FWD_VPORTS; i++) {
12398c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP))
12408c4dc42bSEli Britstein 				continue;
12418c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP_VALID)) {
12428c4dc42bSEli Britstein 				all_flow_encaps_valid = false;
12438c4dc42bSEli Britstein 				break;
12448c4dc42bSEli Britstein 			}
12458c4dc42bSEli Britstein 		}
12468c4dc42bSEli Britstein 		/* Do not offload flows with unresolved neighbors */
12478c4dc42bSEli Britstein 		if (!all_flow_encaps_valid)
12485a7e5bcbSVlad Buslov 			goto loop_cont;
12495dbe906fSPaul Blakey 		/* update from slow path rule to encap rule */
12506d2a3ed0SOr Gerlitz 		rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, esw_attr);
12516d2a3ed0SOr Gerlitz 		if (IS_ERR(rule)) {
12526d2a3ed0SOr Gerlitz 			err = PTR_ERR(rule);
1253232c0013SHadar Hen Zion 			mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n",
1254232c0013SHadar Hen Zion 				       err);
12555a7e5bcbSVlad Buslov 			goto loop_cont;
1256232c0013SHadar Hen Zion 		}
12575dbe906fSPaul Blakey 
12585dbe906fSPaul Blakey 		mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
12596d2a3ed0SOr Gerlitz 		flow->rule[0] = rule;
1260226f2ca3SVlad Buslov 		/* was unset when slow path rule removed */
1261226f2ca3SVlad Buslov 		flow_flag_set(flow, OFFLOADED);
12625a7e5bcbSVlad Buslov 
12635a7e5bcbSVlad Buslov loop_cont:
12645a7e5bcbSVlad Buslov 		mlx5e_flow_put(priv, flow);
1265232c0013SHadar Hen Zion 	}
1266232c0013SHadar Hen Zion }
1267232c0013SHadar Hen Zion 
1268232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv,
1269232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1270232c0013SHadar Hen Zion {
12713c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
12725dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
12735a7e5bcbSVlad Buslov 	struct encap_flow_item *efi, *tmp;
12745dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
12755dbe906fSPaul Blakey 	struct mlx5_flow_spec *spec;
1276232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
12775dbe906fSPaul Blakey 	int err;
1278232c0013SHadar Hen Zion 
12795a7e5bcbSVlad Buslov 	list_for_each_entry_safe(efi, tmp, &e->flows, list) {
128079baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
12815a7e5bcbSVlad Buslov 		if (IS_ERR(mlx5e_flow_get(flow)))
12825a7e5bcbSVlad Buslov 			continue;
12835a7e5bcbSVlad Buslov 
12845dbe906fSPaul Blakey 		spec = &flow->esw_attr->parse_attr->spec;
12855dbe906fSPaul Blakey 
12865dbe906fSPaul Blakey 		/* update from encap rule to slow path rule */
12875dbe906fSPaul Blakey 		rule = mlx5e_tc_offload_to_slow_path(esw, flow, spec, &slow_attr);
12888c4dc42bSEli Britstein 		/* mark the flow's encap dest as non-valid */
12898c4dc42bSEli Britstein 		flow->esw_attr->dests[efi->index].flags &= ~MLX5_ESW_DEST_ENCAP_VALID;
12905dbe906fSPaul Blakey 
12915dbe906fSPaul Blakey 		if (IS_ERR(rule)) {
12925dbe906fSPaul Blakey 			err = PTR_ERR(rule);
12935dbe906fSPaul Blakey 			mlx5_core_warn(priv->mdev, "Failed to update slow path (encap) flow, %d\n",
12945dbe906fSPaul Blakey 				       err);
12955a7e5bcbSVlad Buslov 			goto loop_cont;
12965dbe906fSPaul Blakey 		}
12975dbe906fSPaul Blakey 
12986d2a3ed0SOr Gerlitz 		mlx5e_tc_unoffload_fdb_rules(esw, flow, flow->esw_attr);
12995dbe906fSPaul Blakey 		flow->rule[0] = rule;
1300226f2ca3SVlad Buslov 		/* was unset when fast path rule removed */
1301226f2ca3SVlad Buslov 		flow_flag_set(flow, OFFLOADED);
13025a7e5bcbSVlad Buslov 
13035a7e5bcbSVlad Buslov loop_cont:
13045a7e5bcbSVlad Buslov 		mlx5e_flow_put(priv, flow);
1305232c0013SHadar Hen Zion 	}
1306232c0013SHadar Hen Zion 
130761c806daSOr Gerlitz 	/* we know that the encap is valid */
1308232c0013SHadar Hen Zion 	e->flags &= ~MLX5_ENCAP_ENTRY_VALID;
130960786f09SMark Bloch 	mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1310232c0013SHadar Hen Zion }
1311232c0013SHadar Hen Zion 
1312b8aee822SMark Bloch static struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow)
1313b8aee822SMark Bloch {
1314226f2ca3SVlad Buslov 	if (mlx5e_is_eswitch_flow(flow))
1315b8aee822SMark Bloch 		return flow->esw_attr->counter;
1316b8aee822SMark Bloch 	else
1317b8aee822SMark Bloch 		return flow->nic_attr->counter;
1318b8aee822SMark Bloch }
1319b8aee822SMark Bloch 
1320f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe)
1321f6dfb4c3SHadar Hen Zion {
1322f6dfb4c3SHadar Hen Zion 	struct mlx5e_neigh *m_neigh = &nhe->m_neigh;
1323f6dfb4c3SHadar Hen Zion 	u64 bytes, packets, lastuse = 0;
1324f6dfb4c3SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1325f6dfb4c3SHadar Hen Zion 	struct mlx5e_encap_entry *e;
1326f6dfb4c3SHadar Hen Zion 	struct mlx5_fc *counter;
1327f6dfb4c3SHadar Hen Zion 	struct neigh_table *tbl;
1328f6dfb4c3SHadar Hen Zion 	bool neigh_used = false;
1329f6dfb4c3SHadar Hen Zion 	struct neighbour *n;
1330f6dfb4c3SHadar Hen Zion 
1331f6dfb4c3SHadar Hen Zion 	if (m_neigh->family == AF_INET)
1332f6dfb4c3SHadar Hen Zion 		tbl = &arp_tbl;
1333f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6)
1334f6dfb4c3SHadar Hen Zion 	else if (m_neigh->family == AF_INET6)
1335423c9db2SOr Gerlitz 		tbl = &nd_tbl;
1336f6dfb4c3SHadar Hen Zion #endif
1337f6dfb4c3SHadar Hen Zion 	else
1338f6dfb4c3SHadar Hen Zion 		return;
1339f6dfb4c3SHadar Hen Zion 
1340f6dfb4c3SHadar Hen Zion 	list_for_each_entry(e, &nhe->encap_list, encap_list) {
13415a7e5bcbSVlad Buslov 		struct encap_flow_item *efi, *tmp;
1342f6dfb4c3SHadar Hen Zion 		if (!(e->flags & MLX5_ENCAP_ENTRY_VALID))
1343f6dfb4c3SHadar Hen Zion 			continue;
13445a7e5bcbSVlad Buslov 		list_for_each_entry_safe(efi, tmp, &e->flows, list) {
134579baaec7SEli Britstein 			flow = container_of(efi, struct mlx5e_tc_flow,
134679baaec7SEli Britstein 					    encaps[efi->index]);
13475a7e5bcbSVlad Buslov 			if (IS_ERR(mlx5e_flow_get(flow)))
13485a7e5bcbSVlad Buslov 				continue;
13495a7e5bcbSVlad Buslov 
1350226f2ca3SVlad Buslov 			if (mlx5e_is_offloaded_flow(flow)) {
1351b8aee822SMark Bloch 				counter = mlx5e_tc_get_counter(flow);
1352f6dfb4c3SHadar Hen Zion 				mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
1353f6dfb4c3SHadar Hen Zion 				if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) {
13545a7e5bcbSVlad Buslov 					mlx5e_flow_put(netdev_priv(e->out_dev), flow);
1355f6dfb4c3SHadar Hen Zion 					neigh_used = true;
1356f6dfb4c3SHadar Hen Zion 					break;
1357f6dfb4c3SHadar Hen Zion 				}
1358f6dfb4c3SHadar Hen Zion 			}
13595a7e5bcbSVlad Buslov 
13605a7e5bcbSVlad Buslov 			mlx5e_flow_put(netdev_priv(e->out_dev), flow);
1361f6dfb4c3SHadar Hen Zion 		}
1362e36d4810SRoi Dayan 		if (neigh_used)
1363e36d4810SRoi Dayan 			break;
1364f6dfb4c3SHadar Hen Zion 	}
1365f6dfb4c3SHadar Hen Zion 
1366f6dfb4c3SHadar Hen Zion 	if (neigh_used) {
1367f6dfb4c3SHadar Hen Zion 		nhe->reported_lastuse = jiffies;
1368f6dfb4c3SHadar Hen Zion 
1369f6dfb4c3SHadar Hen Zion 		/* find the relevant neigh according to the cached device and
1370f6dfb4c3SHadar Hen Zion 		 * dst ip pair
1371f6dfb4c3SHadar Hen Zion 		 */
1372f6dfb4c3SHadar Hen Zion 		n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev);
1373c7f7ba8dSRoi Dayan 		if (!n)
1374f6dfb4c3SHadar Hen Zion 			return;
1375f6dfb4c3SHadar Hen Zion 
1376f6dfb4c3SHadar Hen Zion 		neigh_event_send(n, NULL);
1377f6dfb4c3SHadar Hen Zion 		neigh_release(n);
1378f6dfb4c3SHadar Hen Zion 	}
1379f6dfb4c3SHadar Hen Zion }
1380f6dfb4c3SHadar Hen Zion 
1381d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
13828c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index)
1383d85cdccbSOr Gerlitz {
13848c4dc42bSEli Britstein 	struct list_head *next = flow->encaps[out_index].list.next;
13855067b602SRoi Dayan 
13865a7e5bcbSVlad Buslov 	/* flow wasn't fully initialized */
13875a7e5bcbSVlad Buslov 	if (list_empty(&flow->encaps[out_index].list))
13885a7e5bcbSVlad Buslov 		return;
13895a7e5bcbSVlad Buslov 
13908c4dc42bSEli Britstein 	list_del(&flow->encaps[out_index].list);
13915067b602SRoi Dayan 	if (list_empty(next)) {
1392c1ae1152SOr Gerlitz 		struct mlx5e_encap_entry *e;
13935067b602SRoi Dayan 
1394c1ae1152SOr Gerlitz 		e = list_entry(next, struct mlx5e_encap_entry, flows);
1395232c0013SHadar Hen Zion 		mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e);
1396232c0013SHadar Hen Zion 
1397232c0013SHadar Hen Zion 		if (e->flags & MLX5_ENCAP_ENTRY_VALID)
139860786f09SMark Bloch 			mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1399232c0013SHadar Hen Zion 
1400cdc5a7f3SOr Gerlitz 		hash_del_rcu(&e->encap_hlist);
1401232c0013SHadar Hen Zion 		kfree(e->encap_header);
14025067b602SRoi Dayan 		kfree(e);
14035067b602SRoi Dayan 	}
14045067b602SRoi Dayan }
14055067b602SRoi Dayan 
140604de7ddaSRoi Dayan static void __mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
140704de7ddaSRoi Dayan {
140804de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = flow->priv->mdev->priv.eswitch;
140904de7ddaSRoi Dayan 
1410226f2ca3SVlad Buslov 	if (!flow_flag_test(flow, ESWITCH) ||
1411226f2ca3SVlad Buslov 	    !flow_flag_test(flow, DUP))
141204de7ddaSRoi Dayan 		return;
141304de7ddaSRoi Dayan 
141404de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
141504de7ddaSRoi Dayan 	list_del(&flow->peer);
141604de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
141704de7ddaSRoi Dayan 
1418226f2ca3SVlad Buslov 	flow_flag_clear(flow, DUP);
141904de7ddaSRoi Dayan 
142004de7ddaSRoi Dayan 	mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow);
142104de7ddaSRoi Dayan 	kvfree(flow->peer_flow);
142204de7ddaSRoi Dayan 	flow->peer_flow = NULL;
142304de7ddaSRoi Dayan }
142404de7ddaSRoi Dayan 
142504de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
142604de7ddaSRoi Dayan {
142704de7ddaSRoi Dayan 	struct mlx5_core_dev *dev = flow->priv->mdev;
142804de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = dev->priv.devcom;
142904de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
143004de7ddaSRoi Dayan 
143104de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
143204de7ddaSRoi Dayan 	if (!peer_esw)
143304de7ddaSRoi Dayan 		return;
143404de7ddaSRoi Dayan 
143504de7ddaSRoi Dayan 	__mlx5e_tc_del_fdb_peer_flow(flow);
143604de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
143704de7ddaSRoi Dayan }
143804de7ddaSRoi Dayan 
1439e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv,
1440961e8979SRoi Dayan 			      struct mlx5e_tc_flow *flow)
1441e8f887acSAmir Vadai {
1442226f2ca3SVlad Buslov 	if (mlx5e_is_eswitch_flow(flow)) {
144304de7ddaSRoi Dayan 		mlx5e_tc_del_fdb_peer_flow(flow);
1444d85cdccbSOr Gerlitz 		mlx5e_tc_del_fdb_flow(priv, flow);
144504de7ddaSRoi Dayan 	} else {
1446d85cdccbSOr Gerlitz 		mlx5e_tc_del_nic_flow(priv, flow);
1447e8f887acSAmir Vadai 	}
144804de7ddaSRoi Dayan }
1449e8f887acSAmir Vadai 
1450bbd00f7eSHadar Hen Zion 
1451bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv,
1452bbd00f7eSHadar Hen Zion 			     struct mlx5_flow_spec *spec,
1453f9e30088SPablo Neira Ayuso 			     struct flow_cls_offload *f,
14546363651dSOr Gerlitz 			     struct net_device *filter_dev, u8 *match_level)
1455bbd00f7eSHadar Hen Zion {
1456e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1457bbd00f7eSHadar Hen Zion 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1458bbd00f7eSHadar Hen Zion 				       outer_headers);
1459bbd00f7eSHadar Hen Zion 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1460bbd00f7eSHadar Hen Zion 				       outer_headers);
1461f9e30088SPablo Neira Ayuso 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
14628f256622SPablo Neira Ayuso 	int err;
1463bbd00f7eSHadar Hen Zion 
1464101f4de9SOz Shlomo 	err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f,
14656363651dSOr Gerlitz 				 headers_c, headers_v, match_level);
146654c177caSOz Shlomo 	if (err) {
146754c177caSOz Shlomo 		NL_SET_ERR_MSG_MOD(extack,
146854c177caSOz Shlomo 				   "failed to parse tunnel attributes");
1469101f4de9SOz Shlomo 		return err;
1470bbd00f7eSHadar Hen Zion 	}
1471bbd00f7eSHadar Hen Zion 
1472d1bda7eeSTonghao Zhang 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS)) {
14738f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
14748f256622SPablo Neira Ayuso 
14758f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv4_addrs(rule, &match);
1476bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1477bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
14788f256622SPablo Neira Ayuso 			 ntohl(match.mask->src));
1479bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1480bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
14818f256622SPablo Neira Ayuso 			 ntohl(match.key->src));
1482bbd00f7eSHadar Hen Zion 
1483bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1484bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
14858f256622SPablo Neira Ayuso 			 ntohl(match.mask->dst));
1486bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1487bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
14888f256622SPablo Neira Ayuso 			 ntohl(match.key->dst));
1489bbd00f7eSHadar Hen Zion 
1490bbd00f7eSHadar Hen Zion 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
1491bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP);
1492d1bda7eeSTonghao Zhang 	} else if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS)) {
14938f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
149419f44401SOr Gerlitz 
14958f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv6_addrs(rule, &match);
149619f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
149719f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
14988f256622SPablo Neira Ayuso 		       &match.mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
149919f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
150019f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
15018f256622SPablo Neira Ayuso 		       &match.key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
150219f44401SOr Gerlitz 
150319f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
150419f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
15058f256622SPablo Neira Ayuso 		       &match.mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
150619f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
150719f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
15088f256622SPablo Neira Ayuso 		       &match.key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
150919f44401SOr Gerlitz 
151019f44401SOr Gerlitz 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
151119f44401SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6);
15122e72eb43SOr Gerlitz 	}
1513bbd00f7eSHadar Hen Zion 
15148f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) {
15158f256622SPablo Neira Ayuso 		struct flow_match_ip match;
1516bcef735cSOr Gerlitz 
15178f256622SPablo Neira Ayuso 		flow_rule_match_enc_ip(rule, &match);
15188f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
15198f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
15208f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
15218f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
1522bcef735cSOr Gerlitz 
15238f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
15248f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
15258f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
15268f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
1527bcef735cSOr Gerlitz 
15288f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
15298f256622SPablo Neira Ayuso 			 match.mask->ttl);
15308f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
15318f256622SPablo Neira Ayuso 			 match.key->ttl);
1532e98bedf5SEli Britstein 
15338f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1534e98bedf5SEli Britstein 		    !MLX5_CAP_ESW_FLOWTABLE_FDB
1535e98bedf5SEli Britstein 			(priv->mdev,
1536e98bedf5SEli Britstein 			 ft_field_support.outer_ipv4_ttl)) {
1537e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1538e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
1539e98bedf5SEli Britstein 			return -EOPNOTSUPP;
1540e98bedf5SEli Britstein 		}
1541e98bedf5SEli Britstein 
1542bcef735cSOr Gerlitz 	}
1543bcef735cSOr Gerlitz 
1544bbd00f7eSHadar Hen Zion 	/* Enforce DMAC when offloading incoming tunneled flows.
1545bbd00f7eSHadar Hen Zion 	 * Flow counters require a match on the DMAC.
1546bbd00f7eSHadar Hen Zion 	 */
1547bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16);
1548bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0);
1549bbd00f7eSHadar Hen Zion 	ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1550bbd00f7eSHadar Hen Zion 				     dmac_47_16), priv->netdev->dev_addr);
1551bbd00f7eSHadar Hen Zion 
1552bbd00f7eSHadar Hen Zion 	/* let software handle IP fragments */
1553bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
1554bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0);
1555bbd00f7eSHadar Hen Zion 
1556bbd00f7eSHadar Hen Zion 	return 0;
1557bbd00f7eSHadar Hen Zion }
1558bbd00f7eSHadar Hen Zion 
15598377629eSEli Britstein static void *get_match_headers_criteria(u32 flags,
15608377629eSEli Britstein 					struct mlx5_flow_spec *spec)
15618377629eSEli Britstein {
15628377629eSEli Britstein 	return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ?
15638377629eSEli Britstein 		MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
15648377629eSEli Britstein 			     inner_headers) :
15658377629eSEli Britstein 		MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
15668377629eSEli Britstein 			     outer_headers);
15678377629eSEli Britstein }
15688377629eSEli Britstein 
15698377629eSEli Britstein static void *get_match_headers_value(u32 flags,
15708377629eSEli Britstein 				     struct mlx5_flow_spec *spec)
15718377629eSEli Britstein {
15728377629eSEli Britstein 	return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ?
15738377629eSEli Britstein 		MLX5_ADDR_OF(fte_match_param, spec->match_value,
15748377629eSEli Britstein 			     inner_headers) :
15758377629eSEli Britstein 		MLX5_ADDR_OF(fte_match_param, spec->match_value,
15768377629eSEli Britstein 			     outer_headers);
15778377629eSEli Britstein }
15788377629eSEli Britstein 
1579de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv,
1580de0af0bfSRoi Dayan 			      struct mlx5_flow_spec *spec,
1581f9e30088SPablo Neira Ayuso 			      struct flow_cls_offload *f,
158254c177caSOz Shlomo 			      struct net_device *filter_dev,
15836363651dSOr Gerlitz 			      u8 *match_level, u8 *tunnel_match_level)
1584e3a2b7edSAmir Vadai {
1585e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1586c5bb1730SMaor Gottlieb 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1587c5bb1730SMaor Gottlieb 				       outer_headers);
1588c5bb1730SMaor Gottlieb 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1589c5bb1730SMaor Gottlieb 				       outer_headers);
1590699e96ddSJianbo Liu 	void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1591699e96ddSJianbo Liu 				    misc_parameters);
1592699e96ddSJianbo Liu 	void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1593699e96ddSJianbo Liu 				    misc_parameters);
1594f9e30088SPablo Neira Ayuso 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
15958f256622SPablo Neira Ayuso 	struct flow_dissector *dissector = rule->match.dissector;
1596e3a2b7edSAmir Vadai 	u16 addr_type = 0;
1597e3a2b7edSAmir Vadai 	u8 ip_proto = 0;
1598e3a2b7edSAmir Vadai 
1599d708f902SOr Gerlitz 	*match_level = MLX5_MATCH_NONE;
1600de0af0bfSRoi Dayan 
16018f256622SPablo Neira Ayuso 	if (dissector->used_keys &
16023d144578SVlad Buslov 	    ~(BIT(FLOW_DISSECTOR_KEY_META) |
16033d144578SVlad Buslov 	      BIT(FLOW_DISSECTOR_KEY_CONTROL) |
1604e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_BASIC) |
1605e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) |
1606095b6cfdSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_VLAN) |
1607699e96ddSJianbo Liu 	      BIT(FLOW_DISSECTOR_KEY_CVLAN) |
1608e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) |
1609e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) |
1610bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_PORTS) |
1611bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) |
1612bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) |
1613bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) |
1614bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_PORTS)	|
1615e77834ecSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) |
1616fd7da28bSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_TCP) |
1617bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_IP)  |
16189272e3dfSYevgeny Kliteynik 	      BIT(FLOW_DISSECTOR_KEY_ENC_IP) |
16199272e3dfSYevgeny Kliteynik 	      BIT(FLOW_DISSECTOR_KEY_ENC_OPTS))) {
1620e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "Unsupported key");
1621e3a2b7edSAmir Vadai 		netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n",
16228f256622SPablo Neira Ayuso 			    dissector->used_keys);
1623e3a2b7edSAmir Vadai 		return -EOPNOTSUPP;
1624e3a2b7edSAmir Vadai 	}
1625e3a2b7edSAmir Vadai 
1626075973c7SVlad Buslov 	if (mlx5e_get_tc_tun(filter_dev)) {
16276363651dSOr Gerlitz 		if (parse_tunnel_attr(priv, spec, f, filter_dev, tunnel_match_level))
1628bbd00f7eSHadar Hen Zion 			return -EOPNOTSUPP;
1629bbd00f7eSHadar Hen Zion 
1630bbd00f7eSHadar Hen Zion 		/* In decap flow, header pointers should point to the inner
1631bbd00f7eSHadar Hen Zion 		 * headers, outer header were already set by parse_tunnel_attr
1632bbd00f7eSHadar Hen Zion 		 */
16338377629eSEli Britstein 		headers_c = get_match_headers_criteria(MLX5_FLOW_CONTEXT_ACTION_DECAP,
16348377629eSEli Britstein 						       spec);
16358377629eSEli Britstein 		headers_v = get_match_headers_value(MLX5_FLOW_CONTEXT_ACTION_DECAP,
16368377629eSEli Britstein 						    spec);
1637bbd00f7eSHadar Hen Zion 	}
1638bbd00f7eSHadar Hen Zion 
16398f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
16408f256622SPablo Neira Ayuso 		struct flow_match_basic match;
1641e3a2b7edSAmir Vadai 
16428f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
16438f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype,
16448f256622SPablo Neira Ayuso 			 ntohs(match.mask->n_proto));
16458f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype,
16468f256622SPablo Neira Ayuso 			 ntohs(match.key->n_proto));
16478f256622SPablo Neira Ayuso 
16488f256622SPablo Neira Ayuso 		if (match.mask->n_proto)
1649d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1650e3a2b7edSAmir Vadai 	}
165135a605dbSEli Britstein 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN) ||
165235a605dbSEli Britstein 	    is_vlan_dev(filter_dev)) {
165335a605dbSEli Britstein 		struct flow_dissector_key_vlan filter_dev_mask;
165435a605dbSEli Britstein 		struct flow_dissector_key_vlan filter_dev_key;
16558f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
16568f256622SPablo Neira Ayuso 
165735a605dbSEli Britstein 		if (is_vlan_dev(filter_dev)) {
165835a605dbSEli Britstein 			match.key = &filter_dev_key;
165935a605dbSEli Britstein 			match.key->vlan_id = vlan_dev_vlan_id(filter_dev);
166035a605dbSEli Britstein 			match.key->vlan_tpid = vlan_dev_vlan_proto(filter_dev);
166135a605dbSEli Britstein 			match.key->vlan_priority = 0;
166235a605dbSEli Britstein 			match.mask = &filter_dev_mask;
166335a605dbSEli Britstein 			memset(match.mask, 0xff, sizeof(*match.mask));
166435a605dbSEli Britstein 			match.mask->vlan_priority = 0;
166535a605dbSEli Britstein 		} else {
16668f256622SPablo Neira Ayuso 			flow_rule_match_vlan(rule, &match);
166735a605dbSEli Britstein 		}
16688f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
16698f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
16708f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
16718f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1672699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1673699e96ddSJianbo Liu 					 svlan_tag, 1);
1674699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1675699e96ddSJianbo Liu 					 svlan_tag, 1);
1676699e96ddSJianbo Liu 			} else {
1677699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1678699e96ddSJianbo Liu 					 cvlan_tag, 1);
1679699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1680699e96ddSJianbo Liu 					 cvlan_tag, 1);
1681699e96ddSJianbo Liu 			}
1682095b6cfdSOr Gerlitz 
16838f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid,
16848f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
16858f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid,
16868f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1687358d79a4SOr Gerlitz 
16888f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio,
16898f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
16908f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio,
16918f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
169254782900SOr Gerlitz 
1693d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1694095b6cfdSOr Gerlitz 		}
1695d3a80bb5SOr Gerlitz 	} else if (*match_level != MLX5_MATCH_NONE) {
1696cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, svlan_tag, 1);
1697cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1);
1698d3a80bb5SOr Gerlitz 		*match_level = MLX5_MATCH_L2;
1699095b6cfdSOr Gerlitz 	}
1700095b6cfdSOr Gerlitz 
17018f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) {
17028f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
17038f256622SPablo Neira Ayuso 
170412d5cbf8SJianbo Liu 		flow_rule_match_cvlan(rule, &match);
17058f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
17068f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
17078f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
17088f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1709699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1710699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1711699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1712699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1713699e96ddSJianbo Liu 			} else {
1714699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1715699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1716699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1717699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1718699e96ddSJianbo Liu 			}
1719699e96ddSJianbo Liu 
1720699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid,
17218f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
1722699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid,
17238f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1724699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio,
17258f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
1726699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio,
17278f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
1728699e96ddSJianbo Liu 
1729699e96ddSJianbo Liu 			*match_level = MLX5_MATCH_L2;
1730699e96ddSJianbo Liu 		}
1731699e96ddSJianbo Liu 	}
1732699e96ddSJianbo Liu 
17338f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) {
17348f256622SPablo Neira Ayuso 		struct flow_match_eth_addrs match;
173554782900SOr Gerlitz 
17368f256622SPablo Neira Ayuso 		flow_rule_match_eth_addrs(rule, &match);
1737d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1738d3a80bb5SOr Gerlitz 					     dmac_47_16),
17398f256622SPablo Neira Ayuso 				match.mask->dst);
1740d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1741d3a80bb5SOr Gerlitz 					     dmac_47_16),
17428f256622SPablo Neira Ayuso 				match.key->dst);
1743d3a80bb5SOr Gerlitz 
1744d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1745d3a80bb5SOr Gerlitz 					     smac_47_16),
17468f256622SPablo Neira Ayuso 				match.mask->src);
1747d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1748d3a80bb5SOr Gerlitz 					     smac_47_16),
17498f256622SPablo Neira Ayuso 				match.key->src);
1750d3a80bb5SOr Gerlitz 
17518f256622SPablo Neira Ayuso 		if (!is_zero_ether_addr(match.mask->src) ||
17528f256622SPablo Neira Ayuso 		    !is_zero_ether_addr(match.mask->dst))
1753d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
175454782900SOr Gerlitz 	}
175554782900SOr Gerlitz 
17568f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) {
17578f256622SPablo Neira Ayuso 		struct flow_match_control match;
175854782900SOr Gerlitz 
17598f256622SPablo Neira Ayuso 		flow_rule_match_control(rule, &match);
17608f256622SPablo Neira Ayuso 		addr_type = match.key->addr_type;
176154782900SOr Gerlitz 
176254782900SOr Gerlitz 		/* the HW doesn't support frag first/later */
17638f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_FIRST_FRAG)
176454782900SOr Gerlitz 			return -EOPNOTSUPP;
176554782900SOr Gerlitz 
17668f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) {
176754782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
176854782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag,
17698f256622SPablo Neira Ayuso 				 match.key->flags & FLOW_DIS_IS_FRAGMENT);
177054782900SOr Gerlitz 
177154782900SOr Gerlitz 			/* the HW doesn't need L3 inline to match on frag=no */
17728f256622SPablo Neira Ayuso 			if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT))
177383621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L2;
177454782900SOr Gerlitz 	/* ***  L2 attributes parsing up to here *** */
177554782900SOr Gerlitz 			else
177683621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L3;
177754782900SOr Gerlitz 		}
177854782900SOr Gerlitz 	}
177954782900SOr Gerlitz 
17808f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
17818f256622SPablo Neira Ayuso 		struct flow_match_basic match;
17828f256622SPablo Neira Ayuso 
17838f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
17848f256622SPablo Neira Ayuso 		ip_proto = match.key->ip_proto;
178554782900SOr Gerlitz 
178654782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
17878f256622SPablo Neira Ayuso 			 match.mask->ip_proto);
178854782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
17898f256622SPablo Neira Ayuso 			 match.key->ip_proto);
179054782900SOr Gerlitz 
17918f256622SPablo Neira Ayuso 		if (match.mask->ip_proto)
1792d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
179354782900SOr Gerlitz 	}
179454782900SOr Gerlitz 
1795e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
17968f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
1797e3a2b7edSAmir Vadai 
17988f256622SPablo Neira Ayuso 		flow_rule_match_ipv4_addrs(rule, &match);
1799e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1800e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
18018f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1802e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1803e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
18048f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1805e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1806e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
18078f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1808e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1809e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
18108f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1811de0af0bfSRoi Dayan 
18128f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1813d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1814e3a2b7edSAmir Vadai 	}
1815e3a2b7edSAmir Vadai 
1816e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
18178f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
1818e3a2b7edSAmir Vadai 
18198f256622SPablo Neira Ayuso 		flow_rule_match_ipv6_addrs(rule, &match);
1820e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1821e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
18228f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1823e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1824e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
18258f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1826e3a2b7edSAmir Vadai 
1827e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1828e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
18298f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1830e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1831e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
18328f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1833de0af0bfSRoi Dayan 
18348f256622SPablo Neira Ayuso 		if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY ||
18358f256622SPablo Neira Ayuso 		    ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY)
1836d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1837e3a2b7edSAmir Vadai 	}
1838e3a2b7edSAmir Vadai 
18398f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) {
18408f256622SPablo Neira Ayuso 		struct flow_match_ip match;
18411f97a526SOr Gerlitz 
18428f256622SPablo Neira Ayuso 		flow_rule_match_ip(rule, &match);
18438f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
18448f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
18458f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
18468f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
18471f97a526SOr Gerlitz 
18488f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
18498f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
18508f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
18518f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
18521f97a526SOr Gerlitz 
18538f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
18548f256622SPablo Neira Ayuso 			 match.mask->ttl);
18558f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
18568f256622SPablo Neira Ayuso 			 match.key->ttl);
18571f97a526SOr Gerlitz 
18588f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1859a8ade55fSOr Gerlitz 		    !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev,
1860e98bedf5SEli Britstein 						ft_field_support.outer_ipv4_ttl)) {
1861e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1862e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
18631f97a526SOr Gerlitz 			return -EOPNOTSUPP;
1864e98bedf5SEli Britstein 		}
1865a8ade55fSOr Gerlitz 
18668f256622SPablo Neira Ayuso 		if (match.mask->tos || match.mask->ttl)
1867d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
18681f97a526SOr Gerlitz 	}
18691f97a526SOr Gerlitz 
187054782900SOr Gerlitz 	/* ***  L3 attributes parsing up to here *** */
187154782900SOr Gerlitz 
18728f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) {
18738f256622SPablo Neira Ayuso 		struct flow_match_ports match;
18748f256622SPablo Neira Ayuso 
18758f256622SPablo Neira Ayuso 		flow_rule_match_ports(rule, &match);
1876e3a2b7edSAmir Vadai 		switch (ip_proto) {
1877e3a2b7edSAmir Vadai 		case IPPROTO_TCP:
1878e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
18798f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.mask->src));
1880e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
18818f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.key->src));
1882e3a2b7edSAmir Vadai 
1883e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
18848f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.mask->dst));
1885e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
18868f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.key->dst));
1887e3a2b7edSAmir Vadai 			break;
1888e3a2b7edSAmir Vadai 
1889e3a2b7edSAmir Vadai 		case IPPROTO_UDP:
1890e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
18918f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.mask->src));
1892e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
18938f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.key->src));
1894e3a2b7edSAmir Vadai 
1895e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
18968f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.mask->dst));
1897e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
18988f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.key->dst));
1899e3a2b7edSAmir Vadai 			break;
1900e3a2b7edSAmir Vadai 		default:
1901e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1902e98bedf5SEli Britstein 					   "Only UDP and TCP transports are supported for L4 matching");
1903e3a2b7edSAmir Vadai 			netdev_err(priv->netdev,
1904e3a2b7edSAmir Vadai 				   "Only UDP and TCP transport are supported\n");
1905e3a2b7edSAmir Vadai 			return -EINVAL;
1906e3a2b7edSAmir Vadai 		}
1907de0af0bfSRoi Dayan 
19088f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1909d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1910e3a2b7edSAmir Vadai 	}
1911e3a2b7edSAmir Vadai 
19128f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) {
19138f256622SPablo Neira Ayuso 		struct flow_match_tcp match;
1914e77834ecSOr Gerlitz 
19158f256622SPablo Neira Ayuso 		flow_rule_match_tcp(rule, &match);
1916e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags,
19178f256622SPablo Neira Ayuso 			 ntohs(match.mask->flags));
1918e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags,
19198f256622SPablo Neira Ayuso 			 ntohs(match.key->flags));
1920e77834ecSOr Gerlitz 
19218f256622SPablo Neira Ayuso 		if (match.mask->flags)
1922d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1923e77834ecSOr Gerlitz 	}
1924e77834ecSOr Gerlitz 
1925e3a2b7edSAmir Vadai 	return 0;
1926e3a2b7edSAmir Vadai }
1927e3a2b7edSAmir Vadai 
1928de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv,
192965ba8fb7SOr Gerlitz 			    struct mlx5e_tc_flow *flow,
1930de0af0bfSRoi Dayan 			    struct mlx5_flow_spec *spec,
1931f9e30088SPablo Neira Ayuso 			    struct flow_cls_offload *f,
193254c177caSOz Shlomo 			    struct net_device *filter_dev)
1933de0af0bfSRoi Dayan {
1934e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1935de0af0bfSRoi Dayan 	struct mlx5_core_dev *dev = priv->mdev;
1936de0af0bfSRoi Dayan 	struct mlx5_eswitch *esw = dev->priv.eswitch;
19371d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
19386363651dSOr Gerlitz 	u8 match_level, tunnel_match_level = MLX5_MATCH_NONE;
19391d447a39SSaeed Mahameed 	struct mlx5_eswitch_rep *rep;
1940226f2ca3SVlad Buslov 	bool is_eswitch_flow;
1941de0af0bfSRoi Dayan 	int err;
1942de0af0bfSRoi Dayan 
19436363651dSOr Gerlitz 	err = __parse_cls_flower(priv, spec, f, filter_dev, &match_level, &tunnel_match_level);
1944de0af0bfSRoi Dayan 
1945226f2ca3SVlad Buslov 	is_eswitch_flow = mlx5e_is_eswitch_flow(flow);
1946226f2ca3SVlad Buslov 	if (!err && is_eswitch_flow) {
19471d447a39SSaeed Mahameed 		rep = rpriv->rep;
1948b05af6aaSBodong Wang 		if (rep->vport != MLX5_VPORT_UPLINK &&
19491d447a39SSaeed Mahameed 		    (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE &&
1950d708f902SOr Gerlitz 		    esw->offloads.inline_mode < match_level)) {
1951e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1952e98bedf5SEli Britstein 					   "Flow is not offloaded due to min inline setting");
1953de0af0bfSRoi Dayan 			netdev_warn(priv->netdev,
1954de0af0bfSRoi Dayan 				    "Flow is not offloaded due to min inline setting, required %d actual %d\n",
1955d708f902SOr Gerlitz 				    match_level, esw->offloads.inline_mode);
1956de0af0bfSRoi Dayan 			return -EOPNOTSUPP;
1957de0af0bfSRoi Dayan 		}
1958de0af0bfSRoi Dayan 	}
1959de0af0bfSRoi Dayan 
1960226f2ca3SVlad Buslov 	if (is_eswitch_flow) {
196138aa51c1SOr Gerlitz 		flow->esw_attr->match_level = match_level;
19626363651dSOr Gerlitz 		flow->esw_attr->tunnel_match_level = tunnel_match_level;
19636363651dSOr Gerlitz 	} else {
196438aa51c1SOr Gerlitz 		flow->nic_attr->match_level = match_level;
19656363651dSOr Gerlitz 	}
196638aa51c1SOr Gerlitz 
1967de0af0bfSRoi Dayan 	return err;
1968de0af0bfSRoi Dayan }
1969de0af0bfSRoi Dayan 
1970d79b6df6SOr Gerlitz struct pedit_headers {
1971d79b6df6SOr Gerlitz 	struct ethhdr  eth;
19720eb69bb9SEli Britstein 	struct vlan_hdr vlan;
1973d79b6df6SOr Gerlitz 	struct iphdr   ip4;
1974d79b6df6SOr Gerlitz 	struct ipv6hdr ip6;
1975d79b6df6SOr Gerlitz 	struct tcphdr  tcp;
1976d79b6df6SOr Gerlitz 	struct udphdr  udp;
1977d79b6df6SOr Gerlitz };
1978d79b6df6SOr Gerlitz 
1979c500c86bSPablo Neira Ayuso struct pedit_headers_action {
1980c500c86bSPablo Neira Ayuso 	struct pedit_headers	vals;
1981c500c86bSPablo Neira Ayuso 	struct pedit_headers	masks;
1982c500c86bSPablo Neira Ayuso 	u32			pedits;
1983c500c86bSPablo Neira Ayuso };
1984c500c86bSPablo Neira Ayuso 
1985d79b6df6SOr Gerlitz static int pedit_header_offsets[] = {
198673867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth),
198773867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4),
198873867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6),
198973867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp),
199073867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp),
1991d79b6df6SOr Gerlitz };
1992d79b6df6SOr Gerlitz 
1993d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype])
1994d79b6df6SOr Gerlitz 
1995d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset,
1996c500c86bSPablo Neira Ayuso 			 struct pedit_headers_action *hdrs)
1997d79b6df6SOr Gerlitz {
1998d79b6df6SOr Gerlitz 	u32 *curr_pmask, *curr_pval;
1999d79b6df6SOr Gerlitz 
2000c500c86bSPablo Neira Ayuso 	curr_pmask = (u32 *)(pedit_header(&hdrs->masks, hdr_type) + offset);
2001c500c86bSPablo Neira Ayuso 	curr_pval  = (u32 *)(pedit_header(&hdrs->vals, hdr_type) + offset);
2002d79b6df6SOr Gerlitz 
2003d79b6df6SOr Gerlitz 	if (*curr_pmask & mask)  /* disallow acting twice on the same location */
2004d79b6df6SOr Gerlitz 		goto out_err;
2005d79b6df6SOr Gerlitz 
2006d79b6df6SOr Gerlitz 	*curr_pmask |= mask;
2007d79b6df6SOr Gerlitz 	*curr_pval  |= (val & mask);
2008d79b6df6SOr Gerlitz 
2009d79b6df6SOr Gerlitz 	return 0;
2010d79b6df6SOr Gerlitz 
2011d79b6df6SOr Gerlitz out_err:
2012d79b6df6SOr Gerlitz 	return -EOPNOTSUPP;
2013d79b6df6SOr Gerlitz }
2014d79b6df6SOr Gerlitz 
2015d79b6df6SOr Gerlitz struct mlx5_fields {
2016d79b6df6SOr Gerlitz 	u8  field;
2017d79b6df6SOr Gerlitz 	u8  size;
2018d79b6df6SOr Gerlitz 	u32 offset;
201927c11b6bSEli Britstein 	u32 match_offset;
2020d79b6df6SOr Gerlitz };
2021d79b6df6SOr Gerlitz 
202227c11b6bSEli Britstein #define OFFLOAD(fw_field, size, field, off, match_field) \
202327c11b6bSEli Britstein 		{MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, size, \
202427c11b6bSEli Britstein 		 offsetof(struct pedit_headers, field) + (off), \
202527c11b6bSEli Britstein 		 MLX5_BYTE_OFF(fte_match_set_lyr_2_4, match_field)}
202627c11b6bSEli Britstein 
20272ef86872SEli Britstein /* masked values are the same and there are no rewrites that do not have a
20282ef86872SEli Britstein  * match.
20292ef86872SEli Britstein  */
20302ef86872SEli Britstein #define SAME_VAL_MASK(type, valp, maskp, matchvalp, matchmaskp) ({ \
20312ef86872SEli Britstein 	type matchmaskx = *(type *)(matchmaskp); \
20322ef86872SEli Britstein 	type matchvalx = *(type *)(matchvalp); \
20332ef86872SEli Britstein 	type maskx = *(type *)(maskp); \
20342ef86872SEli Britstein 	type valx = *(type *)(valp); \
20352ef86872SEli Britstein 	\
20362ef86872SEli Britstein 	(valx & maskx) == (matchvalx & matchmaskx) && !(maskx & (maskx ^ \
20372ef86872SEli Britstein 								 matchmaskx)); \
20382ef86872SEli Britstein })
20392ef86872SEli Britstein 
204027c11b6bSEli Britstein static bool cmp_val_mask(void *valp, void *maskp, void *matchvalp,
204127c11b6bSEli Britstein 			 void *matchmaskp, int size)
204227c11b6bSEli Britstein {
204327c11b6bSEli Britstein 	bool same = false;
204427c11b6bSEli Britstein 
204527c11b6bSEli Britstein 	switch (size) {
204627c11b6bSEli Britstein 	case sizeof(u8):
20472ef86872SEli Britstein 		same = SAME_VAL_MASK(u8, valp, maskp, matchvalp, matchmaskp);
204827c11b6bSEli Britstein 		break;
204927c11b6bSEli Britstein 	case sizeof(u16):
20502ef86872SEli Britstein 		same = SAME_VAL_MASK(u16, valp, maskp, matchvalp, matchmaskp);
205127c11b6bSEli Britstein 		break;
205227c11b6bSEli Britstein 	case sizeof(u32):
20532ef86872SEli Britstein 		same = SAME_VAL_MASK(u32, valp, maskp, matchvalp, matchmaskp);
205427c11b6bSEli Britstein 		break;
205527c11b6bSEli Britstein 	}
205627c11b6bSEli Britstein 
205727c11b6bSEli Britstein 	return same;
205827c11b6bSEli Britstein }
2059a8e4f0c4SOr Gerlitz 
2060d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = {
206127c11b6bSEli Britstein 	OFFLOAD(DMAC_47_16, 4, eth.h_dest[0], 0, dmac_47_16),
206227c11b6bSEli Britstein 	OFFLOAD(DMAC_15_0,  2, eth.h_dest[4], 0, dmac_15_0),
206327c11b6bSEli Britstein 	OFFLOAD(SMAC_47_16, 4, eth.h_source[0], 0, smac_47_16),
206427c11b6bSEli Britstein 	OFFLOAD(SMAC_15_0,  2, eth.h_source[4], 0, smac_15_0),
206527c11b6bSEli Britstein 	OFFLOAD(ETHERTYPE,  2, eth.h_proto, 0, ethertype),
206627c11b6bSEli Britstein 	OFFLOAD(FIRST_VID,  2, vlan.h_vlan_TCI, 0, first_vid),
2067d79b6df6SOr Gerlitz 
206827c11b6bSEli Britstein 	OFFLOAD(IP_TTL, 1, ip4.ttl,   0, ttl_hoplimit),
206927c11b6bSEli Britstein 	OFFLOAD(SIPV4,  4, ip4.saddr, 0, src_ipv4_src_ipv6.ipv4_layout.ipv4),
207027c11b6bSEli Britstein 	OFFLOAD(DIPV4,  4, ip4.daddr, 0, dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
2071d79b6df6SOr Gerlitz 
207227c11b6bSEli Britstein 	OFFLOAD(SIPV6_127_96, 4, ip6.saddr.s6_addr32[0], 0,
207327c11b6bSEli Britstein 		src_ipv4_src_ipv6.ipv6_layout.ipv6[0]),
207427c11b6bSEli Britstein 	OFFLOAD(SIPV6_95_64,  4, ip6.saddr.s6_addr32[1], 0,
207527c11b6bSEli Britstein 		src_ipv4_src_ipv6.ipv6_layout.ipv6[4]),
207627c11b6bSEli Britstein 	OFFLOAD(SIPV6_63_32,  4, ip6.saddr.s6_addr32[2], 0,
207727c11b6bSEli Britstein 		src_ipv4_src_ipv6.ipv6_layout.ipv6[8]),
207827c11b6bSEli Britstein 	OFFLOAD(SIPV6_31_0,   4, ip6.saddr.s6_addr32[3], 0,
207927c11b6bSEli Britstein 		src_ipv4_src_ipv6.ipv6_layout.ipv6[12]),
208027c11b6bSEli Britstein 	OFFLOAD(DIPV6_127_96, 4, ip6.daddr.s6_addr32[0], 0,
208127c11b6bSEli Britstein 		dst_ipv4_dst_ipv6.ipv6_layout.ipv6[0]),
208227c11b6bSEli Britstein 	OFFLOAD(DIPV6_95_64,  4, ip6.daddr.s6_addr32[1], 0,
208327c11b6bSEli Britstein 		dst_ipv4_dst_ipv6.ipv6_layout.ipv6[4]),
208427c11b6bSEli Britstein 	OFFLOAD(DIPV6_63_32,  4, ip6.daddr.s6_addr32[2], 0,
208527c11b6bSEli Britstein 		dst_ipv4_dst_ipv6.ipv6_layout.ipv6[8]),
208627c11b6bSEli Britstein 	OFFLOAD(DIPV6_31_0,   4, ip6.daddr.s6_addr32[3], 0,
208727c11b6bSEli Britstein 		dst_ipv4_dst_ipv6.ipv6_layout.ipv6[12]),
208827c11b6bSEli Britstein 	OFFLOAD(IPV6_HOPLIMIT, 1, ip6.hop_limit, 0, ttl_hoplimit),
2089d79b6df6SOr Gerlitz 
209027c11b6bSEli Britstein 	OFFLOAD(TCP_SPORT, 2, tcp.source,  0, tcp_sport),
209127c11b6bSEli Britstein 	OFFLOAD(TCP_DPORT, 2, tcp.dest,    0, tcp_dport),
209227c11b6bSEli Britstein 	OFFLOAD(TCP_FLAGS, 1, tcp.ack_seq, 5, tcp_flags),
2093d79b6df6SOr Gerlitz 
209427c11b6bSEli Britstein 	OFFLOAD(UDP_SPORT, 2, udp.source, 0, udp_sport),
209527c11b6bSEli Britstein 	OFFLOAD(UDP_DPORT, 2, udp.dest,   0, udp_dport),
2096d79b6df6SOr Gerlitz };
2097d79b6df6SOr Gerlitz 
2098218d05ceSTonghao Zhang /* On input attr->max_mod_hdr_actions tells how many HW actions can be parsed at
2099218d05ceSTonghao Zhang  * max from the SW pedit action. On success, attr->num_mod_hdr_actions
2100218d05ceSTonghao Zhang  * says how many HW actions were actually parsed.
2101d79b6df6SOr Gerlitz  */
2102c500c86bSPablo Neira Ayuso static int offload_pedit_fields(struct pedit_headers_action *hdrs,
2103e98bedf5SEli Britstein 				struct mlx5e_tc_flow_parse_attr *parse_attr,
210427c11b6bSEli Britstein 				u32 *action_flags,
2105e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2106d79b6df6SOr Gerlitz {
2107d79b6df6SOr Gerlitz 	struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals;
210827c11b6bSEli Britstein 	void *headers_c = get_match_headers_criteria(*action_flags,
210927c11b6bSEli Britstein 						     &parse_attr->spec);
211027c11b6bSEli Britstein 	void *headers_v = get_match_headers_value(*action_flags,
211127c11b6bSEli Britstein 						  &parse_attr->spec);
21122b64bebaSOr Gerlitz 	int i, action_size, nactions, max_actions, first, last, next_z;
2113d79b6df6SOr Gerlitz 	void *s_masks_p, *a_masks_p, *vals_p;
2114d79b6df6SOr Gerlitz 	struct mlx5_fields *f;
2115d79b6df6SOr Gerlitz 	u8 cmd, field_bsize;
2116e3ca4e05SOr Gerlitz 	u32 s_mask, a_mask;
2117d79b6df6SOr Gerlitz 	unsigned long mask;
21182b64bebaSOr Gerlitz 	__be32 mask_be32;
21192b64bebaSOr Gerlitz 	__be16 mask_be16;
2120d79b6df6SOr Gerlitz 	void *action;
2121d79b6df6SOr Gerlitz 
212273867881SPablo Neira Ayuso 	set_masks = &hdrs[0].masks;
212373867881SPablo Neira Ayuso 	add_masks = &hdrs[1].masks;
212473867881SPablo Neira Ayuso 	set_vals = &hdrs[0].vals;
212573867881SPablo Neira Ayuso 	add_vals = &hdrs[1].vals;
2126d79b6df6SOr Gerlitz 
2127d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
2128218d05ceSTonghao Zhang 	action = parse_attr->mod_hdr_actions +
2129218d05ceSTonghao Zhang 		 parse_attr->num_mod_hdr_actions * action_size;
2130218d05ceSTonghao Zhang 
2131218d05ceSTonghao Zhang 	max_actions = parse_attr->max_mod_hdr_actions;
2132218d05ceSTonghao Zhang 	nactions = parse_attr->num_mod_hdr_actions;
2133d79b6df6SOr Gerlitz 
2134d79b6df6SOr Gerlitz 	for (i = 0; i < ARRAY_SIZE(fields); i++) {
213527c11b6bSEli Britstein 		bool skip;
213627c11b6bSEli Britstein 
2137d79b6df6SOr Gerlitz 		f = &fields[i];
2138d79b6df6SOr Gerlitz 		/* avoid seeing bits set from previous iterations */
2139e3ca4e05SOr Gerlitz 		s_mask = 0;
2140e3ca4e05SOr Gerlitz 		a_mask = 0;
2141d79b6df6SOr Gerlitz 
2142d79b6df6SOr Gerlitz 		s_masks_p = (void *)set_masks + f->offset;
2143d79b6df6SOr Gerlitz 		a_masks_p = (void *)add_masks + f->offset;
2144d79b6df6SOr Gerlitz 
2145d79b6df6SOr Gerlitz 		memcpy(&s_mask, s_masks_p, f->size);
2146d79b6df6SOr Gerlitz 		memcpy(&a_mask, a_masks_p, f->size);
2147d79b6df6SOr Gerlitz 
2148d79b6df6SOr Gerlitz 		if (!s_mask && !a_mask) /* nothing to offload here */
2149d79b6df6SOr Gerlitz 			continue;
2150d79b6df6SOr Gerlitz 
2151d79b6df6SOr Gerlitz 		if (s_mask && a_mask) {
2152e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2153e98bedf5SEli Britstein 					   "can't set and add to the same HW field");
2154d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field);
2155d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
2156d79b6df6SOr Gerlitz 		}
2157d79b6df6SOr Gerlitz 
2158d79b6df6SOr Gerlitz 		if (nactions == max_actions) {
2159e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2160e98bedf5SEli Britstein 					   "too many pedit actions, can't offload");
2161d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions);
2162d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
2163d79b6df6SOr Gerlitz 		}
2164d79b6df6SOr Gerlitz 
216527c11b6bSEli Britstein 		skip = false;
2166d79b6df6SOr Gerlitz 		if (s_mask) {
216727c11b6bSEli Britstein 			void *match_mask = headers_c + f->match_offset;
216827c11b6bSEli Britstein 			void *match_val = headers_v + f->match_offset;
216927c11b6bSEli Britstein 
2170d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_SET;
2171d79b6df6SOr Gerlitz 			mask = s_mask;
2172d79b6df6SOr Gerlitz 			vals_p = (void *)set_vals + f->offset;
217327c11b6bSEli Britstein 			/* don't rewrite if we have a match on the same value */
217427c11b6bSEli Britstein 			if (cmp_val_mask(vals_p, s_masks_p, match_val,
217527c11b6bSEli Britstein 					 match_mask, f->size))
217627c11b6bSEli Britstein 				skip = true;
2177d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
2178d79b6df6SOr Gerlitz 			memset(s_masks_p, 0, f->size);
2179d79b6df6SOr Gerlitz 		} else {
218027c11b6bSEli Britstein 			u32 zero = 0;
218127c11b6bSEli Britstein 
2182d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_ADD;
2183d79b6df6SOr Gerlitz 			mask = a_mask;
2184d79b6df6SOr Gerlitz 			vals_p = (void *)add_vals + f->offset;
218527c11b6bSEli Britstein 			/* add 0 is no change */
218627c11b6bSEli Britstein 			if (!memcmp(vals_p, &zero, f->size))
218727c11b6bSEli Britstein 				skip = true;
2188d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
2189d79b6df6SOr Gerlitz 			memset(a_masks_p, 0, f->size);
2190d79b6df6SOr Gerlitz 		}
219127c11b6bSEli Britstein 		if (skip)
219227c11b6bSEli Britstein 			continue;
2193d79b6df6SOr Gerlitz 
2194d79b6df6SOr Gerlitz 		field_bsize = f->size * BITS_PER_BYTE;
2195e3ca4e05SOr Gerlitz 
21962b64bebaSOr Gerlitz 		if (field_bsize == 32) {
21972b64bebaSOr Gerlitz 			mask_be32 = *(__be32 *)&mask;
21982b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32));
21992b64bebaSOr Gerlitz 		} else if (field_bsize == 16) {
22002b64bebaSOr Gerlitz 			mask_be16 = *(__be16 *)&mask;
22012b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16));
22022b64bebaSOr Gerlitz 		}
22032b64bebaSOr Gerlitz 
2204d79b6df6SOr Gerlitz 		first = find_first_bit(&mask, field_bsize);
22052b64bebaSOr Gerlitz 		next_z = find_next_zero_bit(&mask, field_bsize, first);
2206d79b6df6SOr Gerlitz 		last  = find_last_bit(&mask, field_bsize);
22072b64bebaSOr Gerlitz 		if (first < next_z && next_z < last) {
2208e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2209e98bedf5SEli Britstein 					   "rewrite of few sub-fields isn't supported");
22102b64bebaSOr Gerlitz 			printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n",
2211d79b6df6SOr Gerlitz 			       mask);
2212d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
2213d79b6df6SOr Gerlitz 		}
2214d79b6df6SOr Gerlitz 
2215d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, action_type, cmd);
2216d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, field, f->field);
2217d79b6df6SOr Gerlitz 
2218d79b6df6SOr Gerlitz 		if (cmd == MLX5_ACTION_TYPE_SET) {
22192b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, offset, first);
2220d79b6df6SOr Gerlitz 			/* length is num of bits to be written, zero means length of 32 */
22212b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, length, (last - first + 1));
2222d79b6df6SOr Gerlitz 		}
2223d79b6df6SOr Gerlitz 
2224d79b6df6SOr Gerlitz 		if (field_bsize == 32)
22252b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first);
2226d79b6df6SOr Gerlitz 		else if (field_bsize == 16)
22272b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first);
2228d79b6df6SOr Gerlitz 		else if (field_bsize == 8)
22292b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first);
2230d79b6df6SOr Gerlitz 
2231d79b6df6SOr Gerlitz 		action += action_size;
2232d79b6df6SOr Gerlitz 		nactions++;
2233d79b6df6SOr Gerlitz 	}
2234d79b6df6SOr Gerlitz 
2235d79b6df6SOr Gerlitz 	parse_attr->num_mod_hdr_actions = nactions;
2236d79b6df6SOr Gerlitz 	return 0;
2237d79b6df6SOr Gerlitz }
2238d79b6df6SOr Gerlitz 
22392cc1cb1dSTonghao Zhang static int mlx5e_flow_namespace_max_modify_action(struct mlx5_core_dev *mdev,
22402cc1cb1dSTonghao Zhang 						  int namespace)
22412cc1cb1dSTonghao Zhang {
22422cc1cb1dSTonghao Zhang 	if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */
22432cc1cb1dSTonghao Zhang 		return MLX5_CAP_ESW_FLOWTABLE_FDB(mdev, max_modify_header_actions);
22442cc1cb1dSTonghao Zhang 	else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */
22452cc1cb1dSTonghao Zhang 		return MLX5_CAP_FLOWTABLE_NIC_RX(mdev, max_modify_header_actions);
22462cc1cb1dSTonghao Zhang }
22472cc1cb1dSTonghao Zhang 
2248d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv,
2249c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2250c500c86bSPablo Neira Ayuso 				 int namespace,
2251d79b6df6SOr Gerlitz 				 struct mlx5e_tc_flow_parse_attr *parse_attr)
2252d79b6df6SOr Gerlitz {
2253d79b6df6SOr Gerlitz 	int nkeys, action_size, max_actions;
2254d79b6df6SOr Gerlitz 
2255c500c86bSPablo Neira Ayuso 	nkeys = hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits +
2256c500c86bSPablo Neira Ayuso 		hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits;
2257d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
2258d79b6df6SOr Gerlitz 
22592cc1cb1dSTonghao Zhang 	max_actions = mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace);
2260d79b6df6SOr Gerlitz 	/* can get up to crazingly 16 HW actions in 32 bits pedit SW key */
2261d79b6df6SOr Gerlitz 	max_actions = min(max_actions, nkeys * 16);
2262d79b6df6SOr Gerlitz 
2263d79b6df6SOr Gerlitz 	parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL);
2264d79b6df6SOr Gerlitz 	if (!parse_attr->mod_hdr_actions)
2265d79b6df6SOr Gerlitz 		return -ENOMEM;
2266d79b6df6SOr Gerlitz 
2267218d05ceSTonghao Zhang 	parse_attr->max_mod_hdr_actions = max_actions;
2268d79b6df6SOr Gerlitz 	return 0;
2269d79b6df6SOr Gerlitz }
2270d79b6df6SOr Gerlitz 
2271d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {};
2272d79b6df6SOr Gerlitz 
2273d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv,
227473867881SPablo Neira Ayuso 				 const struct flow_action_entry *act, int namespace,
2275e98bedf5SEli Britstein 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2276c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2277e98bedf5SEli Britstein 				 struct netlink_ext_ack *extack)
2278d79b6df6SOr Gerlitz {
227973867881SPablo Neira Ayuso 	u8 cmd = (act->id == FLOW_ACTION_MANGLE) ? 0 : 1;
228073867881SPablo Neira Ayuso 	int err = -EOPNOTSUPP;
2281d79b6df6SOr Gerlitz 	u32 mask, val, offset;
228273867881SPablo Neira Ayuso 	u8 htype;
2283d79b6df6SOr Gerlitz 
228473867881SPablo Neira Ayuso 	htype = act->mangle.htype;
2285d79b6df6SOr Gerlitz 	err = -EOPNOTSUPP; /* can't be all optimistic */
2286d79b6df6SOr Gerlitz 
228773867881SPablo Neira Ayuso 	if (htype == FLOW_ACT_MANGLE_UNSPEC) {
228873867881SPablo Neira Ayuso 		NL_SET_ERR_MSG_MOD(extack, "legacy pedit isn't offloaded");
2289d79b6df6SOr Gerlitz 		goto out_err;
2290d79b6df6SOr Gerlitz 	}
2291d79b6df6SOr Gerlitz 
22922cc1cb1dSTonghao Zhang 	if (!mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace)) {
22932cc1cb1dSTonghao Zhang 		NL_SET_ERR_MSG_MOD(extack,
22942cc1cb1dSTonghao Zhang 				   "The pedit offload action is not supported");
22952cc1cb1dSTonghao Zhang 		goto out_err;
22962cc1cb1dSTonghao Zhang 	}
22972cc1cb1dSTonghao Zhang 
229873867881SPablo Neira Ayuso 	mask = act->mangle.mask;
229973867881SPablo Neira Ayuso 	val = act->mangle.val;
230073867881SPablo Neira Ayuso 	offset = act->mangle.offset;
2301d79b6df6SOr Gerlitz 
2302c500c86bSPablo Neira Ayuso 	err = set_pedit_val(htype, ~mask, val, offset, &hdrs[cmd]);
2303d79b6df6SOr Gerlitz 	if (err)
2304d79b6df6SOr Gerlitz 		goto out_err;
2305c500c86bSPablo Neira Ayuso 
2306c500c86bSPablo Neira Ayuso 	hdrs[cmd].pedits++;
2307d79b6df6SOr Gerlitz 
2308c500c86bSPablo Neira Ayuso 	return 0;
2309c500c86bSPablo Neira Ayuso out_err:
2310c500c86bSPablo Neira Ayuso 	return err;
2311c500c86bSPablo Neira Ayuso }
2312c500c86bSPablo Neira Ayuso 
2313c500c86bSPablo Neira Ayuso static int alloc_tc_pedit_action(struct mlx5e_priv *priv, int namespace,
2314c500c86bSPablo Neira Ayuso 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2315c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
231627c11b6bSEli Britstein 				 u32 *action_flags,
2317c500c86bSPablo Neira Ayuso 				 struct netlink_ext_ack *extack)
2318c500c86bSPablo Neira Ayuso {
2319c500c86bSPablo Neira Ayuso 	struct pedit_headers *cmd_masks;
2320c500c86bSPablo Neira Ayuso 	int err;
2321c500c86bSPablo Neira Ayuso 	u8 cmd;
2322c500c86bSPablo Neira Ayuso 
2323218d05ceSTonghao Zhang 	if (!parse_attr->mod_hdr_actions) {
2324c500c86bSPablo Neira Ayuso 		err = alloc_mod_hdr_actions(priv, hdrs, namespace, parse_attr);
2325d79b6df6SOr Gerlitz 		if (err)
2326d79b6df6SOr Gerlitz 			goto out_err;
2327218d05ceSTonghao Zhang 	}
2328d79b6df6SOr Gerlitz 
232927c11b6bSEli Britstein 	err = offload_pedit_fields(hdrs, parse_attr, action_flags, extack);
2330d79b6df6SOr Gerlitz 	if (err < 0)
2331d79b6df6SOr Gerlitz 		goto out_dealloc_parsed_actions;
2332d79b6df6SOr Gerlitz 
2333d79b6df6SOr Gerlitz 	for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) {
2334c500c86bSPablo Neira Ayuso 		cmd_masks = &hdrs[cmd].masks;
2335d79b6df6SOr Gerlitz 		if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) {
2336e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2337e98bedf5SEli Britstein 					   "attempt to offload an unsupported field");
2338b3a433deSOr Gerlitz 			netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd);
2339d79b6df6SOr Gerlitz 			print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS,
2340d79b6df6SOr Gerlitz 				       16, 1, cmd_masks, sizeof(zero_masks), true);
2341d79b6df6SOr Gerlitz 			err = -EOPNOTSUPP;
2342d79b6df6SOr Gerlitz 			goto out_dealloc_parsed_actions;
2343d79b6df6SOr Gerlitz 		}
2344d79b6df6SOr Gerlitz 	}
2345d79b6df6SOr Gerlitz 
2346d79b6df6SOr Gerlitz 	return 0;
2347d79b6df6SOr Gerlitz 
2348d79b6df6SOr Gerlitz out_dealloc_parsed_actions:
2349d79b6df6SOr Gerlitz 	kfree(parse_attr->mod_hdr_actions);
2350d79b6df6SOr Gerlitz out_err:
2351d79b6df6SOr Gerlitz 	return err;
2352d79b6df6SOr Gerlitz }
2353d79b6df6SOr Gerlitz 
2354e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv,
2355e98bedf5SEli Britstein 				   u32 action,
2356e98bedf5SEli Britstein 				   u32 update_flags,
2357e98bedf5SEli Britstein 				   struct netlink_ext_ack *extack)
235826c02749SOr Gerlitz {
235926c02749SOr Gerlitz 	u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP |
236026c02749SOr Gerlitz 			 TCA_CSUM_UPDATE_FLAG_UDP;
236126c02749SOr Gerlitz 
236226c02749SOr Gerlitz 	/*  The HW recalcs checksums only if re-writing headers */
236326c02749SOr Gerlitz 	if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) {
2364e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2365e98bedf5SEli Britstein 				   "TC csum action is only offloaded with pedit");
236626c02749SOr Gerlitz 		netdev_warn(priv->netdev,
236726c02749SOr Gerlitz 			    "TC csum action is only offloaded with pedit\n");
236826c02749SOr Gerlitz 		return false;
236926c02749SOr Gerlitz 	}
237026c02749SOr Gerlitz 
237126c02749SOr Gerlitz 	if (update_flags & ~prot_flags) {
2372e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2373e98bedf5SEli Britstein 				   "can't offload TC csum action for some header/s");
237426c02749SOr Gerlitz 		netdev_warn(priv->netdev,
237526c02749SOr Gerlitz 			    "can't offload TC csum action for some header/s - flags %#x\n",
237626c02749SOr Gerlitz 			    update_flags);
237726c02749SOr Gerlitz 		return false;
237826c02749SOr Gerlitz 	}
237926c02749SOr Gerlitz 
238026c02749SOr Gerlitz 	return true;
238126c02749SOr Gerlitz }
238226c02749SOr Gerlitz 
23838998576bSDmytro Linkin struct ip_ttl_word {
23848998576bSDmytro Linkin 	__u8	ttl;
23858998576bSDmytro Linkin 	__u8	protocol;
23868998576bSDmytro Linkin 	__sum16	check;
23878998576bSDmytro Linkin };
23888998576bSDmytro Linkin 
23898998576bSDmytro Linkin struct ipv6_hoplimit_word {
23908998576bSDmytro Linkin 	__be16	payload_len;
23918998576bSDmytro Linkin 	__u8	nexthdr;
23928998576bSDmytro Linkin 	__u8	hop_limit;
23938998576bSDmytro Linkin };
23948998576bSDmytro Linkin 
23958998576bSDmytro Linkin static bool is_action_keys_supported(const struct flow_action_entry *act)
23968998576bSDmytro Linkin {
23978998576bSDmytro Linkin 	u32 mask, offset;
23988998576bSDmytro Linkin 	u8 htype;
23998998576bSDmytro Linkin 
24008998576bSDmytro Linkin 	htype = act->mangle.htype;
24018998576bSDmytro Linkin 	offset = act->mangle.offset;
24028998576bSDmytro Linkin 	mask = ~act->mangle.mask;
24038998576bSDmytro Linkin 	/* For IPv4 & IPv6 header check 4 byte word,
24048998576bSDmytro Linkin 	 * to determine that modified fields
24058998576bSDmytro Linkin 	 * are NOT ttl & hop_limit only.
24068998576bSDmytro Linkin 	 */
24078998576bSDmytro Linkin 	if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP4) {
24088998576bSDmytro Linkin 		struct ip_ttl_word *ttl_word =
24098998576bSDmytro Linkin 			(struct ip_ttl_word *)&mask;
24108998576bSDmytro Linkin 
24118998576bSDmytro Linkin 		if (offset != offsetof(struct iphdr, ttl) ||
24128998576bSDmytro Linkin 		    ttl_word->protocol ||
24138998576bSDmytro Linkin 		    ttl_word->check) {
24148998576bSDmytro Linkin 			return true;
24158998576bSDmytro Linkin 		}
24168998576bSDmytro Linkin 	} else if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP6) {
24178998576bSDmytro Linkin 		struct ipv6_hoplimit_word *hoplimit_word =
24188998576bSDmytro Linkin 			(struct ipv6_hoplimit_word *)&mask;
24198998576bSDmytro Linkin 
24208998576bSDmytro Linkin 		if (offset != offsetof(struct ipv6hdr, payload_len) ||
24218998576bSDmytro Linkin 		    hoplimit_word->payload_len ||
24228998576bSDmytro Linkin 		    hoplimit_word->nexthdr) {
24238998576bSDmytro Linkin 			return true;
24248998576bSDmytro Linkin 		}
24258998576bSDmytro Linkin 	}
24268998576bSDmytro Linkin 	return false;
24278998576bSDmytro Linkin }
24288998576bSDmytro Linkin 
2429bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec,
243073867881SPablo Neira Ayuso 					  struct flow_action *flow_action,
24311651925dSGuy Shattah 					  u32 actions,
2432e98bedf5SEli Britstein 					  struct netlink_ext_ack *extack)
2433bdd66ac0SOr Gerlitz {
243473867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
2435bdd66ac0SOr Gerlitz 	bool modify_ip_header;
2436bdd66ac0SOr Gerlitz 	void *headers_v;
2437bdd66ac0SOr Gerlitz 	u16 ethertype;
24388998576bSDmytro Linkin 	u8 ip_proto;
243973867881SPablo Neira Ayuso 	int i;
2440bdd66ac0SOr Gerlitz 
24418377629eSEli Britstein 	headers_v = get_match_headers_value(actions, spec);
2442bdd66ac0SOr Gerlitz 	ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype);
2443bdd66ac0SOr Gerlitz 
2444bdd66ac0SOr Gerlitz 	/* for non-IP we only re-write MACs, so we're okay */
2445bdd66ac0SOr Gerlitz 	if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6)
2446bdd66ac0SOr Gerlitz 		goto out_ok;
2447bdd66ac0SOr Gerlitz 
2448bdd66ac0SOr Gerlitz 	modify_ip_header = false;
244973867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
245073867881SPablo Neira Ayuso 		if (act->id != FLOW_ACTION_MANGLE &&
245173867881SPablo Neira Ayuso 		    act->id != FLOW_ACTION_ADD)
2452bdd66ac0SOr Gerlitz 			continue;
2453bdd66ac0SOr Gerlitz 
24548998576bSDmytro Linkin 		if (is_action_keys_supported(act)) {
2455bdd66ac0SOr Gerlitz 			modify_ip_header = true;
2456bdd66ac0SOr Gerlitz 			break;
2457bdd66ac0SOr Gerlitz 		}
2458bdd66ac0SOr Gerlitz 	}
2459bdd66ac0SOr Gerlitz 
2460bdd66ac0SOr Gerlitz 	ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol);
24611ccef350SJianbo Liu 	if (modify_ip_header && ip_proto != IPPROTO_TCP &&
24621ccef350SJianbo Liu 	    ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) {
2463e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2464e98bedf5SEli Britstein 				   "can't offload re-write of non TCP/UDP");
2465bdd66ac0SOr Gerlitz 		pr_info("can't offload re-write of ip proto %d\n", ip_proto);
2466bdd66ac0SOr Gerlitz 		return false;
2467bdd66ac0SOr Gerlitz 	}
2468bdd66ac0SOr Gerlitz 
2469bdd66ac0SOr Gerlitz out_ok:
2470bdd66ac0SOr Gerlitz 	return true;
2471bdd66ac0SOr Gerlitz }
2472bdd66ac0SOr Gerlitz 
2473bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv,
247473867881SPablo Neira Ayuso 				    struct flow_action *flow_action,
2475bdd66ac0SOr Gerlitz 				    struct mlx5e_tc_flow_parse_attr *parse_attr,
2476e98bedf5SEli Britstein 				    struct mlx5e_tc_flow *flow,
2477e98bedf5SEli Britstein 				    struct netlink_ext_ack *extack)
2478bdd66ac0SOr Gerlitz {
2479bdd66ac0SOr Gerlitz 	u32 actions;
2480bdd66ac0SOr Gerlitz 
2481226f2ca3SVlad Buslov 	if (mlx5e_is_eswitch_flow(flow))
2482bdd66ac0SOr Gerlitz 		actions = flow->esw_attr->action;
2483bdd66ac0SOr Gerlitz 	else
2484bdd66ac0SOr Gerlitz 		actions = flow->nic_attr->action;
2485bdd66ac0SOr Gerlitz 
2486226f2ca3SVlad Buslov 	if (flow_flag_test(flow, EGRESS) &&
248735a605dbSEli Britstein 	    !((actions & MLX5_FLOW_CONTEXT_ACTION_DECAP) ||
24886830b468STonghao Zhang 	      (actions & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) ||
24896830b468STonghao Zhang 	      (actions & MLX5_FLOW_CONTEXT_ACTION_DROP)))
24907e29392eSRoi Dayan 		return false;
24917e29392eSRoi Dayan 
2492bdd66ac0SOr Gerlitz 	if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
249373867881SPablo Neira Ayuso 		return modify_header_match_supported(&parse_attr->spec,
2494a655fe9fSDavid S. Miller 						     flow_action, actions,
2495e98bedf5SEli Britstein 						     extack);
2496bdd66ac0SOr Gerlitz 
2497bdd66ac0SOr Gerlitz 	return true;
2498bdd66ac0SOr Gerlitz }
2499bdd66ac0SOr Gerlitz 
25005c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv)
25015c65c564SOr Gerlitz {
25025c65c564SOr Gerlitz 	struct mlx5_core_dev *fmdev, *pmdev;
2503816f6706SOr Gerlitz 	u64 fsystem_guid, psystem_guid;
25045c65c564SOr Gerlitz 
25055c65c564SOr Gerlitz 	fmdev = priv->mdev;
25065c65c564SOr Gerlitz 	pmdev = peer_priv->mdev;
25075c65c564SOr Gerlitz 
250859c9d35eSAlaa Hleihel 	fsystem_guid = mlx5_query_nic_system_image_guid(fmdev);
250959c9d35eSAlaa Hleihel 	psystem_guid = mlx5_query_nic_system_image_guid(pmdev);
25105c65c564SOr Gerlitz 
2511816f6706SOr Gerlitz 	return (fsystem_guid == psystem_guid);
25125c65c564SOr Gerlitz }
25135c65c564SOr Gerlitz 
2514bdc837eeSEli Britstein static int add_vlan_rewrite_action(struct mlx5e_priv *priv, int namespace,
2515bdc837eeSEli Britstein 				   const struct flow_action_entry *act,
2516bdc837eeSEli Britstein 				   struct mlx5e_tc_flow_parse_attr *parse_attr,
2517bdc837eeSEli Britstein 				   struct pedit_headers_action *hdrs,
2518bdc837eeSEli Britstein 				   u32 *action, struct netlink_ext_ack *extack)
2519bdc837eeSEli Britstein {
2520bdc837eeSEli Britstein 	u16 mask16 = VLAN_VID_MASK;
2521bdc837eeSEli Britstein 	u16 val16 = act->vlan.vid & VLAN_VID_MASK;
2522bdc837eeSEli Britstein 	const struct flow_action_entry pedit_act = {
2523bdc837eeSEli Britstein 		.id = FLOW_ACTION_MANGLE,
2524bdc837eeSEli Britstein 		.mangle.htype = FLOW_ACT_MANGLE_HDR_TYPE_ETH,
2525bdc837eeSEli Britstein 		.mangle.offset = offsetof(struct vlan_ethhdr, h_vlan_TCI),
2526bdc837eeSEli Britstein 		.mangle.mask = ~(u32)be16_to_cpu(*(__be16 *)&mask16),
2527bdc837eeSEli Britstein 		.mangle.val = (u32)be16_to_cpu(*(__be16 *)&val16),
2528bdc837eeSEli Britstein 	};
25296fca9d1eSEli Britstein 	u8 match_prio_mask, match_prio_val;
2530bf2f3bcaSEli Britstein 	void *headers_c, *headers_v;
2531bdc837eeSEli Britstein 	int err;
2532bdc837eeSEli Britstein 
2533bf2f3bcaSEli Britstein 	headers_c = get_match_headers_criteria(*action, &parse_attr->spec);
2534bf2f3bcaSEli Britstein 	headers_v = get_match_headers_value(*action, &parse_attr->spec);
2535bf2f3bcaSEli Britstein 
2536bf2f3bcaSEli Britstein 	if (!(MLX5_GET(fte_match_set_lyr_2_4, headers_c, cvlan_tag) &&
2537bf2f3bcaSEli Britstein 	      MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag))) {
2538bf2f3bcaSEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2539bf2f3bcaSEli Britstein 				   "VLAN rewrite action must have VLAN protocol match");
2540bf2f3bcaSEli Britstein 		return -EOPNOTSUPP;
2541bf2f3bcaSEli Britstein 	}
2542bf2f3bcaSEli Britstein 
25436fca9d1eSEli Britstein 	match_prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio);
25446fca9d1eSEli Britstein 	match_prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio);
25456fca9d1eSEli Britstein 	if (act->vlan.prio != (match_prio_val & match_prio_mask)) {
25466fca9d1eSEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
25476fca9d1eSEli Britstein 				   "Changing VLAN prio is not supported");
2548bdc837eeSEli Britstein 		return -EOPNOTSUPP;
2549bdc837eeSEli Britstein 	}
2550bdc837eeSEli Britstein 
2551bdc837eeSEli Britstein 	err = parse_tc_pedit_action(priv, &pedit_act, namespace, parse_attr,
2552bdc837eeSEli Britstein 				    hdrs, NULL);
2553bdc837eeSEli Britstein 	*action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
2554bdc837eeSEli Britstein 
2555bdc837eeSEli Britstein 	return err;
2556bdc837eeSEli Britstein }
2557bdc837eeSEli Britstein 
25580bac1194SEli Britstein static int
25590bac1194SEli Britstein add_vlan_prio_tag_rewrite_action(struct mlx5e_priv *priv,
25600bac1194SEli Britstein 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
25610bac1194SEli Britstein 				 struct pedit_headers_action *hdrs,
25620bac1194SEli Britstein 				 u32 *action, struct netlink_ext_ack *extack)
25630bac1194SEli Britstein {
25640bac1194SEli Britstein 	const struct flow_action_entry prio_tag_act = {
25650bac1194SEli Britstein 		.vlan.vid = 0,
25660bac1194SEli Britstein 		.vlan.prio =
25670bac1194SEli Britstein 			MLX5_GET(fte_match_set_lyr_2_4,
25680bac1194SEli Britstein 				 get_match_headers_value(*action,
25690bac1194SEli Britstein 							 &parse_attr->spec),
25700bac1194SEli Britstein 				 first_prio) &
25710bac1194SEli Britstein 			MLX5_GET(fte_match_set_lyr_2_4,
25720bac1194SEli Britstein 				 get_match_headers_criteria(*action,
25730bac1194SEli Britstein 							    &parse_attr->spec),
25740bac1194SEli Britstein 				 first_prio),
25750bac1194SEli Britstein 	};
25760bac1194SEli Britstein 
25770bac1194SEli Britstein 	return add_vlan_rewrite_action(priv, MLX5_FLOW_NAMESPACE_FDB,
25780bac1194SEli Britstein 				       &prio_tag_act, parse_attr, hdrs, action,
25790bac1194SEli Britstein 				       extack);
25800bac1194SEli Britstein }
25810bac1194SEli Britstein 
258273867881SPablo Neira Ayuso static int parse_tc_nic_actions(struct mlx5e_priv *priv,
258373867881SPablo Neira Ayuso 				struct flow_action *flow_action,
2584aa0cbbaeSOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr,
2585e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2586e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2587e3a2b7edSAmir Vadai {
2588aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
258973867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
259073867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
25911cab1cd7SOr Gerlitz 	u32 action = 0;
2592244cd96aSCong Wang 	int err, i;
2593e3a2b7edSAmir Vadai 
259473867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
2595e3a2b7edSAmir Vadai 		return -EINVAL;
2596e3a2b7edSAmir Vadai 
25973bc4b7bfSOr Gerlitz 	attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG;
2598e3a2b7edSAmir Vadai 
259973867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
260073867881SPablo Neira Ayuso 		switch (act->id) {
260173867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
26021cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP;
2603aad7e08dSAmir Vadai 			if (MLX5_CAP_FLOWTABLE(priv->mdev,
2604aad7e08dSAmir Vadai 					       flow_table_properties_nic_receive.flow_counter))
26051cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
260673867881SPablo Neira Ayuso 			break;
260773867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
260873867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
260973867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_KERNEL,
2610c500c86bSPablo Neira Ayuso 						    parse_attr, hdrs, extack);
26112f4fe4caSOr Gerlitz 			if (err)
26122f4fe4caSOr Gerlitz 				return err;
26132f4fe4caSOr Gerlitz 
26141cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR |
26152f4fe4caSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
261673867881SPablo Neira Ayuso 			break;
2617bdc837eeSEli Britstein 		case FLOW_ACTION_VLAN_MANGLE:
2618bdc837eeSEli Britstein 			err = add_vlan_rewrite_action(priv,
2619bdc837eeSEli Britstein 						      MLX5_FLOW_NAMESPACE_KERNEL,
2620bdc837eeSEli Britstein 						      act, parse_attr, hdrs,
2621bdc837eeSEli Britstein 						      &action, extack);
2622bdc837eeSEli Britstein 			if (err)
2623bdc837eeSEli Britstein 				return err;
2624bdc837eeSEli Britstein 
2625bdc837eeSEli Britstein 			break;
262673867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
26271cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
262873867881SPablo Neira Ayuso 						   act->csum_flags,
2629e98bedf5SEli Britstein 						   extack))
263073867881SPablo Neira Ayuso 				break;
263126c02749SOr Gerlitz 
263226c02749SOr Gerlitz 			return -EOPNOTSUPP;
263373867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT: {
263473867881SPablo Neira Ayuso 			struct net_device *peer_dev = act->dev;
26355c65c564SOr Gerlitz 
26365c65c564SOr Gerlitz 			if (priv->netdev->netdev_ops == peer_dev->netdev_ops &&
26375c65c564SOr Gerlitz 			    same_hw_devs(priv, netdev_priv(peer_dev))) {
263898b66cb1SEli Britstein 				parse_attr->mirred_ifindex[0] = peer_dev->ifindex;
2639226f2ca3SVlad Buslov 				flow_flag_set(flow, HAIRPIN);
26401cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
26415c65c564SOr Gerlitz 					  MLX5_FLOW_CONTEXT_ACTION_COUNT;
26425c65c564SOr Gerlitz 			} else {
2643e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2644e98bedf5SEli Britstein 						   "device is not on same HW, can't offload");
26455c65c564SOr Gerlitz 				netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n",
26465c65c564SOr Gerlitz 					    peer_dev->name);
26475c65c564SOr Gerlitz 				return -EINVAL;
26485c65c564SOr Gerlitz 			}
26495c65c564SOr Gerlitz 			}
265073867881SPablo Neira Ayuso 			break;
265173867881SPablo Neira Ayuso 		case FLOW_ACTION_MARK: {
265273867881SPablo Neira Ayuso 			u32 mark = act->mark;
2653e3a2b7edSAmir Vadai 
2654e3a2b7edSAmir Vadai 			if (mark & ~MLX5E_TC_FLOW_ID_MASK) {
2655e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2656e98bedf5SEli Britstein 						   "Bad flow mark - only 16 bit is supported");
2657e3a2b7edSAmir Vadai 				return -EINVAL;
2658e3a2b7edSAmir Vadai 			}
2659e3a2b7edSAmir Vadai 
26603bc4b7bfSOr Gerlitz 			attr->flow_tag = mark;
26611cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
2662e3a2b7edSAmir Vadai 			}
266373867881SPablo Neira Ayuso 			break;
266473867881SPablo Neira Ayuso 		default:
26652cc1cb1dSTonghao Zhang 			NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported");
26662cc1cb1dSTonghao Zhang 			return -EOPNOTSUPP;
2667e3a2b7edSAmir Vadai 		}
266873867881SPablo Neira Ayuso 	}
2669e3a2b7edSAmir Vadai 
2670c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
2671c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
2672c500c86bSPablo Neira Ayuso 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL,
267327c11b6bSEli Britstein 					    parse_attr, hdrs, &action, extack);
2674c500c86bSPablo Neira Ayuso 		if (err)
2675c500c86bSPablo Neira Ayuso 			return err;
267627c11b6bSEli Britstein 		/* in case all pedit actions are skipped, remove the MOD_HDR
267727c11b6bSEli Britstein 		 * flag.
267827c11b6bSEli Britstein 		 */
2679e7739a60SEli Britstein 		if (parse_attr->num_mod_hdr_actions == 0) {
268027c11b6bSEli Britstein 			action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
2681e7739a60SEli Britstein 			kfree(parse_attr->mod_hdr_actions);
2682e7739a60SEli Britstein 		}
2683c500c86bSPablo Neira Ayuso 	}
2684c500c86bSPablo Neira Ayuso 
26851cab1cd7SOr Gerlitz 	attr->action = action;
268673867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
2687bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
2688bdd66ac0SOr Gerlitz 
2689e3a2b7edSAmir Vadai 	return 0;
2690e3a2b7edSAmir Vadai }
2691e3a2b7edSAmir Vadai 
26927f1a546eSEli Britstein struct encap_key {
26931f6da306SYevgeny Kliteynik 	const struct ip_tunnel_key *ip_tun_key;
2694d386939aSYevgeny Kliteynik 	struct mlx5e_tc_tunnel *tc_tunnel;
26957f1a546eSEli Britstein };
26967f1a546eSEli Britstein 
26977f1a546eSEli Britstein static inline int cmp_encap_info(struct encap_key *a,
26987f1a546eSEli Britstein 				 struct encap_key *b)
2699a54e20b4SHadar Hen Zion {
27007f1a546eSEli Britstein 	return memcmp(a->ip_tun_key, b->ip_tun_key, sizeof(*a->ip_tun_key)) ||
2701d386939aSYevgeny Kliteynik 	       a->tc_tunnel->tunnel_type != b->tc_tunnel->tunnel_type;
2702a54e20b4SHadar Hen Zion }
2703a54e20b4SHadar Hen Zion 
27047f1a546eSEli Britstein static inline int hash_encap_info(struct encap_key *key)
2705a54e20b4SHadar Hen Zion {
27067f1a546eSEli Britstein 	return jhash(key->ip_tun_key, sizeof(*key->ip_tun_key),
2707d386939aSYevgeny Kliteynik 		     key->tc_tunnel->tunnel_type);
2708a54e20b4SHadar Hen Zion }
2709a54e20b4SHadar Hen Zion 
2710a54e20b4SHadar Hen Zion 
2711b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv,
2712b1d90e6bSRabie Loulou 				  struct net_device *peer_netdev)
2713b1d90e6bSRabie Loulou {
2714b1d90e6bSRabie Loulou 	struct mlx5e_priv *peer_priv;
2715b1d90e6bSRabie Loulou 
2716b1d90e6bSRabie Loulou 	peer_priv = netdev_priv(peer_netdev);
2717b1d90e6bSRabie Loulou 
2718b1d90e6bSRabie Loulou 	return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) &&
271968931c7dSRoi Dayan 		mlx5e_eswitch_rep(priv->netdev) &&
272068931c7dSRoi Dayan 		mlx5e_eswitch_rep(peer_netdev) &&
272168931c7dSRoi Dayan 		same_hw_devs(priv, peer_priv));
2722b1d90e6bSRabie Loulou }
2723b1d90e6bSRabie Loulou 
2724ce99f6b9SOr Gerlitz 
272554c177caSOz Shlomo 
2726a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv,
2727e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
2728733d4f36SRoi Dayan 			      struct net_device *mirred_dev,
2729733d4f36SRoi Dayan 			      int out_index,
27308c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
27310ad060eeSRoi Dayan 			      struct net_device **encap_dev,
27320ad060eeSRoi Dayan 			      bool *encap_valid)
273303a9d11eSOr Gerlitz {
2734a54e20b4SHadar Hen Zion 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
273545247bf2SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
2736733d4f36SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
27371f6da306SYevgeny Kliteynik 	const struct ip_tunnel_info *tun_info;
27387f1a546eSEli Britstein 	struct encap_key key, e_key;
2739c1ae1152SOr Gerlitz 	struct mlx5e_encap_entry *e;
2740733d4f36SRoi Dayan 	unsigned short family;
2741a54e20b4SHadar Hen Zion 	uintptr_t hash_key;
2742a54e20b4SHadar Hen Zion 	bool found = false;
274354c177caSOz Shlomo 	int err = 0;
2744a54e20b4SHadar Hen Zion 
2745733d4f36SRoi Dayan 	parse_attr = attr->parse_attr;
27461f6da306SYevgeny Kliteynik 	tun_info = parse_attr->tun_info[out_index];
2747733d4f36SRoi Dayan 	family = ip_tunnel_info_af(tun_info);
27487f1a546eSEli Britstein 	key.ip_tun_key = &tun_info->key;
2749d386939aSYevgeny Kliteynik 	key.tc_tunnel = mlx5e_get_tc_tun(mirred_dev);
2750d71f895cSEli Cohen 	if (!key.tc_tunnel) {
2751d71f895cSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "Unsupported tunnel");
2752d71f895cSEli Cohen 		return -EOPNOTSUPP;
2753d71f895cSEli Cohen 	}
2754733d4f36SRoi Dayan 
27557f1a546eSEli Britstein 	hash_key = hash_encap_info(&key);
2756a54e20b4SHadar Hen Zion 
2757a54e20b4SHadar Hen Zion 	hash_for_each_possible_rcu(esw->offloads.encap_tbl, e,
2758a54e20b4SHadar Hen Zion 				   encap_hlist, hash_key) {
27591f6da306SYevgeny Kliteynik 		e_key.ip_tun_key = &e->tun_info->key;
2760d386939aSYevgeny Kliteynik 		e_key.tc_tunnel = e->tunnel;
27617f1a546eSEli Britstein 		if (!cmp_encap_info(&e_key, &key)) {
2762a54e20b4SHadar Hen Zion 			found = true;
2763a54e20b4SHadar Hen Zion 			break;
2764a54e20b4SHadar Hen Zion 		}
2765a54e20b4SHadar Hen Zion 	}
2766a54e20b4SHadar Hen Zion 
2767b2812089SVlad Buslov 	/* must verify if encap is valid or not */
276845247bf2SOr Gerlitz 	if (found)
276945247bf2SOr Gerlitz 		goto attach_flow;
2770a54e20b4SHadar Hen Zion 
2771a54e20b4SHadar Hen Zion 	e = kzalloc(sizeof(*e), GFP_KERNEL);
2772a54e20b4SHadar Hen Zion 	if (!e)
2773a54e20b4SHadar Hen Zion 		return -ENOMEM;
2774a54e20b4SHadar Hen Zion 
27751f6da306SYevgeny Kliteynik 	e->tun_info = tun_info;
2776101f4de9SOz Shlomo 	err = mlx5e_tc_tun_init_encap_attr(mirred_dev, priv, e, extack);
277754c177caSOz Shlomo 	if (err)
277854c177caSOz Shlomo 		goto out_err;
277954c177caSOz Shlomo 
2780a54e20b4SHadar Hen Zion 	INIT_LIST_HEAD(&e->flows);
2781a54e20b4SHadar Hen Zion 
2782ce99f6b9SOr Gerlitz 	if (family == AF_INET)
2783101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv4(priv, mirred_dev, e);
2784ce99f6b9SOr Gerlitz 	else if (family == AF_INET6)
2785101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv6(priv, mirred_dev, e);
2786ce99f6b9SOr Gerlitz 
27870ad060eeSRoi Dayan 	if (err)
2788a54e20b4SHadar Hen Zion 		goto out_err;
2789a54e20b4SHadar Hen Zion 
2790a54e20b4SHadar Hen Zion 	hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key);
2791a54e20b4SHadar Hen Zion 
279245247bf2SOr Gerlitz attach_flow:
27938c4dc42bSEli Britstein 	list_add(&flow->encaps[out_index].list, &e->flows);
27948c4dc42bSEli Britstein 	flow->encaps[out_index].index = out_index;
279545247bf2SOr Gerlitz 	*encap_dev = e->out_dev;
27968c4dc42bSEli Britstein 	if (e->flags & MLX5_ENCAP_ENTRY_VALID) {
27978c4dc42bSEli Britstein 		attr->dests[out_index].encap_id = e->encap_id;
27988c4dc42bSEli Britstein 		attr->dests[out_index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
27990ad060eeSRoi Dayan 		*encap_valid = true;
28008c4dc42bSEli Britstein 	} else {
28010ad060eeSRoi Dayan 		*encap_valid = false;
28028c4dc42bSEli Britstein 	}
280345247bf2SOr Gerlitz 
2804232c0013SHadar Hen Zion 	return err;
2805a54e20b4SHadar Hen Zion 
2806a54e20b4SHadar Hen Zion out_err:
2807a54e20b4SHadar Hen Zion 	kfree(e);
2808a54e20b4SHadar Hen Zion 	return err;
2809a54e20b4SHadar Hen Zion }
2810a54e20b4SHadar Hen Zion 
28111482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv,
281273867881SPablo Neira Ayuso 				const struct flow_action_entry *act,
28131482bd3dSJianbo Liu 				struct mlx5_esw_flow_attr *attr,
28141482bd3dSJianbo Liu 				u32 *action)
28151482bd3dSJianbo Liu {
2816cc495188SJianbo Liu 	u8 vlan_idx = attr->total_vlan;
2817cc495188SJianbo Liu 
2818cc495188SJianbo Liu 	if (vlan_idx >= MLX5_FS_VLAN_DEPTH)
28191482bd3dSJianbo Liu 		return -EOPNOTSUPP;
2820cc495188SJianbo Liu 
282173867881SPablo Neira Ayuso 	switch (act->id) {
282273867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_POP:
2823cc495188SJianbo Liu 		if (vlan_idx) {
2824cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2825cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2826cc495188SJianbo Liu 				return -EOPNOTSUPP;
2827cc495188SJianbo Liu 
2828cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2;
2829cc495188SJianbo Liu 		} else {
2830cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
2831cc495188SJianbo Liu 		}
283273867881SPablo Neira Ayuso 		break;
283373867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_PUSH:
283473867881SPablo Neira Ayuso 		attr->vlan_vid[vlan_idx] = act->vlan.vid;
283573867881SPablo Neira Ayuso 		attr->vlan_prio[vlan_idx] = act->vlan.prio;
283673867881SPablo Neira Ayuso 		attr->vlan_proto[vlan_idx] = act->vlan.proto;
2837cc495188SJianbo Liu 		if (!attr->vlan_proto[vlan_idx])
2838cc495188SJianbo Liu 			attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q);
2839cc495188SJianbo Liu 
2840cc495188SJianbo Liu 		if (vlan_idx) {
2841cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2842cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2843cc495188SJianbo Liu 				return -EOPNOTSUPP;
2844cc495188SJianbo Liu 
2845cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2;
2846cc495188SJianbo Liu 		} else {
2847cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) &&
284873867881SPablo Neira Ayuso 			    (act->vlan.proto != htons(ETH_P_8021Q) ||
284973867881SPablo Neira Ayuso 			     act->vlan.prio))
2850cc495188SJianbo Liu 				return -EOPNOTSUPP;
2851cc495188SJianbo Liu 
2852cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH;
28531482bd3dSJianbo Liu 		}
285473867881SPablo Neira Ayuso 		break;
285573867881SPablo Neira Ayuso 	default:
2856bdc837eeSEli Britstein 		return -EINVAL;
28571482bd3dSJianbo Liu 	}
28581482bd3dSJianbo Liu 
2859cc495188SJianbo Liu 	attr->total_vlan = vlan_idx + 1;
2860cc495188SJianbo Liu 
28611482bd3dSJianbo Liu 	return 0;
28621482bd3dSJianbo Liu }
28631482bd3dSJianbo Liu 
2864278748a9SEli Britstein static int add_vlan_push_action(struct mlx5e_priv *priv,
2865278748a9SEli Britstein 				struct mlx5_esw_flow_attr *attr,
2866278748a9SEli Britstein 				struct net_device **out_dev,
2867278748a9SEli Britstein 				u32 *action)
2868278748a9SEli Britstein {
2869278748a9SEli Britstein 	struct net_device *vlan_dev = *out_dev;
2870278748a9SEli Britstein 	struct flow_action_entry vlan_act = {
2871278748a9SEli Britstein 		.id = FLOW_ACTION_VLAN_PUSH,
2872278748a9SEli Britstein 		.vlan.vid = vlan_dev_vlan_id(vlan_dev),
2873278748a9SEli Britstein 		.vlan.proto = vlan_dev_vlan_proto(vlan_dev),
2874278748a9SEli Britstein 		.vlan.prio = 0,
2875278748a9SEli Britstein 	};
2876278748a9SEli Britstein 	int err;
2877278748a9SEli Britstein 
2878278748a9SEli Britstein 	err = parse_tc_vlan_action(priv, &vlan_act, attr, action);
2879278748a9SEli Britstein 	if (err)
2880278748a9SEli Britstein 		return err;
2881278748a9SEli Britstein 
2882278748a9SEli Britstein 	*out_dev = dev_get_by_index_rcu(dev_net(vlan_dev),
2883278748a9SEli Britstein 					dev_get_iflink(vlan_dev));
2884278748a9SEli Britstein 	if (is_vlan_dev(*out_dev))
2885278748a9SEli Britstein 		err = add_vlan_push_action(priv, attr, out_dev, action);
2886278748a9SEli Britstein 
2887278748a9SEli Britstein 	return err;
2888278748a9SEli Britstein }
2889278748a9SEli Britstein 
289035a605dbSEli Britstein static int add_vlan_pop_action(struct mlx5e_priv *priv,
289135a605dbSEli Britstein 			       struct mlx5_esw_flow_attr *attr,
289235a605dbSEli Britstein 			       u32 *action)
289335a605dbSEli Britstein {
289435a605dbSEli Britstein 	int nest_level = vlan_get_encap_level(attr->parse_attr->filter_dev);
289535a605dbSEli Britstein 	struct flow_action_entry vlan_act = {
289635a605dbSEli Britstein 		.id = FLOW_ACTION_VLAN_POP,
289735a605dbSEli Britstein 	};
289835a605dbSEli Britstein 	int err = 0;
289935a605dbSEli Britstein 
290035a605dbSEli Britstein 	while (nest_level--) {
290135a605dbSEli Britstein 		err = parse_tc_vlan_action(priv, &vlan_act, attr, action);
290235a605dbSEli Britstein 		if (err)
290335a605dbSEli Britstein 			return err;
290435a605dbSEli Britstein 	}
290535a605dbSEli Britstein 
290635a605dbSEli Britstein 	return err;
290735a605dbSEli Britstein }
290835a605dbSEli Britstein 
2909f6dc1264SPaul Blakey bool mlx5e_is_valid_eswitch_fwd_dev(struct mlx5e_priv *priv,
2910f6dc1264SPaul Blakey 				    struct net_device *out_dev)
2911f6dc1264SPaul Blakey {
2912f6dc1264SPaul Blakey 	if (is_merged_eswitch_dev(priv, out_dev))
2913f6dc1264SPaul Blakey 		return true;
2914f6dc1264SPaul Blakey 
2915f6dc1264SPaul Blakey 	return mlx5e_eswitch_rep(out_dev) &&
2916f6dc1264SPaul Blakey 	       same_hw_devs(priv, netdev_priv(out_dev));
2917f6dc1264SPaul Blakey }
2918f6dc1264SPaul Blakey 
291973867881SPablo Neira Ayuso static int parse_tc_fdb_actions(struct mlx5e_priv *priv,
292073867881SPablo Neira Ayuso 				struct flow_action *flow_action,
2921e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2922e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2923a54e20b4SHadar Hen Zion {
292473867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
2925bf07aa73SPaul Blakey 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2926ecf5bb79SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
29276f9af8ffSTonghao Zhang 	struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr;
29281d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
292973867881SPablo Neira Ayuso 	const struct ip_tunnel_info *info = NULL;
293073867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
2931a54e20b4SHadar Hen Zion 	bool encap = false;
29321cab1cd7SOr Gerlitz 	u32 action = 0;
2933244cd96aSCong Wang 	int err, i;
293403a9d11eSOr Gerlitz 
293573867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
293603a9d11eSOr Gerlitz 		return -EINVAL;
293703a9d11eSOr Gerlitz 
293873867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
293973867881SPablo Neira Ayuso 		switch (act->id) {
294073867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
29411cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP |
294203a9d11eSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
294373867881SPablo Neira Ayuso 			break;
294473867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
294573867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
294673867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_FDB,
2947c500c86bSPablo Neira Ayuso 						    parse_attr, hdrs, extack);
2948d7e75a32SOr Gerlitz 			if (err)
2949d7e75a32SOr Gerlitz 				return err;
2950d7e75a32SOr Gerlitz 
29511cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
2952e85e02baSEli Britstein 			attr->split_count = attr->out_count;
295373867881SPablo Neira Ayuso 			break;
295473867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
29551cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
295673867881SPablo Neira Ayuso 						   act->csum_flags, extack))
295773867881SPablo Neira Ayuso 				break;
295826c02749SOr Gerlitz 
295926c02749SOr Gerlitz 			return -EOPNOTSUPP;
296073867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT:
296173867881SPablo Neira Ayuso 		case FLOW_ACTION_MIRRED: {
296203a9d11eSOr Gerlitz 			struct mlx5e_priv *out_priv;
2963592d3651SChris Mi 			struct net_device *out_dev;
296403a9d11eSOr Gerlitz 
296573867881SPablo Neira Ayuso 			out_dev = act->dev;
2966ef381359SOz Shlomo 			if (!out_dev) {
2967ef381359SOz Shlomo 				/* out_dev is NULL when filters with
2968ef381359SOz Shlomo 				 * non-existing mirred device are replayed to
2969ef381359SOz Shlomo 				 * the driver.
2970ef381359SOz Shlomo 				 */
2971ef381359SOz Shlomo 				return -EINVAL;
2972ef381359SOz Shlomo 			}
297303a9d11eSOr Gerlitz 
2974592d3651SChris Mi 			if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) {
2975e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2976e98bedf5SEli Britstein 						   "can't support more output ports, can't offload forwarding");
2977592d3651SChris Mi 				pr_err("can't support more than %d output ports, can't offload forwarding\n",
2978592d3651SChris Mi 				       attr->out_count);
2979592d3651SChris Mi 				return -EOPNOTSUPP;
2980592d3651SChris Mi 			}
2981592d3651SChris Mi 
2982f493f155SEli Britstein 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
2983f493f155SEli Britstein 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
2984f6dc1264SPaul Blakey 			if (netdev_port_same_parent_id(priv->netdev, out_dev)) {
29857ba58ba7SRabie Loulou 				struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
29867ba58ba7SRabie Loulou 				struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH);
2987fa833bd5SVlad Buslov 				struct net_device *uplink_upper;
29887ba58ba7SRabie Loulou 
2989fa833bd5SVlad Buslov 				rcu_read_lock();
2990fa833bd5SVlad Buslov 				uplink_upper =
2991fa833bd5SVlad Buslov 					netdev_master_upper_dev_get_rcu(uplink_dev);
29927ba58ba7SRabie Loulou 				if (uplink_upper &&
29937ba58ba7SRabie Loulou 				    netif_is_lag_master(uplink_upper) &&
29947ba58ba7SRabie Loulou 				    uplink_upper == out_dev)
29957ba58ba7SRabie Loulou 					out_dev = uplink_dev;
2996fa833bd5SVlad Buslov 				rcu_read_unlock();
29977ba58ba7SRabie Loulou 
2998278748a9SEli Britstein 				if (is_vlan_dev(out_dev)) {
2999278748a9SEli Britstein 					err = add_vlan_push_action(priv, attr,
3000278748a9SEli Britstein 								   &out_dev,
3001278748a9SEli Britstein 								   &action);
3002278748a9SEli Britstein 					if (err)
3003278748a9SEli Britstein 						return err;
3004278748a9SEli Britstein 				}
3005f6dc1264SPaul Blakey 
300635a605dbSEli Britstein 				if (is_vlan_dev(parse_attr->filter_dev)) {
300735a605dbSEli Britstein 					err = add_vlan_pop_action(priv, attr,
300835a605dbSEli Britstein 								  &action);
300935a605dbSEli Britstein 					if (err)
301035a605dbSEli Britstein 						return err;
301135a605dbSEli Britstein 				}
3012278748a9SEli Britstein 
3013f6dc1264SPaul Blakey 				if (!mlx5e_is_valid_eswitch_fwd_dev(priv, out_dev)) {
3014f6dc1264SPaul Blakey 					NL_SET_ERR_MSG_MOD(extack,
3015f6dc1264SPaul Blakey 							   "devices are not on same switch HW, can't offload forwarding");
3016f6dc1264SPaul Blakey 					pr_err("devices %s %s not on same switch HW, can't offload forwarding\n",
3017f6dc1264SPaul Blakey 					       priv->netdev->name, out_dev->name);
3018a0646c88SEli Britstein 					return -EOPNOTSUPP;
3019f6dc1264SPaul Blakey 				}
3020a0646c88SEli Britstein 
302103a9d11eSOr Gerlitz 				out_priv = netdev_priv(out_dev);
30221d447a39SSaeed Mahameed 				rpriv = out_priv->ppriv;
3023df65a573SEli Britstein 				attr->dests[attr->out_count].rep = rpriv->rep;
3024df65a573SEli Britstein 				attr->dests[attr->out_count].mdev = out_priv->mdev;
3025df65a573SEli Britstein 				attr->out_count++;
3026a54e20b4SHadar Hen Zion 			} else if (encap) {
30278c4dc42bSEli Britstein 				parse_attr->mirred_ifindex[attr->out_count] =
30288c4dc42bSEli Britstein 					out_dev->ifindex;
30291f6da306SYevgeny Kliteynik 				parse_attr->tun_info[attr->out_count] = info;
30308c4dc42bSEli Britstein 				encap = false;
3031f493f155SEli Britstein 				attr->dests[attr->out_count].flags |=
3032f493f155SEli Britstein 					MLX5_ESW_DEST_ENCAP;
30331cc26d74SEli Britstein 				attr->out_count++;
3034df65a573SEli Britstein 				/* attr->dests[].rep is resolved when we
3035df65a573SEli Britstein 				 * handle encap
3036df65a573SEli Britstein 				 */
3037ef381359SOz Shlomo 			} else if (parse_attr->filter_dev != priv->netdev) {
3038ef381359SOz Shlomo 				/* All mlx5 devices are called to configure
3039ef381359SOz Shlomo 				 * high level device filters. Therefore, the
3040ef381359SOz Shlomo 				 * *attempt* to  install a filter on invalid
3041ef381359SOz Shlomo 				 * eswitch should not trigger an explicit error
3042ef381359SOz Shlomo 				 */
3043ef381359SOz Shlomo 				return -EINVAL;
3044a54e20b4SHadar Hen Zion 			} else {
3045e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
3046e98bedf5SEli Britstein 						   "devices are not on same switch HW, can't offload forwarding");
3047a54e20b4SHadar Hen Zion 				pr_err("devices %s %s not on same switch HW, can't offload forwarding\n",
3048a54e20b4SHadar Hen Zion 				       priv->netdev->name, out_dev->name);
3049a54e20b4SHadar Hen Zion 				return -EINVAL;
3050a54e20b4SHadar Hen Zion 			}
3051a54e20b4SHadar Hen Zion 			}
305273867881SPablo Neira Ayuso 			break;
305373867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_ENCAP:
305473867881SPablo Neira Ayuso 			info = act->tunnel;
3055a54e20b4SHadar Hen Zion 			if (info)
3056a54e20b4SHadar Hen Zion 				encap = true;
3057a54e20b4SHadar Hen Zion 			else
3058a54e20b4SHadar Hen Zion 				return -EOPNOTSUPP;
305903a9d11eSOr Gerlitz 
306073867881SPablo Neira Ayuso 			break;
306173867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_PUSH:
306273867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_POP:
306376b496b1SEli Britstein 			if (act->id == FLOW_ACTION_VLAN_PUSH &&
306476b496b1SEli Britstein 			    (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP)) {
306576b496b1SEli Britstein 				/* Replace vlan pop+push with vlan modify */
306676b496b1SEli Britstein 				action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
306776b496b1SEli Britstein 				err = add_vlan_rewrite_action(priv,
306876b496b1SEli Britstein 							      MLX5_FLOW_NAMESPACE_FDB,
306976b496b1SEli Britstein 							      act, parse_attr, hdrs,
307076b496b1SEli Britstein 							      &action, extack);
307176b496b1SEli Britstein 			} else {
307273867881SPablo Neira Ayuso 				err = parse_tc_vlan_action(priv, act, attr, &action);
307376b496b1SEli Britstein 			}
30741482bd3dSJianbo Liu 			if (err)
30751482bd3dSJianbo Liu 				return err;
30761482bd3dSJianbo Liu 
3077e85e02baSEli Britstein 			attr->split_count = attr->out_count;
307873867881SPablo Neira Ayuso 			break;
3079bdc837eeSEli Britstein 		case FLOW_ACTION_VLAN_MANGLE:
3080bdc837eeSEli Britstein 			err = add_vlan_rewrite_action(priv,
3081bdc837eeSEli Britstein 						      MLX5_FLOW_NAMESPACE_FDB,
3082bdc837eeSEli Britstein 						      act, parse_attr, hdrs,
3083bdc837eeSEli Britstein 						      &action, extack);
3084bdc837eeSEli Britstein 			if (err)
3085bdc837eeSEli Britstein 				return err;
3086bdc837eeSEli Britstein 
3087bdc837eeSEli Britstein 			attr->split_count = attr->out_count;
3088bdc837eeSEli Britstein 			break;
308973867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_DECAP:
30901cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DECAP;
309173867881SPablo Neira Ayuso 			break;
309273867881SPablo Neira Ayuso 		case FLOW_ACTION_GOTO: {
309373867881SPablo Neira Ayuso 			u32 dest_chain = act->chain_index;
3094bf07aa73SPaul Blakey 			u32 max_chain = mlx5_eswitch_get_chain_range(esw);
3095bf07aa73SPaul Blakey 
3096bf07aa73SPaul Blakey 			if (dest_chain <= attr->chain) {
3097bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Goto earlier chain isn't supported");
3098bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
3099bf07aa73SPaul Blakey 			}
3100bf07aa73SPaul Blakey 			if (dest_chain > max_chain) {
3101bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Requested destination chain is out of supported range");
3102bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
3103bf07aa73SPaul Blakey 			}
3104e88afe75SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
3105bf07aa73SPaul Blakey 			attr->dest_chain = dest_chain;
310673867881SPablo Neira Ayuso 			break;
3107bf07aa73SPaul Blakey 			}
310873867881SPablo Neira Ayuso 		default:
31092cc1cb1dSTonghao Zhang 			NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported");
31102cc1cb1dSTonghao Zhang 			return -EOPNOTSUPP;
311103a9d11eSOr Gerlitz 		}
311273867881SPablo Neira Ayuso 	}
3113bdd66ac0SOr Gerlitz 
31140bac1194SEli Britstein 	if (MLX5_CAP_GEN(esw->dev, prio_tag_required) &&
31150bac1194SEli Britstein 	    action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) {
31160bac1194SEli Britstein 		/* For prio tag mode, replace vlan pop with rewrite vlan prio
31170bac1194SEli Britstein 		 * tag rewrite.
31180bac1194SEli Britstein 		 */
31190bac1194SEli Britstein 		action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
31200bac1194SEli Britstein 		err = add_vlan_prio_tag_rewrite_action(priv, parse_attr, hdrs,
31210bac1194SEli Britstein 						       &action, extack);
31220bac1194SEli Britstein 		if (err)
31230bac1194SEli Britstein 			return err;
31240bac1194SEli Britstein 	}
31250bac1194SEli Britstein 
3126c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
3127c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
312884be899fSTonghao Zhang 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_FDB,
312927c11b6bSEli Britstein 					    parse_attr, hdrs, &action, extack);
3130c500c86bSPablo Neira Ayuso 		if (err)
3131c500c86bSPablo Neira Ayuso 			return err;
313227c11b6bSEli Britstein 		/* in case all pedit actions are skipped, remove the MOD_HDR
313327c11b6bSEli Britstein 		 * flag. we might have set split_count either by pedit or
313427c11b6bSEli Britstein 		 * pop/push. if there is no pop/push either, reset it too.
313527c11b6bSEli Britstein 		 */
313627c11b6bSEli Britstein 		if (parse_attr->num_mod_hdr_actions == 0) {
313727c11b6bSEli Britstein 			action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
3138e7739a60SEli Britstein 			kfree(parse_attr->mod_hdr_actions);
313927c11b6bSEli Britstein 			if (!((action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) ||
314027c11b6bSEli Britstein 			      (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH)))
314127c11b6bSEli Britstein 				attr->split_count = 0;
314227c11b6bSEli Britstein 		}
3143c500c86bSPablo Neira Ayuso 	}
3144c500c86bSPablo Neira Ayuso 
31451cab1cd7SOr Gerlitz 	attr->action = action;
314673867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
3147bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
3148bdd66ac0SOr Gerlitz 
3149e88afe75SOr Gerlitz 	if (attr->dest_chain) {
3150e88afe75SOr Gerlitz 		if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
3151e88afe75SOr Gerlitz 			NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported");
3152e88afe75SOr Gerlitz 			return -EOPNOTSUPP;
3153e88afe75SOr Gerlitz 		}
3154e88afe75SOr Gerlitz 		attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
3155e88afe75SOr Gerlitz 	}
3156e88afe75SOr Gerlitz 
3157e85e02baSEli Britstein 	if (attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) {
3158e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
3159e98bedf5SEli Britstein 				   "current firmware doesn't support split rule for port mirroring");
3160592d3651SChris Mi 		netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n");
3161592d3651SChris Mi 		return -EOPNOTSUPP;
3162592d3651SChris Mi 	}
3163592d3651SChris Mi 
316431c8eba5SOr Gerlitz 	return 0;
316503a9d11eSOr Gerlitz }
316603a9d11eSOr Gerlitz 
3167226f2ca3SVlad Buslov static void get_flags(int flags, unsigned long *flow_flags)
316860bd4af8SOr Gerlitz {
3169226f2ca3SVlad Buslov 	unsigned long __flow_flags = 0;
317060bd4af8SOr Gerlitz 
3171226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(INGRESS))
3172226f2ca3SVlad Buslov 		__flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_INGRESS);
3173226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(EGRESS))
3174226f2ca3SVlad Buslov 		__flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_EGRESS);
317560bd4af8SOr Gerlitz 
3176226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(ESW_OFFLOAD))
3177226f2ca3SVlad Buslov 		__flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_ESWITCH);
3178226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(NIC_OFFLOAD))
3179226f2ca3SVlad Buslov 		__flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_NIC);
3180d9ee0491SOr Gerlitz 
318160bd4af8SOr Gerlitz 	*flow_flags = __flow_flags;
318260bd4af8SOr Gerlitz }
318360bd4af8SOr Gerlitz 
318405866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = {
318505866c82SOr Gerlitz 	.head_offset = offsetof(struct mlx5e_tc_flow, node),
318605866c82SOr Gerlitz 	.key_offset = offsetof(struct mlx5e_tc_flow, cookie),
318705866c82SOr Gerlitz 	.key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie),
318805866c82SOr Gerlitz 	.automatic_shrinking = true,
318905866c82SOr Gerlitz };
319005866c82SOr Gerlitz 
3191226f2ca3SVlad Buslov static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv,
3192226f2ca3SVlad Buslov 				    unsigned long flags)
319305866c82SOr Gerlitz {
3194655dc3d2SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
3195655dc3d2SOr Gerlitz 	struct mlx5e_rep_priv *uplink_rpriv;
3196655dc3d2SOr Gerlitz 
3197226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(ESW_OFFLOAD)) {
3198655dc3d2SOr Gerlitz 		uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
3199ec1366c2SOz Shlomo 		return &uplink_rpriv->uplink_priv.tc_ht;
3200d9ee0491SOr Gerlitz 	} else /* NIC offload */
320105866c82SOr Gerlitz 		return &priv->fs.tc.ht;
320205866c82SOr Gerlitz }
320305866c82SOr Gerlitz 
320404de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow)
320504de7ddaSRoi Dayan {
32061418ddd9SAviv Heller 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
3207b05af6aaSBodong Wang 	bool is_rep_ingress = attr->in_rep->vport != MLX5_VPORT_UPLINK &&
3208226f2ca3SVlad Buslov 		flow_flag_test(flow, INGRESS);
32091418ddd9SAviv Heller 	bool act_is_encap = !!(attr->action &
32101418ddd9SAviv Heller 			       MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT);
32111418ddd9SAviv Heller 	bool esw_paired = mlx5_devcom_is_paired(attr->in_mdev->priv.devcom,
32121418ddd9SAviv Heller 						MLX5_DEVCOM_ESW_OFFLOADS);
32131418ddd9SAviv Heller 
321410fbb1cdSRoi Dayan 	if (!esw_paired)
321510fbb1cdSRoi Dayan 		return false;
321610fbb1cdSRoi Dayan 
321710fbb1cdSRoi Dayan 	if ((mlx5_lag_is_sriov(attr->in_mdev) ||
321810fbb1cdSRoi Dayan 	     mlx5_lag_is_multipath(attr->in_mdev)) &&
321910fbb1cdSRoi Dayan 	    (is_rep_ingress || act_is_encap))
322010fbb1cdSRoi Dayan 		return true;
322110fbb1cdSRoi Dayan 
322210fbb1cdSRoi Dayan 	return false;
322304de7ddaSRoi Dayan }
322404de7ddaSRoi Dayan 
3225a88780a9SRoi Dayan static int
3226a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size,
3227226f2ca3SVlad Buslov 		 struct flow_cls_offload *f, unsigned long flow_flags,
3228a88780a9SRoi Dayan 		 struct mlx5e_tc_flow_parse_attr **__parse_attr,
3229a88780a9SRoi Dayan 		 struct mlx5e_tc_flow **__flow)
3230e3a2b7edSAmir Vadai {
323117091853SOr Gerlitz 	struct mlx5e_tc_flow_parse_attr *parse_attr;
32323bc4b7bfSOr Gerlitz 	struct mlx5e_tc_flow *flow;
32335a7e5bcbSVlad Buslov 	int out_index, err;
3234776b12b6SOr Gerlitz 
323565ba8fb7SOr Gerlitz 	flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL);
32361b9a07eeSLeon Romanovsky 	parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL);
323717091853SOr Gerlitz 	if (!parse_attr || !flow) {
3238e3a2b7edSAmir Vadai 		err = -ENOMEM;
3239e3a2b7edSAmir Vadai 		goto err_free;
3240e3a2b7edSAmir Vadai 	}
3241e3a2b7edSAmir Vadai 
3242e3a2b7edSAmir Vadai 	flow->cookie = f->cookie;
324365ba8fb7SOr Gerlitz 	flow->flags = flow_flags;
3244655dc3d2SOr Gerlitz 	flow->priv = priv;
32455a7e5bcbSVlad Buslov 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
32465a7e5bcbSVlad Buslov 		INIT_LIST_HEAD(&flow->encaps[out_index].list);
32475a7e5bcbSVlad Buslov 	INIT_LIST_HEAD(&flow->mod_hdr);
32485a7e5bcbSVlad Buslov 	INIT_LIST_HEAD(&flow->hairpin);
32495a7e5bcbSVlad Buslov 	refcount_set(&flow->refcnt, 1);
3250e3a2b7edSAmir Vadai 
3251a88780a9SRoi Dayan 	*__flow = flow;
3252a88780a9SRoi Dayan 	*__parse_attr = parse_attr;
3253a88780a9SRoi Dayan 
3254a88780a9SRoi Dayan 	return 0;
3255a88780a9SRoi Dayan 
3256a88780a9SRoi Dayan err_free:
3257a88780a9SRoi Dayan 	kfree(flow);
3258a88780a9SRoi Dayan 	kvfree(parse_attr);
3259a88780a9SRoi Dayan 	return err;
3260adb4c123SOr Gerlitz }
3261adb4c123SOr Gerlitz 
3262988ab9c7STonghao Zhang static void
3263988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(struct mlx5_esw_flow_attr *esw_attr,
3264988ab9c7STonghao Zhang 			 struct mlx5e_priv *priv,
3265988ab9c7STonghao Zhang 			 struct mlx5e_tc_flow_parse_attr *parse_attr,
3266f9e30088SPablo Neira Ayuso 			 struct flow_cls_offload *f,
3267988ab9c7STonghao Zhang 			 struct mlx5_eswitch_rep *in_rep,
3268988ab9c7STonghao Zhang 			 struct mlx5_core_dev *in_mdev)
3269988ab9c7STonghao Zhang {
3270988ab9c7STonghao Zhang 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
3271988ab9c7STonghao Zhang 
3272988ab9c7STonghao Zhang 	esw_attr->parse_attr = parse_attr;
3273988ab9c7STonghao Zhang 	esw_attr->chain = f->common.chain_index;
3274988ab9c7STonghao Zhang 	esw_attr->prio = TC_H_MAJ(f->common.prio) >> 16;
3275988ab9c7STonghao Zhang 
3276988ab9c7STonghao Zhang 	esw_attr->in_rep = in_rep;
3277988ab9c7STonghao Zhang 	esw_attr->in_mdev = in_mdev;
3278988ab9c7STonghao Zhang 
3279988ab9c7STonghao Zhang 	if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) ==
3280988ab9c7STonghao Zhang 	    MLX5_COUNTER_SOURCE_ESWITCH)
3281988ab9c7STonghao Zhang 		esw_attr->counter_dev = in_mdev;
3282988ab9c7STonghao Zhang 	else
3283988ab9c7STonghao Zhang 		esw_attr->counter_dev = priv->mdev;
3284988ab9c7STonghao Zhang }
3285988ab9c7STonghao Zhang 
328671129676SJason Gunthorpe static struct mlx5e_tc_flow *
328704de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
3288f9e30088SPablo Neira Ayuso 		     struct flow_cls_offload *f,
3289226f2ca3SVlad Buslov 		     unsigned long flow_flags,
3290d11afc26SOz Shlomo 		     struct net_device *filter_dev,
329104de7ddaSRoi Dayan 		     struct mlx5_eswitch_rep *in_rep,
329271129676SJason Gunthorpe 		     struct mlx5_core_dev *in_mdev)
3293a88780a9SRoi Dayan {
3294f9e30088SPablo Neira Ayuso 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
3295a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
3296a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
3297a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
3298a88780a9SRoi Dayan 	int attr_size, err;
3299a88780a9SRoi Dayan 
3300226f2ca3SVlad Buslov 	flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_ESWITCH);
3301a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_esw_flow_attr);
3302a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
3303a88780a9SRoi Dayan 			       &parse_attr, &flow);
3304a88780a9SRoi Dayan 	if (err)
3305a88780a9SRoi Dayan 		goto out;
3306988ab9c7STonghao Zhang 
3307d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
3308988ab9c7STonghao Zhang 	mlx5e_flow_esw_attr_init(flow->esw_attr,
3309988ab9c7STonghao Zhang 				 priv, parse_attr,
3310988ab9c7STonghao Zhang 				 f, in_rep, in_mdev);
3311988ab9c7STonghao Zhang 
331254c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
331354c177caSOz Shlomo 			       f, filter_dev);
3314d11afc26SOz Shlomo 	if (err)
3315d11afc26SOz Shlomo 		goto err_free;
3316a88780a9SRoi Dayan 
33176f9af8ffSTonghao Zhang 	err = parse_tc_fdb_actions(priv, &rule->action, flow, extack);
3318a88780a9SRoi Dayan 	if (err)
3319a88780a9SRoi Dayan 		goto err_free;
3320a88780a9SRoi Dayan 
33217040632dSTonghao Zhang 	err = mlx5e_tc_add_fdb_flow(priv, flow, extack);
3322ef06c9eeSRoi Dayan 	if (err) {
3323ef06c9eeSRoi Dayan 		if (!(err == -ENETUNREACH && mlx5_lag_is_multipath(in_mdev)))
3324aa0cbbaeSOr Gerlitz 			goto err_free;
33255c40348cSOr Gerlitz 
3326b4a23329SRoi Dayan 		add_unready_flow(flow);
3327ef06c9eeSRoi Dayan 	}
3328ef06c9eeSRoi Dayan 
332971129676SJason Gunthorpe 	return flow;
3330e3a2b7edSAmir Vadai 
3331e3a2b7edSAmir Vadai err_free:
33325a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
3333a88780a9SRoi Dayan out:
333471129676SJason Gunthorpe 	return ERR_PTR(err);
3335a88780a9SRoi Dayan }
3336a88780a9SRoi Dayan 
3337f9e30088SPablo Neira Ayuso static int mlx5e_tc_add_fdb_peer_flow(struct flow_cls_offload *f,
333895dc1902SRoi Dayan 				      struct mlx5e_tc_flow *flow,
3339226f2ca3SVlad Buslov 				      unsigned long flow_flags)
334004de7ddaSRoi Dayan {
334104de7ddaSRoi Dayan 	struct mlx5e_priv *priv = flow->priv, *peer_priv;
334204de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw;
334304de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
334404de7ddaSRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
334504de7ddaSRoi Dayan 	struct mlx5e_rep_priv *peer_urpriv;
334604de7ddaSRoi Dayan 	struct mlx5e_tc_flow *peer_flow;
334704de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev;
334804de7ddaSRoi Dayan 	int err = 0;
334904de7ddaSRoi Dayan 
335004de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
335104de7ddaSRoi Dayan 	if (!peer_esw)
335204de7ddaSRoi Dayan 		return -ENODEV;
335304de7ddaSRoi Dayan 
335404de7ddaSRoi Dayan 	peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH);
335504de7ddaSRoi Dayan 	peer_priv = netdev_priv(peer_urpriv->netdev);
335604de7ddaSRoi Dayan 
335704de7ddaSRoi Dayan 	/* in_mdev is assigned of which the packet originated from.
335804de7ddaSRoi Dayan 	 * So packets redirected to uplink use the same mdev of the
335904de7ddaSRoi Dayan 	 * original flow and packets redirected from uplink use the
336004de7ddaSRoi Dayan 	 * peer mdev.
336104de7ddaSRoi Dayan 	 */
3362b05af6aaSBodong Wang 	if (flow->esw_attr->in_rep->vport == MLX5_VPORT_UPLINK)
336304de7ddaSRoi Dayan 		in_mdev = peer_priv->mdev;
336404de7ddaSRoi Dayan 	else
336504de7ddaSRoi Dayan 		in_mdev = priv->mdev;
336604de7ddaSRoi Dayan 
336704de7ddaSRoi Dayan 	parse_attr = flow->esw_attr->parse_attr;
336895dc1902SRoi Dayan 	peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow_flags,
336904de7ddaSRoi Dayan 					 parse_attr->filter_dev,
337071129676SJason Gunthorpe 					 flow->esw_attr->in_rep, in_mdev);
337171129676SJason Gunthorpe 	if (IS_ERR(peer_flow)) {
337271129676SJason Gunthorpe 		err = PTR_ERR(peer_flow);
337304de7ddaSRoi Dayan 		goto out;
337471129676SJason Gunthorpe 	}
337504de7ddaSRoi Dayan 
337604de7ddaSRoi Dayan 	flow->peer_flow = peer_flow;
3377226f2ca3SVlad Buslov 	flow_flag_set(flow, DUP);
337804de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
337904de7ddaSRoi Dayan 	list_add_tail(&flow->peer, &esw->offloads.peer_flows);
338004de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
338104de7ddaSRoi Dayan 
338204de7ddaSRoi Dayan out:
338304de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
338404de7ddaSRoi Dayan 	return err;
338504de7ddaSRoi Dayan }
338604de7ddaSRoi Dayan 
338704de7ddaSRoi Dayan static int
338804de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
3389f9e30088SPablo Neira Ayuso 		   struct flow_cls_offload *f,
3390226f2ca3SVlad Buslov 		   unsigned long flow_flags,
339104de7ddaSRoi Dayan 		   struct net_device *filter_dev,
339204de7ddaSRoi Dayan 		   struct mlx5e_tc_flow **__flow)
339304de7ddaSRoi Dayan {
339404de7ddaSRoi Dayan 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
339504de7ddaSRoi Dayan 	struct mlx5_eswitch_rep *in_rep = rpriv->rep;
339604de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev = priv->mdev;
339704de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow;
339804de7ddaSRoi Dayan 	int err;
339904de7ddaSRoi Dayan 
340071129676SJason Gunthorpe 	flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep,
340171129676SJason Gunthorpe 				    in_mdev);
340271129676SJason Gunthorpe 	if (IS_ERR(flow))
340371129676SJason Gunthorpe 		return PTR_ERR(flow);
340404de7ddaSRoi Dayan 
340504de7ddaSRoi Dayan 	if (is_peer_flow_needed(flow)) {
340695dc1902SRoi Dayan 		err = mlx5e_tc_add_fdb_peer_flow(f, flow, flow_flags);
340704de7ddaSRoi Dayan 		if (err) {
340804de7ddaSRoi Dayan 			mlx5e_tc_del_fdb_flow(priv, flow);
340904de7ddaSRoi Dayan 			goto out;
341004de7ddaSRoi Dayan 		}
341104de7ddaSRoi Dayan 	}
341204de7ddaSRoi Dayan 
341304de7ddaSRoi Dayan 	*__flow = flow;
341404de7ddaSRoi Dayan 
341504de7ddaSRoi Dayan 	return 0;
341604de7ddaSRoi Dayan 
341704de7ddaSRoi Dayan out:
341804de7ddaSRoi Dayan 	return err;
341904de7ddaSRoi Dayan }
342004de7ddaSRoi Dayan 
3421a88780a9SRoi Dayan static int
3422a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv,
3423f9e30088SPablo Neira Ayuso 		   struct flow_cls_offload *f,
3424226f2ca3SVlad Buslov 		   unsigned long flow_flags,
3425d11afc26SOz Shlomo 		   struct net_device *filter_dev,
3426a88780a9SRoi Dayan 		   struct mlx5e_tc_flow **__flow)
3427a88780a9SRoi Dayan {
3428f9e30088SPablo Neira Ayuso 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
3429a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
3430a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
3431a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
3432a88780a9SRoi Dayan 	int attr_size, err;
3433a88780a9SRoi Dayan 
3434bf07aa73SPaul Blakey 	/* multi-chain not supported for NIC rules */
3435bf07aa73SPaul Blakey 	if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common))
3436bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
3437bf07aa73SPaul Blakey 
3438226f2ca3SVlad Buslov 	flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_NIC);
3439a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_nic_flow_attr);
3440a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
3441a88780a9SRoi Dayan 			       &parse_attr, &flow);
3442a88780a9SRoi Dayan 	if (err)
3443a88780a9SRoi Dayan 		goto out;
3444a88780a9SRoi Dayan 
3445d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
344654c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
344754c177caSOz Shlomo 			       f, filter_dev);
3448d11afc26SOz Shlomo 	if (err)
3449d11afc26SOz Shlomo 		goto err_free;
3450d11afc26SOz Shlomo 
345173867881SPablo Neira Ayuso 	err = parse_tc_nic_actions(priv, &rule->action, parse_attr, flow, extack);
3452a88780a9SRoi Dayan 	if (err)
3453a88780a9SRoi Dayan 		goto err_free;
3454a88780a9SRoi Dayan 
3455a88780a9SRoi Dayan 	err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack);
3456a88780a9SRoi Dayan 	if (err)
3457a88780a9SRoi Dayan 		goto err_free;
3458a88780a9SRoi Dayan 
3459226f2ca3SVlad Buslov 	flow_flag_set(flow, OFFLOADED);
3460a88780a9SRoi Dayan 	kvfree(parse_attr);
3461a88780a9SRoi Dayan 	*__flow = flow;
3462a88780a9SRoi Dayan 
3463a88780a9SRoi Dayan 	return 0;
3464a88780a9SRoi Dayan 
3465a88780a9SRoi Dayan err_free:
34665a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
3467a88780a9SRoi Dayan 	kvfree(parse_attr);
3468a88780a9SRoi Dayan out:
3469a88780a9SRoi Dayan 	return err;
3470a88780a9SRoi Dayan }
3471a88780a9SRoi Dayan 
3472a88780a9SRoi Dayan static int
3473a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv,
3474f9e30088SPablo Neira Ayuso 		  struct flow_cls_offload *f,
3475226f2ca3SVlad Buslov 		  unsigned long flags,
3476d11afc26SOz Shlomo 		  struct net_device *filter_dev,
3477a88780a9SRoi Dayan 		  struct mlx5e_tc_flow **flow)
3478a88780a9SRoi Dayan {
3479a88780a9SRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
3480226f2ca3SVlad Buslov 	unsigned long flow_flags;
3481a88780a9SRoi Dayan 	int err;
3482a88780a9SRoi Dayan 
3483a88780a9SRoi Dayan 	get_flags(flags, &flow_flags);
3484a88780a9SRoi Dayan 
3485bf07aa73SPaul Blakey 	if (!tc_can_offload_extack(priv->netdev, f->common.extack))
3486bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
3487bf07aa73SPaul Blakey 
3488f6455de0SBodong Wang 	if (esw && esw->mode == MLX5_ESWITCH_OFFLOADS)
3489d11afc26SOz Shlomo 		err = mlx5e_add_fdb_flow(priv, f, flow_flags,
3490d11afc26SOz Shlomo 					 filter_dev, flow);
3491a88780a9SRoi Dayan 	else
3492d11afc26SOz Shlomo 		err = mlx5e_add_nic_flow(priv, f, flow_flags,
3493d11afc26SOz Shlomo 					 filter_dev, flow);
3494a88780a9SRoi Dayan 
3495a88780a9SRoi Dayan 	return err;
3496a88780a9SRoi Dayan }
3497a88780a9SRoi Dayan 
349871d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv,
3499226f2ca3SVlad Buslov 			   struct flow_cls_offload *f, unsigned long flags)
3500a88780a9SRoi Dayan {
3501a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
3502d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
3503a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
3504a88780a9SRoi Dayan 	int err = 0;
3505a88780a9SRoi Dayan 
3506c5d326b2SVlad Buslov 	rcu_read_lock();
3507c5d326b2SVlad Buslov 	flow = rhashtable_lookup(tc_ht, &f->cookie, tc_ht_params);
3508c5d326b2SVlad Buslov 	rcu_read_unlock();
3509a88780a9SRoi Dayan 	if (flow) {
3510a88780a9SRoi Dayan 		NL_SET_ERR_MSG_MOD(extack,
3511a88780a9SRoi Dayan 				   "flow cookie already exists, ignoring");
3512a88780a9SRoi Dayan 		netdev_warn_once(priv->netdev,
3513a88780a9SRoi Dayan 				 "flow cookie %lx already exists, ignoring\n",
3514a88780a9SRoi Dayan 				 f->cookie);
35150e1c1a2fSVlad Buslov 		err = -EEXIST;
3516a88780a9SRoi Dayan 		goto out;
3517a88780a9SRoi Dayan 	}
3518a88780a9SRoi Dayan 
3519d11afc26SOz Shlomo 	err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow);
3520a88780a9SRoi Dayan 	if (err)
3521a88780a9SRoi Dayan 		goto out;
3522a88780a9SRoi Dayan 
3523c5d326b2SVlad Buslov 	err = rhashtable_lookup_insert_fast(tc_ht, &flow->node, tc_ht_params);
3524a88780a9SRoi Dayan 	if (err)
3525a88780a9SRoi Dayan 		goto err_free;
3526a88780a9SRoi Dayan 
3527a88780a9SRoi Dayan 	return 0;
3528a88780a9SRoi Dayan 
3529a88780a9SRoi Dayan err_free:
35305a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
3531a88780a9SRoi Dayan out:
3532e3a2b7edSAmir Vadai 	return err;
3533e3a2b7edSAmir Vadai }
3534e3a2b7edSAmir Vadai 
35358f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags)
35368f8ae895SOr Gerlitz {
3537226f2ca3SVlad Buslov 	bool dir_ingress = !!(flags & MLX5_TC_FLAG(INGRESS));
3538226f2ca3SVlad Buslov 	bool dir_egress = !!(flags & MLX5_TC_FLAG(EGRESS));
35398f8ae895SOr Gerlitz 
3540226f2ca3SVlad Buslov 	return flow_flag_test(flow, INGRESS) == dir_ingress &&
3541226f2ca3SVlad Buslov 		flow_flag_test(flow, EGRESS) == dir_egress;
35428f8ae895SOr Gerlitz }
35438f8ae895SOr Gerlitz 
354471d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv,
3545226f2ca3SVlad Buslov 			struct flow_cls_offload *f, unsigned long flags)
3546e3a2b7edSAmir Vadai {
3547d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
3548e3a2b7edSAmir Vadai 	struct mlx5e_tc_flow *flow;
3549c5d326b2SVlad Buslov 	int err;
3550e3a2b7edSAmir Vadai 
3551c5d326b2SVlad Buslov 	rcu_read_lock();
355205866c82SOr Gerlitz 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
3553c5d326b2SVlad Buslov 	if (!flow || !same_flow_direction(flow, flags)) {
3554c5d326b2SVlad Buslov 		err = -EINVAL;
3555c5d326b2SVlad Buslov 		goto errout;
3556c5d326b2SVlad Buslov 	}
3557e3a2b7edSAmir Vadai 
3558c5d326b2SVlad Buslov 	/* Only delete the flow if it doesn't have MLX5E_TC_FLOW_DELETED flag
3559c5d326b2SVlad Buslov 	 * set.
3560c5d326b2SVlad Buslov 	 */
3561c5d326b2SVlad Buslov 	if (flow_flag_test_and_set(flow, DELETED)) {
3562c5d326b2SVlad Buslov 		err = -EINVAL;
3563c5d326b2SVlad Buslov 		goto errout;
3564c5d326b2SVlad Buslov 	}
356505866c82SOr Gerlitz 	rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params);
3566c5d326b2SVlad Buslov 	rcu_read_unlock();
3567e3a2b7edSAmir Vadai 
35685a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
3569e3a2b7edSAmir Vadai 
3570e3a2b7edSAmir Vadai 	return 0;
3571c5d326b2SVlad Buslov 
3572c5d326b2SVlad Buslov errout:
3573c5d326b2SVlad Buslov 	rcu_read_unlock();
3574c5d326b2SVlad Buslov 	return err;
3575e3a2b7edSAmir Vadai }
3576e3a2b7edSAmir Vadai 
357771d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv,
3578226f2ca3SVlad Buslov 		       struct flow_cls_offload *f, unsigned long flags)
3579aad7e08dSAmir Vadai {
358004de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
3581d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
358204de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
3583aad7e08dSAmir Vadai 	struct mlx5e_tc_flow *flow;
3584aad7e08dSAmir Vadai 	struct mlx5_fc *counter;
3585316d5f72SRoi Dayan 	u64 lastuse = 0;
3586316d5f72SRoi Dayan 	u64 packets = 0;
3587316d5f72SRoi Dayan 	u64 bytes = 0;
35885a7e5bcbSVlad Buslov 	int err = 0;
3589aad7e08dSAmir Vadai 
3590c5d326b2SVlad Buslov 	rcu_read_lock();
3591c5d326b2SVlad Buslov 	flow = mlx5e_flow_get(rhashtable_lookup(tc_ht, &f->cookie,
35925a7e5bcbSVlad Buslov 						tc_ht_params));
3593c5d326b2SVlad Buslov 	rcu_read_unlock();
35945a7e5bcbSVlad Buslov 	if (IS_ERR(flow))
35955a7e5bcbSVlad Buslov 		return PTR_ERR(flow);
35965a7e5bcbSVlad Buslov 
35975a7e5bcbSVlad Buslov 	if (!same_flow_direction(flow, flags)) {
35985a7e5bcbSVlad Buslov 		err = -EINVAL;
35995a7e5bcbSVlad Buslov 		goto errout;
36005a7e5bcbSVlad Buslov 	}
3601aad7e08dSAmir Vadai 
3602226f2ca3SVlad Buslov 	if (mlx5e_is_offloaded_flow(flow)) {
3603b8aee822SMark Bloch 		counter = mlx5e_tc_get_counter(flow);
3604aad7e08dSAmir Vadai 		if (!counter)
36055a7e5bcbSVlad Buslov 			goto errout;
3606aad7e08dSAmir Vadai 
3607aad7e08dSAmir Vadai 		mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
3608316d5f72SRoi Dayan 	}
3609aad7e08dSAmir Vadai 
3610316d5f72SRoi Dayan 	/* Under multipath it's possible for one rule to be currently
3611316d5f72SRoi Dayan 	 * un-offloaded while the other rule is offloaded.
3612316d5f72SRoi Dayan 	 */
361304de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
361404de7ddaSRoi Dayan 	if (!peer_esw)
361504de7ddaSRoi Dayan 		goto out;
361604de7ddaSRoi Dayan 
3617226f2ca3SVlad Buslov 	if (flow_flag_test(flow, DUP) &&
3618226f2ca3SVlad Buslov 	    flow_flag_test(flow->peer_flow, OFFLOADED)) {
361904de7ddaSRoi Dayan 		u64 bytes2;
362004de7ddaSRoi Dayan 		u64 packets2;
362104de7ddaSRoi Dayan 		u64 lastuse2;
362204de7ddaSRoi Dayan 
362304de7ddaSRoi Dayan 		counter = mlx5e_tc_get_counter(flow->peer_flow);
3624316d5f72SRoi Dayan 		if (!counter)
3625316d5f72SRoi Dayan 			goto no_peer_counter;
362604de7ddaSRoi Dayan 		mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2);
362704de7ddaSRoi Dayan 
362804de7ddaSRoi Dayan 		bytes += bytes2;
362904de7ddaSRoi Dayan 		packets += packets2;
363004de7ddaSRoi Dayan 		lastuse = max_t(u64, lastuse, lastuse2);
363104de7ddaSRoi Dayan 	}
363204de7ddaSRoi Dayan 
3633316d5f72SRoi Dayan no_peer_counter:
363404de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
363504de7ddaSRoi Dayan out:
36363b1903efSPablo Neira Ayuso 	flow_stats_update(&f->stats, bytes, packets, lastuse);
36375a7e5bcbSVlad Buslov errout:
36385a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
36395a7e5bcbSVlad Buslov 	return err;
3640aad7e08dSAmir Vadai }
3641aad7e08dSAmir Vadai 
3642fcb64c0fSEli Cohen static int apply_police_params(struct mlx5e_priv *priv, u32 rate,
3643fcb64c0fSEli Cohen 			       struct netlink_ext_ack *extack)
3644fcb64c0fSEli Cohen {
3645fcb64c0fSEli Cohen 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
3646fcb64c0fSEli Cohen 	struct mlx5_eswitch *esw;
3647fcb64c0fSEli Cohen 	u16 vport_num;
3648fcb64c0fSEli Cohen 	u32 rate_mbps;
3649fcb64c0fSEli Cohen 	int err;
3650fcb64c0fSEli Cohen 
3651fcb64c0fSEli Cohen 	esw = priv->mdev->priv.eswitch;
3652fcb64c0fSEli Cohen 	/* rate is given in bytes/sec.
3653fcb64c0fSEli Cohen 	 * First convert to bits/sec and then round to the nearest mbit/secs.
3654fcb64c0fSEli Cohen 	 * mbit means million bits.
3655fcb64c0fSEli Cohen 	 * Moreover, if rate is non zero we choose to configure to a minimum of
3656fcb64c0fSEli Cohen 	 * 1 mbit/sec.
3657fcb64c0fSEli Cohen 	 */
3658fcb64c0fSEli Cohen 	rate_mbps = rate ? max_t(u32, (rate * 8 + 500000) / 1000000, 1) : 0;
3659fcb64c0fSEli Cohen 	vport_num = rpriv->rep->vport;
3660fcb64c0fSEli Cohen 
3661fcb64c0fSEli Cohen 	err = mlx5_esw_modify_vport_rate(esw, vport_num, rate_mbps);
3662fcb64c0fSEli Cohen 	if (err)
3663fcb64c0fSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "failed applying action to hardware");
3664fcb64c0fSEli Cohen 
3665fcb64c0fSEli Cohen 	return err;
3666fcb64c0fSEli Cohen }
3667fcb64c0fSEli Cohen 
3668fcb64c0fSEli Cohen static int scan_tc_matchall_fdb_actions(struct mlx5e_priv *priv,
3669fcb64c0fSEli Cohen 					struct flow_action *flow_action,
3670fcb64c0fSEli Cohen 					struct netlink_ext_ack *extack)
3671fcb64c0fSEli Cohen {
3672fcb64c0fSEli Cohen 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
3673fcb64c0fSEli Cohen 	const struct flow_action_entry *act;
3674fcb64c0fSEli Cohen 	int err;
3675fcb64c0fSEli Cohen 	int i;
3676fcb64c0fSEli Cohen 
3677fcb64c0fSEli Cohen 	if (!flow_action_has_entries(flow_action)) {
3678fcb64c0fSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "matchall called with no action");
3679fcb64c0fSEli Cohen 		return -EINVAL;
3680fcb64c0fSEli Cohen 	}
3681fcb64c0fSEli Cohen 
3682fcb64c0fSEli Cohen 	if (!flow_offload_has_one_action(flow_action)) {
3683fcb64c0fSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "matchall policing support only a single action");
3684fcb64c0fSEli Cohen 		return -EOPNOTSUPP;
3685fcb64c0fSEli Cohen 	}
3686fcb64c0fSEli Cohen 
3687fcb64c0fSEli Cohen 	flow_action_for_each(i, act, flow_action) {
3688fcb64c0fSEli Cohen 		switch (act->id) {
3689fcb64c0fSEli Cohen 		case FLOW_ACTION_POLICE:
3690fcb64c0fSEli Cohen 			err = apply_police_params(priv, act->police.rate_bytes_ps, extack);
3691fcb64c0fSEli Cohen 			if (err)
3692fcb64c0fSEli Cohen 				return err;
3693fcb64c0fSEli Cohen 
3694fcb64c0fSEli Cohen 			rpriv->prev_vf_vport_stats = priv->stats.vf_vport;
3695fcb64c0fSEli Cohen 			break;
3696fcb64c0fSEli Cohen 		default:
3697fcb64c0fSEli Cohen 			NL_SET_ERR_MSG_MOD(extack, "mlx5 supports only police action for matchall");
3698fcb64c0fSEli Cohen 			return -EOPNOTSUPP;
3699fcb64c0fSEli Cohen 		}
3700fcb64c0fSEli Cohen 	}
3701fcb64c0fSEli Cohen 
3702fcb64c0fSEli Cohen 	return 0;
3703fcb64c0fSEli Cohen }
3704fcb64c0fSEli Cohen 
3705fcb64c0fSEli Cohen int mlx5e_tc_configure_matchall(struct mlx5e_priv *priv,
3706fcb64c0fSEli Cohen 				struct tc_cls_matchall_offload *ma)
3707fcb64c0fSEli Cohen {
3708fcb64c0fSEli Cohen 	struct netlink_ext_ack *extack = ma->common.extack;
3709fcb64c0fSEli Cohen 	int prio = TC_H_MAJ(ma->common.prio) >> 16;
3710fcb64c0fSEli Cohen 
3711fcb64c0fSEli Cohen 	if (prio != 1) {
3712fcb64c0fSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "only priority 1 is supported");
3713fcb64c0fSEli Cohen 		return -EINVAL;
3714fcb64c0fSEli Cohen 	}
3715fcb64c0fSEli Cohen 
3716fcb64c0fSEli Cohen 	return scan_tc_matchall_fdb_actions(priv, &ma->rule->action, extack);
3717fcb64c0fSEli Cohen }
3718fcb64c0fSEli Cohen 
3719fcb64c0fSEli Cohen int mlx5e_tc_delete_matchall(struct mlx5e_priv *priv,
3720fcb64c0fSEli Cohen 			     struct tc_cls_matchall_offload *ma)
3721fcb64c0fSEli Cohen {
3722fcb64c0fSEli Cohen 	struct netlink_ext_ack *extack = ma->common.extack;
3723fcb64c0fSEli Cohen 
3724fcb64c0fSEli Cohen 	return apply_police_params(priv, 0, extack);
3725fcb64c0fSEli Cohen }
3726fcb64c0fSEli Cohen 
3727fcb64c0fSEli Cohen void mlx5e_tc_stats_matchall(struct mlx5e_priv *priv,
3728fcb64c0fSEli Cohen 			     struct tc_cls_matchall_offload *ma)
3729fcb64c0fSEli Cohen {
3730fcb64c0fSEli Cohen 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
3731fcb64c0fSEli Cohen 	struct rtnl_link_stats64 cur_stats;
3732fcb64c0fSEli Cohen 	u64 dbytes;
3733fcb64c0fSEli Cohen 	u64 dpkts;
3734fcb64c0fSEli Cohen 
3735fcb64c0fSEli Cohen 	cur_stats = priv->stats.vf_vport;
3736fcb64c0fSEli Cohen 	dpkts = cur_stats.rx_packets - rpriv->prev_vf_vport_stats.rx_packets;
3737fcb64c0fSEli Cohen 	dbytes = cur_stats.rx_bytes - rpriv->prev_vf_vport_stats.rx_bytes;
3738fcb64c0fSEli Cohen 	rpriv->prev_vf_vport_stats = cur_stats;
3739fcb64c0fSEli Cohen 	flow_stats_update(&ma->stats, dpkts, dbytes, jiffies);
3740fcb64c0fSEli Cohen }
3741fcb64c0fSEli Cohen 
37424d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv,
37434d8fcf21SAlaa Hleihel 					      struct mlx5e_priv *peer_priv)
37444d8fcf21SAlaa Hleihel {
37454d8fcf21SAlaa Hleihel 	struct mlx5_core_dev *peer_mdev = peer_priv->mdev;
37464d8fcf21SAlaa Hleihel 	struct mlx5e_hairpin_entry *hpe;
37474d8fcf21SAlaa Hleihel 	u16 peer_vhca_id;
37484d8fcf21SAlaa Hleihel 	int bkt;
37494d8fcf21SAlaa Hleihel 
37504d8fcf21SAlaa Hleihel 	if (!same_hw_devs(priv, peer_priv))
37514d8fcf21SAlaa Hleihel 		return;
37524d8fcf21SAlaa Hleihel 
37534d8fcf21SAlaa Hleihel 	peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
37544d8fcf21SAlaa Hleihel 
37554d8fcf21SAlaa Hleihel 	hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) {
37564d8fcf21SAlaa Hleihel 		if (hpe->peer_vhca_id == peer_vhca_id)
37574d8fcf21SAlaa Hleihel 			hpe->hp->pair->peer_gone = true;
37584d8fcf21SAlaa Hleihel 	}
37594d8fcf21SAlaa Hleihel }
37604d8fcf21SAlaa Hleihel 
37614d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this,
37624d8fcf21SAlaa Hleihel 				 unsigned long event, void *ptr)
37634d8fcf21SAlaa Hleihel {
37644d8fcf21SAlaa Hleihel 	struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
37654d8fcf21SAlaa Hleihel 	struct mlx5e_flow_steering *fs;
37664d8fcf21SAlaa Hleihel 	struct mlx5e_priv *peer_priv;
37674d8fcf21SAlaa Hleihel 	struct mlx5e_tc_table *tc;
37684d8fcf21SAlaa Hleihel 	struct mlx5e_priv *priv;
37694d8fcf21SAlaa Hleihel 
37704d8fcf21SAlaa Hleihel 	if (ndev->netdev_ops != &mlx5e_netdev_ops ||
37714d8fcf21SAlaa Hleihel 	    event != NETDEV_UNREGISTER ||
37724d8fcf21SAlaa Hleihel 	    ndev->reg_state == NETREG_REGISTERED)
37734d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
37744d8fcf21SAlaa Hleihel 
37754d8fcf21SAlaa Hleihel 	tc = container_of(this, struct mlx5e_tc_table, netdevice_nb);
37764d8fcf21SAlaa Hleihel 	fs = container_of(tc, struct mlx5e_flow_steering, tc);
37774d8fcf21SAlaa Hleihel 	priv = container_of(fs, struct mlx5e_priv, fs);
37784d8fcf21SAlaa Hleihel 	peer_priv = netdev_priv(ndev);
37794d8fcf21SAlaa Hleihel 	if (priv == peer_priv ||
37804d8fcf21SAlaa Hleihel 	    !(priv->netdev->features & NETIF_F_HW_TC))
37814d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
37824d8fcf21SAlaa Hleihel 
37834d8fcf21SAlaa Hleihel 	mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv);
37844d8fcf21SAlaa Hleihel 
37854d8fcf21SAlaa Hleihel 	return NOTIFY_DONE;
37864d8fcf21SAlaa Hleihel }
37874d8fcf21SAlaa Hleihel 
3788655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv)
3789e8f887acSAmir Vadai {
3790acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
37914d8fcf21SAlaa Hleihel 	int err;
3792e8f887acSAmir Vadai 
3793b6fac0b4SVlad Buslov 	mutex_init(&tc->t_lock);
379411c9c548SOr Gerlitz 	hash_init(tc->mod_hdr_tbl);
37955c65c564SOr Gerlitz 	hash_init(tc->hairpin_tbl);
379611c9c548SOr Gerlitz 
37974d8fcf21SAlaa Hleihel 	err = rhashtable_init(&tc->ht, &tc_ht_params);
37984d8fcf21SAlaa Hleihel 	if (err)
37994d8fcf21SAlaa Hleihel 		return err;
38004d8fcf21SAlaa Hleihel 
38014d8fcf21SAlaa Hleihel 	tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event;
38024d8fcf21SAlaa Hleihel 	if (register_netdevice_notifier(&tc->netdevice_nb)) {
38034d8fcf21SAlaa Hleihel 		tc->netdevice_nb.notifier_call = NULL;
38044d8fcf21SAlaa Hleihel 		mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n");
38054d8fcf21SAlaa Hleihel 	}
38064d8fcf21SAlaa Hleihel 
38074d8fcf21SAlaa Hleihel 	return err;
3808e8f887acSAmir Vadai }
3809e8f887acSAmir Vadai 
3810e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg)
3811e8f887acSAmir Vadai {
3812e8f887acSAmir Vadai 	struct mlx5e_tc_flow *flow = ptr;
3813655dc3d2SOr Gerlitz 	struct mlx5e_priv *priv = flow->priv;
3814e8f887acSAmir Vadai 
3815961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3816e8f887acSAmir Vadai 	kfree(flow);
3817e8f887acSAmir Vadai }
3818e8f887acSAmir Vadai 
3819655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv)
3820e8f887acSAmir Vadai {
3821acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
3822e8f887acSAmir Vadai 
38234d8fcf21SAlaa Hleihel 	if (tc->netdevice_nb.notifier_call)
38244d8fcf21SAlaa Hleihel 		unregister_netdevice_notifier(&tc->netdevice_nb);
38254d8fcf21SAlaa Hleihel 
3826d9ee0491SOr Gerlitz 	rhashtable_destroy(&tc->ht);
3827e8f887acSAmir Vadai 
3828acff797cSMaor Gottlieb 	if (!IS_ERR_OR_NULL(tc->t)) {
3829acff797cSMaor Gottlieb 		mlx5_destroy_flow_table(tc->t);
3830acff797cSMaor Gottlieb 		tc->t = NULL;
3831e8f887acSAmir Vadai 	}
3832b6fac0b4SVlad Buslov 	mutex_destroy(&tc->t_lock);
3833e8f887acSAmir Vadai }
3834655dc3d2SOr Gerlitz 
3835655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht)
3836655dc3d2SOr Gerlitz {
3837655dc3d2SOr Gerlitz 	return rhashtable_init(tc_ht, &tc_ht_params);
3838655dc3d2SOr Gerlitz }
3839655dc3d2SOr Gerlitz 
3840655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht)
3841655dc3d2SOr Gerlitz {
3842655dc3d2SOr Gerlitz 	rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL);
3843655dc3d2SOr Gerlitz }
384401252a27SOr Gerlitz 
3845226f2ca3SVlad Buslov int mlx5e_tc_num_filters(struct mlx5e_priv *priv, unsigned long flags)
384601252a27SOr Gerlitz {
3847d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
384801252a27SOr Gerlitz 
384901252a27SOr Gerlitz 	return atomic_read(&tc_ht->nelems);
385001252a27SOr Gerlitz }
385104de7ddaSRoi Dayan 
385204de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw)
385304de7ddaSRoi Dayan {
385404de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
385504de7ddaSRoi Dayan 
385604de7ddaSRoi Dayan 	list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer)
385704de7ddaSRoi Dayan 		__mlx5e_tc_del_fdb_peer_flow(flow);
385804de7ddaSRoi Dayan }
3859b4a23329SRoi Dayan 
3860b4a23329SRoi Dayan void mlx5e_tc_reoffload_flows_work(struct work_struct *work)
3861b4a23329SRoi Dayan {
3862b4a23329SRoi Dayan 	struct mlx5_rep_uplink_priv *rpriv =
3863b4a23329SRoi Dayan 		container_of(work, struct mlx5_rep_uplink_priv,
3864b4a23329SRoi Dayan 			     reoffload_flows_work);
3865b4a23329SRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
3866b4a23329SRoi Dayan 
3867ad86755bSVlad Buslov 	mutex_lock(&rpriv->unready_flows_lock);
3868b4a23329SRoi Dayan 	list_for_each_entry_safe(flow, tmp, &rpriv->unready_flows, unready) {
3869b4a23329SRoi Dayan 		if (!mlx5e_tc_add_fdb_flow(flow->priv, flow, NULL))
3870ad86755bSVlad Buslov 			unready_flow_del(flow);
3871b4a23329SRoi Dayan 	}
3872ad86755bSVlad Buslov 	mutex_unlock(&rpriv->unready_flows_lock);
3873b4a23329SRoi Dayan }
3874