1e8f887acSAmir Vadai /*
2e8f887acSAmir Vadai  * Copyright (c) 2016, Mellanox Technologies. All rights reserved.
3e8f887acSAmir Vadai  *
4e8f887acSAmir Vadai  * This software is available to you under a choice of one of two
5e8f887acSAmir Vadai  * licenses.  You may choose to be licensed under the terms of the GNU
6e8f887acSAmir Vadai  * General Public License (GPL) Version 2, available from the file
7e8f887acSAmir Vadai  * COPYING in the main directory of this source tree, or the
8e8f887acSAmir Vadai  * OpenIB.org BSD license below:
9e8f887acSAmir Vadai  *
10e8f887acSAmir Vadai  *     Redistribution and use in source and binary forms, with or
11e8f887acSAmir Vadai  *     without modification, are permitted provided that the following
12e8f887acSAmir Vadai  *     conditions are met:
13e8f887acSAmir Vadai  *
14e8f887acSAmir Vadai  *      - Redistributions of source code must retain the above
15e8f887acSAmir Vadai  *        copyright notice, this list of conditions and the following
16e8f887acSAmir Vadai  *        disclaimer.
17e8f887acSAmir Vadai  *
18e8f887acSAmir Vadai  *      - Redistributions in binary form must reproduce the above
19e8f887acSAmir Vadai  *        copyright notice, this list of conditions and the following
20e8f887acSAmir Vadai  *        disclaimer in the documentation and/or other materials
21e8f887acSAmir Vadai  *        provided with the distribution.
22e8f887acSAmir Vadai  *
23e8f887acSAmir Vadai  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24e8f887acSAmir Vadai  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25e8f887acSAmir Vadai  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26e8f887acSAmir Vadai  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27e8f887acSAmir Vadai  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28e8f887acSAmir Vadai  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29e8f887acSAmir Vadai  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30e8f887acSAmir Vadai  * SOFTWARE.
31e8f887acSAmir Vadai  */
32e8f887acSAmir Vadai 
33e3a2b7edSAmir Vadai #include <net/flow_dissector.h>
343f7d0eb4SOr Gerlitz #include <net/sch_generic.h>
35e3a2b7edSAmir Vadai #include <net/pkt_cls.h>
36e3a2b7edSAmir Vadai #include <net/tc_act/tc_gact.h>
3712185a9fSAmir Vadai #include <net/tc_act/tc_skbedit.h>
38e8f887acSAmir Vadai #include <linux/mlx5/fs.h>
39e8f887acSAmir Vadai #include <linux/mlx5/device.h>
40e8f887acSAmir Vadai #include <linux/rhashtable.h>
4103a9d11eSOr Gerlitz #include <net/switchdev.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>
48e8f887acSAmir Vadai #include "en.h"
491d447a39SSaeed Mahameed #include "en_rep.h"
50232c0013SHadar Hen Zion #include "en_tc.h"
5103a9d11eSOr Gerlitz #include "eswitch.h"
523f6d08d1SOr Gerlitz #include "fs_core.h"
532c81bfd5SHuy Nguyen #include "en/port.h"
54101f4de9SOz Shlomo #include "en/tc_tun.h"
5504de7ddaSRoi Dayan #include "lib/devcom.h"
56e8f887acSAmir Vadai 
573bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr {
583bc4b7bfSOr Gerlitz 	u32 action;
593bc4b7bfSOr Gerlitz 	u32 flow_tag;
602f4fe4caSOr Gerlitz 	u32 mod_hdr_id;
615c65c564SOr Gerlitz 	u32 hairpin_tirn;
6238aa51c1SOr Gerlitz 	u8 match_level;
633f6d08d1SOr Gerlitz 	struct mlx5_flow_table	*hairpin_ft;
64b8aee822SMark Bloch 	struct mlx5_fc		*counter;
653bc4b7bfSOr Gerlitz };
663bc4b7bfSOr Gerlitz 
6760bd4af8SOr Gerlitz #define MLX5E_TC_FLOW_BASE (MLX5E_TC_LAST_EXPORTED_BIT + 1)
6860bd4af8SOr Gerlitz 
6965ba8fb7SOr Gerlitz enum {
7060bd4af8SOr Gerlitz 	MLX5E_TC_FLOW_INGRESS	= MLX5E_TC_INGRESS,
7160bd4af8SOr Gerlitz 	MLX5E_TC_FLOW_EGRESS	= MLX5E_TC_EGRESS,
72d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_ESWITCH	= MLX5E_TC_ESW_OFFLOAD,
73d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_NIC	= MLX5E_TC_NIC_OFFLOAD,
74d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_OFFLOADED	= BIT(MLX5E_TC_FLOW_BASE),
75d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_HAIRPIN	= BIT(MLX5E_TC_FLOW_BASE + 1),
76d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_HAIRPIN_RSS = BIT(MLX5E_TC_FLOW_BASE + 2),
77d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_SLOW	  = BIT(MLX5E_TC_FLOW_BASE + 3),
78d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_DUP         = BIT(MLX5E_TC_FLOW_BASE + 4),
7965ba8fb7SOr Gerlitz };
8065ba8fb7SOr Gerlitz 
81e4ad91f2SChris Mi #define MLX5E_TC_MAX_SPLITS 1
82e4ad91f2SChris Mi 
8379baaec7SEli Britstein /* Helper struct for accessing a struct containing list_head array.
8479baaec7SEli Britstein  * Containing struct
8579baaec7SEli Britstein  *   |- Helper array
8679baaec7SEli Britstein  *      [0] Helper item 0
8779baaec7SEli Britstein  *          |- list_head item 0
8879baaec7SEli Britstein  *          |- index (0)
8979baaec7SEli Britstein  *      [1] Helper item 1
9079baaec7SEli Britstein  *          |- list_head item 1
9179baaec7SEli Britstein  *          |- index (1)
9279baaec7SEli Britstein  * To access the containing struct from one of the list_head items:
9379baaec7SEli Britstein  * 1. Get the helper item from the list_head item using
9479baaec7SEli Britstein  *    helper item =
9579baaec7SEli Britstein  *        container_of(list_head item, helper struct type, list_head field)
9679baaec7SEli Britstein  * 2. Get the contining struct from the helper item and its index in the array:
9779baaec7SEli Britstein  *    containing struct =
9879baaec7SEli Britstein  *        container_of(helper item, containing struct type, helper field[index])
9979baaec7SEli Britstein  */
10079baaec7SEli Britstein struct encap_flow_item {
10179baaec7SEli Britstein 	struct list_head list;
10279baaec7SEli Britstein 	int index;
10379baaec7SEli Britstein };
10479baaec7SEli Britstein 
105e8f887acSAmir Vadai struct mlx5e_tc_flow {
106e8f887acSAmir Vadai 	struct rhash_head	node;
107655dc3d2SOr Gerlitz 	struct mlx5e_priv	*priv;
108e8f887acSAmir Vadai 	u64			cookie;
1095dbe906fSPaul Blakey 	u16			flags;
110e4ad91f2SChris Mi 	struct mlx5_flow_handle *rule[MLX5E_TC_MAX_SPLITS + 1];
11179baaec7SEli Britstein 	/* Flow can be associated with multiple encap IDs.
11279baaec7SEli Britstein 	 * The number of encaps is bounded by the number of supported
11379baaec7SEli Britstein 	 * destinations.
11479baaec7SEli Britstein 	 */
11579baaec7SEli Britstein 	struct encap_flow_item encaps[MLX5_MAX_FLOW_FWD_VPORTS];
11604de7ddaSRoi Dayan 	struct mlx5e_tc_flow    *peer_flow;
11711c9c548SOr Gerlitz 	struct list_head	mod_hdr; /* flows sharing the same mod hdr ID */
1185c65c564SOr Gerlitz 	struct list_head	hairpin; /* flows sharing the same hairpin */
11904de7ddaSRoi Dayan 	struct list_head	peer;    /* flows with peer flow */
1203bc4b7bfSOr Gerlitz 	union {
121ecf5bb79SOr Gerlitz 		struct mlx5_esw_flow_attr esw_attr[0];
1223bc4b7bfSOr Gerlitz 		struct mlx5_nic_flow_attr nic_attr[0];
1233bc4b7bfSOr Gerlitz 	};
124e8f887acSAmir Vadai };
125e8f887acSAmir Vadai 
12617091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr {
12798b66cb1SEli Britstein 	struct ip_tunnel_info tun_info[MLX5_MAX_FLOW_FWD_VPORTS];
128d11afc26SOz Shlomo 	struct net_device *filter_dev;
12917091853SOr Gerlitz 	struct mlx5_flow_spec spec;
130d79b6df6SOr Gerlitz 	int num_mod_hdr_actions;
131d79b6df6SOr Gerlitz 	void *mod_hdr_actions;
13298b66cb1SEli Britstein 	int mirred_ifindex[MLX5_MAX_FLOW_FWD_VPORTS];
13317091853SOr Gerlitz };
13417091853SOr Gerlitz 
135acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4
136b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16)
137e8f887acSAmir Vadai 
13877ab67b7SOr Gerlitz struct mlx5e_hairpin {
13977ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
14077ab67b7SOr Gerlitz 
14177ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev;
1423f6d08d1SOr Gerlitz 	struct mlx5e_priv *func_priv;
14377ab67b7SOr Gerlitz 	u32 tdn;
14477ab67b7SOr Gerlitz 	u32 tirn;
1453f6d08d1SOr Gerlitz 
1463f6d08d1SOr Gerlitz 	int num_channels;
1473f6d08d1SOr Gerlitz 	struct mlx5e_rqt indir_rqt;
1483f6d08d1SOr Gerlitz 	u32 indir_tirn[MLX5E_NUM_INDIR_TIRS];
1493f6d08d1SOr Gerlitz 	struct mlx5e_ttc_table ttc;
15077ab67b7SOr Gerlitz };
15177ab67b7SOr Gerlitz 
1525c65c564SOr Gerlitz struct mlx5e_hairpin_entry {
1535c65c564SOr Gerlitz 	/* a node of a hash table which keeps all the  hairpin entries */
1545c65c564SOr Gerlitz 	struct hlist_node hairpin_hlist;
1555c65c564SOr Gerlitz 
1565c65c564SOr Gerlitz 	/* flows sharing the same hairpin */
1575c65c564SOr Gerlitz 	struct list_head flows;
1585c65c564SOr Gerlitz 
159d8822868SOr Gerlitz 	u16 peer_vhca_id;
160106be53bSOr Gerlitz 	u8 prio;
1615c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
1625c65c564SOr Gerlitz };
1635c65c564SOr Gerlitz 
16411c9c548SOr Gerlitz struct mod_hdr_key {
16511c9c548SOr Gerlitz 	int num_actions;
16611c9c548SOr Gerlitz 	void *actions;
16711c9c548SOr Gerlitz };
16811c9c548SOr Gerlitz 
16911c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry {
17011c9c548SOr Gerlitz 	/* a node of a hash table which keeps all the mod_hdr entries */
17111c9c548SOr Gerlitz 	struct hlist_node mod_hdr_hlist;
17211c9c548SOr Gerlitz 
17311c9c548SOr Gerlitz 	/* flows sharing the same mod_hdr entry */
17411c9c548SOr Gerlitz 	struct list_head flows;
17511c9c548SOr Gerlitz 
17611c9c548SOr Gerlitz 	struct mod_hdr_key key;
17711c9c548SOr Gerlitz 
17811c9c548SOr Gerlitz 	u32 mod_hdr_id;
17911c9c548SOr Gerlitz };
18011c9c548SOr Gerlitz 
18111c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto)
18211c9c548SOr Gerlitz 
18311c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key)
18411c9c548SOr Gerlitz {
18511c9c548SOr Gerlitz 	return jhash(key->actions,
18611c9c548SOr Gerlitz 		     key->num_actions * MLX5_MH_ACT_SZ, 0);
18711c9c548SOr Gerlitz }
18811c9c548SOr Gerlitz 
18911c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a,
19011c9c548SOr Gerlitz 				   struct mod_hdr_key *b)
19111c9c548SOr Gerlitz {
19211c9c548SOr Gerlitz 	if (a->num_actions != b->num_actions)
19311c9c548SOr Gerlitz 		return 1;
19411c9c548SOr Gerlitz 
19511c9c548SOr Gerlitz 	return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ);
19611c9c548SOr Gerlitz }
19711c9c548SOr Gerlitz 
19811c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv,
19911c9c548SOr Gerlitz 				struct mlx5e_tc_flow *flow,
20011c9c548SOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr)
20111c9c548SOr Gerlitz {
20211c9c548SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
20311c9c548SOr Gerlitz 	int num_actions, actions_size, namespace, err;
20411c9c548SOr Gerlitz 	struct mlx5e_mod_hdr_entry *mh;
20511c9c548SOr Gerlitz 	struct mod_hdr_key key;
20611c9c548SOr Gerlitz 	bool found = false;
20711c9c548SOr Gerlitz 	u32 hash_key;
20811c9c548SOr Gerlitz 
20911c9c548SOr Gerlitz 	num_actions  = parse_attr->num_mod_hdr_actions;
21011c9c548SOr Gerlitz 	actions_size = MLX5_MH_ACT_SZ * num_actions;
21111c9c548SOr Gerlitz 
21211c9c548SOr Gerlitz 	key.actions = parse_attr->mod_hdr_actions;
21311c9c548SOr Gerlitz 	key.num_actions = num_actions;
21411c9c548SOr Gerlitz 
21511c9c548SOr Gerlitz 	hash_key = hash_mod_hdr_info(&key);
21611c9c548SOr Gerlitz 
21711c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
21811c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_FDB;
21911c9c548SOr Gerlitz 		hash_for_each_possible(esw->offloads.mod_hdr_tbl, mh,
22011c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
22111c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
22211c9c548SOr Gerlitz 				found = true;
22311c9c548SOr Gerlitz 				break;
22411c9c548SOr Gerlitz 			}
22511c9c548SOr Gerlitz 		}
22611c9c548SOr Gerlitz 	} else {
22711c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_KERNEL;
22811c9c548SOr Gerlitz 		hash_for_each_possible(priv->fs.tc.mod_hdr_tbl, mh,
22911c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
23011c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
23111c9c548SOr Gerlitz 				found = true;
23211c9c548SOr Gerlitz 				break;
23311c9c548SOr Gerlitz 			}
23411c9c548SOr Gerlitz 		}
23511c9c548SOr Gerlitz 	}
23611c9c548SOr Gerlitz 
23711c9c548SOr Gerlitz 	if (found)
23811c9c548SOr Gerlitz 		goto attach_flow;
23911c9c548SOr Gerlitz 
24011c9c548SOr Gerlitz 	mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL);
24111c9c548SOr Gerlitz 	if (!mh)
24211c9c548SOr Gerlitz 		return -ENOMEM;
24311c9c548SOr Gerlitz 
24411c9c548SOr Gerlitz 	mh->key.actions = (void *)mh + sizeof(*mh);
24511c9c548SOr Gerlitz 	memcpy(mh->key.actions, key.actions, actions_size);
24611c9c548SOr Gerlitz 	mh->key.num_actions = num_actions;
24711c9c548SOr Gerlitz 	INIT_LIST_HEAD(&mh->flows);
24811c9c548SOr Gerlitz 
24911c9c548SOr Gerlitz 	err = mlx5_modify_header_alloc(priv->mdev, namespace,
25011c9c548SOr Gerlitz 				       mh->key.num_actions,
25111c9c548SOr Gerlitz 				       mh->key.actions,
25211c9c548SOr Gerlitz 				       &mh->mod_hdr_id);
25311c9c548SOr Gerlitz 	if (err)
25411c9c548SOr Gerlitz 		goto out_err;
25511c9c548SOr Gerlitz 
25611c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
25711c9c548SOr Gerlitz 		hash_add(esw->offloads.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
25811c9c548SOr Gerlitz 	else
25911c9c548SOr Gerlitz 		hash_add(priv->fs.tc.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
26011c9c548SOr Gerlitz 
26111c9c548SOr Gerlitz attach_flow:
26211c9c548SOr Gerlitz 	list_add(&flow->mod_hdr, &mh->flows);
26311c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
26411c9c548SOr Gerlitz 		flow->esw_attr->mod_hdr_id = mh->mod_hdr_id;
26511c9c548SOr Gerlitz 	else
26611c9c548SOr Gerlitz 		flow->nic_attr->mod_hdr_id = mh->mod_hdr_id;
26711c9c548SOr Gerlitz 
26811c9c548SOr Gerlitz 	return 0;
26911c9c548SOr Gerlitz 
27011c9c548SOr Gerlitz out_err:
27111c9c548SOr Gerlitz 	kfree(mh);
27211c9c548SOr Gerlitz 	return err;
27311c9c548SOr Gerlitz }
27411c9c548SOr Gerlitz 
27511c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv,
27611c9c548SOr Gerlitz 				 struct mlx5e_tc_flow *flow)
27711c9c548SOr Gerlitz {
27811c9c548SOr Gerlitz 	struct list_head *next = flow->mod_hdr.next;
27911c9c548SOr Gerlitz 
28011c9c548SOr Gerlitz 	list_del(&flow->mod_hdr);
28111c9c548SOr Gerlitz 
28211c9c548SOr Gerlitz 	if (list_empty(next)) {
28311c9c548SOr Gerlitz 		struct mlx5e_mod_hdr_entry *mh;
28411c9c548SOr Gerlitz 
28511c9c548SOr Gerlitz 		mh = list_entry(next, struct mlx5e_mod_hdr_entry, flows);
28611c9c548SOr Gerlitz 
28711c9c548SOr Gerlitz 		mlx5_modify_header_dealloc(priv->mdev, mh->mod_hdr_id);
28811c9c548SOr Gerlitz 		hash_del(&mh->mod_hdr_hlist);
28911c9c548SOr Gerlitz 		kfree(mh);
29011c9c548SOr Gerlitz 	}
29111c9c548SOr Gerlitz }
29211c9c548SOr Gerlitz 
29377ab67b7SOr Gerlitz static
29477ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex)
29577ab67b7SOr Gerlitz {
29677ab67b7SOr Gerlitz 	struct net_device *netdev;
29777ab67b7SOr Gerlitz 	struct mlx5e_priv *priv;
29877ab67b7SOr Gerlitz 
29977ab67b7SOr Gerlitz 	netdev = __dev_get_by_index(net, ifindex);
30077ab67b7SOr Gerlitz 	priv = netdev_priv(netdev);
30177ab67b7SOr Gerlitz 	return priv->mdev;
30277ab67b7SOr Gerlitz }
30377ab67b7SOr Gerlitz 
30477ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp)
30577ab67b7SOr Gerlitz {
30677ab67b7SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0};
30777ab67b7SOr Gerlitz 	void *tirc;
30877ab67b7SOr Gerlitz 	int err;
30977ab67b7SOr Gerlitz 
31077ab67b7SOr Gerlitz 	err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn);
31177ab67b7SOr Gerlitz 	if (err)
31277ab67b7SOr Gerlitz 		goto alloc_tdn_err;
31377ab67b7SOr Gerlitz 
31477ab67b7SOr Gerlitz 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
31577ab67b7SOr Gerlitz 
31677ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT);
317ddae74acSOr Gerlitz 	MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]);
31877ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
31977ab67b7SOr Gerlitz 
32077ab67b7SOr Gerlitz 	err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn);
32177ab67b7SOr Gerlitz 	if (err)
32277ab67b7SOr Gerlitz 		goto create_tir_err;
32377ab67b7SOr Gerlitz 
32477ab67b7SOr Gerlitz 	return 0;
32577ab67b7SOr Gerlitz 
32677ab67b7SOr Gerlitz create_tir_err:
32777ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
32877ab67b7SOr Gerlitz alloc_tdn_err:
32977ab67b7SOr Gerlitz 	return err;
33077ab67b7SOr Gerlitz }
33177ab67b7SOr Gerlitz 
33277ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp)
33377ab67b7SOr Gerlitz {
33477ab67b7SOr Gerlitz 	mlx5_core_destroy_tir(hp->func_mdev, hp->tirn);
33577ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
33677ab67b7SOr Gerlitz }
33777ab67b7SOr Gerlitz 
3383f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc)
3393f6d08d1SOr Gerlitz {
3403f6d08d1SOr Gerlitz 	u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn;
3413f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3423f6d08d1SOr Gerlitz 	int i, ix, sz = MLX5E_INDIR_RQT_SIZE;
3433f6d08d1SOr Gerlitz 
3443f6d08d1SOr Gerlitz 	mlx5e_build_default_indir_rqt(indirection_rqt, sz,
3453f6d08d1SOr Gerlitz 				      hp->num_channels);
3463f6d08d1SOr Gerlitz 
3473f6d08d1SOr Gerlitz 	for (i = 0; i < sz; i++) {
3483f6d08d1SOr Gerlitz 		ix = i;
349bbeb53b8SAya Levin 		if (priv->rss_params.hfunc == ETH_RSS_HASH_XOR)
3503f6d08d1SOr Gerlitz 			ix = mlx5e_bits_invert(i, ilog2(sz));
3513f6d08d1SOr Gerlitz 		ix = indirection_rqt[ix];
3523f6d08d1SOr Gerlitz 		rqn = hp->pair->rqn[ix];
3533f6d08d1SOr Gerlitz 		MLX5_SET(rqtc, rqtc, rq_num[i], rqn);
3543f6d08d1SOr Gerlitz 	}
3553f6d08d1SOr Gerlitz }
3563f6d08d1SOr Gerlitz 
3573f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp)
3583f6d08d1SOr Gerlitz {
3593f6d08d1SOr Gerlitz 	int inlen, err, sz = MLX5E_INDIR_RQT_SIZE;
3603f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3613f6d08d1SOr Gerlitz 	struct mlx5_core_dev *mdev = priv->mdev;
3623f6d08d1SOr Gerlitz 	void *rqtc;
3633f6d08d1SOr Gerlitz 	u32 *in;
3643f6d08d1SOr Gerlitz 
3653f6d08d1SOr Gerlitz 	inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz;
3663f6d08d1SOr Gerlitz 	in = kvzalloc(inlen, GFP_KERNEL);
3673f6d08d1SOr Gerlitz 	if (!in)
3683f6d08d1SOr Gerlitz 		return -ENOMEM;
3693f6d08d1SOr Gerlitz 
3703f6d08d1SOr Gerlitz 	rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context);
3713f6d08d1SOr Gerlitz 
3723f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_actual_size, sz);
3733f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_max_size, sz);
3743f6d08d1SOr Gerlitz 
3753f6d08d1SOr Gerlitz 	mlx5e_hairpin_fill_rqt_rqns(hp, rqtc);
3763f6d08d1SOr Gerlitz 
3773f6d08d1SOr Gerlitz 	err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn);
3783f6d08d1SOr Gerlitz 	if (!err)
3793f6d08d1SOr Gerlitz 		hp->indir_rqt.enabled = true;
3803f6d08d1SOr Gerlitz 
3813f6d08d1SOr Gerlitz 	kvfree(in);
3823f6d08d1SOr Gerlitz 	return err;
3833f6d08d1SOr Gerlitz }
3843f6d08d1SOr Gerlitz 
3853f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp)
3863f6d08d1SOr Gerlitz {
3873f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3883f6d08d1SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)];
3893f6d08d1SOr Gerlitz 	int tt, i, err;
3903f6d08d1SOr Gerlitz 	void *tirc;
3913f6d08d1SOr Gerlitz 
3923f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) {
393d930ac79SAya Levin 		struct mlx5e_tirc_config ttconfig = mlx5e_tirc_get_default_config(tt);
394d930ac79SAya Levin 
3953f6d08d1SOr Gerlitz 		memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in));
3963f6d08d1SOr Gerlitz 		tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
3973f6d08d1SOr Gerlitz 
3983f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
3993f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT);
4003f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn);
401bbeb53b8SAya Levin 		mlx5e_build_indir_tir_ctx_hash(&priv->rss_params, &ttconfig, tirc, false);
402bbeb53b8SAya Levin 
4033f6d08d1SOr Gerlitz 		err = mlx5_core_create_tir(hp->func_mdev, in,
4043f6d08d1SOr Gerlitz 					   MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]);
4053f6d08d1SOr Gerlitz 		if (err) {
4063f6d08d1SOr Gerlitz 			mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err);
4073f6d08d1SOr Gerlitz 			goto err_destroy_tirs;
4083f6d08d1SOr Gerlitz 		}
4093f6d08d1SOr Gerlitz 	}
4103f6d08d1SOr Gerlitz 	return 0;
4113f6d08d1SOr Gerlitz 
4123f6d08d1SOr Gerlitz err_destroy_tirs:
4133f6d08d1SOr Gerlitz 	for (i = 0; i < tt; i++)
4143f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]);
4153f6d08d1SOr Gerlitz 	return err;
4163f6d08d1SOr Gerlitz }
4173f6d08d1SOr Gerlitz 
4183f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp)
4193f6d08d1SOr Gerlitz {
4203f6d08d1SOr Gerlitz 	int tt;
4213f6d08d1SOr Gerlitz 
4223f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
4233f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]);
4243f6d08d1SOr Gerlitz }
4253f6d08d1SOr Gerlitz 
4263f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp,
4273f6d08d1SOr Gerlitz 					 struct ttc_params *ttc_params)
4283f6d08d1SOr Gerlitz {
4293f6d08d1SOr Gerlitz 	struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
4303f6d08d1SOr Gerlitz 	int tt;
4313f6d08d1SOr Gerlitz 
4323f6d08d1SOr Gerlitz 	memset(ttc_params, 0, sizeof(*ttc_params));
4333f6d08d1SOr Gerlitz 
4343f6d08d1SOr Gerlitz 	ttc_params->any_tt_tirn = hp->tirn;
4353f6d08d1SOr Gerlitz 
4363f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
4373f6d08d1SOr Gerlitz 		ttc_params->indir_tirn[tt] = hp->indir_tirn[tt];
4383f6d08d1SOr Gerlitz 
4393f6d08d1SOr Gerlitz 	ft_attr->max_fte = MLX5E_NUM_TT;
4403f6d08d1SOr Gerlitz 	ft_attr->level = MLX5E_TC_TTC_FT_LEVEL;
4413f6d08d1SOr Gerlitz 	ft_attr->prio = MLX5E_TC_PRIO;
4423f6d08d1SOr Gerlitz }
4433f6d08d1SOr Gerlitz 
4443f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp)
4453f6d08d1SOr Gerlitz {
4463f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4473f6d08d1SOr Gerlitz 	struct ttc_params ttc_params;
4483f6d08d1SOr Gerlitz 	int err;
4493f6d08d1SOr Gerlitz 
4503f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_rqt(hp);
4513f6d08d1SOr Gerlitz 	if (err)
4523f6d08d1SOr Gerlitz 		return err;
4533f6d08d1SOr Gerlitz 
4543f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_tirs(hp);
4553f6d08d1SOr Gerlitz 	if (err)
4563f6d08d1SOr Gerlitz 		goto err_create_indirect_tirs;
4573f6d08d1SOr Gerlitz 
4583f6d08d1SOr Gerlitz 	mlx5e_hairpin_set_ttc_params(hp, &ttc_params);
4593f6d08d1SOr Gerlitz 	err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc);
4603f6d08d1SOr Gerlitz 	if (err)
4613f6d08d1SOr Gerlitz 		goto err_create_ttc_table;
4623f6d08d1SOr Gerlitz 
4633f6d08d1SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n",
4643f6d08d1SOr Gerlitz 		   hp->num_channels, hp->ttc.ft.t->id);
4653f6d08d1SOr Gerlitz 
4663f6d08d1SOr Gerlitz 	return 0;
4673f6d08d1SOr Gerlitz 
4683f6d08d1SOr Gerlitz err_create_ttc_table:
4693f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
4703f6d08d1SOr Gerlitz err_create_indirect_tirs:
4713f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
4723f6d08d1SOr Gerlitz 
4733f6d08d1SOr Gerlitz 	return err;
4743f6d08d1SOr Gerlitz }
4753f6d08d1SOr Gerlitz 
4763f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp)
4773f6d08d1SOr Gerlitz {
4783f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4793f6d08d1SOr Gerlitz 
4803f6d08d1SOr Gerlitz 	mlx5e_destroy_ttc_table(priv, &hp->ttc);
4813f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
4823f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
4833f6d08d1SOr Gerlitz }
4843f6d08d1SOr Gerlitz 
48577ab67b7SOr Gerlitz static struct mlx5e_hairpin *
48677ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params,
48777ab67b7SOr Gerlitz 		     int peer_ifindex)
48877ab67b7SOr Gerlitz {
48977ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev, *peer_mdev;
49077ab67b7SOr Gerlitz 	struct mlx5e_hairpin *hp;
49177ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
49277ab67b7SOr Gerlitz 	int err;
49377ab67b7SOr Gerlitz 
49477ab67b7SOr Gerlitz 	hp = kzalloc(sizeof(*hp), GFP_KERNEL);
49577ab67b7SOr Gerlitz 	if (!hp)
49677ab67b7SOr Gerlitz 		return ERR_PTR(-ENOMEM);
49777ab67b7SOr Gerlitz 
49877ab67b7SOr Gerlitz 	func_mdev = priv->mdev;
49977ab67b7SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
50077ab67b7SOr Gerlitz 
50177ab67b7SOr Gerlitz 	pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params);
50277ab67b7SOr Gerlitz 	if (IS_ERR(pair)) {
50377ab67b7SOr Gerlitz 		err = PTR_ERR(pair);
50477ab67b7SOr Gerlitz 		goto create_pair_err;
50577ab67b7SOr Gerlitz 	}
50677ab67b7SOr Gerlitz 	hp->pair = pair;
50777ab67b7SOr Gerlitz 	hp->func_mdev = func_mdev;
5083f6d08d1SOr Gerlitz 	hp->func_priv = priv;
5093f6d08d1SOr Gerlitz 	hp->num_channels = params->num_channels;
51077ab67b7SOr Gerlitz 
51177ab67b7SOr Gerlitz 	err = mlx5e_hairpin_create_transport(hp);
51277ab67b7SOr Gerlitz 	if (err)
51377ab67b7SOr Gerlitz 		goto create_transport_err;
51477ab67b7SOr Gerlitz 
5153f6d08d1SOr Gerlitz 	if (hp->num_channels > 1) {
5163f6d08d1SOr Gerlitz 		err = mlx5e_hairpin_rss_init(hp);
5173f6d08d1SOr Gerlitz 		if (err)
5183f6d08d1SOr Gerlitz 			goto rss_init_err;
5193f6d08d1SOr Gerlitz 	}
5203f6d08d1SOr Gerlitz 
52177ab67b7SOr Gerlitz 	return hp;
52277ab67b7SOr Gerlitz 
5233f6d08d1SOr Gerlitz rss_init_err:
5243f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
52577ab67b7SOr Gerlitz create_transport_err:
52677ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
52777ab67b7SOr Gerlitz create_pair_err:
52877ab67b7SOr Gerlitz 	kfree(hp);
52977ab67b7SOr Gerlitz 	return ERR_PTR(err);
53077ab67b7SOr Gerlitz }
53177ab67b7SOr Gerlitz 
53277ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp)
53377ab67b7SOr Gerlitz {
5343f6d08d1SOr Gerlitz 	if (hp->num_channels > 1)
5353f6d08d1SOr Gerlitz 		mlx5e_hairpin_rss_cleanup(hp);
53677ab67b7SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
53777ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
53877ab67b7SOr Gerlitz 	kvfree(hp);
53977ab67b7SOr Gerlitz }
54077ab67b7SOr Gerlitz 
541106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio)
542106be53bSOr Gerlitz {
543106be53bSOr Gerlitz 	return (peer_vhca_id << 16 | prio);
544106be53bSOr Gerlitz }
545106be53bSOr Gerlitz 
5465c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv,
547106be53bSOr Gerlitz 						     u16 peer_vhca_id, u8 prio)
5485c65c564SOr Gerlitz {
5495c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
550106be53bSOr Gerlitz 	u32 hash_key = hash_hairpin_info(peer_vhca_id, prio);
5515c65c564SOr Gerlitz 
5525c65c564SOr Gerlitz 	hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe,
553106be53bSOr Gerlitz 			       hairpin_hlist, hash_key) {
554106be53bSOr Gerlitz 		if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio)
5555c65c564SOr Gerlitz 			return hpe;
5565c65c564SOr Gerlitz 	}
5575c65c564SOr Gerlitz 
5585c65c564SOr Gerlitz 	return NULL;
5595c65c564SOr Gerlitz }
5605c65c564SOr Gerlitz 
561106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8
562106be53bSOr Gerlitz 
563106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv,
564e98bedf5SEli Britstein 				  struct mlx5_flow_spec *spec, u8 *match_prio,
565e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
566106be53bSOr Gerlitz {
567106be53bSOr Gerlitz 	void *headers_c, *headers_v;
568106be53bSOr Gerlitz 	u8 prio_val, prio_mask = 0;
569106be53bSOr Gerlitz 	bool vlan_present;
570106be53bSOr Gerlitz 
571106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB
572106be53bSOr Gerlitz 	if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) {
573e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
574e98bedf5SEli Britstein 				   "only PCP trust state supported for hairpin");
575106be53bSOr Gerlitz 		return -EOPNOTSUPP;
576106be53bSOr Gerlitz 	}
577106be53bSOr Gerlitz #endif
578106be53bSOr Gerlitz 	headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers);
579106be53bSOr Gerlitz 	headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
580106be53bSOr Gerlitz 
581106be53bSOr Gerlitz 	vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag);
582106be53bSOr Gerlitz 	if (vlan_present) {
583106be53bSOr Gerlitz 		prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio);
584106be53bSOr Gerlitz 		prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio);
585106be53bSOr Gerlitz 	}
586106be53bSOr Gerlitz 
587106be53bSOr Gerlitz 	if (!vlan_present || !prio_mask) {
588106be53bSOr Gerlitz 		prio_val = UNKNOWN_MATCH_PRIO;
589106be53bSOr Gerlitz 	} else if (prio_mask != 0x7) {
590e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
591e98bedf5SEli Britstein 				   "masked priority match not supported for hairpin");
592106be53bSOr Gerlitz 		return -EOPNOTSUPP;
593106be53bSOr Gerlitz 	}
594106be53bSOr Gerlitz 
595106be53bSOr Gerlitz 	*match_prio = prio_val;
596106be53bSOr Gerlitz 	return 0;
597106be53bSOr Gerlitz }
598106be53bSOr Gerlitz 
5995c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv,
6005c65c564SOr Gerlitz 				  struct mlx5e_tc_flow *flow,
601e98bedf5SEli Britstein 				  struct mlx5e_tc_flow_parse_attr *parse_attr,
602e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
6035c65c564SOr Gerlitz {
60498b66cb1SEli Britstein 	int peer_ifindex = parse_attr->mirred_ifindex[0];
6055c65c564SOr Gerlitz 	struct mlx5_hairpin_params params;
606d8822868SOr Gerlitz 	struct mlx5_core_dev *peer_mdev;
6075c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
6085c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
6093f6d08d1SOr Gerlitz 	u64 link_speed64;
6103f6d08d1SOr Gerlitz 	u32 link_speed;
611106be53bSOr Gerlitz 	u8 match_prio;
612d8822868SOr Gerlitz 	u16 peer_id;
6135c65c564SOr Gerlitz 	int err;
6145c65c564SOr Gerlitz 
615d8822868SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
616d8822868SOr Gerlitz 	if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) {
617e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported");
6185c65c564SOr Gerlitz 		return -EOPNOTSUPP;
6195c65c564SOr Gerlitz 	}
6205c65c564SOr Gerlitz 
621d8822868SOr Gerlitz 	peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
622e98bedf5SEli Britstein 	err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio,
623e98bedf5SEli Britstein 				     extack);
624106be53bSOr Gerlitz 	if (err)
625106be53bSOr Gerlitz 		return err;
626106be53bSOr Gerlitz 	hpe = mlx5e_hairpin_get(priv, peer_id, match_prio);
6275c65c564SOr Gerlitz 	if (hpe)
6285c65c564SOr Gerlitz 		goto attach_flow;
6295c65c564SOr Gerlitz 
6305c65c564SOr Gerlitz 	hpe = kzalloc(sizeof(*hpe), GFP_KERNEL);
6315c65c564SOr Gerlitz 	if (!hpe)
6325c65c564SOr Gerlitz 		return -ENOMEM;
6335c65c564SOr Gerlitz 
6345c65c564SOr Gerlitz 	INIT_LIST_HEAD(&hpe->flows);
635d8822868SOr Gerlitz 	hpe->peer_vhca_id = peer_id;
636106be53bSOr Gerlitz 	hpe->prio = match_prio;
6375c65c564SOr Gerlitz 
6385c65c564SOr Gerlitz 	params.log_data_size = 15;
6395c65c564SOr Gerlitz 	params.log_data_size = min_t(u8, params.log_data_size,
6405c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz));
6415c65c564SOr Gerlitz 	params.log_data_size = max_t(u8, params.log_data_size,
6425c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz));
6435c65c564SOr Gerlitz 
644eb9180f7SOr Gerlitz 	params.log_num_packets = params.log_data_size -
645eb9180f7SOr Gerlitz 				 MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev);
646eb9180f7SOr Gerlitz 	params.log_num_packets = min_t(u8, params.log_num_packets,
647eb9180f7SOr Gerlitz 				       MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets));
648eb9180f7SOr Gerlitz 
649eb9180f7SOr Gerlitz 	params.q_counter = priv->q_counter;
6503f6d08d1SOr Gerlitz 	/* set hairpin pair per each 50Gbs share of the link */
6512c81bfd5SHuy Nguyen 	mlx5e_port_max_linkspeed(priv->mdev, &link_speed);
6523f6d08d1SOr Gerlitz 	link_speed = max_t(u32, link_speed, 50000);
6533f6d08d1SOr Gerlitz 	link_speed64 = link_speed;
6543f6d08d1SOr Gerlitz 	do_div(link_speed64, 50000);
6553f6d08d1SOr Gerlitz 	params.num_channels = link_speed64;
6563f6d08d1SOr Gerlitz 
6575c65c564SOr Gerlitz 	hp = mlx5e_hairpin_create(priv, &params, peer_ifindex);
6585c65c564SOr Gerlitz 	if (IS_ERR(hp)) {
6595c65c564SOr Gerlitz 		err = PTR_ERR(hp);
6605c65c564SOr Gerlitz 		goto create_hairpin_err;
6615c65c564SOr Gerlitz 	}
6625c65c564SOr Gerlitz 
663eb9180f7SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n",
664ddae74acSOr Gerlitz 		   hp->tirn, hp->pair->rqn[0], hp->pair->peer_mdev->priv.name,
665eb9180f7SOr Gerlitz 		   hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets);
6665c65c564SOr Gerlitz 
6675c65c564SOr Gerlitz 	hpe->hp = hp;
668106be53bSOr Gerlitz 	hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist,
669106be53bSOr Gerlitz 		 hash_hairpin_info(peer_id, match_prio));
6705c65c564SOr Gerlitz 
6715c65c564SOr Gerlitz attach_flow:
6723f6d08d1SOr Gerlitz 	if (hpe->hp->num_channels > 1) {
6733f6d08d1SOr Gerlitz 		flow->flags |= MLX5E_TC_FLOW_HAIRPIN_RSS;
6743f6d08d1SOr Gerlitz 		flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t;
6753f6d08d1SOr Gerlitz 	} else {
6765c65c564SOr Gerlitz 		flow->nic_attr->hairpin_tirn = hpe->hp->tirn;
6773f6d08d1SOr Gerlitz 	}
6785c65c564SOr Gerlitz 	list_add(&flow->hairpin, &hpe->flows);
6793f6d08d1SOr Gerlitz 
6805c65c564SOr Gerlitz 	return 0;
6815c65c564SOr Gerlitz 
6825c65c564SOr Gerlitz create_hairpin_err:
6835c65c564SOr Gerlitz 	kfree(hpe);
6845c65c564SOr Gerlitz 	return err;
6855c65c564SOr Gerlitz }
6865c65c564SOr Gerlitz 
6875c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv,
6885c65c564SOr Gerlitz 				   struct mlx5e_tc_flow *flow)
6895c65c564SOr Gerlitz {
6905c65c564SOr Gerlitz 	struct list_head *next = flow->hairpin.next;
6915c65c564SOr Gerlitz 
6925c65c564SOr Gerlitz 	list_del(&flow->hairpin);
6935c65c564SOr Gerlitz 
6945c65c564SOr Gerlitz 	/* no more hairpin flows for us, release the hairpin pair */
6955c65c564SOr Gerlitz 	if (list_empty(next)) {
6965c65c564SOr Gerlitz 		struct mlx5e_hairpin_entry *hpe;
6975c65c564SOr Gerlitz 
6985c65c564SOr Gerlitz 		hpe = list_entry(next, struct mlx5e_hairpin_entry, flows);
6995c65c564SOr Gerlitz 
7005c65c564SOr Gerlitz 		netdev_dbg(priv->netdev, "del hairpin: peer %s\n",
7015c65c564SOr Gerlitz 			   hpe->hp->pair->peer_mdev->priv.name);
7025c65c564SOr Gerlitz 
7035c65c564SOr Gerlitz 		mlx5e_hairpin_destroy(hpe->hp);
7045c65c564SOr Gerlitz 		hash_del(&hpe->hairpin_hlist);
7055c65c564SOr Gerlitz 		kfree(hpe);
7065c65c564SOr Gerlitz 	}
7075c65c564SOr Gerlitz }
7085c65c564SOr Gerlitz 
709c83954abSRabie Loulou static int
71074491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv,
71117091853SOr Gerlitz 		      struct mlx5e_tc_flow_parse_attr *parse_attr,
712e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
713e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
714e8f887acSAmir Vadai {
715aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
716aad7e08dSAmir Vadai 	struct mlx5_core_dev *dev = priv->mdev;
7175c65c564SOr Gerlitz 	struct mlx5_flow_destination dest[2] = {};
71866958ed9SHadar Hen Zion 	struct mlx5_flow_act flow_act = {
7193bc4b7bfSOr Gerlitz 		.action = attr->action,
7203bc4b7bfSOr Gerlitz 		.flow_tag = attr->flow_tag,
72160786f09SMark Bloch 		.reformat_id = 0,
72242f7ad67SPaul Blakey 		.flags    = FLOW_ACT_HAS_TAG | FLOW_ACT_NO_APPEND,
72366958ed9SHadar Hen Zion 	};
724aad7e08dSAmir Vadai 	struct mlx5_fc *counter = NULL;
725e8f887acSAmir Vadai 	bool table_created = false;
7265c65c564SOr Gerlitz 	int err, dest_ix = 0;
727e8f887acSAmir Vadai 
7285c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) {
729e98bedf5SEli Britstein 		err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack);
7305c65c564SOr Gerlitz 		if (err) {
7315c65c564SOr Gerlitz 			goto err_add_hairpin_flow;
7325c65c564SOr Gerlitz 		}
7333f6d08d1SOr Gerlitz 		if (flow->flags & MLX5E_TC_FLOW_HAIRPIN_RSS) {
7343f6d08d1SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
7353f6d08d1SOr Gerlitz 			dest[dest_ix].ft = attr->hairpin_ft;
7363f6d08d1SOr Gerlitz 		} else {
7375c65c564SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR;
7385c65c564SOr Gerlitz 			dest[dest_ix].tir_num = attr->hairpin_tirn;
7393f6d08d1SOr Gerlitz 		}
7403f6d08d1SOr Gerlitz 		dest_ix++;
7413f6d08d1SOr Gerlitz 	} else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
7425c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
7435c65c564SOr Gerlitz 		dest[dest_ix].ft = priv->fs.vlan.ft.t;
7445c65c564SOr Gerlitz 		dest_ix++;
7455c65c564SOr Gerlitz 	}
746aad7e08dSAmir Vadai 
7475c65c564SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
7485c65c564SOr Gerlitz 		counter = mlx5_fc_create(dev, true);
7495c65c564SOr Gerlitz 		if (IS_ERR(counter)) {
750c83954abSRabie Loulou 			err = PTR_ERR(counter);
7515c65c564SOr Gerlitz 			goto err_fc_create;
7525c65c564SOr Gerlitz 		}
7535c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
754171c7625SMark Bloch 		dest[dest_ix].counter_id = mlx5_fc_id(counter);
7555c65c564SOr Gerlitz 		dest_ix++;
756b8aee822SMark Bloch 		attr->counter = counter;
757aad7e08dSAmir Vadai 	}
758aad7e08dSAmir Vadai 
7592f4fe4caSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
7603099eb5aSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
761d7e75a32SOr Gerlitz 		flow_act.modify_id = attr->mod_hdr_id;
7622f4fe4caSOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
763c83954abSRabie Loulou 		if (err)
7642f4fe4caSOr Gerlitz 			goto err_create_mod_hdr_id;
7652f4fe4caSOr Gerlitz 	}
7662f4fe4caSOr Gerlitz 
767acff797cSMaor Gottlieb 	if (IS_ERR_OR_NULL(priv->fs.tc.t)) {
76821b9c144SOr Gerlitz 		int tc_grp_size, tc_tbl_size;
76921b9c144SOr Gerlitz 		u32 max_flow_counter;
77021b9c144SOr Gerlitz 
77121b9c144SOr Gerlitz 		max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) |
77221b9c144SOr Gerlitz 				    MLX5_CAP_GEN(dev, max_flow_counter_15_0);
77321b9c144SOr Gerlitz 
77421b9c144SOr Gerlitz 		tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE);
77521b9c144SOr Gerlitz 
77621b9c144SOr Gerlitz 		tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS,
77721b9c144SOr Gerlitz 				    BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size)));
77821b9c144SOr Gerlitz 
779acff797cSMaor Gottlieb 		priv->fs.tc.t =
780acff797cSMaor Gottlieb 			mlx5_create_auto_grouped_flow_table(priv->fs.ns,
781acff797cSMaor Gottlieb 							    MLX5E_TC_PRIO,
78221b9c144SOr Gerlitz 							    tc_tbl_size,
783acff797cSMaor Gottlieb 							    MLX5E_TC_TABLE_NUM_GROUPS,
7843f6d08d1SOr Gerlitz 							    MLX5E_TC_FT_LEVEL, 0);
785acff797cSMaor Gottlieb 		if (IS_ERR(priv->fs.tc.t)) {
786e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
787e98bedf5SEli Britstein 					   "Failed to create tc offload table\n");
788e8f887acSAmir Vadai 			netdev_err(priv->netdev,
789e8f887acSAmir Vadai 				   "Failed to create tc offload table\n");
790c83954abSRabie Loulou 			err = PTR_ERR(priv->fs.tc.t);
791aad7e08dSAmir Vadai 			goto err_create_ft;
792e8f887acSAmir Vadai 		}
793e8f887acSAmir Vadai 
794e8f887acSAmir Vadai 		table_created = true;
795e8f887acSAmir Vadai 	}
796e8f887acSAmir Vadai 
79738aa51c1SOr Gerlitz 	if (attr->match_level != MLX5_MATCH_NONE)
79817091853SOr Gerlitz 		parse_attr->spec.match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
79938aa51c1SOr Gerlitz 
800c83954abSRabie Loulou 	flow->rule[0] = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec,
8015c65c564SOr Gerlitz 					    &flow_act, dest, dest_ix);
802e8f887acSAmir Vadai 
803c83954abSRabie Loulou 	if (IS_ERR(flow->rule[0])) {
804c83954abSRabie Loulou 		err = PTR_ERR(flow->rule[0]);
805aad7e08dSAmir Vadai 		goto err_add_rule;
806c83954abSRabie Loulou 	}
807aad7e08dSAmir Vadai 
808c83954abSRabie Loulou 	return 0;
809aad7e08dSAmir Vadai 
810aad7e08dSAmir Vadai err_add_rule:
811aad7e08dSAmir Vadai 	if (table_created) {
812acff797cSMaor Gottlieb 		mlx5_destroy_flow_table(priv->fs.tc.t);
813acff797cSMaor Gottlieb 		priv->fs.tc.t = NULL;
814e8f887acSAmir Vadai 	}
815aad7e08dSAmir Vadai err_create_ft:
8162f4fe4caSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
8173099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
8182f4fe4caSOr Gerlitz err_create_mod_hdr_id:
819aad7e08dSAmir Vadai 	mlx5_fc_destroy(dev, counter);
8205c65c564SOr Gerlitz err_fc_create:
8215c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN)
8225c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
8235c65c564SOr Gerlitz err_add_hairpin_flow:
824c83954abSRabie Loulou 	return err;
825e8f887acSAmir Vadai }
826e8f887acSAmir Vadai 
827d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv,
828d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
829d85cdccbSOr Gerlitz {
830513f8f7fSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
831d85cdccbSOr Gerlitz 	struct mlx5_fc *counter = NULL;
832d85cdccbSOr Gerlitz 
833b8aee822SMark Bloch 	counter = attr->counter;
834e4ad91f2SChris Mi 	mlx5_del_flow_rules(flow->rule[0]);
835d85cdccbSOr Gerlitz 	mlx5_fc_destroy(priv->mdev, counter);
836d85cdccbSOr Gerlitz 
837d9ee0491SOr Gerlitz 	if (!mlx5e_tc_num_filters(priv, MLX5E_TC_NIC_OFFLOAD)  && priv->fs.tc.t) {
838d85cdccbSOr Gerlitz 		mlx5_destroy_flow_table(priv->fs.tc.t);
839d85cdccbSOr Gerlitz 		priv->fs.tc.t = NULL;
840d85cdccbSOr Gerlitz 	}
8412f4fe4caSOr Gerlitz 
842513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
8433099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
8445c65c564SOr Gerlitz 
8455c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN)
8465c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
847d85cdccbSOr Gerlitz }
848d85cdccbSOr Gerlitz 
849aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
8508c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index);
851aa0cbbaeSOr Gerlitz 
8523c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv,
8533c37745eSOr Gerlitz 			      struct ip_tunnel_info *tun_info,
8543c37745eSOr Gerlitz 			      struct net_device *mirred_dev,
8553c37745eSOr Gerlitz 			      struct net_device **encap_dev,
856e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
8578c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
8588c4dc42bSEli Britstein 			      int out_index);
8593c37745eSOr Gerlitz 
8606d2a3ed0SOr Gerlitz static struct mlx5_flow_handle *
8616d2a3ed0SOr Gerlitz mlx5e_tc_offload_fdb_rules(struct mlx5_eswitch *esw,
8626d2a3ed0SOr Gerlitz 			   struct mlx5e_tc_flow *flow,
8636d2a3ed0SOr Gerlitz 			   struct mlx5_flow_spec *spec,
8646d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
8656d2a3ed0SOr Gerlitz {
8666d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
8676d2a3ed0SOr Gerlitz 
8686d2a3ed0SOr Gerlitz 	rule = mlx5_eswitch_add_offloaded_rule(esw, spec, attr);
8696d2a3ed0SOr Gerlitz 	if (IS_ERR(rule))
8706d2a3ed0SOr Gerlitz 		return rule;
8716d2a3ed0SOr Gerlitz 
872e85e02baSEli Britstein 	if (attr->split_count) {
8736d2a3ed0SOr Gerlitz 		flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, spec, attr);
8746d2a3ed0SOr Gerlitz 		if (IS_ERR(flow->rule[1])) {
8756d2a3ed0SOr Gerlitz 			mlx5_eswitch_del_offloaded_rule(esw, rule, attr);
8766d2a3ed0SOr Gerlitz 			return flow->rule[1];
8776d2a3ed0SOr Gerlitz 		}
8786d2a3ed0SOr Gerlitz 	}
8796d2a3ed0SOr Gerlitz 
8806d2a3ed0SOr Gerlitz 	flow->flags |= MLX5E_TC_FLOW_OFFLOADED;
8816d2a3ed0SOr Gerlitz 	return rule;
8826d2a3ed0SOr Gerlitz }
8836d2a3ed0SOr Gerlitz 
8846d2a3ed0SOr Gerlitz static void
8856d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(struct mlx5_eswitch *esw,
8866d2a3ed0SOr Gerlitz 			     struct mlx5e_tc_flow *flow,
8876d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
8886d2a3ed0SOr Gerlitz {
8896d2a3ed0SOr Gerlitz 	flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED;
8906d2a3ed0SOr Gerlitz 
891e85e02baSEli Britstein 	if (attr->split_count)
8926d2a3ed0SOr Gerlitz 		mlx5_eswitch_del_fwd_rule(esw, flow->rule[1], attr);
8936d2a3ed0SOr Gerlitz 
8946d2a3ed0SOr Gerlitz 	mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr);
8956d2a3ed0SOr Gerlitz }
8966d2a3ed0SOr Gerlitz 
8975dbe906fSPaul Blakey static struct mlx5_flow_handle *
8985dbe906fSPaul Blakey mlx5e_tc_offload_to_slow_path(struct mlx5_eswitch *esw,
8995dbe906fSPaul Blakey 			      struct mlx5e_tc_flow *flow,
9005dbe906fSPaul Blakey 			      struct mlx5_flow_spec *spec,
9015dbe906fSPaul Blakey 			      struct mlx5_esw_flow_attr *slow_attr)
9025dbe906fSPaul Blakey {
9035dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
9045dbe906fSPaul Blakey 
9055dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
906154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9072be09de7SDavid S. Miller 	slow_attr->split_count = 0;
908154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
9095dbe906fSPaul Blakey 
9105dbe906fSPaul Blakey 	rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, slow_attr);
9115dbe906fSPaul Blakey 	if (!IS_ERR(rule))
9125dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_SLOW;
9135dbe906fSPaul Blakey 
9145dbe906fSPaul Blakey 	return rule;
9155dbe906fSPaul Blakey }
9165dbe906fSPaul Blakey 
9175dbe906fSPaul Blakey static void
9185dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(struct mlx5_eswitch *esw,
9195dbe906fSPaul Blakey 				  struct mlx5e_tc_flow *flow,
9205dbe906fSPaul Blakey 				  struct mlx5_esw_flow_attr *slow_attr)
9215dbe906fSPaul Blakey {
9225dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
923154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9242be09de7SDavid S. Miller 	slow_attr->split_count = 0;
925154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
9265dbe906fSPaul Blakey 	mlx5e_tc_unoffload_fdb_rules(esw, flow, slow_attr);
9275dbe906fSPaul Blakey 	flow->flags &= ~MLX5E_TC_FLOW_SLOW;
9285dbe906fSPaul Blakey }
9295dbe906fSPaul Blakey 
930c83954abSRabie Loulou static int
93174491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv,
93217091853SOr Gerlitz 		      struct mlx5e_tc_flow_parse_attr *parse_attr,
933e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
934e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
935adb4c123SOr Gerlitz {
936adb4c123SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
937bf07aa73SPaul Blakey 	u32 max_chain = mlx5_eswitch_get_chain_range(esw);
938aa0cbbaeSOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
939bf07aa73SPaul Blakey 	u16 max_prio = mlx5_eswitch_get_prio_range(esw);
9403c37745eSOr Gerlitz 	struct net_device *out_dev, *encap_dev = NULL;
941b8aee822SMark Bloch 	struct mlx5_fc *counter = NULL;
9423c37745eSOr Gerlitz 	struct mlx5e_rep_priv *rpriv;
9433c37745eSOr Gerlitz 	struct mlx5e_priv *out_priv;
944c83954abSRabie Loulou 	int err = 0, encap_err = 0;
945f493f155SEli Britstein 	int out_index;
9468b32580dSOr Gerlitz 
947d14f6f2aSOr Gerlitz 	if (!mlx5_eswitch_prios_supported(esw) && attr->prio != 1) {
948d14f6f2aSOr Gerlitz 		NL_SET_ERR_MSG(extack, "E-switch priorities unsupported, upgrade FW");
949d14f6f2aSOr Gerlitz 		return -EOPNOTSUPP;
950d14f6f2aSOr Gerlitz 	}
951e52c2802SPaul Blakey 
952bf07aa73SPaul Blakey 	if (attr->chain > max_chain) {
953bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested chain is out of supported range");
954bf07aa73SPaul Blakey 		err = -EOPNOTSUPP;
955bf07aa73SPaul Blakey 		goto err_max_prio_chain;
956bf07aa73SPaul Blakey 	}
957bf07aa73SPaul Blakey 
958bf07aa73SPaul Blakey 	if (attr->prio > max_prio) {
959bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested priority is out of supported range");
960bf07aa73SPaul Blakey 		err = -EOPNOTSUPP;
961bf07aa73SPaul Blakey 		goto err_max_prio_chain;
962bf07aa73SPaul Blakey 	}
963bf07aa73SPaul Blakey 
964f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) {
9658c4dc42bSEli Britstein 		int mirred_ifindex;
9668c4dc42bSEli Britstein 
967f493f155SEli Britstein 		if (!(attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP))
968f493f155SEli Britstein 			continue;
969f493f155SEli Britstein 
9708c4dc42bSEli Britstein 		mirred_ifindex = attr->parse_attr->mirred_ifindex[out_index];
9713c37745eSOr Gerlitz 		out_dev = __dev_get_by_index(dev_net(priv->netdev),
9728c4dc42bSEli Britstein 					     mirred_ifindex);
9738c4dc42bSEli Britstein 		err = mlx5e_attach_encap(priv,
9748c4dc42bSEli Britstein 					 &parse_attr->tun_info[out_index],
975c83954abSRabie Loulou 					 out_dev, &encap_dev, flow,
9768c4dc42bSEli Britstein 					 extack, out_index);
9778c4dc42bSEli Britstein 		if (err && err != -EAGAIN)
9783c37745eSOr Gerlitz 			goto err_attach_encap;
9798c4dc42bSEli Britstein 		if (err == -EAGAIN)
9808c4dc42bSEli Britstein 			encap_err = err;
9813c37745eSOr Gerlitz 		out_priv = netdev_priv(encap_dev);
9823c37745eSOr Gerlitz 		rpriv = out_priv->ppriv;
9831cc26d74SEli Britstein 		attr->dests[out_index].rep = rpriv->rep;
9841cc26d74SEli Britstein 		attr->dests[out_index].mdev = out_priv->mdev;
9853c37745eSOr Gerlitz 	}
9863c37745eSOr Gerlitz 
9878b32580dSOr Gerlitz 	err = mlx5_eswitch_add_vlan_action(esw, attr);
988c83954abSRabie Loulou 	if (err)
989aa0cbbaeSOr Gerlitz 		goto err_add_vlan;
990adb4c123SOr Gerlitz 
991d7e75a32SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
9921a9527bbSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
993d7e75a32SOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
994c83954abSRabie Loulou 		if (err)
995d7e75a32SOr Gerlitz 			goto err_mod_hdr;
996d7e75a32SOr Gerlitz 	}
997d7e75a32SOr Gerlitz 
998b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
999f9392795SShahar Klein 		counter = mlx5_fc_create(attr->counter_dev, true);
1000b8aee822SMark Bloch 		if (IS_ERR(counter)) {
1001c83954abSRabie Loulou 			err = PTR_ERR(counter);
1002b8aee822SMark Bloch 			goto err_create_counter;
1003b8aee822SMark Bloch 		}
1004b8aee822SMark Bloch 
1005b8aee822SMark Bloch 		attr->counter = counter;
1006b8aee822SMark Bloch 	}
1007b8aee822SMark Bloch 
1008c83954abSRabie Loulou 	/* we get here if (1) there's no error or when
10093c37745eSOr Gerlitz 	 * (2) there's an encap action and we're on -EAGAIN (no valid neigh)
10103c37745eSOr Gerlitz 	 */
10115dbe906fSPaul Blakey 	if (encap_err == -EAGAIN) {
10125dbe906fSPaul Blakey 		/* continue with goto slow path rule instead */
10135dbe906fSPaul Blakey 		struct mlx5_esw_flow_attr slow_attr;
10145dbe906fSPaul Blakey 
10155dbe906fSPaul Blakey 		flow->rule[0] = mlx5e_tc_offload_to_slow_path(esw, flow, &parse_attr->spec, &slow_attr);
10165dbe906fSPaul Blakey 	} else {
10176d2a3ed0SOr Gerlitz 		flow->rule[0] = mlx5e_tc_offload_fdb_rules(esw, flow, &parse_attr->spec, attr);
10185dbe906fSPaul Blakey 	}
10195dbe906fSPaul Blakey 
1020c83954abSRabie Loulou 	if (IS_ERR(flow->rule[0])) {
1021c83954abSRabie Loulou 		err = PTR_ERR(flow->rule[0]);
1022aa0cbbaeSOr Gerlitz 		goto err_add_rule;
1023c83954abSRabie Loulou 	}
1024c83954abSRabie Loulou 
10255dbe906fSPaul Blakey 	return 0;
1026aa0cbbaeSOr Gerlitz 
1027aa0cbbaeSOr Gerlitz err_add_rule:
1028f9392795SShahar Klein 	mlx5_fc_destroy(attr->counter_dev, counter);
1029b8aee822SMark Bloch err_create_counter:
1030513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
10311a9527bbSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
1032d7e75a32SOr Gerlitz err_mod_hdr:
1033aa0cbbaeSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1034aa0cbbaeSOr Gerlitz err_add_vlan:
1035f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
10368c4dc42bSEli Britstein 		if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)
10378c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
10383c37745eSOr Gerlitz err_attach_encap:
1039bf07aa73SPaul Blakey err_max_prio_chain:
1040c83954abSRabie Loulou 	return err;
1041aa0cbbaeSOr Gerlitz }
1042d85cdccbSOr Gerlitz 
1043d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv,
1044d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
1045d85cdccbSOr Gerlitz {
1046d85cdccbSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
1047d7e75a32SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
10485dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
1049f493f155SEli Britstein 	int out_index;
1050d85cdccbSOr Gerlitz 
10515dbe906fSPaul Blakey 	if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
10525dbe906fSPaul Blakey 		if (flow->flags & MLX5E_TC_FLOW_SLOW)
10535dbe906fSPaul Blakey 			mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
10545dbe906fSPaul Blakey 		else
10555dbe906fSPaul Blakey 			mlx5e_tc_unoffload_fdb_rules(esw, flow, attr);
10565dbe906fSPaul Blakey 	}
1057d85cdccbSOr Gerlitz 
1058513f8f7fSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1059d85cdccbSOr Gerlitz 
1060f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
10618c4dc42bSEli Britstein 		if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)
10628c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
1063f493f155SEli Britstein 	kvfree(attr->parse_attr);
1064d7e75a32SOr Gerlitz 
1065513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
10661a9527bbSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
1067b8aee822SMark Bloch 
1068b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT)
1069f9392795SShahar Klein 		mlx5_fc_destroy(attr->counter_dev, attr->counter);
1070d85cdccbSOr Gerlitz }
1071d85cdccbSOr Gerlitz 
1072232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv,
1073232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1074232c0013SHadar Hen Zion {
10753c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
10765dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr, *esw_attr;
10776d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
10786d2a3ed0SOr Gerlitz 	struct mlx5_flow_spec *spec;
107979baaec7SEli Britstein 	struct encap_flow_item *efi;
1080232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1081232c0013SHadar Hen Zion 	int err;
1082232c0013SHadar Hen Zion 
108354c177caSOz Shlomo 	err = mlx5_packet_reformat_alloc(priv->mdev,
108454c177caSOz Shlomo 					 e->reformat_type,
1085232c0013SHadar Hen Zion 					 e->encap_size, e->encap_header,
108631ca3648SMark Bloch 					 MLX5_FLOW_NAMESPACE_FDB,
1087232c0013SHadar Hen Zion 					 &e->encap_id);
1088232c0013SHadar Hen Zion 	if (err) {
1089232c0013SHadar Hen Zion 		mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n",
1090232c0013SHadar Hen Zion 			       err);
1091232c0013SHadar Hen Zion 		return;
1092232c0013SHadar Hen Zion 	}
1093232c0013SHadar Hen Zion 	e->flags |= MLX5_ENCAP_ENTRY_VALID;
1094f6dfb4c3SHadar Hen Zion 	mlx5e_rep_queue_neigh_stats_work(priv);
1095232c0013SHadar Hen Zion 
109679baaec7SEli Britstein 	list_for_each_entry(efi, &e->flows, list) {
10978c4dc42bSEli Britstein 		bool all_flow_encaps_valid = true;
10988c4dc42bSEli Britstein 		int i;
10998c4dc42bSEli Britstein 
110079baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
11013c37745eSOr Gerlitz 		esw_attr = flow->esw_attr;
11026d2a3ed0SOr Gerlitz 		spec = &esw_attr->parse_attr->spec;
11036d2a3ed0SOr Gerlitz 
11048c4dc42bSEli Britstein 		esw_attr->dests[efi->index].encap_id = e->encap_id;
11058c4dc42bSEli Britstein 		esw_attr->dests[efi->index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
11068c4dc42bSEli Britstein 		/* Flow can be associated with multiple encap entries.
11078c4dc42bSEli Britstein 		 * Before offloading the flow verify that all of them have
11088c4dc42bSEli Britstein 		 * a valid neighbour.
11098c4dc42bSEli Britstein 		 */
11108c4dc42bSEli Britstein 		for (i = 0; i < MLX5_MAX_FLOW_FWD_VPORTS; i++) {
11118c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP))
11128c4dc42bSEli Britstein 				continue;
11138c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP_VALID)) {
11148c4dc42bSEli Britstein 				all_flow_encaps_valid = false;
11158c4dc42bSEli Britstein 				break;
11168c4dc42bSEli Britstein 			}
11178c4dc42bSEli Britstein 		}
11188c4dc42bSEli Britstein 		/* Do not offload flows with unresolved neighbors */
11198c4dc42bSEli Britstein 		if (!all_flow_encaps_valid)
11208c4dc42bSEli Britstein 			continue;
11215dbe906fSPaul Blakey 		/* update from slow path rule to encap rule */
11226d2a3ed0SOr Gerlitz 		rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, esw_attr);
11236d2a3ed0SOr Gerlitz 		if (IS_ERR(rule)) {
11246d2a3ed0SOr Gerlitz 			err = PTR_ERR(rule);
1125232c0013SHadar Hen Zion 			mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n",
1126232c0013SHadar Hen Zion 				       err);
1127232c0013SHadar Hen Zion 			continue;
1128232c0013SHadar Hen Zion 		}
11295dbe906fSPaul Blakey 
11305dbe906fSPaul Blakey 		mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
11315dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when slow path rule removed */
11326d2a3ed0SOr Gerlitz 		flow->rule[0] = rule;
1133232c0013SHadar Hen Zion 	}
1134232c0013SHadar Hen Zion }
1135232c0013SHadar Hen Zion 
1136232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv,
1137232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1138232c0013SHadar Hen Zion {
11393c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
11405dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
11415dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
11425dbe906fSPaul Blakey 	struct mlx5_flow_spec *spec;
114379baaec7SEli Britstein 	struct encap_flow_item *efi;
1144232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
11455dbe906fSPaul Blakey 	int err;
1146232c0013SHadar Hen Zion 
114779baaec7SEli Britstein 	list_for_each_entry(efi, &e->flows, list) {
114879baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
11495dbe906fSPaul Blakey 		spec = &flow->esw_attr->parse_attr->spec;
11505dbe906fSPaul Blakey 
11515dbe906fSPaul Blakey 		/* update from encap rule to slow path rule */
11525dbe906fSPaul Blakey 		rule = mlx5e_tc_offload_to_slow_path(esw, flow, spec, &slow_attr);
11538c4dc42bSEli Britstein 		/* mark the flow's encap dest as non-valid */
11548c4dc42bSEli Britstein 		flow->esw_attr->dests[efi->index].flags &= ~MLX5_ESW_DEST_ENCAP_VALID;
11555dbe906fSPaul Blakey 
11565dbe906fSPaul Blakey 		if (IS_ERR(rule)) {
11575dbe906fSPaul Blakey 			err = PTR_ERR(rule);
11585dbe906fSPaul Blakey 			mlx5_core_warn(priv->mdev, "Failed to update slow path (encap) flow, %d\n",
11595dbe906fSPaul Blakey 				       err);
11605dbe906fSPaul Blakey 			continue;
11615dbe906fSPaul Blakey 		}
11625dbe906fSPaul Blakey 
11636d2a3ed0SOr Gerlitz 		mlx5e_tc_unoffload_fdb_rules(esw, flow, flow->esw_attr);
11645dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when fast path rule removed */
11655dbe906fSPaul Blakey 		flow->rule[0] = rule;
1166232c0013SHadar Hen Zion 	}
1167232c0013SHadar Hen Zion 
116861c806daSOr Gerlitz 	/* we know that the encap is valid */
1169232c0013SHadar Hen Zion 	e->flags &= ~MLX5_ENCAP_ENTRY_VALID;
117060786f09SMark Bloch 	mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1171232c0013SHadar Hen Zion }
1172232c0013SHadar Hen Zion 
1173b8aee822SMark Bloch static struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow)
1174b8aee822SMark Bloch {
1175b8aee822SMark Bloch 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
1176b8aee822SMark Bloch 		return flow->esw_attr->counter;
1177b8aee822SMark Bloch 	else
1178b8aee822SMark Bloch 		return flow->nic_attr->counter;
1179b8aee822SMark Bloch }
1180b8aee822SMark Bloch 
1181f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe)
1182f6dfb4c3SHadar Hen Zion {
1183f6dfb4c3SHadar Hen Zion 	struct mlx5e_neigh *m_neigh = &nhe->m_neigh;
1184f6dfb4c3SHadar Hen Zion 	u64 bytes, packets, lastuse = 0;
1185f6dfb4c3SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1186f6dfb4c3SHadar Hen Zion 	struct mlx5e_encap_entry *e;
1187f6dfb4c3SHadar Hen Zion 	struct mlx5_fc *counter;
1188f6dfb4c3SHadar Hen Zion 	struct neigh_table *tbl;
1189f6dfb4c3SHadar Hen Zion 	bool neigh_used = false;
1190f6dfb4c3SHadar Hen Zion 	struct neighbour *n;
1191f6dfb4c3SHadar Hen Zion 
1192f6dfb4c3SHadar Hen Zion 	if (m_neigh->family == AF_INET)
1193f6dfb4c3SHadar Hen Zion 		tbl = &arp_tbl;
1194f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6)
1195f6dfb4c3SHadar Hen Zion 	else if (m_neigh->family == AF_INET6)
1196423c9db2SOr Gerlitz 		tbl = &nd_tbl;
1197f6dfb4c3SHadar Hen Zion #endif
1198f6dfb4c3SHadar Hen Zion 	else
1199f6dfb4c3SHadar Hen Zion 		return;
1200f6dfb4c3SHadar Hen Zion 
1201f6dfb4c3SHadar Hen Zion 	list_for_each_entry(e, &nhe->encap_list, encap_list) {
120279baaec7SEli Britstein 		struct encap_flow_item *efi;
1203f6dfb4c3SHadar Hen Zion 		if (!(e->flags & MLX5_ENCAP_ENTRY_VALID))
1204f6dfb4c3SHadar Hen Zion 			continue;
120579baaec7SEli Britstein 		list_for_each_entry(efi, &e->flows, list) {
120679baaec7SEli Britstein 			flow = container_of(efi, struct mlx5e_tc_flow,
120779baaec7SEli Britstein 					    encaps[efi->index]);
1208f6dfb4c3SHadar Hen Zion 			if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
1209b8aee822SMark Bloch 				counter = mlx5e_tc_get_counter(flow);
1210f6dfb4c3SHadar Hen Zion 				mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
1211f6dfb4c3SHadar Hen Zion 				if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) {
1212f6dfb4c3SHadar Hen Zion 					neigh_used = true;
1213f6dfb4c3SHadar Hen Zion 					break;
1214f6dfb4c3SHadar Hen Zion 				}
1215f6dfb4c3SHadar Hen Zion 			}
1216f6dfb4c3SHadar Hen Zion 		}
1217e36d4810SRoi Dayan 		if (neigh_used)
1218e36d4810SRoi Dayan 			break;
1219f6dfb4c3SHadar Hen Zion 	}
1220f6dfb4c3SHadar Hen Zion 
1221f6dfb4c3SHadar Hen Zion 	if (neigh_used) {
1222f6dfb4c3SHadar Hen Zion 		nhe->reported_lastuse = jiffies;
1223f6dfb4c3SHadar Hen Zion 
1224f6dfb4c3SHadar Hen Zion 		/* find the relevant neigh according to the cached device and
1225f6dfb4c3SHadar Hen Zion 		 * dst ip pair
1226f6dfb4c3SHadar Hen Zion 		 */
1227f6dfb4c3SHadar Hen Zion 		n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev);
1228c7f7ba8dSRoi Dayan 		if (!n)
1229f6dfb4c3SHadar Hen Zion 			return;
1230f6dfb4c3SHadar Hen Zion 
1231f6dfb4c3SHadar Hen Zion 		neigh_event_send(n, NULL);
1232f6dfb4c3SHadar Hen Zion 		neigh_release(n);
1233f6dfb4c3SHadar Hen Zion 	}
1234f6dfb4c3SHadar Hen Zion }
1235f6dfb4c3SHadar Hen Zion 
1236d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
12378c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index)
1238d85cdccbSOr Gerlitz {
12398c4dc42bSEli Britstein 	struct list_head *next = flow->encaps[out_index].list.next;
12405067b602SRoi Dayan 
12418c4dc42bSEli Britstein 	list_del(&flow->encaps[out_index].list);
12425067b602SRoi Dayan 	if (list_empty(next)) {
1243c1ae1152SOr Gerlitz 		struct mlx5e_encap_entry *e;
12445067b602SRoi Dayan 
1245c1ae1152SOr Gerlitz 		e = list_entry(next, struct mlx5e_encap_entry, flows);
1246232c0013SHadar Hen Zion 		mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e);
1247232c0013SHadar Hen Zion 
1248232c0013SHadar Hen Zion 		if (e->flags & MLX5_ENCAP_ENTRY_VALID)
124960786f09SMark Bloch 			mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1250232c0013SHadar Hen Zion 
1251cdc5a7f3SOr Gerlitz 		hash_del_rcu(&e->encap_hlist);
1252232c0013SHadar Hen Zion 		kfree(e->encap_header);
12535067b602SRoi Dayan 		kfree(e);
12545067b602SRoi Dayan 	}
12555067b602SRoi Dayan }
12565067b602SRoi Dayan 
125704de7ddaSRoi Dayan static void __mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
125804de7ddaSRoi Dayan {
125904de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = flow->priv->mdev->priv.eswitch;
126004de7ddaSRoi Dayan 
126104de7ddaSRoi Dayan 	if (!(flow->flags & MLX5E_TC_FLOW_ESWITCH) ||
126204de7ddaSRoi Dayan 	    !(flow->flags & MLX5E_TC_FLOW_DUP))
126304de7ddaSRoi Dayan 		return;
126404de7ddaSRoi Dayan 
126504de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
126604de7ddaSRoi Dayan 	list_del(&flow->peer);
126704de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
126804de7ddaSRoi Dayan 
126904de7ddaSRoi Dayan 	flow->flags &= ~MLX5E_TC_FLOW_DUP;
127004de7ddaSRoi Dayan 
127104de7ddaSRoi Dayan 	mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow);
127204de7ddaSRoi Dayan 	kvfree(flow->peer_flow);
127304de7ddaSRoi Dayan 	flow->peer_flow = NULL;
127404de7ddaSRoi Dayan }
127504de7ddaSRoi Dayan 
127604de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
127704de7ddaSRoi Dayan {
127804de7ddaSRoi Dayan 	struct mlx5_core_dev *dev = flow->priv->mdev;
127904de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = dev->priv.devcom;
128004de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
128104de7ddaSRoi Dayan 
128204de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
128304de7ddaSRoi Dayan 	if (!peer_esw)
128404de7ddaSRoi Dayan 		return;
128504de7ddaSRoi Dayan 
128604de7ddaSRoi Dayan 	__mlx5e_tc_del_fdb_peer_flow(flow);
128704de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
128804de7ddaSRoi Dayan }
128904de7ddaSRoi Dayan 
1290e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv,
1291961e8979SRoi Dayan 			      struct mlx5e_tc_flow *flow)
1292e8f887acSAmir Vadai {
129304de7ddaSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
129404de7ddaSRoi Dayan 		mlx5e_tc_del_fdb_peer_flow(flow);
1295d85cdccbSOr Gerlitz 		mlx5e_tc_del_fdb_flow(priv, flow);
129604de7ddaSRoi Dayan 	} else {
1297d85cdccbSOr Gerlitz 		mlx5e_tc_del_nic_flow(priv, flow);
1298e8f887acSAmir Vadai 	}
129904de7ddaSRoi Dayan }
1300e8f887acSAmir Vadai 
1301bbd00f7eSHadar Hen Zion 
1302bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv,
1303bbd00f7eSHadar Hen Zion 			     struct mlx5_flow_spec *spec,
130454c177caSOz Shlomo 			     struct tc_cls_flower_offload *f,
130554c177caSOz Shlomo 			     struct net_device *filter_dev)
1306bbd00f7eSHadar Hen Zion {
1307e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1308bbd00f7eSHadar Hen Zion 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1309bbd00f7eSHadar Hen Zion 				       outer_headers);
1310bbd00f7eSHadar Hen Zion 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1311bbd00f7eSHadar Hen Zion 				       outer_headers);
13128f256622SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
13138f256622SPablo Neira Ayuso 	struct flow_match_control enc_control;
13148f256622SPablo Neira Ayuso 	int err;
1315bbd00f7eSHadar Hen Zion 
1316101f4de9SOz Shlomo 	err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f,
13174d70564dSOz Shlomo 				 headers_c, headers_v);
131854c177caSOz Shlomo 	if (err) {
131954c177caSOz Shlomo 		NL_SET_ERR_MSG_MOD(extack,
132054c177caSOz Shlomo 				   "failed to parse tunnel attributes");
1321101f4de9SOz Shlomo 		return err;
1322bbd00f7eSHadar Hen Zion 	}
1323bbd00f7eSHadar Hen Zion 
13248f256622SPablo Neira Ayuso 	flow_rule_match_enc_control(rule, &enc_control);
13258f256622SPablo Neira Ayuso 
13268f256622SPablo Neira Ayuso 	if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
13278f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
13288f256622SPablo Neira Ayuso 
13298f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv4_addrs(rule, &match);
1330bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1331bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
13328f256622SPablo Neira Ayuso 			 ntohl(match.mask->src));
1333bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1334bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
13358f256622SPablo Neira Ayuso 			 ntohl(match.key->src));
1336bbd00f7eSHadar Hen Zion 
1337bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1338bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
13398f256622SPablo Neira Ayuso 			 ntohl(match.mask->dst));
1340bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1341bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
13428f256622SPablo Neira Ayuso 			 ntohl(match.key->dst));
1343bbd00f7eSHadar Hen Zion 
1344bbd00f7eSHadar Hen Zion 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
1345bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP);
13468f256622SPablo Neira Ayuso 	} else if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
13478f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
134819f44401SOr Gerlitz 
13498f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv6_addrs(rule, &match);
135019f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
135119f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
13528f256622SPablo Neira Ayuso 		       &match.mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
135319f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
135419f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
13558f256622SPablo Neira Ayuso 		       &match.key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
135619f44401SOr Gerlitz 
135719f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
135819f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
13598f256622SPablo Neira Ayuso 		       &match.mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
136019f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
136119f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
13628f256622SPablo Neira Ayuso 		       &match.key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
136319f44401SOr Gerlitz 
136419f44401SOr Gerlitz 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
136519f44401SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6);
13662e72eb43SOr Gerlitz 	}
1367bbd00f7eSHadar Hen Zion 
13688f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) {
13698f256622SPablo Neira Ayuso 		struct flow_match_ip match;
1370bcef735cSOr Gerlitz 
13718f256622SPablo Neira Ayuso 		flow_rule_match_enc_ip(rule, &match);
13728f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
13738f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
13748f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
13758f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
1376bcef735cSOr Gerlitz 
13778f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
13788f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
13798f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
13808f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
1381bcef735cSOr Gerlitz 
13828f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
13838f256622SPablo Neira Ayuso 			 match.mask->ttl);
13848f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
13858f256622SPablo Neira Ayuso 			 match.key->ttl);
1386e98bedf5SEli Britstein 
13878f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1388e98bedf5SEli Britstein 		    !MLX5_CAP_ESW_FLOWTABLE_FDB
1389e98bedf5SEli Britstein 			(priv->mdev,
1390e98bedf5SEli Britstein 			 ft_field_support.outer_ipv4_ttl)) {
1391e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1392e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
1393e98bedf5SEli Britstein 			return -EOPNOTSUPP;
1394e98bedf5SEli Britstein 		}
1395e98bedf5SEli Britstein 
1396bcef735cSOr Gerlitz 	}
1397bcef735cSOr Gerlitz 
1398bbd00f7eSHadar Hen Zion 	/* Enforce DMAC when offloading incoming tunneled flows.
1399bbd00f7eSHadar Hen Zion 	 * Flow counters require a match on the DMAC.
1400bbd00f7eSHadar Hen Zion 	 */
1401bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16);
1402bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0);
1403bbd00f7eSHadar Hen Zion 	ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1404bbd00f7eSHadar Hen Zion 				     dmac_47_16), priv->netdev->dev_addr);
1405bbd00f7eSHadar Hen Zion 
1406bbd00f7eSHadar Hen Zion 	/* let software handle IP fragments */
1407bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
1408bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0);
1409bbd00f7eSHadar Hen Zion 
1410bbd00f7eSHadar Hen Zion 	return 0;
1411bbd00f7eSHadar Hen Zion }
1412bbd00f7eSHadar Hen Zion 
1413de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv,
1414de0af0bfSRoi Dayan 			      struct mlx5_flow_spec *spec,
1415de0af0bfSRoi Dayan 			      struct tc_cls_flower_offload *f,
141654c177caSOz Shlomo 			      struct net_device *filter_dev,
1417d708f902SOr Gerlitz 			      u8 *match_level)
1418e3a2b7edSAmir Vadai {
1419e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1420c5bb1730SMaor Gottlieb 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1421c5bb1730SMaor Gottlieb 				       outer_headers);
1422c5bb1730SMaor Gottlieb 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1423c5bb1730SMaor Gottlieb 				       outer_headers);
1424699e96ddSJianbo Liu 	void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1425699e96ddSJianbo Liu 				    misc_parameters);
1426699e96ddSJianbo Liu 	void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1427699e96ddSJianbo Liu 				    misc_parameters);
14288f256622SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
14298f256622SPablo Neira Ayuso 	struct flow_dissector *dissector = rule->match.dissector;
1430e3a2b7edSAmir Vadai 	u16 addr_type = 0;
1431e3a2b7edSAmir Vadai 	u8 ip_proto = 0;
1432e3a2b7edSAmir Vadai 
1433d708f902SOr Gerlitz 	*match_level = MLX5_MATCH_NONE;
1434de0af0bfSRoi Dayan 
14358f256622SPablo Neira Ayuso 	if (dissector->used_keys &
1436e3a2b7edSAmir Vadai 	    ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) |
1437e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_BASIC) |
1438e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) |
1439095b6cfdSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_VLAN) |
1440699e96ddSJianbo Liu 	      BIT(FLOW_DISSECTOR_KEY_CVLAN) |
1441e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) |
1442e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) |
1443bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_PORTS) |
1444bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) |
1445bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) |
1446bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) |
1447bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_PORTS)	|
1448e77834ecSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) |
1449fd7da28bSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_TCP) |
1450bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_IP)  |
1451bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_IP))) {
1452e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "Unsupported key");
1453e3a2b7edSAmir Vadai 		netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n",
14548f256622SPablo Neira Ayuso 			    dissector->used_keys);
1455e3a2b7edSAmir Vadai 		return -EOPNOTSUPP;
1456e3a2b7edSAmir Vadai 	}
1457e3a2b7edSAmir Vadai 
14588f256622SPablo Neira Ayuso 	if ((flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) ||
14598f256622SPablo Neira Ayuso 	     flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_KEYID) ||
14608f256622SPablo Neira Ayuso 	     flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_PORTS)) &&
14618f256622SPablo Neira Ayuso 	    flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_CONTROL)) {
14628f256622SPablo Neira Ayuso 		struct flow_match_control match;
14638f256622SPablo Neira Ayuso 
14648f256622SPablo Neira Ayuso 		flow_rule_match_enc_control(rule, &match);
14658f256622SPablo Neira Ayuso 		switch (match.key->addr_type) {
1466bbd00f7eSHadar Hen Zion 		case FLOW_DISSECTOR_KEY_IPV4_ADDRS:
146719f44401SOr Gerlitz 		case FLOW_DISSECTOR_KEY_IPV6_ADDRS:
146854c177caSOz Shlomo 			if (parse_tunnel_attr(priv, spec, f, filter_dev))
1469bbd00f7eSHadar Hen Zion 				return -EOPNOTSUPP;
1470bbd00f7eSHadar Hen Zion 			break;
1471bbd00f7eSHadar Hen Zion 		default:
1472bbd00f7eSHadar Hen Zion 			return -EOPNOTSUPP;
1473bbd00f7eSHadar Hen Zion 		}
1474bbd00f7eSHadar Hen Zion 
1475bbd00f7eSHadar Hen Zion 		/* In decap flow, header pointers should point to the inner
1476bbd00f7eSHadar Hen Zion 		 * headers, outer header were already set by parse_tunnel_attr
1477bbd00f7eSHadar Hen Zion 		 */
1478bbd00f7eSHadar Hen Zion 		headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1479bbd00f7eSHadar Hen Zion 					 inner_headers);
1480bbd00f7eSHadar Hen Zion 		headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1481bbd00f7eSHadar Hen Zion 					 inner_headers);
1482bbd00f7eSHadar Hen Zion 	}
1483bbd00f7eSHadar Hen Zion 
14848f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
14858f256622SPablo Neira Ayuso 		struct flow_match_basic match;
1486e3a2b7edSAmir Vadai 
14878f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
14888f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype,
14898f256622SPablo Neira Ayuso 			 ntohs(match.mask->n_proto));
14908f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype,
14918f256622SPablo Neira Ayuso 			 ntohs(match.key->n_proto));
14928f256622SPablo Neira Ayuso 
14938f256622SPablo Neira Ayuso 		if (match.mask->n_proto)
1494d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1495e3a2b7edSAmir Vadai 	}
1496e3a2b7edSAmir Vadai 
14978f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN)) {
14988f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
14998f256622SPablo Neira Ayuso 
15008f256622SPablo Neira Ayuso 		flow_rule_match_vlan(rule, &match);
15018f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
15028f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
15038f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
15048f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1505699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1506699e96ddSJianbo Liu 					 svlan_tag, 1);
1507699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1508699e96ddSJianbo Liu 					 svlan_tag, 1);
1509699e96ddSJianbo Liu 			} else {
1510699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1511699e96ddSJianbo Liu 					 cvlan_tag, 1);
1512699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1513699e96ddSJianbo Liu 					 cvlan_tag, 1);
1514699e96ddSJianbo Liu 			}
1515095b6cfdSOr Gerlitz 
15168f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid,
15178f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
15188f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid,
15198f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1520358d79a4SOr Gerlitz 
15218f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio,
15228f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
15238f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio,
15248f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
152554782900SOr Gerlitz 
1526d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1527095b6cfdSOr Gerlitz 		}
1528d3a80bb5SOr Gerlitz 	} else if (*match_level != MLX5_MATCH_NONE) {
1529cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, svlan_tag, 1);
1530cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1);
1531d3a80bb5SOr Gerlitz 		*match_level = MLX5_MATCH_L2;
1532095b6cfdSOr Gerlitz 	}
1533095b6cfdSOr Gerlitz 
15348f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) {
15358f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
15368f256622SPablo Neira Ayuso 
15378f256622SPablo Neira Ayuso 		flow_rule_match_vlan(rule, &match);
15388f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
15398f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
15408f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
15418f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1542699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1543699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1544699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1545699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1546699e96ddSJianbo Liu 			} else {
1547699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1548699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1549699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1550699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1551699e96ddSJianbo Liu 			}
1552699e96ddSJianbo Liu 
1553699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid,
15548f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
1555699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid,
15568f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1557699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio,
15588f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
1559699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio,
15608f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
1561699e96ddSJianbo Liu 
1562699e96ddSJianbo Liu 			*match_level = MLX5_MATCH_L2;
1563699e96ddSJianbo Liu 		}
1564699e96ddSJianbo Liu 	}
1565699e96ddSJianbo Liu 
15668f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) {
15678f256622SPablo Neira Ayuso 		struct flow_match_eth_addrs match;
156854782900SOr Gerlitz 
15698f256622SPablo Neira Ayuso 		flow_rule_match_eth_addrs(rule, &match);
1570d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1571d3a80bb5SOr Gerlitz 					     dmac_47_16),
15728f256622SPablo Neira Ayuso 				match.mask->dst);
1573d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1574d3a80bb5SOr Gerlitz 					     dmac_47_16),
15758f256622SPablo Neira Ayuso 				match.key->dst);
1576d3a80bb5SOr Gerlitz 
1577d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1578d3a80bb5SOr Gerlitz 					     smac_47_16),
15798f256622SPablo Neira Ayuso 				match.mask->src);
1580d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1581d3a80bb5SOr Gerlitz 					     smac_47_16),
15828f256622SPablo Neira Ayuso 				match.key->src);
1583d3a80bb5SOr Gerlitz 
15848f256622SPablo Neira Ayuso 		if (!is_zero_ether_addr(match.mask->src) ||
15858f256622SPablo Neira Ayuso 		    !is_zero_ether_addr(match.mask->dst))
1586d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
158754782900SOr Gerlitz 	}
158854782900SOr Gerlitz 
15898f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) {
15908f256622SPablo Neira Ayuso 		struct flow_match_control match;
159154782900SOr Gerlitz 
15928f256622SPablo Neira Ayuso 		flow_rule_match_control(rule, &match);
15938f256622SPablo Neira Ayuso 		addr_type = match.key->addr_type;
159454782900SOr Gerlitz 
159554782900SOr Gerlitz 		/* the HW doesn't support frag first/later */
15968f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_FIRST_FRAG)
159754782900SOr Gerlitz 			return -EOPNOTSUPP;
159854782900SOr Gerlitz 
15998f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) {
160054782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
160154782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag,
16028f256622SPablo Neira Ayuso 				 match.key->flags & FLOW_DIS_IS_FRAGMENT);
160354782900SOr Gerlitz 
160454782900SOr Gerlitz 			/* the HW doesn't need L3 inline to match on frag=no */
16058f256622SPablo Neira Ayuso 			if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT))
160683621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L2;
160754782900SOr Gerlitz 	/* ***  L2 attributes parsing up to here *** */
160854782900SOr Gerlitz 			else
160983621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L3;
161054782900SOr Gerlitz 		}
161154782900SOr Gerlitz 	}
161254782900SOr Gerlitz 
16138f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
16148f256622SPablo Neira Ayuso 		struct flow_match_basic match;
16158f256622SPablo Neira Ayuso 
16168f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
16178f256622SPablo Neira Ayuso 		ip_proto = match.key->ip_proto;
161854782900SOr Gerlitz 
161954782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
16208f256622SPablo Neira Ayuso 			 match.mask->ip_proto);
162154782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
16228f256622SPablo Neira Ayuso 			 match.key->ip_proto);
162354782900SOr Gerlitz 
16248f256622SPablo Neira Ayuso 		if (match.mask->ip_proto)
1625d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
162654782900SOr Gerlitz 	}
162754782900SOr Gerlitz 
1628e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
16298f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
1630e3a2b7edSAmir Vadai 
16318f256622SPablo Neira Ayuso 		flow_rule_match_ipv4_addrs(rule, &match);
1632e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1633e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
16348f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1635e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1636e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
16378f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1638e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1639e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
16408f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1641e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1642e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
16438f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1644de0af0bfSRoi Dayan 
16458f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1646d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1647e3a2b7edSAmir Vadai 	}
1648e3a2b7edSAmir Vadai 
1649e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
16508f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
1651e3a2b7edSAmir Vadai 
16528f256622SPablo Neira Ayuso 		flow_rule_match_ipv6_addrs(rule, &match);
1653e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1654e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
16558f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1656e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1657e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
16588f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1659e3a2b7edSAmir Vadai 
1660e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1661e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
16628f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1663e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1664e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
16658f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1666de0af0bfSRoi Dayan 
16678f256622SPablo Neira Ayuso 		if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY ||
16688f256622SPablo Neira Ayuso 		    ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY)
1669d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1670e3a2b7edSAmir Vadai 	}
1671e3a2b7edSAmir Vadai 
16728f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) {
16738f256622SPablo Neira Ayuso 		struct flow_match_ip match;
16741f97a526SOr Gerlitz 
16758f256622SPablo Neira Ayuso 		flow_rule_match_ip(rule, &match);
16768f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
16778f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
16788f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
16798f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
16801f97a526SOr Gerlitz 
16818f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
16828f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
16838f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
16848f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
16851f97a526SOr Gerlitz 
16868f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
16878f256622SPablo Neira Ayuso 			 match.mask->ttl);
16888f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
16898f256622SPablo Neira Ayuso 			 match.key->ttl);
16901f97a526SOr Gerlitz 
16918f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1692a8ade55fSOr Gerlitz 		    !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev,
1693e98bedf5SEli Britstein 						ft_field_support.outer_ipv4_ttl)) {
1694e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1695e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
16961f97a526SOr Gerlitz 			return -EOPNOTSUPP;
1697e98bedf5SEli Britstein 		}
1698a8ade55fSOr Gerlitz 
16998f256622SPablo Neira Ayuso 		if (match.mask->tos || match.mask->ttl)
1700d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
17011f97a526SOr Gerlitz 	}
17021f97a526SOr Gerlitz 
170354782900SOr Gerlitz 	/* ***  L3 attributes parsing up to here *** */
170454782900SOr Gerlitz 
17058f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) {
17068f256622SPablo Neira Ayuso 		struct flow_match_ports match;
17078f256622SPablo Neira Ayuso 
17088f256622SPablo Neira Ayuso 		flow_rule_match_ports(rule, &match);
1709e3a2b7edSAmir Vadai 		switch (ip_proto) {
1710e3a2b7edSAmir Vadai 		case IPPROTO_TCP:
1711e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17128f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.mask->src));
1713e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17148f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.key->src));
1715e3a2b7edSAmir Vadai 
1716e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17178f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.mask->dst));
1718e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17198f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.key->dst));
1720e3a2b7edSAmir Vadai 			break;
1721e3a2b7edSAmir Vadai 
1722e3a2b7edSAmir Vadai 		case IPPROTO_UDP:
1723e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17248f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.mask->src));
1725e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17268f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.key->src));
1727e3a2b7edSAmir Vadai 
1728e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17298f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.mask->dst));
1730e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17318f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.key->dst));
1732e3a2b7edSAmir Vadai 			break;
1733e3a2b7edSAmir Vadai 		default:
1734e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1735e98bedf5SEli Britstein 					   "Only UDP and TCP transports are supported for L4 matching");
1736e3a2b7edSAmir Vadai 			netdev_err(priv->netdev,
1737e3a2b7edSAmir Vadai 				   "Only UDP and TCP transport are supported\n");
1738e3a2b7edSAmir Vadai 			return -EINVAL;
1739e3a2b7edSAmir Vadai 		}
1740de0af0bfSRoi Dayan 
17418f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1742d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1743e3a2b7edSAmir Vadai 	}
1744e3a2b7edSAmir Vadai 
17458f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) {
17468f256622SPablo Neira Ayuso 		struct flow_match_tcp match;
1747e77834ecSOr Gerlitz 
17488f256622SPablo Neira Ayuso 		flow_rule_match_tcp(rule, &match);
1749e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags,
17508f256622SPablo Neira Ayuso 			 ntohs(match.mask->flags));
1751e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags,
17528f256622SPablo Neira Ayuso 			 ntohs(match.key->flags));
1753e77834ecSOr Gerlitz 
17548f256622SPablo Neira Ayuso 		if (match.mask->flags)
1755d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1756e77834ecSOr Gerlitz 	}
1757e77834ecSOr Gerlitz 
1758e3a2b7edSAmir Vadai 	return 0;
1759e3a2b7edSAmir Vadai }
1760e3a2b7edSAmir Vadai 
1761de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv,
176265ba8fb7SOr Gerlitz 			    struct mlx5e_tc_flow *flow,
1763de0af0bfSRoi Dayan 			    struct mlx5_flow_spec *spec,
176454c177caSOz Shlomo 			    struct tc_cls_flower_offload *f,
176554c177caSOz Shlomo 			    struct net_device *filter_dev)
1766de0af0bfSRoi Dayan {
1767e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1768de0af0bfSRoi Dayan 	struct mlx5_core_dev *dev = priv->mdev;
1769de0af0bfSRoi Dayan 	struct mlx5_eswitch *esw = dev->priv.eswitch;
17701d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
17711d447a39SSaeed Mahameed 	struct mlx5_eswitch_rep *rep;
1772d708f902SOr Gerlitz 	u8 match_level;
1773de0af0bfSRoi Dayan 	int err;
1774de0af0bfSRoi Dayan 
177554c177caSOz Shlomo 	err = __parse_cls_flower(priv, spec, f, filter_dev, &match_level);
1776de0af0bfSRoi Dayan 
17771d447a39SSaeed Mahameed 	if (!err && (flow->flags & MLX5E_TC_FLOW_ESWITCH)) {
17781d447a39SSaeed Mahameed 		rep = rpriv->rep;
17791d447a39SSaeed Mahameed 		if (rep->vport != FDB_UPLINK_VPORT &&
17801d447a39SSaeed Mahameed 		    (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE &&
1781d708f902SOr Gerlitz 		    esw->offloads.inline_mode < match_level)) {
1782e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1783e98bedf5SEli Britstein 					   "Flow is not offloaded due to min inline setting");
1784de0af0bfSRoi Dayan 			netdev_warn(priv->netdev,
1785de0af0bfSRoi Dayan 				    "Flow is not offloaded due to min inline setting, required %d actual %d\n",
1786d708f902SOr Gerlitz 				    match_level, esw->offloads.inline_mode);
1787de0af0bfSRoi Dayan 			return -EOPNOTSUPP;
1788de0af0bfSRoi Dayan 		}
1789de0af0bfSRoi Dayan 	}
1790de0af0bfSRoi Dayan 
179138aa51c1SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
179238aa51c1SOr Gerlitz 		flow->esw_attr->match_level = match_level;
179338aa51c1SOr Gerlitz 	else
179438aa51c1SOr Gerlitz 		flow->nic_attr->match_level = match_level;
179538aa51c1SOr Gerlitz 
1796de0af0bfSRoi Dayan 	return err;
1797de0af0bfSRoi Dayan }
1798de0af0bfSRoi Dayan 
1799d79b6df6SOr Gerlitz struct pedit_headers {
1800d79b6df6SOr Gerlitz 	struct ethhdr  eth;
1801d79b6df6SOr Gerlitz 	struct iphdr   ip4;
1802d79b6df6SOr Gerlitz 	struct ipv6hdr ip6;
1803d79b6df6SOr Gerlitz 	struct tcphdr  tcp;
1804d79b6df6SOr Gerlitz 	struct udphdr  udp;
1805d79b6df6SOr Gerlitz };
1806d79b6df6SOr Gerlitz 
1807d79b6df6SOr Gerlitz static int pedit_header_offsets[] = {
1808d79b6df6SOr Gerlitz 	[TCA_PEDIT_KEY_EX_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth),
1809d79b6df6SOr Gerlitz 	[TCA_PEDIT_KEY_EX_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4),
1810d79b6df6SOr Gerlitz 	[TCA_PEDIT_KEY_EX_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6),
1811d79b6df6SOr Gerlitz 	[TCA_PEDIT_KEY_EX_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp),
1812d79b6df6SOr Gerlitz 	[TCA_PEDIT_KEY_EX_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp),
1813d79b6df6SOr Gerlitz };
1814d79b6df6SOr Gerlitz 
1815d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype])
1816d79b6df6SOr Gerlitz 
1817d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset,
1818d79b6df6SOr Gerlitz 			 struct pedit_headers *masks,
1819d79b6df6SOr Gerlitz 			 struct pedit_headers *vals)
1820d79b6df6SOr Gerlitz {
1821d79b6df6SOr Gerlitz 	u32 *curr_pmask, *curr_pval;
1822d79b6df6SOr Gerlitz 
1823d79b6df6SOr Gerlitz 	if (hdr_type >= __PEDIT_HDR_TYPE_MAX)
1824d79b6df6SOr Gerlitz 		goto out_err;
1825d79b6df6SOr Gerlitz 
1826d79b6df6SOr Gerlitz 	curr_pmask = (u32 *)(pedit_header(masks, hdr_type) + offset);
1827d79b6df6SOr Gerlitz 	curr_pval  = (u32 *)(pedit_header(vals, hdr_type) + offset);
1828d79b6df6SOr Gerlitz 
1829d79b6df6SOr Gerlitz 	if (*curr_pmask & mask)  /* disallow acting twice on the same location */
1830d79b6df6SOr Gerlitz 		goto out_err;
1831d79b6df6SOr Gerlitz 
1832d79b6df6SOr Gerlitz 	*curr_pmask |= mask;
1833d79b6df6SOr Gerlitz 	*curr_pval  |= (val & mask);
1834d79b6df6SOr Gerlitz 
1835d79b6df6SOr Gerlitz 	return 0;
1836d79b6df6SOr Gerlitz 
1837d79b6df6SOr Gerlitz out_err:
1838d79b6df6SOr Gerlitz 	return -EOPNOTSUPP;
1839d79b6df6SOr Gerlitz }
1840d79b6df6SOr Gerlitz 
1841d79b6df6SOr Gerlitz struct mlx5_fields {
1842d79b6df6SOr Gerlitz 	u8  field;
1843d79b6df6SOr Gerlitz 	u8  size;
1844d79b6df6SOr Gerlitz 	u32 offset;
1845d79b6df6SOr Gerlitz };
1846d79b6df6SOr Gerlitz 
1847a8e4f0c4SOr Gerlitz #define OFFLOAD(fw_field, size, field, off) \
1848a8e4f0c4SOr Gerlitz 		{MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, size, offsetof(struct pedit_headers, field) + (off)}
1849a8e4f0c4SOr Gerlitz 
1850d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = {
1851a8e4f0c4SOr Gerlitz 	OFFLOAD(DMAC_47_16, 4, eth.h_dest[0], 0),
1852a8e4f0c4SOr Gerlitz 	OFFLOAD(DMAC_15_0,  2, eth.h_dest[4], 0),
1853a8e4f0c4SOr Gerlitz 	OFFLOAD(SMAC_47_16, 4, eth.h_source[0], 0),
1854a8e4f0c4SOr Gerlitz 	OFFLOAD(SMAC_15_0,  2, eth.h_source[4], 0),
1855a8e4f0c4SOr Gerlitz 	OFFLOAD(ETHERTYPE,  2, eth.h_proto, 0),
1856d79b6df6SOr Gerlitz 
1857a8e4f0c4SOr Gerlitz 	OFFLOAD(IP_TTL, 1, ip4.ttl,   0),
1858a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV4,  4, ip4.saddr, 0),
1859a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV4,  4, ip4.daddr, 0),
1860d79b6df6SOr Gerlitz 
1861a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_127_96, 4, ip6.saddr.s6_addr32[0], 0),
1862a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_95_64,  4, ip6.saddr.s6_addr32[1], 0),
1863a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_63_32,  4, ip6.saddr.s6_addr32[2], 0),
1864a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_31_0,   4, ip6.saddr.s6_addr32[3], 0),
1865a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_127_96, 4, ip6.daddr.s6_addr32[0], 0),
1866a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_95_64,  4, ip6.daddr.s6_addr32[1], 0),
1867a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_63_32,  4, ip6.daddr.s6_addr32[2], 0),
1868a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_31_0,   4, ip6.daddr.s6_addr32[3], 0),
18690c0316f5SOr Gerlitz 	OFFLOAD(IPV6_HOPLIMIT, 1, ip6.hop_limit, 0),
1870d79b6df6SOr Gerlitz 
1871a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_SPORT, 2, tcp.source,  0),
1872a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_DPORT, 2, tcp.dest,    0),
1873a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_FLAGS, 1, tcp.ack_seq, 5),
1874d79b6df6SOr Gerlitz 
1875a8e4f0c4SOr Gerlitz 	OFFLOAD(UDP_SPORT, 2, udp.source, 0),
1876a8e4f0c4SOr Gerlitz 	OFFLOAD(UDP_DPORT, 2, udp.dest,   0),
1877d79b6df6SOr Gerlitz };
1878d79b6df6SOr Gerlitz 
1879d79b6df6SOr Gerlitz /* On input attr->num_mod_hdr_actions tells how many HW actions can be parsed at
1880d79b6df6SOr Gerlitz  * max from the SW pedit action. On success, it says how many HW actions were
1881d79b6df6SOr Gerlitz  * actually parsed.
1882d79b6df6SOr Gerlitz  */
1883d79b6df6SOr Gerlitz static int offload_pedit_fields(struct pedit_headers *masks,
1884d79b6df6SOr Gerlitz 				struct pedit_headers *vals,
1885e98bedf5SEli Britstein 				struct mlx5e_tc_flow_parse_attr *parse_attr,
1886e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
1887d79b6df6SOr Gerlitz {
1888d79b6df6SOr Gerlitz 	struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals;
18892b64bebaSOr Gerlitz 	int i, action_size, nactions, max_actions, first, last, next_z;
1890d79b6df6SOr Gerlitz 	void *s_masks_p, *a_masks_p, *vals_p;
1891d79b6df6SOr Gerlitz 	struct mlx5_fields *f;
1892d79b6df6SOr Gerlitz 	u8 cmd, field_bsize;
1893e3ca4e05SOr Gerlitz 	u32 s_mask, a_mask;
1894d79b6df6SOr Gerlitz 	unsigned long mask;
18952b64bebaSOr Gerlitz 	__be32 mask_be32;
18962b64bebaSOr Gerlitz 	__be16 mask_be16;
1897d79b6df6SOr Gerlitz 	void *action;
1898d79b6df6SOr Gerlitz 
1899d79b6df6SOr Gerlitz 	set_masks = &masks[TCA_PEDIT_KEY_EX_CMD_SET];
1900d79b6df6SOr Gerlitz 	add_masks = &masks[TCA_PEDIT_KEY_EX_CMD_ADD];
1901d79b6df6SOr Gerlitz 	set_vals = &vals[TCA_PEDIT_KEY_EX_CMD_SET];
1902d79b6df6SOr Gerlitz 	add_vals = &vals[TCA_PEDIT_KEY_EX_CMD_ADD];
1903d79b6df6SOr Gerlitz 
1904d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
1905d79b6df6SOr Gerlitz 	action = parse_attr->mod_hdr_actions;
1906d79b6df6SOr Gerlitz 	max_actions = parse_attr->num_mod_hdr_actions;
1907d79b6df6SOr Gerlitz 	nactions = 0;
1908d79b6df6SOr Gerlitz 
1909d79b6df6SOr Gerlitz 	for (i = 0; i < ARRAY_SIZE(fields); i++) {
1910d79b6df6SOr Gerlitz 		f = &fields[i];
1911d79b6df6SOr Gerlitz 		/* avoid seeing bits set from previous iterations */
1912e3ca4e05SOr Gerlitz 		s_mask = 0;
1913e3ca4e05SOr Gerlitz 		a_mask = 0;
1914d79b6df6SOr Gerlitz 
1915d79b6df6SOr Gerlitz 		s_masks_p = (void *)set_masks + f->offset;
1916d79b6df6SOr Gerlitz 		a_masks_p = (void *)add_masks + f->offset;
1917d79b6df6SOr Gerlitz 
1918d79b6df6SOr Gerlitz 		memcpy(&s_mask, s_masks_p, f->size);
1919d79b6df6SOr Gerlitz 		memcpy(&a_mask, a_masks_p, f->size);
1920d79b6df6SOr Gerlitz 
1921d79b6df6SOr Gerlitz 		if (!s_mask && !a_mask) /* nothing to offload here */
1922d79b6df6SOr Gerlitz 			continue;
1923d79b6df6SOr Gerlitz 
1924d79b6df6SOr Gerlitz 		if (s_mask && a_mask) {
1925e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1926e98bedf5SEli Britstein 					   "can't set and add to the same HW field");
1927d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field);
1928d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1929d79b6df6SOr Gerlitz 		}
1930d79b6df6SOr Gerlitz 
1931d79b6df6SOr Gerlitz 		if (nactions == max_actions) {
1932e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1933e98bedf5SEli Britstein 					   "too many pedit actions, can't offload");
1934d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions);
1935d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1936d79b6df6SOr Gerlitz 		}
1937d79b6df6SOr Gerlitz 
1938d79b6df6SOr Gerlitz 		if (s_mask) {
1939d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_SET;
1940d79b6df6SOr Gerlitz 			mask = s_mask;
1941d79b6df6SOr Gerlitz 			vals_p = (void *)set_vals + f->offset;
1942d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
1943d79b6df6SOr Gerlitz 			memset(s_masks_p, 0, f->size);
1944d79b6df6SOr Gerlitz 		} else {
1945d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_ADD;
1946d79b6df6SOr Gerlitz 			mask = a_mask;
1947d79b6df6SOr Gerlitz 			vals_p = (void *)add_vals + f->offset;
1948d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
1949d79b6df6SOr Gerlitz 			memset(a_masks_p, 0, f->size);
1950d79b6df6SOr Gerlitz 		}
1951d79b6df6SOr Gerlitz 
1952d79b6df6SOr Gerlitz 		field_bsize = f->size * BITS_PER_BYTE;
1953e3ca4e05SOr Gerlitz 
19542b64bebaSOr Gerlitz 		if (field_bsize == 32) {
19552b64bebaSOr Gerlitz 			mask_be32 = *(__be32 *)&mask;
19562b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32));
19572b64bebaSOr Gerlitz 		} else if (field_bsize == 16) {
19582b64bebaSOr Gerlitz 			mask_be16 = *(__be16 *)&mask;
19592b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16));
19602b64bebaSOr Gerlitz 		}
19612b64bebaSOr Gerlitz 
1962d79b6df6SOr Gerlitz 		first = find_first_bit(&mask, field_bsize);
19632b64bebaSOr Gerlitz 		next_z = find_next_zero_bit(&mask, field_bsize, first);
1964d79b6df6SOr Gerlitz 		last  = find_last_bit(&mask, field_bsize);
19652b64bebaSOr Gerlitz 		if (first < next_z && next_z < last) {
1966e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1967e98bedf5SEli Britstein 					   "rewrite of few sub-fields isn't supported");
19682b64bebaSOr Gerlitz 			printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n",
1969d79b6df6SOr Gerlitz 			       mask);
1970d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1971d79b6df6SOr Gerlitz 		}
1972d79b6df6SOr Gerlitz 
1973d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, action_type, cmd);
1974d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, field, f->field);
1975d79b6df6SOr Gerlitz 
1976d79b6df6SOr Gerlitz 		if (cmd == MLX5_ACTION_TYPE_SET) {
19772b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, offset, first);
1978d79b6df6SOr Gerlitz 			/* length is num of bits to be written, zero means length of 32 */
19792b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, length, (last - first + 1));
1980d79b6df6SOr Gerlitz 		}
1981d79b6df6SOr Gerlitz 
1982d79b6df6SOr Gerlitz 		if (field_bsize == 32)
19832b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first);
1984d79b6df6SOr Gerlitz 		else if (field_bsize == 16)
19852b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first);
1986d79b6df6SOr Gerlitz 		else if (field_bsize == 8)
19872b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first);
1988d79b6df6SOr Gerlitz 
1989d79b6df6SOr Gerlitz 		action += action_size;
1990d79b6df6SOr Gerlitz 		nactions++;
1991d79b6df6SOr Gerlitz 	}
1992d79b6df6SOr Gerlitz 
1993d79b6df6SOr Gerlitz 	parse_attr->num_mod_hdr_actions = nactions;
1994d79b6df6SOr Gerlitz 	return 0;
1995d79b6df6SOr Gerlitz }
1996d79b6df6SOr Gerlitz 
1997d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv,
1998d79b6df6SOr Gerlitz 				 const struct tc_action *a, int namespace,
1999d79b6df6SOr Gerlitz 				 struct mlx5e_tc_flow_parse_attr *parse_attr)
2000d79b6df6SOr Gerlitz {
2001d79b6df6SOr Gerlitz 	int nkeys, action_size, max_actions;
2002d79b6df6SOr Gerlitz 
2003d79b6df6SOr Gerlitz 	nkeys = tcf_pedit_nkeys(a);
2004d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
2005d79b6df6SOr Gerlitz 
2006d79b6df6SOr Gerlitz 	if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */
2007d79b6df6SOr Gerlitz 		max_actions = MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, max_modify_header_actions);
2008d79b6df6SOr Gerlitz 	else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */
2009d79b6df6SOr Gerlitz 		max_actions = MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, max_modify_header_actions);
2010d79b6df6SOr Gerlitz 
2011d79b6df6SOr Gerlitz 	/* can get up to crazingly 16 HW actions in 32 bits pedit SW key */
2012d79b6df6SOr Gerlitz 	max_actions = min(max_actions, nkeys * 16);
2013d79b6df6SOr Gerlitz 
2014d79b6df6SOr Gerlitz 	parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL);
2015d79b6df6SOr Gerlitz 	if (!parse_attr->mod_hdr_actions)
2016d79b6df6SOr Gerlitz 		return -ENOMEM;
2017d79b6df6SOr Gerlitz 
2018d79b6df6SOr Gerlitz 	parse_attr->num_mod_hdr_actions = max_actions;
2019d79b6df6SOr Gerlitz 	return 0;
2020d79b6df6SOr Gerlitz }
2021d79b6df6SOr Gerlitz 
2022d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {};
2023d79b6df6SOr Gerlitz 
2024d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv,
2025d79b6df6SOr Gerlitz 				 const struct tc_action *a, int namespace,
2026e98bedf5SEli Britstein 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2027e98bedf5SEli Britstein 				 struct netlink_ext_ack *extack)
2028d79b6df6SOr Gerlitz {
2029d79b6df6SOr Gerlitz 	struct pedit_headers masks[__PEDIT_CMD_MAX], vals[__PEDIT_CMD_MAX], *cmd_masks;
2030d79b6df6SOr Gerlitz 	int nkeys, i, err = -EOPNOTSUPP;
2031d79b6df6SOr Gerlitz 	u32 mask, val, offset;
2032d79b6df6SOr Gerlitz 	u8 cmd, htype;
2033d79b6df6SOr Gerlitz 
2034d79b6df6SOr Gerlitz 	nkeys = tcf_pedit_nkeys(a);
2035d79b6df6SOr Gerlitz 
2036d79b6df6SOr Gerlitz 	memset(masks, 0, sizeof(struct pedit_headers) * __PEDIT_CMD_MAX);
2037d79b6df6SOr Gerlitz 	memset(vals,  0, sizeof(struct pedit_headers) * __PEDIT_CMD_MAX);
2038d79b6df6SOr Gerlitz 
2039d79b6df6SOr Gerlitz 	for (i = 0; i < nkeys; i++) {
2040d79b6df6SOr Gerlitz 		htype = tcf_pedit_htype(a, i);
2041d79b6df6SOr Gerlitz 		cmd = tcf_pedit_cmd(a, i);
2042d79b6df6SOr Gerlitz 		err = -EOPNOTSUPP; /* can't be all optimistic */
2043d79b6df6SOr Gerlitz 
2044d79b6df6SOr Gerlitz 		if (htype == TCA_PEDIT_KEY_EX_HDR_TYPE_NETWORK) {
2045e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2046e98bedf5SEli Britstein 					   "legacy pedit isn't offloaded");
2047d79b6df6SOr Gerlitz 			goto out_err;
2048d79b6df6SOr Gerlitz 		}
2049d79b6df6SOr Gerlitz 
2050d79b6df6SOr Gerlitz 		if (cmd != TCA_PEDIT_KEY_EX_CMD_SET && cmd != TCA_PEDIT_KEY_EX_CMD_ADD) {
2051e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack, "pedit cmd isn't offloaded");
2052d79b6df6SOr Gerlitz 			goto out_err;
2053d79b6df6SOr Gerlitz 		}
2054d79b6df6SOr Gerlitz 
2055d79b6df6SOr Gerlitz 		mask = tcf_pedit_mask(a, i);
2056d79b6df6SOr Gerlitz 		val = tcf_pedit_val(a, i);
2057d79b6df6SOr Gerlitz 		offset = tcf_pedit_offset(a, i);
2058d79b6df6SOr Gerlitz 
2059d79b6df6SOr Gerlitz 		err = set_pedit_val(htype, ~mask, val, offset, &masks[cmd], &vals[cmd]);
2060d79b6df6SOr Gerlitz 		if (err)
2061d79b6df6SOr Gerlitz 			goto out_err;
2062d79b6df6SOr Gerlitz 	}
2063d79b6df6SOr Gerlitz 
2064d79b6df6SOr Gerlitz 	err = alloc_mod_hdr_actions(priv, a, namespace, parse_attr);
2065d79b6df6SOr Gerlitz 	if (err)
2066d79b6df6SOr Gerlitz 		goto out_err;
2067d79b6df6SOr Gerlitz 
2068e98bedf5SEli Britstein 	err = offload_pedit_fields(masks, vals, parse_attr, extack);
2069d79b6df6SOr Gerlitz 	if (err < 0)
2070d79b6df6SOr Gerlitz 		goto out_dealloc_parsed_actions;
2071d79b6df6SOr Gerlitz 
2072d79b6df6SOr Gerlitz 	for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) {
2073d79b6df6SOr Gerlitz 		cmd_masks = &masks[cmd];
2074d79b6df6SOr Gerlitz 		if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) {
2075e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2076e98bedf5SEli Britstein 					   "attempt to offload an unsupported field");
2077b3a433deSOr Gerlitz 			netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd);
2078d79b6df6SOr Gerlitz 			print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS,
2079d79b6df6SOr Gerlitz 				       16, 1, cmd_masks, sizeof(zero_masks), true);
2080d79b6df6SOr Gerlitz 			err = -EOPNOTSUPP;
2081d79b6df6SOr Gerlitz 			goto out_dealloc_parsed_actions;
2082d79b6df6SOr Gerlitz 		}
2083d79b6df6SOr Gerlitz 	}
2084d79b6df6SOr Gerlitz 
2085d79b6df6SOr Gerlitz 	return 0;
2086d79b6df6SOr Gerlitz 
2087d79b6df6SOr Gerlitz out_dealloc_parsed_actions:
2088d79b6df6SOr Gerlitz 	kfree(parse_attr->mod_hdr_actions);
2089d79b6df6SOr Gerlitz out_err:
2090d79b6df6SOr Gerlitz 	return err;
2091d79b6df6SOr Gerlitz }
2092d79b6df6SOr Gerlitz 
2093e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv,
2094e98bedf5SEli Britstein 				   u32 action,
2095e98bedf5SEli Britstein 				   u32 update_flags,
2096e98bedf5SEli Britstein 				   struct netlink_ext_ack *extack)
209726c02749SOr Gerlitz {
209826c02749SOr Gerlitz 	u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP |
209926c02749SOr Gerlitz 			 TCA_CSUM_UPDATE_FLAG_UDP;
210026c02749SOr Gerlitz 
210126c02749SOr Gerlitz 	/*  The HW recalcs checksums only if re-writing headers */
210226c02749SOr Gerlitz 	if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) {
2103e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2104e98bedf5SEli Britstein 				   "TC csum action is only offloaded with pedit");
210526c02749SOr Gerlitz 		netdev_warn(priv->netdev,
210626c02749SOr Gerlitz 			    "TC csum action is only offloaded with pedit\n");
210726c02749SOr Gerlitz 		return false;
210826c02749SOr Gerlitz 	}
210926c02749SOr Gerlitz 
211026c02749SOr Gerlitz 	if (update_flags & ~prot_flags) {
2111e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2112e98bedf5SEli Britstein 				   "can't offload TC csum action for some header/s");
211326c02749SOr Gerlitz 		netdev_warn(priv->netdev,
211426c02749SOr Gerlitz 			    "can't offload TC csum action for some header/s - flags %#x\n",
211526c02749SOr Gerlitz 			    update_flags);
211626c02749SOr Gerlitz 		return false;
211726c02749SOr Gerlitz 	}
211826c02749SOr Gerlitz 
211926c02749SOr Gerlitz 	return true;
212026c02749SOr Gerlitz }
212126c02749SOr Gerlitz 
2122bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec,
2123e98bedf5SEli Britstein 					  struct tcf_exts *exts,
2124e98bedf5SEli Britstein 					  struct netlink_ext_ack *extack)
2125bdd66ac0SOr Gerlitz {
2126bdd66ac0SOr Gerlitz 	const struct tc_action *a;
2127bdd66ac0SOr Gerlitz 	bool modify_ip_header;
2128bdd66ac0SOr Gerlitz 	u8 htype, ip_proto;
2129bdd66ac0SOr Gerlitz 	void *headers_v;
2130bdd66ac0SOr Gerlitz 	u16 ethertype;
2131bdd66ac0SOr Gerlitz 	int nkeys, i;
2132bdd66ac0SOr Gerlitz 
2133bdd66ac0SOr Gerlitz 	headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
2134bdd66ac0SOr Gerlitz 	ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype);
2135bdd66ac0SOr Gerlitz 
2136bdd66ac0SOr Gerlitz 	/* for non-IP we only re-write MACs, so we're okay */
2137bdd66ac0SOr Gerlitz 	if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6)
2138bdd66ac0SOr Gerlitz 		goto out_ok;
2139bdd66ac0SOr Gerlitz 
2140bdd66ac0SOr Gerlitz 	modify_ip_header = false;
2141244cd96aSCong Wang 	tcf_exts_for_each_action(i, a, exts) {
2142244cd96aSCong Wang 		int k;
2143244cd96aSCong Wang 
2144bdd66ac0SOr Gerlitz 		if (!is_tcf_pedit(a))
2145bdd66ac0SOr Gerlitz 			continue;
2146bdd66ac0SOr Gerlitz 
2147bdd66ac0SOr Gerlitz 		nkeys = tcf_pedit_nkeys(a);
2148244cd96aSCong Wang 		for (k = 0; k < nkeys; k++) {
2149244cd96aSCong Wang 			htype = tcf_pedit_htype(a, k);
2150bdd66ac0SOr Gerlitz 			if (htype == TCA_PEDIT_KEY_EX_HDR_TYPE_IP4 ||
2151bdd66ac0SOr Gerlitz 			    htype == TCA_PEDIT_KEY_EX_HDR_TYPE_IP6) {
2152bdd66ac0SOr Gerlitz 				modify_ip_header = true;
2153bdd66ac0SOr Gerlitz 				break;
2154bdd66ac0SOr Gerlitz 			}
2155bdd66ac0SOr Gerlitz 		}
2156bdd66ac0SOr Gerlitz 	}
2157bdd66ac0SOr Gerlitz 
2158bdd66ac0SOr Gerlitz 	ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol);
21591ccef350SJianbo Liu 	if (modify_ip_header && ip_proto != IPPROTO_TCP &&
21601ccef350SJianbo Liu 	    ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) {
2161e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2162e98bedf5SEli Britstein 				   "can't offload re-write of non TCP/UDP");
2163bdd66ac0SOr Gerlitz 		pr_info("can't offload re-write of ip proto %d\n", ip_proto);
2164bdd66ac0SOr Gerlitz 		return false;
2165bdd66ac0SOr Gerlitz 	}
2166bdd66ac0SOr Gerlitz 
2167bdd66ac0SOr Gerlitz out_ok:
2168bdd66ac0SOr Gerlitz 	return true;
2169bdd66ac0SOr Gerlitz }
2170bdd66ac0SOr Gerlitz 
2171bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv,
2172bdd66ac0SOr Gerlitz 				    struct tcf_exts *exts,
2173bdd66ac0SOr Gerlitz 				    struct mlx5e_tc_flow_parse_attr *parse_attr,
2174e98bedf5SEli Britstein 				    struct mlx5e_tc_flow *flow,
2175e98bedf5SEli Britstein 				    struct netlink_ext_ack *extack)
2176bdd66ac0SOr Gerlitz {
2177bdd66ac0SOr Gerlitz 	u32 actions;
2178bdd66ac0SOr Gerlitz 
2179bdd66ac0SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
2180bdd66ac0SOr Gerlitz 		actions = flow->esw_attr->action;
2181bdd66ac0SOr Gerlitz 	else
2182bdd66ac0SOr Gerlitz 		actions = flow->nic_attr->action;
2183bdd66ac0SOr Gerlitz 
21847e29392eSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_EGRESS &&
21857e29392eSRoi Dayan 	    !(actions & MLX5_FLOW_CONTEXT_ACTION_DECAP))
21867e29392eSRoi Dayan 		return false;
21877e29392eSRoi Dayan 
2188bdd66ac0SOr Gerlitz 	if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
2189e98bedf5SEli Britstein 		return modify_header_match_supported(&parse_attr->spec, exts,
2190e98bedf5SEli Britstein 						     extack);
2191bdd66ac0SOr Gerlitz 
2192bdd66ac0SOr Gerlitz 	return true;
2193bdd66ac0SOr Gerlitz }
2194bdd66ac0SOr Gerlitz 
21955c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv)
21965c65c564SOr Gerlitz {
21975c65c564SOr Gerlitz 	struct mlx5_core_dev *fmdev, *pmdev;
2198816f6706SOr Gerlitz 	u64 fsystem_guid, psystem_guid;
21995c65c564SOr Gerlitz 
22005c65c564SOr Gerlitz 	fmdev = priv->mdev;
22015c65c564SOr Gerlitz 	pmdev = peer_priv->mdev;
22025c65c564SOr Gerlitz 
220359c9d35eSAlaa Hleihel 	fsystem_guid = mlx5_query_nic_system_image_guid(fmdev);
220459c9d35eSAlaa Hleihel 	psystem_guid = mlx5_query_nic_system_image_guid(pmdev);
22055c65c564SOr Gerlitz 
2206816f6706SOr Gerlitz 	return (fsystem_guid == psystem_guid);
22075c65c564SOr Gerlitz }
22085c65c564SOr Gerlitz 
22095c40348cSOr Gerlitz static int parse_tc_nic_actions(struct mlx5e_priv *priv, struct tcf_exts *exts,
2210aa0cbbaeSOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr,
2211e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2212e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2213e3a2b7edSAmir Vadai {
2214aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
2215e3a2b7edSAmir Vadai 	const struct tc_action *a;
22161cab1cd7SOr Gerlitz 	u32 action = 0;
2217244cd96aSCong Wang 	int err, i;
2218e3a2b7edSAmir Vadai 
22193bcc0cecSJiri Pirko 	if (!tcf_exts_has_actions(exts))
2220e3a2b7edSAmir Vadai 		return -EINVAL;
2221e3a2b7edSAmir Vadai 
22223bc4b7bfSOr Gerlitz 	attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG;
2223e3a2b7edSAmir Vadai 
2224244cd96aSCong Wang 	tcf_exts_for_each_action(i, a, exts) {
2225e3a2b7edSAmir Vadai 		if (is_tcf_gact_shot(a)) {
22261cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP;
2227aad7e08dSAmir Vadai 			if (MLX5_CAP_FLOWTABLE(priv->mdev,
2228aad7e08dSAmir Vadai 					       flow_table_properties_nic_receive.flow_counter))
22291cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
2230e3a2b7edSAmir Vadai 			continue;
2231e3a2b7edSAmir Vadai 		}
2232e3a2b7edSAmir Vadai 
22332f4fe4caSOr Gerlitz 		if (is_tcf_pedit(a)) {
22342f4fe4caSOr Gerlitz 			err = parse_tc_pedit_action(priv, a, MLX5_FLOW_NAMESPACE_KERNEL,
2235e98bedf5SEli Britstein 						    parse_attr, extack);
22362f4fe4caSOr Gerlitz 			if (err)
22372f4fe4caSOr Gerlitz 				return err;
22382f4fe4caSOr Gerlitz 
22391cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR |
22402f4fe4caSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
22412f4fe4caSOr Gerlitz 			continue;
22422f4fe4caSOr Gerlitz 		}
22432f4fe4caSOr Gerlitz 
224426c02749SOr Gerlitz 		if (is_tcf_csum(a)) {
22451cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
2246e98bedf5SEli Britstein 						   tcf_csum_update_flags(a),
2247e98bedf5SEli Britstein 						   extack))
224826c02749SOr Gerlitz 				continue;
224926c02749SOr Gerlitz 
225026c02749SOr Gerlitz 			return -EOPNOTSUPP;
225126c02749SOr Gerlitz 		}
225226c02749SOr Gerlitz 
22535c65c564SOr Gerlitz 		if (is_tcf_mirred_egress_redirect(a)) {
22545c65c564SOr Gerlitz 			struct net_device *peer_dev = tcf_mirred_dev(a);
22555c65c564SOr Gerlitz 
22565c65c564SOr Gerlitz 			if (priv->netdev->netdev_ops == peer_dev->netdev_ops &&
22575c65c564SOr Gerlitz 			    same_hw_devs(priv, netdev_priv(peer_dev))) {
225898b66cb1SEli Britstein 				parse_attr->mirred_ifindex[0] = peer_dev->ifindex;
22595c65c564SOr Gerlitz 				flow->flags |= MLX5E_TC_FLOW_HAIRPIN;
22601cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
22615c65c564SOr Gerlitz 					  MLX5_FLOW_CONTEXT_ACTION_COUNT;
22625c65c564SOr Gerlitz 			} else {
2263e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2264e98bedf5SEli Britstein 						   "device is not on same HW, can't offload");
22655c65c564SOr Gerlitz 				netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n",
22665c65c564SOr Gerlitz 					    peer_dev->name);
22675c65c564SOr Gerlitz 				return -EINVAL;
22685c65c564SOr Gerlitz 			}
22695c65c564SOr Gerlitz 			continue;
22705c65c564SOr Gerlitz 		}
22715c65c564SOr Gerlitz 
2272e3a2b7edSAmir Vadai 		if (is_tcf_skbedit_mark(a)) {
2273e3a2b7edSAmir Vadai 			u32 mark = tcf_skbedit_mark(a);
2274e3a2b7edSAmir Vadai 
2275e3a2b7edSAmir Vadai 			if (mark & ~MLX5E_TC_FLOW_ID_MASK) {
2276e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2277e98bedf5SEli Britstein 						   "Bad flow mark - only 16 bit is supported");
2278e3a2b7edSAmir Vadai 				return -EINVAL;
2279e3a2b7edSAmir Vadai 			}
2280e3a2b7edSAmir Vadai 
22813bc4b7bfSOr Gerlitz 			attr->flow_tag = mark;
22821cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
2283e3a2b7edSAmir Vadai 			continue;
2284e3a2b7edSAmir Vadai 		}
2285e3a2b7edSAmir Vadai 
2286e3a2b7edSAmir Vadai 		return -EINVAL;
2287e3a2b7edSAmir Vadai 	}
2288e3a2b7edSAmir Vadai 
22891cab1cd7SOr Gerlitz 	attr->action = action;
2290e98bedf5SEli Britstein 	if (!actions_match_supported(priv, exts, parse_attr, flow, extack))
2291bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
2292bdd66ac0SOr Gerlitz 
2293e3a2b7edSAmir Vadai 	return 0;
2294e3a2b7edSAmir Vadai }
2295e3a2b7edSAmir Vadai 
229676f7444dSOr Gerlitz static inline int cmp_encap_info(struct ip_tunnel_key *a,
229776f7444dSOr Gerlitz 				 struct ip_tunnel_key *b)
2298a54e20b4SHadar Hen Zion {
2299a54e20b4SHadar Hen Zion 	return memcmp(a, b, sizeof(*a));
2300a54e20b4SHadar Hen Zion }
2301a54e20b4SHadar Hen Zion 
230276f7444dSOr Gerlitz static inline int hash_encap_info(struct ip_tunnel_key *key)
2303a54e20b4SHadar Hen Zion {
230476f7444dSOr Gerlitz 	return jhash(key, sizeof(*key), 0);
2305a54e20b4SHadar Hen Zion }
2306a54e20b4SHadar Hen Zion 
2307a54e20b4SHadar Hen Zion 
2308b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv,
2309b1d90e6bSRabie Loulou 				  struct net_device *peer_netdev)
2310b1d90e6bSRabie Loulou {
2311b1d90e6bSRabie Loulou 	struct mlx5e_priv *peer_priv;
2312b1d90e6bSRabie Loulou 
2313b1d90e6bSRabie Loulou 	peer_priv = netdev_priv(peer_netdev);
2314b1d90e6bSRabie Loulou 
2315b1d90e6bSRabie Loulou 	return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) &&
2316b1d90e6bSRabie Loulou 		(priv->netdev->netdev_ops == peer_netdev->netdev_ops) &&
2317b1d90e6bSRabie Loulou 		same_hw_devs(priv, peer_priv) &&
2318b1d90e6bSRabie Loulou 		MLX5_VPORT_MANAGER(peer_priv->mdev) &&
2319b1d90e6bSRabie Loulou 		(peer_priv->mdev->priv.eswitch->mode == SRIOV_OFFLOADS));
2320b1d90e6bSRabie Loulou }
2321b1d90e6bSRabie Loulou 
2322ce99f6b9SOr Gerlitz 
232354c177caSOz Shlomo 
2324a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv,
2325a54e20b4SHadar Hen Zion 			      struct ip_tunnel_info *tun_info,
2326a54e20b4SHadar Hen Zion 			      struct net_device *mirred_dev,
232745247bf2SOr Gerlitz 			      struct net_device **encap_dev,
2328e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
23298c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
23308c4dc42bSEli Britstein 			      int out_index)
233103a9d11eSOr Gerlitz {
2332a54e20b4SHadar Hen Zion 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2333a54e20b4SHadar Hen Zion 	unsigned short family = ip_tunnel_info_af(tun_info);
233445247bf2SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
2335a54e20b4SHadar Hen Zion 	struct ip_tunnel_key *key = &tun_info->key;
2336c1ae1152SOr Gerlitz 	struct mlx5e_encap_entry *e;
2337a54e20b4SHadar Hen Zion 	uintptr_t hash_key;
2338a54e20b4SHadar Hen Zion 	bool found = false;
233954c177caSOz Shlomo 	int err = 0;
2340a54e20b4SHadar Hen Zion 
234176f7444dSOr Gerlitz 	hash_key = hash_encap_info(key);
2342a54e20b4SHadar Hen Zion 
2343a54e20b4SHadar Hen Zion 	hash_for_each_possible_rcu(esw->offloads.encap_tbl, e,
2344a54e20b4SHadar Hen Zion 				   encap_hlist, hash_key) {
234576f7444dSOr Gerlitz 		if (!cmp_encap_info(&e->tun_info.key, key)) {
2346a54e20b4SHadar Hen Zion 			found = true;
2347a54e20b4SHadar Hen Zion 			break;
2348a54e20b4SHadar Hen Zion 		}
2349a54e20b4SHadar Hen Zion 	}
2350a54e20b4SHadar Hen Zion 
2351b2812089SVlad Buslov 	/* must verify if encap is valid or not */
235245247bf2SOr Gerlitz 	if (found)
235345247bf2SOr Gerlitz 		goto attach_flow;
2354a54e20b4SHadar Hen Zion 
2355a54e20b4SHadar Hen Zion 	e = kzalloc(sizeof(*e), GFP_KERNEL);
2356a54e20b4SHadar Hen Zion 	if (!e)
2357a54e20b4SHadar Hen Zion 		return -ENOMEM;
2358a54e20b4SHadar Hen Zion 
235976f7444dSOr Gerlitz 	e->tun_info = *tun_info;
2360101f4de9SOz Shlomo 	err = mlx5e_tc_tun_init_encap_attr(mirred_dev, priv, e, extack);
236154c177caSOz Shlomo 	if (err)
236254c177caSOz Shlomo 		goto out_err;
236354c177caSOz Shlomo 
2364a54e20b4SHadar Hen Zion 	INIT_LIST_HEAD(&e->flows);
2365a54e20b4SHadar Hen Zion 
2366ce99f6b9SOr Gerlitz 	if (family == AF_INET)
2367101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv4(priv, mirred_dev, e);
2368ce99f6b9SOr Gerlitz 	else if (family == AF_INET6)
2369101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv6(priv, mirred_dev, e);
2370ce99f6b9SOr Gerlitz 
2371232c0013SHadar Hen Zion 	if (err && err != -EAGAIN)
2372a54e20b4SHadar Hen Zion 		goto out_err;
2373a54e20b4SHadar Hen Zion 
2374a54e20b4SHadar Hen Zion 	hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key);
2375a54e20b4SHadar Hen Zion 
237645247bf2SOr Gerlitz attach_flow:
23778c4dc42bSEli Britstein 	list_add(&flow->encaps[out_index].list, &e->flows);
23788c4dc42bSEli Britstein 	flow->encaps[out_index].index = out_index;
237945247bf2SOr Gerlitz 	*encap_dev = e->out_dev;
23808c4dc42bSEli Britstein 	if (e->flags & MLX5_ENCAP_ENTRY_VALID) {
23818c4dc42bSEli Britstein 		attr->dests[out_index].encap_id = e->encap_id;
23828c4dc42bSEli Britstein 		attr->dests[out_index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
23838c4dc42bSEli Britstein 	} else {
2384b2812089SVlad Buslov 		err = -EAGAIN;
23858c4dc42bSEli Britstein 	}
238645247bf2SOr Gerlitz 
2387232c0013SHadar Hen Zion 	return err;
2388a54e20b4SHadar Hen Zion 
2389a54e20b4SHadar Hen Zion out_err:
2390a54e20b4SHadar Hen Zion 	kfree(e);
2391a54e20b4SHadar Hen Zion 	return err;
2392a54e20b4SHadar Hen Zion }
2393a54e20b4SHadar Hen Zion 
23941482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv,
23951482bd3dSJianbo Liu 				const struct tc_action *a,
23961482bd3dSJianbo Liu 				struct mlx5_esw_flow_attr *attr,
23971482bd3dSJianbo Liu 				u32 *action)
23981482bd3dSJianbo Liu {
2399cc495188SJianbo Liu 	u8 vlan_idx = attr->total_vlan;
2400cc495188SJianbo Liu 
2401cc495188SJianbo Liu 	if (vlan_idx >= MLX5_FS_VLAN_DEPTH)
24021482bd3dSJianbo Liu 		return -EOPNOTSUPP;
2403cc495188SJianbo Liu 
2404cc495188SJianbo Liu 	if (tcf_vlan_action(a) == TCA_VLAN_ACT_POP) {
2405cc495188SJianbo Liu 		if (vlan_idx) {
2406cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2407cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2408cc495188SJianbo Liu 				return -EOPNOTSUPP;
2409cc495188SJianbo Liu 
2410cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2;
2411cc495188SJianbo Liu 		} else {
2412cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
2413cc495188SJianbo Liu 		}
2414cc495188SJianbo Liu 	} else if (tcf_vlan_action(a) == TCA_VLAN_ACT_PUSH) {
2415cc495188SJianbo Liu 		attr->vlan_vid[vlan_idx] = tcf_vlan_push_vid(a);
2416cc495188SJianbo Liu 		attr->vlan_prio[vlan_idx] = tcf_vlan_push_prio(a);
2417cc495188SJianbo Liu 		attr->vlan_proto[vlan_idx] = tcf_vlan_push_proto(a);
2418cc495188SJianbo Liu 		if (!attr->vlan_proto[vlan_idx])
2419cc495188SJianbo Liu 			attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q);
2420cc495188SJianbo Liu 
2421cc495188SJianbo Liu 		if (vlan_idx) {
2422cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2423cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2424cc495188SJianbo Liu 				return -EOPNOTSUPP;
2425cc495188SJianbo Liu 
2426cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2;
2427cc495188SJianbo Liu 		} else {
2428cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) &&
2429cc495188SJianbo Liu 			    (tcf_vlan_push_proto(a) != htons(ETH_P_8021Q) ||
2430cc495188SJianbo Liu 			     tcf_vlan_push_prio(a)))
2431cc495188SJianbo Liu 				return -EOPNOTSUPP;
2432cc495188SJianbo Liu 
2433cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH;
24341482bd3dSJianbo Liu 		}
24351482bd3dSJianbo Liu 	} else { /* action is TCA_VLAN_ACT_MODIFY */
24361482bd3dSJianbo Liu 		return -EOPNOTSUPP;
24371482bd3dSJianbo Liu 	}
24381482bd3dSJianbo Liu 
2439cc495188SJianbo Liu 	attr->total_vlan = vlan_idx + 1;
2440cc495188SJianbo Liu 
24411482bd3dSJianbo Liu 	return 0;
24421482bd3dSJianbo Liu }
24431482bd3dSJianbo Liu 
2444a54e20b4SHadar Hen Zion static int parse_tc_fdb_actions(struct mlx5e_priv *priv, struct tcf_exts *exts,
2445d7e75a32SOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr,
2446e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2447e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2448a54e20b4SHadar Hen Zion {
2449bf07aa73SPaul Blakey 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2450ecf5bb79SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
24511d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
2452a54e20b4SHadar Hen Zion 	struct ip_tunnel_info *info = NULL;
245303a9d11eSOr Gerlitz 	const struct tc_action *a;
2454a54e20b4SHadar Hen Zion 	bool encap = false;
24551cab1cd7SOr Gerlitz 	u32 action = 0;
2456244cd96aSCong Wang 	int err, i;
245703a9d11eSOr Gerlitz 
24583bcc0cecSJiri Pirko 	if (!tcf_exts_has_actions(exts))
245903a9d11eSOr Gerlitz 		return -EINVAL;
246003a9d11eSOr Gerlitz 
24611d447a39SSaeed Mahameed 	attr->in_rep = rpriv->rep;
246210ff5359SShahar Klein 	attr->in_mdev = priv->mdev;
246303a9d11eSOr Gerlitz 
2464244cd96aSCong Wang 	tcf_exts_for_each_action(i, a, exts) {
246503a9d11eSOr Gerlitz 		if (is_tcf_gact_shot(a)) {
24661cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP |
246703a9d11eSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
246803a9d11eSOr Gerlitz 			continue;
246903a9d11eSOr Gerlitz 		}
247003a9d11eSOr Gerlitz 
2471d7e75a32SOr Gerlitz 		if (is_tcf_pedit(a)) {
2472d7e75a32SOr Gerlitz 			err = parse_tc_pedit_action(priv, a, MLX5_FLOW_NAMESPACE_FDB,
2473e98bedf5SEli Britstein 						    parse_attr, extack);
2474d7e75a32SOr Gerlitz 			if (err)
2475d7e75a32SOr Gerlitz 				return err;
2476d7e75a32SOr Gerlitz 
24771cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
2478e85e02baSEli Britstein 			attr->split_count = attr->out_count;
2479d7e75a32SOr Gerlitz 			continue;
2480d7e75a32SOr Gerlitz 		}
2481d7e75a32SOr Gerlitz 
248226c02749SOr Gerlitz 		if (is_tcf_csum(a)) {
24831cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
2484e98bedf5SEli Britstein 						   tcf_csum_update_flags(a),
2485e98bedf5SEli Britstein 						   extack))
248626c02749SOr Gerlitz 				continue;
248726c02749SOr Gerlitz 
248826c02749SOr Gerlitz 			return -EOPNOTSUPP;
248926c02749SOr Gerlitz 		}
249026c02749SOr Gerlitz 
2491592d3651SChris Mi 		if (is_tcf_mirred_egress_redirect(a) || is_tcf_mirred_egress_mirror(a)) {
249203a9d11eSOr Gerlitz 			struct mlx5e_priv *out_priv;
2493592d3651SChris Mi 			struct net_device *out_dev;
249403a9d11eSOr Gerlitz 
24959f8a739eSCong Wang 			out_dev = tcf_mirred_dev(a);
2496ef381359SOz Shlomo 			if (!out_dev) {
2497ef381359SOz Shlomo 				/* out_dev is NULL when filters with
2498ef381359SOz Shlomo 				 * non-existing mirred device are replayed to
2499ef381359SOz Shlomo 				 * the driver.
2500ef381359SOz Shlomo 				 */
2501ef381359SOz Shlomo 				return -EINVAL;
2502ef381359SOz Shlomo 			}
250303a9d11eSOr Gerlitz 
2504592d3651SChris Mi 			if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) {
2505e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2506e98bedf5SEli Britstein 						   "can't support more output ports, can't offload forwarding");
2507592d3651SChris Mi 				pr_err("can't support more than %d output ports, can't offload forwarding\n",
2508592d3651SChris Mi 				       attr->out_count);
2509592d3651SChris Mi 				return -EOPNOTSUPP;
2510592d3651SChris Mi 			}
2511592d3651SChris Mi 
2512f493f155SEli Britstein 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
2513f493f155SEli Britstein 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
2514a54e20b4SHadar Hen Zion 			if (switchdev_port_same_parent_id(priv->netdev,
2515b1d90e6bSRabie Loulou 							  out_dev) ||
2516b1d90e6bSRabie Loulou 			    is_merged_eswitch_dev(priv, out_dev)) {
25177ba58ba7SRabie Loulou 				struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
25187ba58ba7SRabie Loulou 				struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH);
25197ba58ba7SRabie Loulou 				struct net_device *uplink_upper = netdev_master_upper_dev_get(uplink_dev);
25207ba58ba7SRabie Loulou 
25217ba58ba7SRabie Loulou 				if (uplink_upper &&
25227ba58ba7SRabie Loulou 				    netif_is_lag_master(uplink_upper) &&
25237ba58ba7SRabie Loulou 				    uplink_upper == out_dev)
25247ba58ba7SRabie Loulou 					out_dev = uplink_dev;
25257ba58ba7SRabie Loulou 
2526a0646c88SEli Britstein 				if (!mlx5e_eswitch_rep(out_dev))
2527a0646c88SEli Britstein 					return -EOPNOTSUPP;
2528a0646c88SEli Britstein 
252903a9d11eSOr Gerlitz 				out_priv = netdev_priv(out_dev);
25301d447a39SSaeed Mahameed 				rpriv = out_priv->ppriv;
2531df65a573SEli Britstein 				attr->dests[attr->out_count].rep = rpriv->rep;
2532df65a573SEli Britstein 				attr->dests[attr->out_count].mdev = out_priv->mdev;
2533df65a573SEli Britstein 				attr->out_count++;
2534a54e20b4SHadar Hen Zion 			} else if (encap) {
25358c4dc42bSEli Britstein 				parse_attr->mirred_ifindex[attr->out_count] =
25368c4dc42bSEli Britstein 					out_dev->ifindex;
25378c4dc42bSEli Britstein 				parse_attr->tun_info[attr->out_count] = *info;
25388c4dc42bSEli Britstein 				encap = false;
25393c37745eSOr Gerlitz 				attr->parse_attr = parse_attr;
2540f493f155SEli Britstein 				attr->dests[attr->out_count].flags |=
2541f493f155SEli Britstein 					MLX5_ESW_DEST_ENCAP;
25421cc26d74SEli Britstein 				attr->out_count++;
2543df65a573SEli Britstein 				/* attr->dests[].rep is resolved when we
2544df65a573SEli Britstein 				 * handle encap
2545df65a573SEli Britstein 				 */
2546ef381359SOz Shlomo 			} else if (parse_attr->filter_dev != priv->netdev) {
2547ef381359SOz Shlomo 				/* All mlx5 devices are called to configure
2548ef381359SOz Shlomo 				 * high level device filters. Therefore, the
2549ef381359SOz Shlomo 				 * *attempt* to  install a filter on invalid
2550ef381359SOz Shlomo 				 * eswitch should not trigger an explicit error
2551ef381359SOz Shlomo 				 */
2552ef381359SOz Shlomo 				return -EINVAL;
2553a54e20b4SHadar Hen Zion 			} else {
2554e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2555e98bedf5SEli Britstein 						   "devices are not on same switch HW, can't offload forwarding");
2556a54e20b4SHadar Hen Zion 				pr_err("devices %s %s not on same switch HW, can't offload forwarding\n",
2557a54e20b4SHadar Hen Zion 				       priv->netdev->name, out_dev->name);
2558a54e20b4SHadar Hen Zion 				return -EINVAL;
2559a54e20b4SHadar Hen Zion 			}
2560a54e20b4SHadar Hen Zion 			continue;
2561a54e20b4SHadar Hen Zion 		}
2562a54e20b4SHadar Hen Zion 
2563a54e20b4SHadar Hen Zion 		if (is_tcf_tunnel_set(a)) {
2564a54e20b4SHadar Hen Zion 			info = tcf_tunnel_info(a);
2565a54e20b4SHadar Hen Zion 			if (info)
2566a54e20b4SHadar Hen Zion 				encap = true;
2567a54e20b4SHadar Hen Zion 			else
2568a54e20b4SHadar Hen Zion 				return -EOPNOTSUPP;
256903a9d11eSOr Gerlitz 			continue;
257003a9d11eSOr Gerlitz 		}
257103a9d11eSOr Gerlitz 
25728b32580dSOr Gerlitz 		if (is_tcf_vlan(a)) {
25731482bd3dSJianbo Liu 			err = parse_tc_vlan_action(priv, a, attr, &action);
25741482bd3dSJianbo Liu 
25751482bd3dSJianbo Liu 			if (err)
25761482bd3dSJianbo Liu 				return err;
25771482bd3dSJianbo Liu 
2578e85e02baSEli Britstein 			attr->split_count = attr->out_count;
25798b32580dSOr Gerlitz 			continue;
25808b32580dSOr Gerlitz 		}
25818b32580dSOr Gerlitz 
2582bbd00f7eSHadar Hen Zion 		if (is_tcf_tunnel_release(a)) {
25831cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DECAP;
2584bbd00f7eSHadar Hen Zion 			continue;
2585bbd00f7eSHadar Hen Zion 		}
2586bbd00f7eSHadar Hen Zion 
2587bf07aa73SPaul Blakey 		if (is_tcf_gact_goto_chain(a)) {
2588bf07aa73SPaul Blakey 			u32 dest_chain = tcf_gact_goto_chain_index(a);
2589bf07aa73SPaul Blakey 			u32 max_chain = mlx5_eswitch_get_chain_range(esw);
2590bf07aa73SPaul Blakey 
2591bf07aa73SPaul Blakey 			if (dest_chain <= attr->chain) {
2592bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Goto earlier chain isn't supported");
2593bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
2594bf07aa73SPaul Blakey 			}
2595bf07aa73SPaul Blakey 			if (dest_chain > max_chain) {
2596bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Requested destination chain is out of supported range");
2597bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
2598bf07aa73SPaul Blakey 			}
2599e88afe75SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
2600bf07aa73SPaul Blakey 			attr->dest_chain = dest_chain;
2601bf07aa73SPaul Blakey 
2602bf07aa73SPaul Blakey 			continue;
2603bf07aa73SPaul Blakey 		}
2604bf07aa73SPaul Blakey 
260503a9d11eSOr Gerlitz 		return -EINVAL;
260603a9d11eSOr Gerlitz 	}
2607bdd66ac0SOr Gerlitz 
26081cab1cd7SOr Gerlitz 	attr->action = action;
2609e98bedf5SEli Britstein 	if (!actions_match_supported(priv, exts, parse_attr, flow, extack))
2610bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
2611bdd66ac0SOr Gerlitz 
2612e88afe75SOr Gerlitz 	if (attr->dest_chain) {
2613e88afe75SOr Gerlitz 		if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
2614e88afe75SOr Gerlitz 			NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported");
2615e88afe75SOr Gerlitz 			return -EOPNOTSUPP;
2616e88afe75SOr Gerlitz 		}
2617e88afe75SOr Gerlitz 		attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
2618e88afe75SOr Gerlitz 	}
2619e88afe75SOr Gerlitz 
2620e85e02baSEli Britstein 	if (attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) {
2621e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2622e98bedf5SEli Britstein 				   "current firmware doesn't support split rule for port mirroring");
2623592d3651SChris Mi 		netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n");
2624592d3651SChris Mi 		return -EOPNOTSUPP;
2625592d3651SChris Mi 	}
2626592d3651SChris Mi 
262731c8eba5SOr Gerlitz 	return 0;
262803a9d11eSOr Gerlitz }
262903a9d11eSOr Gerlitz 
26305dbe906fSPaul Blakey static void get_flags(int flags, u16 *flow_flags)
263160bd4af8SOr Gerlitz {
26325dbe906fSPaul Blakey 	u16 __flow_flags = 0;
263360bd4af8SOr Gerlitz 
263460bd4af8SOr Gerlitz 	if (flags & MLX5E_TC_INGRESS)
263560bd4af8SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_INGRESS;
263660bd4af8SOr Gerlitz 	if (flags & MLX5E_TC_EGRESS)
263760bd4af8SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_EGRESS;
263860bd4af8SOr Gerlitz 
2639d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_ESW_OFFLOAD)
2640d9ee0491SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_ESWITCH;
2641d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_NIC_OFFLOAD)
2642d9ee0491SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_NIC;
2643d9ee0491SOr Gerlitz 
264460bd4af8SOr Gerlitz 	*flow_flags = __flow_flags;
264560bd4af8SOr Gerlitz }
264660bd4af8SOr Gerlitz 
264705866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = {
264805866c82SOr Gerlitz 	.head_offset = offsetof(struct mlx5e_tc_flow, node),
264905866c82SOr Gerlitz 	.key_offset = offsetof(struct mlx5e_tc_flow, cookie),
265005866c82SOr Gerlitz 	.key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie),
265105866c82SOr Gerlitz 	.automatic_shrinking = true,
265205866c82SOr Gerlitz };
265305866c82SOr Gerlitz 
2654d9ee0491SOr Gerlitz static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv, int flags)
265505866c82SOr Gerlitz {
2656655dc3d2SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2657655dc3d2SOr Gerlitz 	struct mlx5e_rep_priv *uplink_rpriv;
2658655dc3d2SOr Gerlitz 
2659d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_ESW_OFFLOAD) {
2660655dc3d2SOr Gerlitz 		uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
2661ec1366c2SOz Shlomo 		return &uplink_rpriv->uplink_priv.tc_ht;
2662d9ee0491SOr Gerlitz 	} else /* NIC offload */
266305866c82SOr Gerlitz 		return &priv->fs.tc.ht;
266405866c82SOr Gerlitz }
266505866c82SOr Gerlitz 
266604de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow)
266704de7ddaSRoi Dayan {
26681418ddd9SAviv Heller 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
26691418ddd9SAviv Heller 	bool is_rep_ingress = attr->in_rep->vport != FDB_UPLINK_VPORT &&
26701418ddd9SAviv Heller 			      flow->flags & MLX5E_TC_FLOW_INGRESS;
26711418ddd9SAviv Heller 	bool act_is_encap = !!(attr->action &
26721418ddd9SAviv Heller 			       MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT);
26731418ddd9SAviv Heller 	bool esw_paired = mlx5_devcom_is_paired(attr->in_mdev->priv.devcom,
26741418ddd9SAviv Heller 						MLX5_DEVCOM_ESW_OFFLOADS);
26751418ddd9SAviv Heller 
26767c34ec19SAviv Heller 	return esw_paired && mlx5_lag_is_sriov(attr->in_mdev) &&
26771418ddd9SAviv Heller 	       (is_rep_ingress || act_is_encap);
267804de7ddaSRoi Dayan }
267904de7ddaSRoi Dayan 
2680a88780a9SRoi Dayan static int
2681a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size,
26825dbe906fSPaul Blakey 		 struct tc_cls_flower_offload *f, u16 flow_flags,
2683a88780a9SRoi Dayan 		 struct mlx5e_tc_flow_parse_attr **__parse_attr,
2684a88780a9SRoi Dayan 		 struct mlx5e_tc_flow **__flow)
2685e3a2b7edSAmir Vadai {
268617091853SOr Gerlitz 	struct mlx5e_tc_flow_parse_attr *parse_attr;
26873bc4b7bfSOr Gerlitz 	struct mlx5e_tc_flow *flow;
2688a88780a9SRoi Dayan 	int err;
2689776b12b6SOr Gerlitz 
269065ba8fb7SOr Gerlitz 	flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL);
26911b9a07eeSLeon Romanovsky 	parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL);
269217091853SOr Gerlitz 	if (!parse_attr || !flow) {
2693e3a2b7edSAmir Vadai 		err = -ENOMEM;
2694e3a2b7edSAmir Vadai 		goto err_free;
2695e3a2b7edSAmir Vadai 	}
2696e3a2b7edSAmir Vadai 
2697e3a2b7edSAmir Vadai 	flow->cookie = f->cookie;
269865ba8fb7SOr Gerlitz 	flow->flags = flow_flags;
2699655dc3d2SOr Gerlitz 	flow->priv = priv;
2700e3a2b7edSAmir Vadai 
2701a88780a9SRoi Dayan 	*__flow = flow;
2702a88780a9SRoi Dayan 	*__parse_attr = parse_attr;
2703a88780a9SRoi Dayan 
2704a88780a9SRoi Dayan 	return 0;
2705a88780a9SRoi Dayan 
2706a88780a9SRoi Dayan err_free:
2707a88780a9SRoi Dayan 	kfree(flow);
2708a88780a9SRoi Dayan 	kvfree(parse_attr);
2709a88780a9SRoi Dayan 	return err;
2710adb4c123SOr Gerlitz }
2711adb4c123SOr Gerlitz 
271271129676SJason Gunthorpe static struct mlx5e_tc_flow *
271304de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
2714a88780a9SRoi Dayan 		     struct tc_cls_flower_offload *f,
27155dbe906fSPaul Blakey 		     u16 flow_flags,
2716d11afc26SOz Shlomo 		     struct net_device *filter_dev,
271704de7ddaSRoi Dayan 		     struct mlx5_eswitch_rep *in_rep,
271871129676SJason Gunthorpe 		     struct mlx5_core_dev *in_mdev)
2719a88780a9SRoi Dayan {
2720a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
2721f9392795SShahar Klein 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2722a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2723a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
2724a88780a9SRoi Dayan 	int attr_size, err;
2725a88780a9SRoi Dayan 
2726a88780a9SRoi Dayan 	flow_flags |= MLX5E_TC_FLOW_ESWITCH;
2727a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_esw_flow_attr);
2728a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
2729a88780a9SRoi Dayan 			       &parse_attr, &flow);
2730a88780a9SRoi Dayan 	if (err)
2731a88780a9SRoi Dayan 		goto out;
2732d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
2733d11afc26SOz Shlomo 	flow->esw_attr->parse_attr = parse_attr;
273454c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
273554c177caSOz Shlomo 			       f, filter_dev);
2736d11afc26SOz Shlomo 	if (err)
2737d11afc26SOz Shlomo 		goto err_free;
2738a88780a9SRoi Dayan 
2739bf07aa73SPaul Blakey 	flow->esw_attr->chain = f->common.chain_index;
2740bf07aa73SPaul Blakey 	flow->esw_attr->prio = TC_H_MAJ(f->common.prio) >> 16;
2741a88780a9SRoi Dayan 	err = parse_tc_fdb_actions(priv, f->exts, parse_attr, flow, extack);
2742a88780a9SRoi Dayan 	if (err)
2743a88780a9SRoi Dayan 		goto err_free;
2744a88780a9SRoi Dayan 
274504de7ddaSRoi Dayan 	flow->esw_attr->in_rep = in_rep;
274604de7ddaSRoi Dayan 	flow->esw_attr->in_mdev = in_mdev;
2747f9392795SShahar Klein 
2748f9392795SShahar Klein 	if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) ==
2749f9392795SShahar Klein 	    MLX5_COUNTER_SOURCE_ESWITCH)
2750f9392795SShahar Klein 		flow->esw_attr->counter_dev = in_mdev;
2751f9392795SShahar Klein 	else
2752f9392795SShahar Klein 		flow->esw_attr->counter_dev = priv->mdev;
2753f9392795SShahar Klein 
2754a88780a9SRoi Dayan 	err = mlx5e_tc_add_fdb_flow(priv, parse_attr, flow, extack);
27555dbe906fSPaul Blakey 	if (err)
2756aa0cbbaeSOr Gerlitz 		goto err_free;
27575c40348cSOr Gerlitz 
275871129676SJason Gunthorpe 	return flow;
2759e3a2b7edSAmir Vadai 
2760e3a2b7edSAmir Vadai err_free:
2761232c0013SHadar Hen Zion 	kfree(flow);
2762a88780a9SRoi Dayan 	kvfree(parse_attr);
2763a88780a9SRoi Dayan out:
276471129676SJason Gunthorpe 	return ERR_PTR(err);
2765a88780a9SRoi Dayan }
2766a88780a9SRoi Dayan 
276704de7ddaSRoi Dayan static int mlx5e_tc_add_fdb_peer_flow(struct tc_cls_flower_offload *f,
276804de7ddaSRoi Dayan 				      struct mlx5e_tc_flow *flow)
276904de7ddaSRoi Dayan {
277004de7ddaSRoi Dayan 	struct mlx5e_priv *priv = flow->priv, *peer_priv;
277104de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw;
277204de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
277304de7ddaSRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
277404de7ddaSRoi Dayan 	struct mlx5e_rep_priv *peer_urpriv;
277504de7ddaSRoi Dayan 	struct mlx5e_tc_flow *peer_flow;
277604de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev;
277704de7ddaSRoi Dayan 	int err = 0;
277804de7ddaSRoi Dayan 
277904de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
278004de7ddaSRoi Dayan 	if (!peer_esw)
278104de7ddaSRoi Dayan 		return -ENODEV;
278204de7ddaSRoi Dayan 
278304de7ddaSRoi Dayan 	peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH);
278404de7ddaSRoi Dayan 	peer_priv = netdev_priv(peer_urpriv->netdev);
278504de7ddaSRoi Dayan 
278604de7ddaSRoi Dayan 	/* in_mdev is assigned of which the packet originated from.
278704de7ddaSRoi Dayan 	 * So packets redirected to uplink use the same mdev of the
278804de7ddaSRoi Dayan 	 * original flow and packets redirected from uplink use the
278904de7ddaSRoi Dayan 	 * peer mdev.
279004de7ddaSRoi Dayan 	 */
279104de7ddaSRoi Dayan 	if (flow->esw_attr->in_rep->vport == FDB_UPLINK_VPORT)
279204de7ddaSRoi Dayan 		in_mdev = peer_priv->mdev;
279304de7ddaSRoi Dayan 	else
279404de7ddaSRoi Dayan 		in_mdev = priv->mdev;
279504de7ddaSRoi Dayan 
279604de7ddaSRoi Dayan 	parse_attr = flow->esw_attr->parse_attr;
279771129676SJason Gunthorpe 	peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow->flags,
279804de7ddaSRoi Dayan 					 parse_attr->filter_dev,
279971129676SJason Gunthorpe 					 flow->esw_attr->in_rep, in_mdev);
280071129676SJason Gunthorpe 	if (IS_ERR(peer_flow)) {
280171129676SJason Gunthorpe 		err = PTR_ERR(peer_flow);
280204de7ddaSRoi Dayan 		goto out;
280371129676SJason Gunthorpe 	}
280404de7ddaSRoi Dayan 
280504de7ddaSRoi Dayan 	flow->peer_flow = peer_flow;
280604de7ddaSRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_DUP;
280704de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
280804de7ddaSRoi Dayan 	list_add_tail(&flow->peer, &esw->offloads.peer_flows);
280904de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
281004de7ddaSRoi Dayan 
281104de7ddaSRoi Dayan out:
281204de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
281304de7ddaSRoi Dayan 	return err;
281404de7ddaSRoi Dayan }
281504de7ddaSRoi Dayan 
281604de7ddaSRoi Dayan static int
281704de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
281804de7ddaSRoi Dayan 		   struct tc_cls_flower_offload *f,
281904de7ddaSRoi Dayan 		   u16 flow_flags,
282004de7ddaSRoi Dayan 		   struct net_device *filter_dev,
282104de7ddaSRoi Dayan 		   struct mlx5e_tc_flow **__flow)
282204de7ddaSRoi Dayan {
282304de7ddaSRoi Dayan 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
282404de7ddaSRoi Dayan 	struct mlx5_eswitch_rep *in_rep = rpriv->rep;
282504de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev = priv->mdev;
282604de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow;
282704de7ddaSRoi Dayan 	int err;
282804de7ddaSRoi Dayan 
282971129676SJason Gunthorpe 	flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep,
283071129676SJason Gunthorpe 				    in_mdev);
283171129676SJason Gunthorpe 	if (IS_ERR(flow))
283271129676SJason Gunthorpe 		return PTR_ERR(flow);
283304de7ddaSRoi Dayan 
283404de7ddaSRoi Dayan 	if (is_peer_flow_needed(flow)) {
283504de7ddaSRoi Dayan 		err = mlx5e_tc_add_fdb_peer_flow(f, flow);
283604de7ddaSRoi Dayan 		if (err) {
283704de7ddaSRoi Dayan 			mlx5e_tc_del_fdb_flow(priv, flow);
283804de7ddaSRoi Dayan 			goto out;
283904de7ddaSRoi Dayan 		}
284004de7ddaSRoi Dayan 	}
284104de7ddaSRoi Dayan 
284204de7ddaSRoi Dayan 	*__flow = flow;
284304de7ddaSRoi Dayan 
284404de7ddaSRoi Dayan 	return 0;
284504de7ddaSRoi Dayan 
284604de7ddaSRoi Dayan out:
284704de7ddaSRoi Dayan 	return err;
284804de7ddaSRoi Dayan }
284904de7ddaSRoi Dayan 
2850a88780a9SRoi Dayan static int
2851a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv,
2852a88780a9SRoi Dayan 		   struct tc_cls_flower_offload *f,
28535dbe906fSPaul Blakey 		   u16 flow_flags,
2854d11afc26SOz Shlomo 		   struct net_device *filter_dev,
2855a88780a9SRoi Dayan 		   struct mlx5e_tc_flow **__flow)
2856a88780a9SRoi Dayan {
2857a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
2858a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2859a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
2860a88780a9SRoi Dayan 	int attr_size, err;
2861a88780a9SRoi Dayan 
2862bf07aa73SPaul Blakey 	/* multi-chain not supported for NIC rules */
2863bf07aa73SPaul Blakey 	if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common))
2864bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
2865bf07aa73SPaul Blakey 
2866a88780a9SRoi Dayan 	flow_flags |= MLX5E_TC_FLOW_NIC;
2867a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_nic_flow_attr);
2868a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
2869a88780a9SRoi Dayan 			       &parse_attr, &flow);
2870a88780a9SRoi Dayan 	if (err)
2871a88780a9SRoi Dayan 		goto out;
2872a88780a9SRoi Dayan 
2873d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
287454c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
287554c177caSOz Shlomo 			       f, filter_dev);
2876d11afc26SOz Shlomo 	if (err)
2877d11afc26SOz Shlomo 		goto err_free;
2878d11afc26SOz Shlomo 
2879a88780a9SRoi Dayan 	err = parse_tc_nic_actions(priv, f->exts, parse_attr, flow, extack);
2880a88780a9SRoi Dayan 	if (err)
2881a88780a9SRoi Dayan 		goto err_free;
2882a88780a9SRoi Dayan 
2883a88780a9SRoi Dayan 	err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack);
2884a88780a9SRoi Dayan 	if (err)
2885a88780a9SRoi Dayan 		goto err_free;
2886a88780a9SRoi Dayan 
2887a88780a9SRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_OFFLOADED;
2888a88780a9SRoi Dayan 	kvfree(parse_attr);
2889a88780a9SRoi Dayan 	*__flow = flow;
2890a88780a9SRoi Dayan 
2891a88780a9SRoi Dayan 	return 0;
2892a88780a9SRoi Dayan 
2893a88780a9SRoi Dayan err_free:
2894a88780a9SRoi Dayan 	kfree(flow);
2895a88780a9SRoi Dayan 	kvfree(parse_attr);
2896a88780a9SRoi Dayan out:
2897a88780a9SRoi Dayan 	return err;
2898a88780a9SRoi Dayan }
2899a88780a9SRoi Dayan 
2900a88780a9SRoi Dayan static int
2901a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv,
2902a88780a9SRoi Dayan 		  struct tc_cls_flower_offload *f,
2903a88780a9SRoi Dayan 		  int flags,
2904d11afc26SOz Shlomo 		  struct net_device *filter_dev,
2905a88780a9SRoi Dayan 		  struct mlx5e_tc_flow **flow)
2906a88780a9SRoi Dayan {
2907a88780a9SRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
29085dbe906fSPaul Blakey 	u16 flow_flags;
2909a88780a9SRoi Dayan 	int err;
2910a88780a9SRoi Dayan 
2911a88780a9SRoi Dayan 	get_flags(flags, &flow_flags);
2912a88780a9SRoi Dayan 
2913bf07aa73SPaul Blakey 	if (!tc_can_offload_extack(priv->netdev, f->common.extack))
2914bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
2915bf07aa73SPaul Blakey 
2916a88780a9SRoi Dayan 	if (esw && esw->mode == SRIOV_OFFLOADS)
2917d11afc26SOz Shlomo 		err = mlx5e_add_fdb_flow(priv, f, flow_flags,
2918d11afc26SOz Shlomo 					 filter_dev, flow);
2919a88780a9SRoi Dayan 	else
2920d11afc26SOz Shlomo 		err = mlx5e_add_nic_flow(priv, f, flow_flags,
2921d11afc26SOz Shlomo 					 filter_dev, flow);
2922a88780a9SRoi Dayan 
2923a88780a9SRoi Dayan 	return err;
2924a88780a9SRoi Dayan }
2925a88780a9SRoi Dayan 
292671d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv,
2927a88780a9SRoi Dayan 			   struct tc_cls_flower_offload *f, int flags)
2928a88780a9SRoi Dayan {
2929a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
2930d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
2931a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
2932a88780a9SRoi Dayan 	int err = 0;
2933a88780a9SRoi Dayan 
2934a88780a9SRoi Dayan 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
2935a88780a9SRoi Dayan 	if (flow) {
2936a88780a9SRoi Dayan 		NL_SET_ERR_MSG_MOD(extack,
2937a88780a9SRoi Dayan 				   "flow cookie already exists, ignoring");
2938a88780a9SRoi Dayan 		netdev_warn_once(priv->netdev,
2939a88780a9SRoi Dayan 				 "flow cookie %lx already exists, ignoring\n",
2940a88780a9SRoi Dayan 				 f->cookie);
2941a88780a9SRoi Dayan 		goto out;
2942a88780a9SRoi Dayan 	}
2943a88780a9SRoi Dayan 
2944d11afc26SOz Shlomo 	err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow);
2945a88780a9SRoi Dayan 	if (err)
2946a88780a9SRoi Dayan 		goto out;
2947a88780a9SRoi Dayan 
2948a88780a9SRoi Dayan 	err = rhashtable_insert_fast(tc_ht, &flow->node, tc_ht_params);
2949a88780a9SRoi Dayan 	if (err)
2950a88780a9SRoi Dayan 		goto err_free;
2951a88780a9SRoi Dayan 
2952a88780a9SRoi Dayan 	return 0;
2953a88780a9SRoi Dayan 
2954a88780a9SRoi Dayan err_free:
2955a88780a9SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
2956a88780a9SRoi Dayan 	kfree(flow);
2957a88780a9SRoi Dayan out:
2958e3a2b7edSAmir Vadai 	return err;
2959e3a2b7edSAmir Vadai }
2960e3a2b7edSAmir Vadai 
29618f8ae895SOr Gerlitz #define DIRECTION_MASK (MLX5E_TC_INGRESS | MLX5E_TC_EGRESS)
29628f8ae895SOr Gerlitz #define FLOW_DIRECTION_MASK (MLX5E_TC_FLOW_INGRESS | MLX5E_TC_FLOW_EGRESS)
29638f8ae895SOr Gerlitz 
29648f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags)
29658f8ae895SOr Gerlitz {
29668f8ae895SOr Gerlitz 	if ((flow->flags & FLOW_DIRECTION_MASK) == (flags & DIRECTION_MASK))
29678f8ae895SOr Gerlitz 		return true;
29688f8ae895SOr Gerlitz 
29698f8ae895SOr Gerlitz 	return false;
29708f8ae895SOr Gerlitz }
29718f8ae895SOr Gerlitz 
297271d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv,
297360bd4af8SOr Gerlitz 			struct tc_cls_flower_offload *f, int flags)
2974e3a2b7edSAmir Vadai {
2975d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
2976e3a2b7edSAmir Vadai 	struct mlx5e_tc_flow *flow;
2977e3a2b7edSAmir Vadai 
297805866c82SOr Gerlitz 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
29798f8ae895SOr Gerlitz 	if (!flow || !same_flow_direction(flow, flags))
2980e3a2b7edSAmir Vadai 		return -EINVAL;
2981e3a2b7edSAmir Vadai 
298205866c82SOr Gerlitz 	rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params);
2983e3a2b7edSAmir Vadai 
2984961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
2985e3a2b7edSAmir Vadai 
2986e3a2b7edSAmir Vadai 	kfree(flow);
2987e3a2b7edSAmir Vadai 
2988e3a2b7edSAmir Vadai 	return 0;
2989e3a2b7edSAmir Vadai }
2990e3a2b7edSAmir Vadai 
299171d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv,
299260bd4af8SOr Gerlitz 		       struct tc_cls_flower_offload *f, int flags)
2993aad7e08dSAmir Vadai {
299404de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
2995d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
299604de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
2997aad7e08dSAmir Vadai 	struct mlx5e_tc_flow *flow;
2998aad7e08dSAmir Vadai 	struct mlx5_fc *counter;
2999aad7e08dSAmir Vadai 	u64 bytes;
3000aad7e08dSAmir Vadai 	u64 packets;
3001aad7e08dSAmir Vadai 	u64 lastuse;
3002aad7e08dSAmir Vadai 
300305866c82SOr Gerlitz 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
30048f8ae895SOr Gerlitz 	if (!flow || !same_flow_direction(flow, flags))
3005aad7e08dSAmir Vadai 		return -EINVAL;
3006aad7e08dSAmir Vadai 
30070b67a38fSHadar Hen Zion 	if (!(flow->flags & MLX5E_TC_FLOW_OFFLOADED))
30080b67a38fSHadar Hen Zion 		return 0;
30090b67a38fSHadar Hen Zion 
3010b8aee822SMark Bloch 	counter = mlx5e_tc_get_counter(flow);
3011aad7e08dSAmir Vadai 	if (!counter)
3012aad7e08dSAmir Vadai 		return 0;
3013aad7e08dSAmir Vadai 
3014aad7e08dSAmir Vadai 	mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
3015aad7e08dSAmir Vadai 
301604de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
301704de7ddaSRoi Dayan 	if (!peer_esw)
301804de7ddaSRoi Dayan 		goto out;
301904de7ddaSRoi Dayan 
302004de7ddaSRoi Dayan 	if ((flow->flags & MLX5E_TC_FLOW_DUP) &&
302104de7ddaSRoi Dayan 	    (flow->peer_flow->flags & MLX5E_TC_FLOW_OFFLOADED)) {
302204de7ddaSRoi Dayan 		u64 bytes2;
302304de7ddaSRoi Dayan 		u64 packets2;
302404de7ddaSRoi Dayan 		u64 lastuse2;
302504de7ddaSRoi Dayan 
302604de7ddaSRoi Dayan 		counter = mlx5e_tc_get_counter(flow->peer_flow);
302704de7ddaSRoi Dayan 		mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2);
302804de7ddaSRoi Dayan 
302904de7ddaSRoi Dayan 		bytes += bytes2;
303004de7ddaSRoi Dayan 		packets += packets2;
303104de7ddaSRoi Dayan 		lastuse = max_t(u64, lastuse, lastuse2);
303204de7ddaSRoi Dayan 	}
303304de7ddaSRoi Dayan 
303404de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
303504de7ddaSRoi Dayan 
303604de7ddaSRoi Dayan out:
3037d897a638SJakub Kicinski 	tcf_exts_stats_update(f->exts, bytes, packets, lastuse);
3038fed06ee8SOr Gerlitz 
3039aad7e08dSAmir Vadai 	return 0;
3040aad7e08dSAmir Vadai }
3041aad7e08dSAmir Vadai 
30424d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv,
30434d8fcf21SAlaa Hleihel 					      struct mlx5e_priv *peer_priv)
30444d8fcf21SAlaa Hleihel {
30454d8fcf21SAlaa Hleihel 	struct mlx5_core_dev *peer_mdev = peer_priv->mdev;
30464d8fcf21SAlaa Hleihel 	struct mlx5e_hairpin_entry *hpe;
30474d8fcf21SAlaa Hleihel 	u16 peer_vhca_id;
30484d8fcf21SAlaa Hleihel 	int bkt;
30494d8fcf21SAlaa Hleihel 
30504d8fcf21SAlaa Hleihel 	if (!same_hw_devs(priv, peer_priv))
30514d8fcf21SAlaa Hleihel 		return;
30524d8fcf21SAlaa Hleihel 
30534d8fcf21SAlaa Hleihel 	peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
30544d8fcf21SAlaa Hleihel 
30554d8fcf21SAlaa Hleihel 	hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) {
30564d8fcf21SAlaa Hleihel 		if (hpe->peer_vhca_id == peer_vhca_id)
30574d8fcf21SAlaa Hleihel 			hpe->hp->pair->peer_gone = true;
30584d8fcf21SAlaa Hleihel 	}
30594d8fcf21SAlaa Hleihel }
30604d8fcf21SAlaa Hleihel 
30614d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this,
30624d8fcf21SAlaa Hleihel 				 unsigned long event, void *ptr)
30634d8fcf21SAlaa Hleihel {
30644d8fcf21SAlaa Hleihel 	struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
30654d8fcf21SAlaa Hleihel 	struct mlx5e_flow_steering *fs;
30664d8fcf21SAlaa Hleihel 	struct mlx5e_priv *peer_priv;
30674d8fcf21SAlaa Hleihel 	struct mlx5e_tc_table *tc;
30684d8fcf21SAlaa Hleihel 	struct mlx5e_priv *priv;
30694d8fcf21SAlaa Hleihel 
30704d8fcf21SAlaa Hleihel 	if (ndev->netdev_ops != &mlx5e_netdev_ops ||
30714d8fcf21SAlaa Hleihel 	    event != NETDEV_UNREGISTER ||
30724d8fcf21SAlaa Hleihel 	    ndev->reg_state == NETREG_REGISTERED)
30734d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
30744d8fcf21SAlaa Hleihel 
30754d8fcf21SAlaa Hleihel 	tc = container_of(this, struct mlx5e_tc_table, netdevice_nb);
30764d8fcf21SAlaa Hleihel 	fs = container_of(tc, struct mlx5e_flow_steering, tc);
30774d8fcf21SAlaa Hleihel 	priv = container_of(fs, struct mlx5e_priv, fs);
30784d8fcf21SAlaa Hleihel 	peer_priv = netdev_priv(ndev);
30794d8fcf21SAlaa Hleihel 	if (priv == peer_priv ||
30804d8fcf21SAlaa Hleihel 	    !(priv->netdev->features & NETIF_F_HW_TC))
30814d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
30824d8fcf21SAlaa Hleihel 
30834d8fcf21SAlaa Hleihel 	mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv);
30844d8fcf21SAlaa Hleihel 
30854d8fcf21SAlaa Hleihel 	return NOTIFY_DONE;
30864d8fcf21SAlaa Hleihel }
30874d8fcf21SAlaa Hleihel 
3088655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv)
3089e8f887acSAmir Vadai {
3090acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
30914d8fcf21SAlaa Hleihel 	int err;
3092e8f887acSAmir Vadai 
309311c9c548SOr Gerlitz 	hash_init(tc->mod_hdr_tbl);
30945c65c564SOr Gerlitz 	hash_init(tc->hairpin_tbl);
309511c9c548SOr Gerlitz 
30964d8fcf21SAlaa Hleihel 	err = rhashtable_init(&tc->ht, &tc_ht_params);
30974d8fcf21SAlaa Hleihel 	if (err)
30984d8fcf21SAlaa Hleihel 		return err;
30994d8fcf21SAlaa Hleihel 
31004d8fcf21SAlaa Hleihel 	tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event;
31014d8fcf21SAlaa Hleihel 	if (register_netdevice_notifier(&tc->netdevice_nb)) {
31024d8fcf21SAlaa Hleihel 		tc->netdevice_nb.notifier_call = NULL;
31034d8fcf21SAlaa Hleihel 		mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n");
31044d8fcf21SAlaa Hleihel 	}
31054d8fcf21SAlaa Hleihel 
31064d8fcf21SAlaa Hleihel 	return err;
3107e8f887acSAmir Vadai }
3108e8f887acSAmir Vadai 
3109e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg)
3110e8f887acSAmir Vadai {
3111e8f887acSAmir Vadai 	struct mlx5e_tc_flow *flow = ptr;
3112655dc3d2SOr Gerlitz 	struct mlx5e_priv *priv = flow->priv;
3113e8f887acSAmir Vadai 
3114961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3115e8f887acSAmir Vadai 	kfree(flow);
3116e8f887acSAmir Vadai }
3117e8f887acSAmir Vadai 
3118655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv)
3119e8f887acSAmir Vadai {
3120acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
3121e8f887acSAmir Vadai 
31224d8fcf21SAlaa Hleihel 	if (tc->netdevice_nb.notifier_call)
31234d8fcf21SAlaa Hleihel 		unregister_netdevice_notifier(&tc->netdevice_nb);
31244d8fcf21SAlaa Hleihel 
3125d9ee0491SOr Gerlitz 	rhashtable_destroy(&tc->ht);
3126e8f887acSAmir Vadai 
3127acff797cSMaor Gottlieb 	if (!IS_ERR_OR_NULL(tc->t)) {
3128acff797cSMaor Gottlieb 		mlx5_destroy_flow_table(tc->t);
3129acff797cSMaor Gottlieb 		tc->t = NULL;
3130e8f887acSAmir Vadai 	}
3131e8f887acSAmir Vadai }
3132655dc3d2SOr Gerlitz 
3133655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht)
3134655dc3d2SOr Gerlitz {
3135655dc3d2SOr Gerlitz 	return rhashtable_init(tc_ht, &tc_ht_params);
3136655dc3d2SOr Gerlitz }
3137655dc3d2SOr Gerlitz 
3138655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht)
3139655dc3d2SOr Gerlitz {
3140655dc3d2SOr Gerlitz 	rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL);
3141655dc3d2SOr Gerlitz }
314201252a27SOr Gerlitz 
3143d9ee0491SOr Gerlitz int mlx5e_tc_num_filters(struct mlx5e_priv *priv, int flags)
314401252a27SOr Gerlitz {
3145d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
314601252a27SOr Gerlitz 
314701252a27SOr Gerlitz 	return atomic_read(&tc_ht->nelems);
314801252a27SOr Gerlitz }
314904de7ddaSRoi Dayan 
315004de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw)
315104de7ddaSRoi Dayan {
315204de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
315304de7ddaSRoi Dayan 
315404de7ddaSRoi Dayan 	list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer)
315504de7ddaSRoi Dayan 		__mlx5e_tc_del_fdb_peer_flow(flow);
315604de7ddaSRoi Dayan }
3157