1e8f887acSAmir Vadai /*
2e8f887acSAmir Vadai  * Copyright (c) 2016, Mellanox Technologies. All rights reserved.
3e8f887acSAmir Vadai  *
4e8f887acSAmir Vadai  * This software is available to you under a choice of one of two
5e8f887acSAmir Vadai  * licenses.  You may choose to be licensed under the terms of the GNU
6e8f887acSAmir Vadai  * General Public License (GPL) Version 2, available from the file
7e8f887acSAmir Vadai  * COPYING in the main directory of this source tree, or the
8e8f887acSAmir Vadai  * OpenIB.org BSD license below:
9e8f887acSAmir Vadai  *
10e8f887acSAmir Vadai  *     Redistribution and use in source and binary forms, with or
11e8f887acSAmir Vadai  *     without modification, are permitted provided that the following
12e8f887acSAmir Vadai  *     conditions are met:
13e8f887acSAmir Vadai  *
14e8f887acSAmir Vadai  *      - Redistributions of source code must retain the above
15e8f887acSAmir Vadai  *        copyright notice, this list of conditions and the following
16e8f887acSAmir Vadai  *        disclaimer.
17e8f887acSAmir Vadai  *
18e8f887acSAmir Vadai  *      - Redistributions in binary form must reproduce the above
19e8f887acSAmir Vadai  *        copyright notice, this list of conditions and the following
20e8f887acSAmir Vadai  *        disclaimer in the documentation and/or other materials
21e8f887acSAmir Vadai  *        provided with the distribution.
22e8f887acSAmir Vadai  *
23e8f887acSAmir Vadai  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24e8f887acSAmir Vadai  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25e8f887acSAmir Vadai  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26e8f887acSAmir Vadai  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27e8f887acSAmir Vadai  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28e8f887acSAmir Vadai  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29e8f887acSAmir Vadai  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30e8f887acSAmir Vadai  * SOFTWARE.
31e8f887acSAmir Vadai  */
32e8f887acSAmir Vadai 
33e3a2b7edSAmir Vadai #include <net/flow_dissector.h>
343f7d0eb4SOr Gerlitz #include <net/sch_generic.h>
35e3a2b7edSAmir Vadai #include <net/pkt_cls.h>
36e3a2b7edSAmir Vadai #include <net/tc_act/tc_gact.h>
3712185a9fSAmir Vadai #include <net/tc_act/tc_skbedit.h>
38e8f887acSAmir Vadai #include <linux/mlx5/fs.h>
39e8f887acSAmir Vadai #include <linux/mlx5/device.h>
40e8f887acSAmir Vadai #include <linux/rhashtable.h>
4103a9d11eSOr Gerlitz #include <net/tc_act/tc_mirred.h>
42776b12b6SOr Gerlitz #include <net/tc_act/tc_vlan.h>
43bbd00f7eSHadar Hen Zion #include <net/tc_act/tc_tunnel_key.h>
44d79b6df6SOr Gerlitz #include <net/tc_act/tc_pedit.h>
4526c02749SOr Gerlitz #include <net/tc_act/tc_csum.h>
46f6dfb4c3SHadar Hen Zion #include <net/arp.h>
47e8f887acSAmir Vadai #include "en.h"
481d447a39SSaeed Mahameed #include "en_rep.h"
49232c0013SHadar Hen Zion #include "en_tc.h"
5003a9d11eSOr Gerlitz #include "eswitch.h"
513f6d08d1SOr Gerlitz #include "fs_core.h"
522c81bfd5SHuy Nguyen #include "en/port.h"
53101f4de9SOz Shlomo #include "en/tc_tun.h"
5404de7ddaSRoi Dayan #include "lib/devcom.h"
55e8f887acSAmir Vadai 
563bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr {
573bc4b7bfSOr Gerlitz 	u32 action;
583bc4b7bfSOr Gerlitz 	u32 flow_tag;
592f4fe4caSOr Gerlitz 	u32 mod_hdr_id;
605c65c564SOr Gerlitz 	u32 hairpin_tirn;
6138aa51c1SOr Gerlitz 	u8 match_level;
623f6d08d1SOr Gerlitz 	struct mlx5_flow_table	*hairpin_ft;
63b8aee822SMark Bloch 	struct mlx5_fc		*counter;
643bc4b7bfSOr Gerlitz };
653bc4b7bfSOr Gerlitz 
6660bd4af8SOr Gerlitz #define MLX5E_TC_FLOW_BASE (MLX5E_TC_LAST_EXPORTED_BIT + 1)
6760bd4af8SOr Gerlitz 
6865ba8fb7SOr Gerlitz enum {
6960bd4af8SOr Gerlitz 	MLX5E_TC_FLOW_INGRESS	= MLX5E_TC_INGRESS,
7060bd4af8SOr Gerlitz 	MLX5E_TC_FLOW_EGRESS	= MLX5E_TC_EGRESS,
71d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_ESWITCH	= MLX5E_TC_ESW_OFFLOAD,
72d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_NIC	= MLX5E_TC_NIC_OFFLOAD,
73d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_OFFLOADED	= BIT(MLX5E_TC_FLOW_BASE),
74d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_HAIRPIN	= BIT(MLX5E_TC_FLOW_BASE + 1),
75d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_HAIRPIN_RSS = BIT(MLX5E_TC_FLOW_BASE + 2),
76d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_SLOW	  = BIT(MLX5E_TC_FLOW_BASE + 3),
77d9ee0491SOr Gerlitz 	MLX5E_TC_FLOW_DUP         = BIT(MLX5E_TC_FLOW_BASE + 4),
78ef06c9eeSRoi Dayan 	MLX5E_TC_FLOW_NOT_READY   = BIT(MLX5E_TC_FLOW_BASE + 5),
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 */
120b4a23329SRoi Dayan 	struct list_head	unready; /* flows not ready to be offloaded (e.g due to missing route) */
1213bc4b7bfSOr Gerlitz 	union {
122ecf5bb79SOr Gerlitz 		struct mlx5_esw_flow_attr esw_attr[0];
1233bc4b7bfSOr Gerlitz 		struct mlx5_nic_flow_attr nic_attr[0];
1243bc4b7bfSOr Gerlitz 	};
125e8f887acSAmir Vadai };
126e8f887acSAmir Vadai 
12717091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr {
12898b66cb1SEli Britstein 	struct ip_tunnel_info tun_info[MLX5_MAX_FLOW_FWD_VPORTS];
129d11afc26SOz Shlomo 	struct net_device *filter_dev;
13017091853SOr Gerlitz 	struct mlx5_flow_spec spec;
131d79b6df6SOr Gerlitz 	int num_mod_hdr_actions;
132218d05ceSTonghao Zhang 	int max_mod_hdr_actions;
133d79b6df6SOr Gerlitz 	void *mod_hdr_actions;
13498b66cb1SEli Britstein 	int mirred_ifindex[MLX5_MAX_FLOW_FWD_VPORTS];
13517091853SOr Gerlitz };
13617091853SOr Gerlitz 
137acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4
138b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16)
139e8f887acSAmir Vadai 
14077ab67b7SOr Gerlitz struct mlx5e_hairpin {
14177ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
14277ab67b7SOr Gerlitz 
14377ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev;
1443f6d08d1SOr Gerlitz 	struct mlx5e_priv *func_priv;
14577ab67b7SOr Gerlitz 	u32 tdn;
14677ab67b7SOr Gerlitz 	u32 tirn;
1473f6d08d1SOr Gerlitz 
1483f6d08d1SOr Gerlitz 	int num_channels;
1493f6d08d1SOr Gerlitz 	struct mlx5e_rqt indir_rqt;
1503f6d08d1SOr Gerlitz 	u32 indir_tirn[MLX5E_NUM_INDIR_TIRS];
1513f6d08d1SOr Gerlitz 	struct mlx5e_ttc_table ttc;
15277ab67b7SOr Gerlitz };
15377ab67b7SOr Gerlitz 
1545c65c564SOr Gerlitz struct mlx5e_hairpin_entry {
1555c65c564SOr Gerlitz 	/* a node of a hash table which keeps all the  hairpin entries */
1565c65c564SOr Gerlitz 	struct hlist_node hairpin_hlist;
1575c65c564SOr Gerlitz 
1585c65c564SOr Gerlitz 	/* flows sharing the same hairpin */
1595c65c564SOr Gerlitz 	struct list_head flows;
1605c65c564SOr Gerlitz 
161d8822868SOr Gerlitz 	u16 peer_vhca_id;
162106be53bSOr Gerlitz 	u8 prio;
1635c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
1645c65c564SOr Gerlitz };
1655c65c564SOr Gerlitz 
16611c9c548SOr Gerlitz struct mod_hdr_key {
16711c9c548SOr Gerlitz 	int num_actions;
16811c9c548SOr Gerlitz 	void *actions;
16911c9c548SOr Gerlitz };
17011c9c548SOr Gerlitz 
17111c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry {
17211c9c548SOr Gerlitz 	/* a node of a hash table which keeps all the mod_hdr entries */
17311c9c548SOr Gerlitz 	struct hlist_node mod_hdr_hlist;
17411c9c548SOr Gerlitz 
17511c9c548SOr Gerlitz 	/* flows sharing the same mod_hdr entry */
17611c9c548SOr Gerlitz 	struct list_head flows;
17711c9c548SOr Gerlitz 
17811c9c548SOr Gerlitz 	struct mod_hdr_key key;
17911c9c548SOr Gerlitz 
18011c9c548SOr Gerlitz 	u32 mod_hdr_id;
18111c9c548SOr Gerlitz };
18211c9c548SOr Gerlitz 
18311c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto)
18411c9c548SOr Gerlitz 
18511c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key)
18611c9c548SOr Gerlitz {
18711c9c548SOr Gerlitz 	return jhash(key->actions,
18811c9c548SOr Gerlitz 		     key->num_actions * MLX5_MH_ACT_SZ, 0);
18911c9c548SOr Gerlitz }
19011c9c548SOr Gerlitz 
19111c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a,
19211c9c548SOr Gerlitz 				   struct mod_hdr_key *b)
19311c9c548SOr Gerlitz {
19411c9c548SOr Gerlitz 	if (a->num_actions != b->num_actions)
19511c9c548SOr Gerlitz 		return 1;
19611c9c548SOr Gerlitz 
19711c9c548SOr Gerlitz 	return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ);
19811c9c548SOr Gerlitz }
19911c9c548SOr Gerlitz 
20011c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv,
20111c9c548SOr Gerlitz 				struct mlx5e_tc_flow *flow,
20211c9c548SOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr)
20311c9c548SOr Gerlitz {
20411c9c548SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
20511c9c548SOr Gerlitz 	int num_actions, actions_size, namespace, err;
20611c9c548SOr Gerlitz 	struct mlx5e_mod_hdr_entry *mh;
20711c9c548SOr Gerlitz 	struct mod_hdr_key key;
20811c9c548SOr Gerlitz 	bool found = false;
20911c9c548SOr Gerlitz 	u32 hash_key;
21011c9c548SOr Gerlitz 
21111c9c548SOr Gerlitz 	num_actions  = parse_attr->num_mod_hdr_actions;
21211c9c548SOr Gerlitz 	actions_size = MLX5_MH_ACT_SZ * num_actions;
21311c9c548SOr Gerlitz 
21411c9c548SOr Gerlitz 	key.actions = parse_attr->mod_hdr_actions;
21511c9c548SOr Gerlitz 	key.num_actions = num_actions;
21611c9c548SOr Gerlitz 
21711c9c548SOr Gerlitz 	hash_key = hash_mod_hdr_info(&key);
21811c9c548SOr Gerlitz 
21911c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
22011c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_FDB;
22111c9c548SOr Gerlitz 		hash_for_each_possible(esw->offloads.mod_hdr_tbl, mh,
22211c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
22311c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
22411c9c548SOr Gerlitz 				found = true;
22511c9c548SOr Gerlitz 				break;
22611c9c548SOr Gerlitz 			}
22711c9c548SOr Gerlitz 		}
22811c9c548SOr Gerlitz 	} else {
22911c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_KERNEL;
23011c9c548SOr Gerlitz 		hash_for_each_possible(priv->fs.tc.mod_hdr_tbl, mh,
23111c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
23211c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
23311c9c548SOr Gerlitz 				found = true;
23411c9c548SOr Gerlitz 				break;
23511c9c548SOr Gerlitz 			}
23611c9c548SOr Gerlitz 		}
23711c9c548SOr Gerlitz 	}
23811c9c548SOr Gerlitz 
23911c9c548SOr Gerlitz 	if (found)
24011c9c548SOr Gerlitz 		goto attach_flow;
24111c9c548SOr Gerlitz 
24211c9c548SOr Gerlitz 	mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL);
24311c9c548SOr Gerlitz 	if (!mh)
24411c9c548SOr Gerlitz 		return -ENOMEM;
24511c9c548SOr Gerlitz 
24611c9c548SOr Gerlitz 	mh->key.actions = (void *)mh + sizeof(*mh);
24711c9c548SOr Gerlitz 	memcpy(mh->key.actions, key.actions, actions_size);
24811c9c548SOr Gerlitz 	mh->key.num_actions = num_actions;
24911c9c548SOr Gerlitz 	INIT_LIST_HEAD(&mh->flows);
25011c9c548SOr Gerlitz 
25111c9c548SOr Gerlitz 	err = mlx5_modify_header_alloc(priv->mdev, namespace,
25211c9c548SOr Gerlitz 				       mh->key.num_actions,
25311c9c548SOr Gerlitz 				       mh->key.actions,
25411c9c548SOr Gerlitz 				       &mh->mod_hdr_id);
25511c9c548SOr Gerlitz 	if (err)
25611c9c548SOr Gerlitz 		goto out_err;
25711c9c548SOr Gerlitz 
25811c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
25911c9c548SOr Gerlitz 		hash_add(esw->offloads.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
26011c9c548SOr Gerlitz 	else
26111c9c548SOr Gerlitz 		hash_add(priv->fs.tc.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
26211c9c548SOr Gerlitz 
26311c9c548SOr Gerlitz attach_flow:
26411c9c548SOr Gerlitz 	list_add(&flow->mod_hdr, &mh->flows);
26511c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
26611c9c548SOr Gerlitz 		flow->esw_attr->mod_hdr_id = mh->mod_hdr_id;
26711c9c548SOr Gerlitz 	else
26811c9c548SOr Gerlitz 		flow->nic_attr->mod_hdr_id = mh->mod_hdr_id;
26911c9c548SOr Gerlitz 
27011c9c548SOr Gerlitz 	return 0;
27111c9c548SOr Gerlitz 
27211c9c548SOr Gerlitz out_err:
27311c9c548SOr Gerlitz 	kfree(mh);
27411c9c548SOr Gerlitz 	return err;
27511c9c548SOr Gerlitz }
27611c9c548SOr Gerlitz 
27711c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv,
27811c9c548SOr Gerlitz 				 struct mlx5e_tc_flow *flow)
27911c9c548SOr Gerlitz {
28011c9c548SOr Gerlitz 	struct list_head *next = flow->mod_hdr.next;
28111c9c548SOr Gerlitz 
28211c9c548SOr Gerlitz 	list_del(&flow->mod_hdr);
28311c9c548SOr Gerlitz 
28411c9c548SOr Gerlitz 	if (list_empty(next)) {
28511c9c548SOr Gerlitz 		struct mlx5e_mod_hdr_entry *mh;
28611c9c548SOr Gerlitz 
28711c9c548SOr Gerlitz 		mh = list_entry(next, struct mlx5e_mod_hdr_entry, flows);
28811c9c548SOr Gerlitz 
28911c9c548SOr Gerlitz 		mlx5_modify_header_dealloc(priv->mdev, mh->mod_hdr_id);
29011c9c548SOr Gerlitz 		hash_del(&mh->mod_hdr_hlist);
29111c9c548SOr Gerlitz 		kfree(mh);
29211c9c548SOr Gerlitz 	}
29311c9c548SOr Gerlitz }
29411c9c548SOr Gerlitz 
29577ab67b7SOr Gerlitz static
29677ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex)
29777ab67b7SOr Gerlitz {
29877ab67b7SOr Gerlitz 	struct net_device *netdev;
29977ab67b7SOr Gerlitz 	struct mlx5e_priv *priv;
30077ab67b7SOr Gerlitz 
30177ab67b7SOr Gerlitz 	netdev = __dev_get_by_index(net, ifindex);
30277ab67b7SOr Gerlitz 	priv = netdev_priv(netdev);
30377ab67b7SOr Gerlitz 	return priv->mdev;
30477ab67b7SOr Gerlitz }
30577ab67b7SOr Gerlitz 
30677ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp)
30777ab67b7SOr Gerlitz {
30877ab67b7SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0};
30977ab67b7SOr Gerlitz 	void *tirc;
31077ab67b7SOr Gerlitz 	int err;
31177ab67b7SOr Gerlitz 
31277ab67b7SOr Gerlitz 	err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn);
31377ab67b7SOr Gerlitz 	if (err)
31477ab67b7SOr Gerlitz 		goto alloc_tdn_err;
31577ab67b7SOr Gerlitz 
31677ab67b7SOr Gerlitz 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
31777ab67b7SOr Gerlitz 
31877ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT);
319ddae74acSOr Gerlitz 	MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]);
32077ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
32177ab67b7SOr Gerlitz 
32277ab67b7SOr Gerlitz 	err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn);
32377ab67b7SOr Gerlitz 	if (err)
32477ab67b7SOr Gerlitz 		goto create_tir_err;
32577ab67b7SOr Gerlitz 
32677ab67b7SOr Gerlitz 	return 0;
32777ab67b7SOr Gerlitz 
32877ab67b7SOr Gerlitz create_tir_err:
32977ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
33077ab67b7SOr Gerlitz alloc_tdn_err:
33177ab67b7SOr Gerlitz 	return err;
33277ab67b7SOr Gerlitz }
33377ab67b7SOr Gerlitz 
33477ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp)
33577ab67b7SOr Gerlitz {
33677ab67b7SOr Gerlitz 	mlx5_core_destroy_tir(hp->func_mdev, hp->tirn);
33777ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
33877ab67b7SOr Gerlitz }
33977ab67b7SOr Gerlitz 
3403f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc)
3413f6d08d1SOr Gerlitz {
3423f6d08d1SOr Gerlitz 	u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn;
3433f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3443f6d08d1SOr Gerlitz 	int i, ix, sz = MLX5E_INDIR_RQT_SIZE;
3453f6d08d1SOr Gerlitz 
3463f6d08d1SOr Gerlitz 	mlx5e_build_default_indir_rqt(indirection_rqt, sz,
3473f6d08d1SOr Gerlitz 				      hp->num_channels);
3483f6d08d1SOr Gerlitz 
3493f6d08d1SOr Gerlitz 	for (i = 0; i < sz; i++) {
3503f6d08d1SOr Gerlitz 		ix = i;
351bbeb53b8SAya Levin 		if (priv->rss_params.hfunc == ETH_RSS_HASH_XOR)
3523f6d08d1SOr Gerlitz 			ix = mlx5e_bits_invert(i, ilog2(sz));
3533f6d08d1SOr Gerlitz 		ix = indirection_rqt[ix];
3543f6d08d1SOr Gerlitz 		rqn = hp->pair->rqn[ix];
3553f6d08d1SOr Gerlitz 		MLX5_SET(rqtc, rqtc, rq_num[i], rqn);
3563f6d08d1SOr Gerlitz 	}
3573f6d08d1SOr Gerlitz }
3583f6d08d1SOr Gerlitz 
3593f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp)
3603f6d08d1SOr Gerlitz {
3613f6d08d1SOr Gerlitz 	int inlen, err, sz = MLX5E_INDIR_RQT_SIZE;
3623f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3633f6d08d1SOr Gerlitz 	struct mlx5_core_dev *mdev = priv->mdev;
3643f6d08d1SOr Gerlitz 	void *rqtc;
3653f6d08d1SOr Gerlitz 	u32 *in;
3663f6d08d1SOr Gerlitz 
3673f6d08d1SOr Gerlitz 	inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz;
3683f6d08d1SOr Gerlitz 	in = kvzalloc(inlen, GFP_KERNEL);
3693f6d08d1SOr Gerlitz 	if (!in)
3703f6d08d1SOr Gerlitz 		return -ENOMEM;
3713f6d08d1SOr Gerlitz 
3723f6d08d1SOr Gerlitz 	rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context);
3733f6d08d1SOr Gerlitz 
3743f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_actual_size, sz);
3753f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_max_size, sz);
3763f6d08d1SOr Gerlitz 
3773f6d08d1SOr Gerlitz 	mlx5e_hairpin_fill_rqt_rqns(hp, rqtc);
3783f6d08d1SOr Gerlitz 
3793f6d08d1SOr Gerlitz 	err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn);
3803f6d08d1SOr Gerlitz 	if (!err)
3813f6d08d1SOr Gerlitz 		hp->indir_rqt.enabled = true;
3823f6d08d1SOr Gerlitz 
3833f6d08d1SOr Gerlitz 	kvfree(in);
3843f6d08d1SOr Gerlitz 	return err;
3853f6d08d1SOr Gerlitz }
3863f6d08d1SOr Gerlitz 
3873f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp)
3883f6d08d1SOr Gerlitz {
3893f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3903f6d08d1SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)];
3913f6d08d1SOr Gerlitz 	int tt, i, err;
3923f6d08d1SOr Gerlitz 	void *tirc;
3933f6d08d1SOr Gerlitz 
3943f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) {
395d930ac79SAya Levin 		struct mlx5e_tirc_config ttconfig = mlx5e_tirc_get_default_config(tt);
396d930ac79SAya Levin 
3973f6d08d1SOr Gerlitz 		memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in));
3983f6d08d1SOr Gerlitz 		tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
3993f6d08d1SOr Gerlitz 
4003f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
4013f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT);
4023f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn);
403bbeb53b8SAya Levin 		mlx5e_build_indir_tir_ctx_hash(&priv->rss_params, &ttconfig, tirc, false);
404bbeb53b8SAya Levin 
4053f6d08d1SOr Gerlitz 		err = mlx5_core_create_tir(hp->func_mdev, in,
4063f6d08d1SOr Gerlitz 					   MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]);
4073f6d08d1SOr Gerlitz 		if (err) {
4083f6d08d1SOr Gerlitz 			mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err);
4093f6d08d1SOr Gerlitz 			goto err_destroy_tirs;
4103f6d08d1SOr Gerlitz 		}
4113f6d08d1SOr Gerlitz 	}
4123f6d08d1SOr Gerlitz 	return 0;
4133f6d08d1SOr Gerlitz 
4143f6d08d1SOr Gerlitz err_destroy_tirs:
4153f6d08d1SOr Gerlitz 	for (i = 0; i < tt; i++)
4163f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]);
4173f6d08d1SOr Gerlitz 	return err;
4183f6d08d1SOr Gerlitz }
4193f6d08d1SOr Gerlitz 
4203f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp)
4213f6d08d1SOr Gerlitz {
4223f6d08d1SOr Gerlitz 	int tt;
4233f6d08d1SOr Gerlitz 
4243f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
4253f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]);
4263f6d08d1SOr Gerlitz }
4273f6d08d1SOr Gerlitz 
4283f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp,
4293f6d08d1SOr Gerlitz 					 struct ttc_params *ttc_params)
4303f6d08d1SOr Gerlitz {
4313f6d08d1SOr Gerlitz 	struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
4323f6d08d1SOr Gerlitz 	int tt;
4333f6d08d1SOr Gerlitz 
4343f6d08d1SOr Gerlitz 	memset(ttc_params, 0, sizeof(*ttc_params));
4353f6d08d1SOr Gerlitz 
4363f6d08d1SOr Gerlitz 	ttc_params->any_tt_tirn = hp->tirn;
4373f6d08d1SOr Gerlitz 
4383f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
4393f6d08d1SOr Gerlitz 		ttc_params->indir_tirn[tt] = hp->indir_tirn[tt];
4403f6d08d1SOr Gerlitz 
4413f6d08d1SOr Gerlitz 	ft_attr->max_fte = MLX5E_NUM_TT;
4423f6d08d1SOr Gerlitz 	ft_attr->level = MLX5E_TC_TTC_FT_LEVEL;
4433f6d08d1SOr Gerlitz 	ft_attr->prio = MLX5E_TC_PRIO;
4443f6d08d1SOr Gerlitz }
4453f6d08d1SOr Gerlitz 
4463f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp)
4473f6d08d1SOr Gerlitz {
4483f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4493f6d08d1SOr Gerlitz 	struct ttc_params ttc_params;
4503f6d08d1SOr Gerlitz 	int err;
4513f6d08d1SOr Gerlitz 
4523f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_rqt(hp);
4533f6d08d1SOr Gerlitz 	if (err)
4543f6d08d1SOr Gerlitz 		return err;
4553f6d08d1SOr Gerlitz 
4563f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_tirs(hp);
4573f6d08d1SOr Gerlitz 	if (err)
4583f6d08d1SOr Gerlitz 		goto err_create_indirect_tirs;
4593f6d08d1SOr Gerlitz 
4603f6d08d1SOr Gerlitz 	mlx5e_hairpin_set_ttc_params(hp, &ttc_params);
4613f6d08d1SOr Gerlitz 	err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc);
4623f6d08d1SOr Gerlitz 	if (err)
4633f6d08d1SOr Gerlitz 		goto err_create_ttc_table;
4643f6d08d1SOr Gerlitz 
4653f6d08d1SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n",
4663f6d08d1SOr Gerlitz 		   hp->num_channels, hp->ttc.ft.t->id);
4673f6d08d1SOr Gerlitz 
4683f6d08d1SOr Gerlitz 	return 0;
4693f6d08d1SOr Gerlitz 
4703f6d08d1SOr Gerlitz err_create_ttc_table:
4713f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
4723f6d08d1SOr Gerlitz err_create_indirect_tirs:
4733f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
4743f6d08d1SOr Gerlitz 
4753f6d08d1SOr Gerlitz 	return err;
4763f6d08d1SOr Gerlitz }
4773f6d08d1SOr Gerlitz 
4783f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp)
4793f6d08d1SOr Gerlitz {
4803f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4813f6d08d1SOr Gerlitz 
4823f6d08d1SOr Gerlitz 	mlx5e_destroy_ttc_table(priv, &hp->ttc);
4833f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
4843f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
4853f6d08d1SOr Gerlitz }
4863f6d08d1SOr Gerlitz 
48777ab67b7SOr Gerlitz static struct mlx5e_hairpin *
48877ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params,
48977ab67b7SOr Gerlitz 		     int peer_ifindex)
49077ab67b7SOr Gerlitz {
49177ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev, *peer_mdev;
49277ab67b7SOr Gerlitz 	struct mlx5e_hairpin *hp;
49377ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
49477ab67b7SOr Gerlitz 	int err;
49577ab67b7SOr Gerlitz 
49677ab67b7SOr Gerlitz 	hp = kzalloc(sizeof(*hp), GFP_KERNEL);
49777ab67b7SOr Gerlitz 	if (!hp)
49877ab67b7SOr Gerlitz 		return ERR_PTR(-ENOMEM);
49977ab67b7SOr Gerlitz 
50077ab67b7SOr Gerlitz 	func_mdev = priv->mdev;
50177ab67b7SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
50277ab67b7SOr Gerlitz 
50377ab67b7SOr Gerlitz 	pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params);
50477ab67b7SOr Gerlitz 	if (IS_ERR(pair)) {
50577ab67b7SOr Gerlitz 		err = PTR_ERR(pair);
50677ab67b7SOr Gerlitz 		goto create_pair_err;
50777ab67b7SOr Gerlitz 	}
50877ab67b7SOr Gerlitz 	hp->pair = pair;
50977ab67b7SOr Gerlitz 	hp->func_mdev = func_mdev;
5103f6d08d1SOr Gerlitz 	hp->func_priv = priv;
5113f6d08d1SOr Gerlitz 	hp->num_channels = params->num_channels;
51277ab67b7SOr Gerlitz 
51377ab67b7SOr Gerlitz 	err = mlx5e_hairpin_create_transport(hp);
51477ab67b7SOr Gerlitz 	if (err)
51577ab67b7SOr Gerlitz 		goto create_transport_err;
51677ab67b7SOr Gerlitz 
5173f6d08d1SOr Gerlitz 	if (hp->num_channels > 1) {
5183f6d08d1SOr Gerlitz 		err = mlx5e_hairpin_rss_init(hp);
5193f6d08d1SOr Gerlitz 		if (err)
5203f6d08d1SOr Gerlitz 			goto rss_init_err;
5213f6d08d1SOr Gerlitz 	}
5223f6d08d1SOr Gerlitz 
52377ab67b7SOr Gerlitz 	return hp;
52477ab67b7SOr Gerlitz 
5253f6d08d1SOr Gerlitz rss_init_err:
5263f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
52777ab67b7SOr Gerlitz create_transport_err:
52877ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
52977ab67b7SOr Gerlitz create_pair_err:
53077ab67b7SOr Gerlitz 	kfree(hp);
53177ab67b7SOr Gerlitz 	return ERR_PTR(err);
53277ab67b7SOr Gerlitz }
53377ab67b7SOr Gerlitz 
53477ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp)
53577ab67b7SOr Gerlitz {
5363f6d08d1SOr Gerlitz 	if (hp->num_channels > 1)
5373f6d08d1SOr Gerlitz 		mlx5e_hairpin_rss_cleanup(hp);
53877ab67b7SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
53977ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
54077ab67b7SOr Gerlitz 	kvfree(hp);
54177ab67b7SOr Gerlitz }
54277ab67b7SOr Gerlitz 
543106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio)
544106be53bSOr Gerlitz {
545106be53bSOr Gerlitz 	return (peer_vhca_id << 16 | prio);
546106be53bSOr Gerlitz }
547106be53bSOr Gerlitz 
5485c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv,
549106be53bSOr Gerlitz 						     u16 peer_vhca_id, u8 prio)
5505c65c564SOr Gerlitz {
5515c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
552106be53bSOr Gerlitz 	u32 hash_key = hash_hairpin_info(peer_vhca_id, prio);
5535c65c564SOr Gerlitz 
5545c65c564SOr Gerlitz 	hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe,
555106be53bSOr Gerlitz 			       hairpin_hlist, hash_key) {
556106be53bSOr Gerlitz 		if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio)
5575c65c564SOr Gerlitz 			return hpe;
5585c65c564SOr Gerlitz 	}
5595c65c564SOr Gerlitz 
5605c65c564SOr Gerlitz 	return NULL;
5615c65c564SOr Gerlitz }
5625c65c564SOr Gerlitz 
563106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8
564106be53bSOr Gerlitz 
565106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv,
566e98bedf5SEli Britstein 				  struct mlx5_flow_spec *spec, u8 *match_prio,
567e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
568106be53bSOr Gerlitz {
569106be53bSOr Gerlitz 	void *headers_c, *headers_v;
570106be53bSOr Gerlitz 	u8 prio_val, prio_mask = 0;
571106be53bSOr Gerlitz 	bool vlan_present;
572106be53bSOr Gerlitz 
573106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB
574106be53bSOr Gerlitz 	if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) {
575e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
576e98bedf5SEli Britstein 				   "only PCP trust state supported for hairpin");
577106be53bSOr Gerlitz 		return -EOPNOTSUPP;
578106be53bSOr Gerlitz 	}
579106be53bSOr Gerlitz #endif
580106be53bSOr Gerlitz 	headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers);
581106be53bSOr Gerlitz 	headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
582106be53bSOr Gerlitz 
583106be53bSOr Gerlitz 	vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag);
584106be53bSOr Gerlitz 	if (vlan_present) {
585106be53bSOr Gerlitz 		prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio);
586106be53bSOr Gerlitz 		prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio);
587106be53bSOr Gerlitz 	}
588106be53bSOr Gerlitz 
589106be53bSOr Gerlitz 	if (!vlan_present || !prio_mask) {
590106be53bSOr Gerlitz 		prio_val = UNKNOWN_MATCH_PRIO;
591106be53bSOr Gerlitz 	} else if (prio_mask != 0x7) {
592e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
593e98bedf5SEli Britstein 				   "masked priority match not supported for hairpin");
594106be53bSOr Gerlitz 		return -EOPNOTSUPP;
595106be53bSOr Gerlitz 	}
596106be53bSOr Gerlitz 
597106be53bSOr Gerlitz 	*match_prio = prio_val;
598106be53bSOr Gerlitz 	return 0;
599106be53bSOr Gerlitz }
600106be53bSOr Gerlitz 
6015c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv,
6025c65c564SOr Gerlitz 				  struct mlx5e_tc_flow *flow,
603e98bedf5SEli Britstein 				  struct mlx5e_tc_flow_parse_attr *parse_attr,
604e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
6055c65c564SOr Gerlitz {
60698b66cb1SEli Britstein 	int peer_ifindex = parse_attr->mirred_ifindex[0];
6075c65c564SOr Gerlitz 	struct mlx5_hairpin_params params;
608d8822868SOr Gerlitz 	struct mlx5_core_dev *peer_mdev;
6095c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
6105c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
6113f6d08d1SOr Gerlitz 	u64 link_speed64;
6123f6d08d1SOr Gerlitz 	u32 link_speed;
613106be53bSOr Gerlitz 	u8 match_prio;
614d8822868SOr Gerlitz 	u16 peer_id;
6155c65c564SOr Gerlitz 	int err;
6165c65c564SOr Gerlitz 
617d8822868SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
618d8822868SOr Gerlitz 	if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) {
619e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported");
6205c65c564SOr Gerlitz 		return -EOPNOTSUPP;
6215c65c564SOr Gerlitz 	}
6225c65c564SOr Gerlitz 
623d8822868SOr Gerlitz 	peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
624e98bedf5SEli Britstein 	err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio,
625e98bedf5SEli Britstein 				     extack);
626106be53bSOr Gerlitz 	if (err)
627106be53bSOr Gerlitz 		return err;
628106be53bSOr Gerlitz 	hpe = mlx5e_hairpin_get(priv, peer_id, match_prio);
6295c65c564SOr Gerlitz 	if (hpe)
6305c65c564SOr Gerlitz 		goto attach_flow;
6315c65c564SOr Gerlitz 
6325c65c564SOr Gerlitz 	hpe = kzalloc(sizeof(*hpe), GFP_KERNEL);
6335c65c564SOr Gerlitz 	if (!hpe)
6345c65c564SOr Gerlitz 		return -ENOMEM;
6355c65c564SOr Gerlitz 
6365c65c564SOr Gerlitz 	INIT_LIST_HEAD(&hpe->flows);
637d8822868SOr Gerlitz 	hpe->peer_vhca_id = peer_id;
638106be53bSOr Gerlitz 	hpe->prio = match_prio;
6395c65c564SOr Gerlitz 
6405c65c564SOr Gerlitz 	params.log_data_size = 15;
6415c65c564SOr Gerlitz 	params.log_data_size = min_t(u8, params.log_data_size,
6425c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz));
6435c65c564SOr Gerlitz 	params.log_data_size = max_t(u8, params.log_data_size,
6445c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz));
6455c65c564SOr Gerlitz 
646eb9180f7SOr Gerlitz 	params.log_num_packets = params.log_data_size -
647eb9180f7SOr Gerlitz 				 MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev);
648eb9180f7SOr Gerlitz 	params.log_num_packets = min_t(u8, params.log_num_packets,
649eb9180f7SOr Gerlitz 				       MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets));
650eb9180f7SOr Gerlitz 
651eb9180f7SOr Gerlitz 	params.q_counter = priv->q_counter;
6523f6d08d1SOr Gerlitz 	/* set hairpin pair per each 50Gbs share of the link */
6532c81bfd5SHuy Nguyen 	mlx5e_port_max_linkspeed(priv->mdev, &link_speed);
6543f6d08d1SOr Gerlitz 	link_speed = max_t(u32, link_speed, 50000);
6553f6d08d1SOr Gerlitz 	link_speed64 = link_speed;
6563f6d08d1SOr Gerlitz 	do_div(link_speed64, 50000);
6573f6d08d1SOr Gerlitz 	params.num_channels = link_speed64;
6583f6d08d1SOr Gerlitz 
6595c65c564SOr Gerlitz 	hp = mlx5e_hairpin_create(priv, &params, peer_ifindex);
6605c65c564SOr Gerlitz 	if (IS_ERR(hp)) {
6615c65c564SOr Gerlitz 		err = PTR_ERR(hp);
6625c65c564SOr Gerlitz 		goto create_hairpin_err;
6635c65c564SOr Gerlitz 	}
6645c65c564SOr Gerlitz 
665eb9180f7SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n",
666ddae74acSOr Gerlitz 		   hp->tirn, hp->pair->rqn[0], hp->pair->peer_mdev->priv.name,
667eb9180f7SOr Gerlitz 		   hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets);
6685c65c564SOr Gerlitz 
6695c65c564SOr Gerlitz 	hpe->hp = hp;
670106be53bSOr Gerlitz 	hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist,
671106be53bSOr Gerlitz 		 hash_hairpin_info(peer_id, match_prio));
6725c65c564SOr Gerlitz 
6735c65c564SOr Gerlitz attach_flow:
6743f6d08d1SOr Gerlitz 	if (hpe->hp->num_channels > 1) {
6753f6d08d1SOr Gerlitz 		flow->flags |= MLX5E_TC_FLOW_HAIRPIN_RSS;
6763f6d08d1SOr Gerlitz 		flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t;
6773f6d08d1SOr Gerlitz 	} else {
6785c65c564SOr Gerlitz 		flow->nic_attr->hairpin_tirn = hpe->hp->tirn;
6793f6d08d1SOr Gerlitz 	}
6805c65c564SOr Gerlitz 	list_add(&flow->hairpin, &hpe->flows);
6813f6d08d1SOr Gerlitz 
6825c65c564SOr Gerlitz 	return 0;
6835c65c564SOr Gerlitz 
6845c65c564SOr Gerlitz create_hairpin_err:
6855c65c564SOr Gerlitz 	kfree(hpe);
6865c65c564SOr Gerlitz 	return err;
6875c65c564SOr Gerlitz }
6885c65c564SOr Gerlitz 
6895c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv,
6905c65c564SOr Gerlitz 				   struct mlx5e_tc_flow *flow)
6915c65c564SOr Gerlitz {
6925c65c564SOr Gerlitz 	struct list_head *next = flow->hairpin.next;
6935c65c564SOr Gerlitz 
6945c65c564SOr Gerlitz 	list_del(&flow->hairpin);
6955c65c564SOr Gerlitz 
6965c65c564SOr Gerlitz 	/* no more hairpin flows for us, release the hairpin pair */
6975c65c564SOr Gerlitz 	if (list_empty(next)) {
6985c65c564SOr Gerlitz 		struct mlx5e_hairpin_entry *hpe;
6995c65c564SOr Gerlitz 
7005c65c564SOr Gerlitz 		hpe = list_entry(next, struct mlx5e_hairpin_entry, flows);
7015c65c564SOr Gerlitz 
7025c65c564SOr Gerlitz 		netdev_dbg(priv->netdev, "del hairpin: peer %s\n",
7035c65c564SOr Gerlitz 			   hpe->hp->pair->peer_mdev->priv.name);
7045c65c564SOr Gerlitz 
7055c65c564SOr Gerlitz 		mlx5e_hairpin_destroy(hpe->hp);
7065c65c564SOr Gerlitz 		hash_del(&hpe->hairpin_hlist);
7075c65c564SOr Gerlitz 		kfree(hpe);
7085c65c564SOr Gerlitz 	}
7095c65c564SOr Gerlitz }
7105c65c564SOr Gerlitz 
711c83954abSRabie Loulou static int
71274491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv,
71317091853SOr Gerlitz 		      struct mlx5e_tc_flow_parse_attr *parse_attr,
714e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
715e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
716e8f887acSAmir Vadai {
717aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
718aad7e08dSAmir Vadai 	struct mlx5_core_dev *dev = priv->mdev;
7195c65c564SOr Gerlitz 	struct mlx5_flow_destination dest[2] = {};
72066958ed9SHadar Hen Zion 	struct mlx5_flow_act flow_act = {
7213bc4b7bfSOr Gerlitz 		.action = attr->action,
7223bc4b7bfSOr Gerlitz 		.flow_tag = attr->flow_tag,
72360786f09SMark Bloch 		.reformat_id = 0,
72442f7ad67SPaul Blakey 		.flags    = FLOW_ACT_HAS_TAG | FLOW_ACT_NO_APPEND,
72566958ed9SHadar Hen Zion 	};
726aad7e08dSAmir Vadai 	struct mlx5_fc *counter = NULL;
727e8f887acSAmir Vadai 	bool table_created = false;
7285c65c564SOr Gerlitz 	int err, dest_ix = 0;
729e8f887acSAmir Vadai 
7305c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) {
731e98bedf5SEli Britstein 		err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack);
7325c65c564SOr Gerlitz 		if (err) {
7335c65c564SOr Gerlitz 			goto err_add_hairpin_flow;
7345c65c564SOr Gerlitz 		}
7353f6d08d1SOr Gerlitz 		if (flow->flags & MLX5E_TC_FLOW_HAIRPIN_RSS) {
7363f6d08d1SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
7373f6d08d1SOr Gerlitz 			dest[dest_ix].ft = attr->hairpin_ft;
7383f6d08d1SOr Gerlitz 		} else {
7395c65c564SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR;
7405c65c564SOr Gerlitz 			dest[dest_ix].tir_num = attr->hairpin_tirn;
7413f6d08d1SOr Gerlitz 		}
7423f6d08d1SOr Gerlitz 		dest_ix++;
7433f6d08d1SOr Gerlitz 	} else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
7445c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
7455c65c564SOr Gerlitz 		dest[dest_ix].ft = priv->fs.vlan.ft.t;
7465c65c564SOr Gerlitz 		dest_ix++;
7475c65c564SOr Gerlitz 	}
748aad7e08dSAmir Vadai 
7495c65c564SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
7505c65c564SOr Gerlitz 		counter = mlx5_fc_create(dev, true);
7515c65c564SOr Gerlitz 		if (IS_ERR(counter)) {
752c83954abSRabie Loulou 			err = PTR_ERR(counter);
7535c65c564SOr Gerlitz 			goto err_fc_create;
7545c65c564SOr Gerlitz 		}
7555c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
756171c7625SMark Bloch 		dest[dest_ix].counter_id = mlx5_fc_id(counter);
7575c65c564SOr Gerlitz 		dest_ix++;
758b8aee822SMark Bloch 		attr->counter = counter;
759aad7e08dSAmir Vadai 	}
760aad7e08dSAmir Vadai 
7612f4fe4caSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
7623099eb5aSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
763d7e75a32SOr Gerlitz 		flow_act.modify_id = attr->mod_hdr_id;
7642f4fe4caSOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
765c83954abSRabie Loulou 		if (err)
7662f4fe4caSOr Gerlitz 			goto err_create_mod_hdr_id;
7672f4fe4caSOr Gerlitz 	}
7682f4fe4caSOr Gerlitz 
769acff797cSMaor Gottlieb 	if (IS_ERR_OR_NULL(priv->fs.tc.t)) {
77021b9c144SOr Gerlitz 		int tc_grp_size, tc_tbl_size;
77121b9c144SOr Gerlitz 		u32 max_flow_counter;
77221b9c144SOr Gerlitz 
77321b9c144SOr Gerlitz 		max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) |
77421b9c144SOr Gerlitz 				    MLX5_CAP_GEN(dev, max_flow_counter_15_0);
77521b9c144SOr Gerlitz 
77621b9c144SOr Gerlitz 		tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE);
77721b9c144SOr Gerlitz 
77821b9c144SOr Gerlitz 		tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS,
77921b9c144SOr Gerlitz 				    BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size)));
78021b9c144SOr Gerlitz 
781acff797cSMaor Gottlieb 		priv->fs.tc.t =
782acff797cSMaor Gottlieb 			mlx5_create_auto_grouped_flow_table(priv->fs.ns,
783acff797cSMaor Gottlieb 							    MLX5E_TC_PRIO,
78421b9c144SOr Gerlitz 							    tc_tbl_size,
785acff797cSMaor Gottlieb 							    MLX5E_TC_TABLE_NUM_GROUPS,
7863f6d08d1SOr Gerlitz 							    MLX5E_TC_FT_LEVEL, 0);
787acff797cSMaor Gottlieb 		if (IS_ERR(priv->fs.tc.t)) {
788e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
789e98bedf5SEli Britstein 					   "Failed to create tc offload table\n");
790e8f887acSAmir Vadai 			netdev_err(priv->netdev,
791e8f887acSAmir Vadai 				   "Failed to create tc offload table\n");
792c83954abSRabie Loulou 			err = PTR_ERR(priv->fs.tc.t);
793aad7e08dSAmir Vadai 			goto err_create_ft;
794e8f887acSAmir Vadai 		}
795e8f887acSAmir Vadai 
796e8f887acSAmir Vadai 		table_created = true;
797e8f887acSAmir Vadai 	}
798e8f887acSAmir Vadai 
79938aa51c1SOr Gerlitz 	if (attr->match_level != MLX5_MATCH_NONE)
80017091853SOr Gerlitz 		parse_attr->spec.match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
80138aa51c1SOr Gerlitz 
802c83954abSRabie Loulou 	flow->rule[0] = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec,
8035c65c564SOr Gerlitz 					    &flow_act, dest, dest_ix);
804e8f887acSAmir Vadai 
805c83954abSRabie Loulou 	if (IS_ERR(flow->rule[0])) {
806c83954abSRabie Loulou 		err = PTR_ERR(flow->rule[0]);
807aad7e08dSAmir Vadai 		goto err_add_rule;
808c83954abSRabie Loulou 	}
809aad7e08dSAmir Vadai 
810c83954abSRabie Loulou 	return 0;
811aad7e08dSAmir Vadai 
812aad7e08dSAmir Vadai err_add_rule:
813aad7e08dSAmir Vadai 	if (table_created) {
814acff797cSMaor Gottlieb 		mlx5_destroy_flow_table(priv->fs.tc.t);
815acff797cSMaor Gottlieb 		priv->fs.tc.t = NULL;
816e8f887acSAmir Vadai 	}
817aad7e08dSAmir Vadai err_create_ft:
8182f4fe4caSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
8193099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
8202f4fe4caSOr Gerlitz err_create_mod_hdr_id:
821aad7e08dSAmir Vadai 	mlx5_fc_destroy(dev, counter);
8225c65c564SOr Gerlitz err_fc_create:
8235c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN)
8245c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
8255c65c564SOr Gerlitz err_add_hairpin_flow:
826c83954abSRabie Loulou 	return err;
827e8f887acSAmir Vadai }
828e8f887acSAmir Vadai 
829d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv,
830d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
831d85cdccbSOr Gerlitz {
832513f8f7fSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
833d85cdccbSOr Gerlitz 	struct mlx5_fc *counter = NULL;
834d85cdccbSOr Gerlitz 
835b8aee822SMark Bloch 	counter = attr->counter;
836e4ad91f2SChris Mi 	mlx5_del_flow_rules(flow->rule[0]);
837d85cdccbSOr Gerlitz 	mlx5_fc_destroy(priv->mdev, counter);
838d85cdccbSOr Gerlitz 
839d9ee0491SOr Gerlitz 	if (!mlx5e_tc_num_filters(priv, MLX5E_TC_NIC_OFFLOAD)  && priv->fs.tc.t) {
840d85cdccbSOr Gerlitz 		mlx5_destroy_flow_table(priv->fs.tc.t);
841d85cdccbSOr Gerlitz 		priv->fs.tc.t = NULL;
842d85cdccbSOr Gerlitz 	}
8432f4fe4caSOr Gerlitz 
844513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
8453099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
8465c65c564SOr Gerlitz 
8475c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN)
8485c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
849d85cdccbSOr Gerlitz }
850d85cdccbSOr Gerlitz 
851aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
8528c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index);
853aa0cbbaeSOr Gerlitz 
8543c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv,
855e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
856733d4f36SRoi Dayan 			      struct net_device *mirred_dev,
857733d4f36SRoi Dayan 			      int out_index,
8588c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
8590ad060eeSRoi Dayan 			      struct net_device **encap_dev,
8600ad060eeSRoi Dayan 			      bool *encap_valid);
8613c37745eSOr Gerlitz 
8626d2a3ed0SOr Gerlitz static struct mlx5_flow_handle *
8636d2a3ed0SOr Gerlitz mlx5e_tc_offload_fdb_rules(struct mlx5_eswitch *esw,
8646d2a3ed0SOr Gerlitz 			   struct mlx5e_tc_flow *flow,
8656d2a3ed0SOr Gerlitz 			   struct mlx5_flow_spec *spec,
8666d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
8676d2a3ed0SOr Gerlitz {
8686d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
8696d2a3ed0SOr Gerlitz 
8706d2a3ed0SOr Gerlitz 	rule = mlx5_eswitch_add_offloaded_rule(esw, spec, attr);
8716d2a3ed0SOr Gerlitz 	if (IS_ERR(rule))
8726d2a3ed0SOr Gerlitz 		return rule;
8736d2a3ed0SOr Gerlitz 
874e85e02baSEli Britstein 	if (attr->split_count) {
8756d2a3ed0SOr Gerlitz 		flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, spec, attr);
8766d2a3ed0SOr Gerlitz 		if (IS_ERR(flow->rule[1])) {
8776d2a3ed0SOr Gerlitz 			mlx5_eswitch_del_offloaded_rule(esw, rule, attr);
8786d2a3ed0SOr Gerlitz 			return flow->rule[1];
8796d2a3ed0SOr Gerlitz 		}
8806d2a3ed0SOr Gerlitz 	}
8816d2a3ed0SOr Gerlitz 
8826d2a3ed0SOr Gerlitz 	flow->flags |= MLX5E_TC_FLOW_OFFLOADED;
8836d2a3ed0SOr Gerlitz 	return rule;
8846d2a3ed0SOr Gerlitz }
8856d2a3ed0SOr Gerlitz 
8866d2a3ed0SOr Gerlitz static void
8876d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(struct mlx5_eswitch *esw,
8886d2a3ed0SOr Gerlitz 			     struct mlx5e_tc_flow *flow,
8896d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
8906d2a3ed0SOr Gerlitz {
8916d2a3ed0SOr Gerlitz 	flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED;
8926d2a3ed0SOr Gerlitz 
893e85e02baSEli Britstein 	if (attr->split_count)
8946d2a3ed0SOr Gerlitz 		mlx5_eswitch_del_fwd_rule(esw, flow->rule[1], attr);
8956d2a3ed0SOr Gerlitz 
8966d2a3ed0SOr Gerlitz 	mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr);
8976d2a3ed0SOr Gerlitz }
8986d2a3ed0SOr Gerlitz 
8995dbe906fSPaul Blakey static struct mlx5_flow_handle *
9005dbe906fSPaul Blakey mlx5e_tc_offload_to_slow_path(struct mlx5_eswitch *esw,
9015dbe906fSPaul Blakey 			      struct mlx5e_tc_flow *flow,
9025dbe906fSPaul Blakey 			      struct mlx5_flow_spec *spec,
9035dbe906fSPaul Blakey 			      struct mlx5_esw_flow_attr *slow_attr)
9045dbe906fSPaul Blakey {
9055dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
9065dbe906fSPaul Blakey 
9075dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
908154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9092be09de7SDavid S. Miller 	slow_attr->split_count = 0;
910154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
9115dbe906fSPaul Blakey 
9125dbe906fSPaul Blakey 	rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, slow_attr);
9135dbe906fSPaul Blakey 	if (!IS_ERR(rule))
9145dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_SLOW;
9155dbe906fSPaul Blakey 
9165dbe906fSPaul Blakey 	return rule;
9175dbe906fSPaul Blakey }
9185dbe906fSPaul Blakey 
9195dbe906fSPaul Blakey static void
9205dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(struct mlx5_eswitch *esw,
9215dbe906fSPaul Blakey 				  struct mlx5e_tc_flow *flow,
9225dbe906fSPaul Blakey 				  struct mlx5_esw_flow_attr *slow_attr)
9235dbe906fSPaul Blakey {
9245dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
925154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9262be09de7SDavid S. Miller 	slow_attr->split_count = 0;
927154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
9285dbe906fSPaul Blakey 	mlx5e_tc_unoffload_fdb_rules(esw, flow, slow_attr);
9295dbe906fSPaul Blakey 	flow->flags &= ~MLX5E_TC_FLOW_SLOW;
9305dbe906fSPaul Blakey }
9315dbe906fSPaul Blakey 
932b4a23329SRoi Dayan static void add_unready_flow(struct mlx5e_tc_flow *flow)
933b4a23329SRoi Dayan {
934b4a23329SRoi Dayan 	struct mlx5_rep_uplink_priv *uplink_priv;
935b4a23329SRoi Dayan 	struct mlx5e_rep_priv *rpriv;
936b4a23329SRoi Dayan 	struct mlx5_eswitch *esw;
937b4a23329SRoi Dayan 
938b4a23329SRoi Dayan 	esw = flow->priv->mdev->priv.eswitch;
939b4a23329SRoi Dayan 	rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
940b4a23329SRoi Dayan 	uplink_priv = &rpriv->uplink_priv;
941b4a23329SRoi Dayan 
942b4a23329SRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_NOT_READY;
943b4a23329SRoi Dayan 	list_add_tail(&flow->unready, &uplink_priv->unready_flows);
944b4a23329SRoi Dayan }
945b4a23329SRoi Dayan 
946b4a23329SRoi Dayan static void remove_unready_flow(struct mlx5e_tc_flow *flow)
947b4a23329SRoi Dayan {
948b4a23329SRoi Dayan 	list_del(&flow->unready);
949b4a23329SRoi Dayan 	flow->flags &= ~MLX5E_TC_FLOW_NOT_READY;
950b4a23329SRoi Dayan }
951b4a23329SRoi Dayan 
952c83954abSRabie Loulou static int
95374491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv,
954e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
955e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
956adb4c123SOr Gerlitz {
957adb4c123SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
958bf07aa73SPaul Blakey 	u32 max_chain = mlx5_eswitch_get_chain_range(esw);
959aa0cbbaeSOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
9607040632dSTonghao Zhang 	struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr;
961bf07aa73SPaul Blakey 	u16 max_prio = mlx5_eswitch_get_prio_range(esw);
9623c37745eSOr Gerlitz 	struct net_device *out_dev, *encap_dev = NULL;
963b8aee822SMark Bloch 	struct mlx5_fc *counter = NULL;
9643c37745eSOr Gerlitz 	struct mlx5e_rep_priv *rpriv;
9653c37745eSOr Gerlitz 	struct mlx5e_priv *out_priv;
9660ad060eeSRoi Dayan 	bool encap_valid = true;
9670ad060eeSRoi Dayan 	int err = 0;
968f493f155SEli Britstein 	int out_index;
9698b32580dSOr Gerlitz 
970d14f6f2aSOr Gerlitz 	if (!mlx5_eswitch_prios_supported(esw) && attr->prio != 1) {
971d14f6f2aSOr Gerlitz 		NL_SET_ERR_MSG(extack, "E-switch priorities unsupported, upgrade FW");
972d14f6f2aSOr Gerlitz 		return -EOPNOTSUPP;
973d14f6f2aSOr Gerlitz 	}
974e52c2802SPaul Blakey 
975bf07aa73SPaul Blakey 	if (attr->chain > max_chain) {
976bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested chain is out of supported range");
977bf07aa73SPaul Blakey 		err = -EOPNOTSUPP;
978bf07aa73SPaul Blakey 		goto err_max_prio_chain;
979bf07aa73SPaul Blakey 	}
980bf07aa73SPaul Blakey 
981bf07aa73SPaul Blakey 	if (attr->prio > max_prio) {
982bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested priority is out of supported range");
983bf07aa73SPaul Blakey 		err = -EOPNOTSUPP;
984bf07aa73SPaul Blakey 		goto err_max_prio_chain;
985bf07aa73SPaul Blakey 	}
986bf07aa73SPaul Blakey 
987f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) {
9888c4dc42bSEli Britstein 		int mirred_ifindex;
9898c4dc42bSEli Britstein 
990f493f155SEli Britstein 		if (!(attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP))
991f493f155SEli Britstein 			continue;
992f493f155SEli Britstein 
9937040632dSTonghao Zhang 		mirred_ifindex = parse_attr->mirred_ifindex[out_index];
9943c37745eSOr Gerlitz 		out_dev = __dev_get_by_index(dev_net(priv->netdev),
9958c4dc42bSEli Britstein 					     mirred_ifindex);
996733d4f36SRoi Dayan 		err = mlx5e_attach_encap(priv, flow, out_dev, out_index,
9970ad060eeSRoi Dayan 					 extack, &encap_dev, &encap_valid);
9980ad060eeSRoi Dayan 		if (err)
9993c37745eSOr Gerlitz 			goto err_attach_encap;
10000ad060eeSRoi Dayan 
10013c37745eSOr Gerlitz 		out_priv = netdev_priv(encap_dev);
10023c37745eSOr Gerlitz 		rpriv = out_priv->ppriv;
10031cc26d74SEli Britstein 		attr->dests[out_index].rep = rpriv->rep;
10041cc26d74SEli Britstein 		attr->dests[out_index].mdev = out_priv->mdev;
10053c37745eSOr Gerlitz 	}
10063c37745eSOr Gerlitz 
10078b32580dSOr Gerlitz 	err = mlx5_eswitch_add_vlan_action(esw, attr);
1008c83954abSRabie Loulou 	if (err)
1009aa0cbbaeSOr Gerlitz 		goto err_add_vlan;
1010adb4c123SOr Gerlitz 
1011d7e75a32SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
10121a9527bbSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
1013d7e75a32SOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
1014c83954abSRabie Loulou 		if (err)
1015d7e75a32SOr Gerlitz 			goto err_mod_hdr;
1016d7e75a32SOr Gerlitz 	}
1017d7e75a32SOr Gerlitz 
1018b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
1019f9392795SShahar Klein 		counter = mlx5_fc_create(attr->counter_dev, true);
1020b8aee822SMark Bloch 		if (IS_ERR(counter)) {
1021c83954abSRabie Loulou 			err = PTR_ERR(counter);
1022b8aee822SMark Bloch 			goto err_create_counter;
1023b8aee822SMark Bloch 		}
1024b8aee822SMark Bloch 
1025b8aee822SMark Bloch 		attr->counter = counter;
1026b8aee822SMark Bloch 	}
1027b8aee822SMark Bloch 
10280ad060eeSRoi Dayan 	/* we get here if one of the following takes place:
10290ad060eeSRoi Dayan 	 * (1) there's no error
10300ad060eeSRoi Dayan 	 * (2) there's an encap action and we don't have valid neigh
10313c37745eSOr Gerlitz 	 */
10320ad060eeSRoi Dayan 	if (!encap_valid) {
10335dbe906fSPaul Blakey 		/* continue with goto slow path rule instead */
10345dbe906fSPaul Blakey 		struct mlx5_esw_flow_attr slow_attr;
10355dbe906fSPaul Blakey 
10365dbe906fSPaul Blakey 		flow->rule[0] = mlx5e_tc_offload_to_slow_path(esw, flow, &parse_attr->spec, &slow_attr);
10375dbe906fSPaul Blakey 	} else {
10386d2a3ed0SOr Gerlitz 		flow->rule[0] = mlx5e_tc_offload_fdb_rules(esw, flow, &parse_attr->spec, attr);
10395dbe906fSPaul Blakey 	}
10405dbe906fSPaul Blakey 
1041c83954abSRabie Loulou 	if (IS_ERR(flow->rule[0])) {
1042c83954abSRabie Loulou 		err = PTR_ERR(flow->rule[0]);
1043aa0cbbaeSOr Gerlitz 		goto err_add_rule;
1044c83954abSRabie Loulou 	}
1045c83954abSRabie Loulou 
10465dbe906fSPaul Blakey 	return 0;
1047aa0cbbaeSOr Gerlitz 
1048aa0cbbaeSOr Gerlitz err_add_rule:
1049f9392795SShahar Klein 	mlx5_fc_destroy(attr->counter_dev, counter);
1050b8aee822SMark Bloch err_create_counter:
1051513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
10521a9527bbSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
1053d7e75a32SOr Gerlitz err_mod_hdr:
1054aa0cbbaeSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1055aa0cbbaeSOr Gerlitz err_add_vlan:
1056f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
10578c4dc42bSEli Britstein 		if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)
10588c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
10593c37745eSOr Gerlitz err_attach_encap:
1060bf07aa73SPaul Blakey err_max_prio_chain:
1061c83954abSRabie Loulou 	return err;
1062aa0cbbaeSOr Gerlitz }
1063d85cdccbSOr Gerlitz 
1064d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv,
1065d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
1066d85cdccbSOr Gerlitz {
1067d85cdccbSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
1068d7e75a32SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
10695dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
1070f493f155SEli Britstein 	int out_index;
1071d85cdccbSOr Gerlitz 
1072ef06c9eeSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_NOT_READY) {
1073b4a23329SRoi Dayan 		remove_unready_flow(flow);
1074ef06c9eeSRoi Dayan 		kvfree(attr->parse_attr);
1075ef06c9eeSRoi Dayan 		return;
1076ef06c9eeSRoi Dayan 	}
1077ef06c9eeSRoi Dayan 
10785dbe906fSPaul Blakey 	if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
10795dbe906fSPaul Blakey 		if (flow->flags & MLX5E_TC_FLOW_SLOW)
10805dbe906fSPaul Blakey 			mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
10815dbe906fSPaul Blakey 		else
10825dbe906fSPaul Blakey 			mlx5e_tc_unoffload_fdb_rules(esw, flow, attr);
10835dbe906fSPaul Blakey 	}
1084d85cdccbSOr Gerlitz 
1085513f8f7fSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1086d85cdccbSOr Gerlitz 
1087f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
10888c4dc42bSEli Britstein 		if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)
10898c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
1090f493f155SEli Britstein 	kvfree(attr->parse_attr);
1091d7e75a32SOr Gerlitz 
1092513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
10931a9527bbSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
1094b8aee822SMark Bloch 
1095b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT)
1096f9392795SShahar Klein 		mlx5_fc_destroy(attr->counter_dev, attr->counter);
1097d85cdccbSOr Gerlitz }
1098d85cdccbSOr Gerlitz 
1099232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv,
1100232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1101232c0013SHadar Hen Zion {
11023c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
11035dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr, *esw_attr;
11046d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
11056d2a3ed0SOr Gerlitz 	struct mlx5_flow_spec *spec;
110679baaec7SEli Britstein 	struct encap_flow_item *efi;
1107232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1108232c0013SHadar Hen Zion 	int err;
1109232c0013SHadar Hen Zion 
111054c177caSOz Shlomo 	err = mlx5_packet_reformat_alloc(priv->mdev,
111154c177caSOz Shlomo 					 e->reformat_type,
1112232c0013SHadar Hen Zion 					 e->encap_size, e->encap_header,
111331ca3648SMark Bloch 					 MLX5_FLOW_NAMESPACE_FDB,
1114232c0013SHadar Hen Zion 					 &e->encap_id);
1115232c0013SHadar Hen Zion 	if (err) {
1116232c0013SHadar Hen Zion 		mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n",
1117232c0013SHadar Hen Zion 			       err);
1118232c0013SHadar Hen Zion 		return;
1119232c0013SHadar Hen Zion 	}
1120232c0013SHadar Hen Zion 	e->flags |= MLX5_ENCAP_ENTRY_VALID;
1121f6dfb4c3SHadar Hen Zion 	mlx5e_rep_queue_neigh_stats_work(priv);
1122232c0013SHadar Hen Zion 
112379baaec7SEli Britstein 	list_for_each_entry(efi, &e->flows, list) {
11248c4dc42bSEli Britstein 		bool all_flow_encaps_valid = true;
11258c4dc42bSEli Britstein 		int i;
11268c4dc42bSEli Britstein 
112779baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
11283c37745eSOr Gerlitz 		esw_attr = flow->esw_attr;
11296d2a3ed0SOr Gerlitz 		spec = &esw_attr->parse_attr->spec;
11306d2a3ed0SOr Gerlitz 
11318c4dc42bSEli Britstein 		esw_attr->dests[efi->index].encap_id = e->encap_id;
11328c4dc42bSEli Britstein 		esw_attr->dests[efi->index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
11338c4dc42bSEli Britstein 		/* Flow can be associated with multiple encap entries.
11348c4dc42bSEli Britstein 		 * Before offloading the flow verify that all of them have
11358c4dc42bSEli Britstein 		 * a valid neighbour.
11368c4dc42bSEli Britstein 		 */
11378c4dc42bSEli Britstein 		for (i = 0; i < MLX5_MAX_FLOW_FWD_VPORTS; i++) {
11388c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP))
11398c4dc42bSEli Britstein 				continue;
11408c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP_VALID)) {
11418c4dc42bSEli Britstein 				all_flow_encaps_valid = false;
11428c4dc42bSEli Britstein 				break;
11438c4dc42bSEli Britstein 			}
11448c4dc42bSEli Britstein 		}
11458c4dc42bSEli Britstein 		/* Do not offload flows with unresolved neighbors */
11468c4dc42bSEli Britstein 		if (!all_flow_encaps_valid)
11478c4dc42bSEli Britstein 			continue;
11485dbe906fSPaul Blakey 		/* update from slow path rule to encap rule */
11496d2a3ed0SOr Gerlitz 		rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, esw_attr);
11506d2a3ed0SOr Gerlitz 		if (IS_ERR(rule)) {
11516d2a3ed0SOr Gerlitz 			err = PTR_ERR(rule);
1152232c0013SHadar Hen Zion 			mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n",
1153232c0013SHadar Hen Zion 				       err);
1154232c0013SHadar Hen Zion 			continue;
1155232c0013SHadar Hen Zion 		}
11565dbe906fSPaul Blakey 
11575dbe906fSPaul Blakey 		mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
11585dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when slow path rule removed */
11596d2a3ed0SOr Gerlitz 		flow->rule[0] = rule;
1160232c0013SHadar Hen Zion 	}
1161232c0013SHadar Hen Zion }
1162232c0013SHadar Hen Zion 
1163232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv,
1164232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1165232c0013SHadar Hen Zion {
11663c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
11675dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
11685dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
11695dbe906fSPaul Blakey 	struct mlx5_flow_spec *spec;
117079baaec7SEli Britstein 	struct encap_flow_item *efi;
1171232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
11725dbe906fSPaul Blakey 	int err;
1173232c0013SHadar Hen Zion 
117479baaec7SEli Britstein 	list_for_each_entry(efi, &e->flows, list) {
117579baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
11765dbe906fSPaul Blakey 		spec = &flow->esw_attr->parse_attr->spec;
11775dbe906fSPaul Blakey 
11785dbe906fSPaul Blakey 		/* update from encap rule to slow path rule */
11795dbe906fSPaul Blakey 		rule = mlx5e_tc_offload_to_slow_path(esw, flow, spec, &slow_attr);
11808c4dc42bSEli Britstein 		/* mark the flow's encap dest as non-valid */
11818c4dc42bSEli Britstein 		flow->esw_attr->dests[efi->index].flags &= ~MLX5_ESW_DEST_ENCAP_VALID;
11825dbe906fSPaul Blakey 
11835dbe906fSPaul Blakey 		if (IS_ERR(rule)) {
11845dbe906fSPaul Blakey 			err = PTR_ERR(rule);
11855dbe906fSPaul Blakey 			mlx5_core_warn(priv->mdev, "Failed to update slow path (encap) flow, %d\n",
11865dbe906fSPaul Blakey 				       err);
11875dbe906fSPaul Blakey 			continue;
11885dbe906fSPaul Blakey 		}
11895dbe906fSPaul Blakey 
11906d2a3ed0SOr Gerlitz 		mlx5e_tc_unoffload_fdb_rules(esw, flow, flow->esw_attr);
11915dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when fast path rule removed */
11925dbe906fSPaul Blakey 		flow->rule[0] = rule;
1193232c0013SHadar Hen Zion 	}
1194232c0013SHadar Hen Zion 
119561c806daSOr Gerlitz 	/* we know that the encap is valid */
1196232c0013SHadar Hen Zion 	e->flags &= ~MLX5_ENCAP_ENTRY_VALID;
119760786f09SMark Bloch 	mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1198232c0013SHadar Hen Zion }
1199232c0013SHadar Hen Zion 
1200b8aee822SMark Bloch static struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow)
1201b8aee822SMark Bloch {
1202b8aee822SMark Bloch 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
1203b8aee822SMark Bloch 		return flow->esw_attr->counter;
1204b8aee822SMark Bloch 	else
1205b8aee822SMark Bloch 		return flow->nic_attr->counter;
1206b8aee822SMark Bloch }
1207b8aee822SMark Bloch 
1208f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe)
1209f6dfb4c3SHadar Hen Zion {
1210f6dfb4c3SHadar Hen Zion 	struct mlx5e_neigh *m_neigh = &nhe->m_neigh;
1211f6dfb4c3SHadar Hen Zion 	u64 bytes, packets, lastuse = 0;
1212f6dfb4c3SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1213f6dfb4c3SHadar Hen Zion 	struct mlx5e_encap_entry *e;
1214f6dfb4c3SHadar Hen Zion 	struct mlx5_fc *counter;
1215f6dfb4c3SHadar Hen Zion 	struct neigh_table *tbl;
1216f6dfb4c3SHadar Hen Zion 	bool neigh_used = false;
1217f6dfb4c3SHadar Hen Zion 	struct neighbour *n;
1218f6dfb4c3SHadar Hen Zion 
1219f6dfb4c3SHadar Hen Zion 	if (m_neigh->family == AF_INET)
1220f6dfb4c3SHadar Hen Zion 		tbl = &arp_tbl;
1221f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6)
1222f6dfb4c3SHadar Hen Zion 	else if (m_neigh->family == AF_INET6)
1223423c9db2SOr Gerlitz 		tbl = &nd_tbl;
1224f6dfb4c3SHadar Hen Zion #endif
1225f6dfb4c3SHadar Hen Zion 	else
1226f6dfb4c3SHadar Hen Zion 		return;
1227f6dfb4c3SHadar Hen Zion 
1228f6dfb4c3SHadar Hen Zion 	list_for_each_entry(e, &nhe->encap_list, encap_list) {
122979baaec7SEli Britstein 		struct encap_flow_item *efi;
1230f6dfb4c3SHadar Hen Zion 		if (!(e->flags & MLX5_ENCAP_ENTRY_VALID))
1231f6dfb4c3SHadar Hen Zion 			continue;
123279baaec7SEli Britstein 		list_for_each_entry(efi, &e->flows, list) {
123379baaec7SEli Britstein 			flow = container_of(efi, struct mlx5e_tc_flow,
123479baaec7SEli Britstein 					    encaps[efi->index]);
1235f6dfb4c3SHadar Hen Zion 			if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
1236b8aee822SMark Bloch 				counter = mlx5e_tc_get_counter(flow);
1237f6dfb4c3SHadar Hen Zion 				mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
1238f6dfb4c3SHadar Hen Zion 				if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) {
1239f6dfb4c3SHadar Hen Zion 					neigh_used = true;
1240f6dfb4c3SHadar Hen Zion 					break;
1241f6dfb4c3SHadar Hen Zion 				}
1242f6dfb4c3SHadar Hen Zion 			}
1243f6dfb4c3SHadar Hen Zion 		}
1244e36d4810SRoi Dayan 		if (neigh_used)
1245e36d4810SRoi Dayan 			break;
1246f6dfb4c3SHadar Hen Zion 	}
1247f6dfb4c3SHadar Hen Zion 
1248f6dfb4c3SHadar Hen Zion 	if (neigh_used) {
1249f6dfb4c3SHadar Hen Zion 		nhe->reported_lastuse = jiffies;
1250f6dfb4c3SHadar Hen Zion 
1251f6dfb4c3SHadar Hen Zion 		/* find the relevant neigh according to the cached device and
1252f6dfb4c3SHadar Hen Zion 		 * dst ip pair
1253f6dfb4c3SHadar Hen Zion 		 */
1254f6dfb4c3SHadar Hen Zion 		n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev);
1255c7f7ba8dSRoi Dayan 		if (!n)
1256f6dfb4c3SHadar Hen Zion 			return;
1257f6dfb4c3SHadar Hen Zion 
1258f6dfb4c3SHadar Hen Zion 		neigh_event_send(n, NULL);
1259f6dfb4c3SHadar Hen Zion 		neigh_release(n);
1260f6dfb4c3SHadar Hen Zion 	}
1261f6dfb4c3SHadar Hen Zion }
1262f6dfb4c3SHadar Hen Zion 
1263d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
12648c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index)
1265d85cdccbSOr Gerlitz {
12668c4dc42bSEli Britstein 	struct list_head *next = flow->encaps[out_index].list.next;
12675067b602SRoi Dayan 
12688c4dc42bSEli Britstein 	list_del(&flow->encaps[out_index].list);
12695067b602SRoi Dayan 	if (list_empty(next)) {
1270c1ae1152SOr Gerlitz 		struct mlx5e_encap_entry *e;
12715067b602SRoi Dayan 
1272c1ae1152SOr Gerlitz 		e = list_entry(next, struct mlx5e_encap_entry, flows);
1273232c0013SHadar Hen Zion 		mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e);
1274232c0013SHadar Hen Zion 
1275232c0013SHadar Hen Zion 		if (e->flags & MLX5_ENCAP_ENTRY_VALID)
127660786f09SMark Bloch 			mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1277232c0013SHadar Hen Zion 
1278cdc5a7f3SOr Gerlitz 		hash_del_rcu(&e->encap_hlist);
1279232c0013SHadar Hen Zion 		kfree(e->encap_header);
12805067b602SRoi Dayan 		kfree(e);
12815067b602SRoi Dayan 	}
12825067b602SRoi Dayan }
12835067b602SRoi Dayan 
128404de7ddaSRoi Dayan static void __mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
128504de7ddaSRoi Dayan {
128604de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = flow->priv->mdev->priv.eswitch;
128704de7ddaSRoi Dayan 
128804de7ddaSRoi Dayan 	if (!(flow->flags & MLX5E_TC_FLOW_ESWITCH) ||
128904de7ddaSRoi Dayan 	    !(flow->flags & MLX5E_TC_FLOW_DUP))
129004de7ddaSRoi Dayan 		return;
129104de7ddaSRoi Dayan 
129204de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
129304de7ddaSRoi Dayan 	list_del(&flow->peer);
129404de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
129504de7ddaSRoi Dayan 
129604de7ddaSRoi Dayan 	flow->flags &= ~MLX5E_TC_FLOW_DUP;
129704de7ddaSRoi Dayan 
129804de7ddaSRoi Dayan 	mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow);
129904de7ddaSRoi Dayan 	kvfree(flow->peer_flow);
130004de7ddaSRoi Dayan 	flow->peer_flow = NULL;
130104de7ddaSRoi Dayan }
130204de7ddaSRoi Dayan 
130304de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
130404de7ddaSRoi Dayan {
130504de7ddaSRoi Dayan 	struct mlx5_core_dev *dev = flow->priv->mdev;
130604de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = dev->priv.devcom;
130704de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
130804de7ddaSRoi Dayan 
130904de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
131004de7ddaSRoi Dayan 	if (!peer_esw)
131104de7ddaSRoi Dayan 		return;
131204de7ddaSRoi Dayan 
131304de7ddaSRoi Dayan 	__mlx5e_tc_del_fdb_peer_flow(flow);
131404de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
131504de7ddaSRoi Dayan }
131604de7ddaSRoi Dayan 
1317e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv,
1318961e8979SRoi Dayan 			      struct mlx5e_tc_flow *flow)
1319e8f887acSAmir Vadai {
132004de7ddaSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
132104de7ddaSRoi Dayan 		mlx5e_tc_del_fdb_peer_flow(flow);
1322d85cdccbSOr Gerlitz 		mlx5e_tc_del_fdb_flow(priv, flow);
132304de7ddaSRoi Dayan 	} else {
1324d85cdccbSOr Gerlitz 		mlx5e_tc_del_nic_flow(priv, flow);
1325e8f887acSAmir Vadai 	}
132604de7ddaSRoi Dayan }
1327e8f887acSAmir Vadai 
1328bbd00f7eSHadar Hen Zion 
1329bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv,
1330bbd00f7eSHadar Hen Zion 			     struct mlx5_flow_spec *spec,
133154c177caSOz Shlomo 			     struct tc_cls_flower_offload *f,
13326363651dSOr Gerlitz 			     struct net_device *filter_dev, u8 *match_level)
1333bbd00f7eSHadar Hen Zion {
1334e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1335bbd00f7eSHadar Hen Zion 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1336bbd00f7eSHadar Hen Zion 				       outer_headers);
1337bbd00f7eSHadar Hen Zion 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1338bbd00f7eSHadar Hen Zion 				       outer_headers);
13398f256622SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
13408f256622SPablo Neira Ayuso 	struct flow_match_control enc_control;
13418f256622SPablo Neira Ayuso 	int err;
1342bbd00f7eSHadar Hen Zion 
1343101f4de9SOz Shlomo 	err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f,
13446363651dSOr Gerlitz 				 headers_c, headers_v, match_level);
134554c177caSOz Shlomo 	if (err) {
134654c177caSOz Shlomo 		NL_SET_ERR_MSG_MOD(extack,
134754c177caSOz Shlomo 				   "failed to parse tunnel attributes");
1348101f4de9SOz Shlomo 		return err;
1349bbd00f7eSHadar Hen Zion 	}
1350bbd00f7eSHadar Hen Zion 
13518f256622SPablo Neira Ayuso 	flow_rule_match_enc_control(rule, &enc_control);
13528f256622SPablo Neira Ayuso 
13538f256622SPablo Neira Ayuso 	if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
13548f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
13558f256622SPablo Neira Ayuso 
13568f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv4_addrs(rule, &match);
1357bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1358bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
13598f256622SPablo Neira Ayuso 			 ntohl(match.mask->src));
1360bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1361bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
13628f256622SPablo Neira Ayuso 			 ntohl(match.key->src));
1363bbd00f7eSHadar Hen Zion 
1364bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1365bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
13668f256622SPablo Neira Ayuso 			 ntohl(match.mask->dst));
1367bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1368bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
13698f256622SPablo Neira Ayuso 			 ntohl(match.key->dst));
1370bbd00f7eSHadar Hen Zion 
1371bbd00f7eSHadar Hen Zion 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
1372bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP);
13738f256622SPablo Neira Ayuso 	} else if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
13748f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
137519f44401SOr Gerlitz 
13768f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv6_addrs(rule, &match);
137719f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
137819f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
13798f256622SPablo Neira Ayuso 		       &match.mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
138019f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
138119f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
13828f256622SPablo Neira Ayuso 		       &match.key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
138319f44401SOr Gerlitz 
138419f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
138519f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
13868f256622SPablo Neira Ayuso 		       &match.mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
138719f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
138819f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
13898f256622SPablo Neira Ayuso 		       &match.key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
139019f44401SOr Gerlitz 
139119f44401SOr Gerlitz 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
139219f44401SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6);
13932e72eb43SOr Gerlitz 	}
1394bbd00f7eSHadar Hen Zion 
13958f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) {
13968f256622SPablo Neira Ayuso 		struct flow_match_ip match;
1397bcef735cSOr Gerlitz 
13988f256622SPablo Neira Ayuso 		flow_rule_match_enc_ip(rule, &match);
13998f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
14008f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
14018f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
14028f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
1403bcef735cSOr Gerlitz 
14048f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
14058f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
14068f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
14078f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
1408bcef735cSOr Gerlitz 
14098f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
14108f256622SPablo Neira Ayuso 			 match.mask->ttl);
14118f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
14128f256622SPablo Neira Ayuso 			 match.key->ttl);
1413e98bedf5SEli Britstein 
14148f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1415e98bedf5SEli Britstein 		    !MLX5_CAP_ESW_FLOWTABLE_FDB
1416e98bedf5SEli Britstein 			(priv->mdev,
1417e98bedf5SEli Britstein 			 ft_field_support.outer_ipv4_ttl)) {
1418e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1419e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
1420e98bedf5SEli Britstein 			return -EOPNOTSUPP;
1421e98bedf5SEli Britstein 		}
1422e98bedf5SEli Britstein 
1423bcef735cSOr Gerlitz 	}
1424bcef735cSOr Gerlitz 
1425bbd00f7eSHadar Hen Zion 	/* Enforce DMAC when offloading incoming tunneled flows.
1426bbd00f7eSHadar Hen Zion 	 * Flow counters require a match on the DMAC.
1427bbd00f7eSHadar Hen Zion 	 */
1428bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16);
1429bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0);
1430bbd00f7eSHadar Hen Zion 	ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1431bbd00f7eSHadar Hen Zion 				     dmac_47_16), priv->netdev->dev_addr);
1432bbd00f7eSHadar Hen Zion 
1433bbd00f7eSHadar Hen Zion 	/* let software handle IP fragments */
1434bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
1435bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0);
1436bbd00f7eSHadar Hen Zion 
1437bbd00f7eSHadar Hen Zion 	return 0;
1438bbd00f7eSHadar Hen Zion }
1439bbd00f7eSHadar Hen Zion 
1440de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv,
1441de0af0bfSRoi Dayan 			      struct mlx5_flow_spec *spec,
1442de0af0bfSRoi Dayan 			      struct tc_cls_flower_offload *f,
144354c177caSOz Shlomo 			      struct net_device *filter_dev,
14446363651dSOr Gerlitz 			      u8 *match_level, u8 *tunnel_match_level)
1445e3a2b7edSAmir Vadai {
1446e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1447c5bb1730SMaor Gottlieb 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1448c5bb1730SMaor Gottlieb 				       outer_headers);
1449c5bb1730SMaor Gottlieb 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1450c5bb1730SMaor Gottlieb 				       outer_headers);
1451699e96ddSJianbo Liu 	void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1452699e96ddSJianbo Liu 				    misc_parameters);
1453699e96ddSJianbo Liu 	void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1454699e96ddSJianbo Liu 				    misc_parameters);
14558f256622SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
14568f256622SPablo Neira Ayuso 	struct flow_dissector *dissector = rule->match.dissector;
1457e3a2b7edSAmir Vadai 	u16 addr_type = 0;
1458e3a2b7edSAmir Vadai 	u8 ip_proto = 0;
1459e3a2b7edSAmir Vadai 
1460d708f902SOr Gerlitz 	*match_level = MLX5_MATCH_NONE;
1461de0af0bfSRoi Dayan 
14628f256622SPablo Neira Ayuso 	if (dissector->used_keys &
1463e3a2b7edSAmir Vadai 	    ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) |
1464e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_BASIC) |
1465e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) |
1466095b6cfdSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_VLAN) |
1467699e96ddSJianbo Liu 	      BIT(FLOW_DISSECTOR_KEY_CVLAN) |
1468e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) |
1469e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) |
1470bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_PORTS) |
1471bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) |
1472bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) |
1473bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) |
1474bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_PORTS)	|
1475e77834ecSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) |
1476fd7da28bSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_TCP) |
1477bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_IP)  |
1478bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_IP))) {
1479e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "Unsupported key");
1480e3a2b7edSAmir Vadai 		netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n",
14818f256622SPablo Neira Ayuso 			    dissector->used_keys);
1482e3a2b7edSAmir Vadai 		return -EOPNOTSUPP;
1483e3a2b7edSAmir Vadai 	}
1484e3a2b7edSAmir Vadai 
14858f256622SPablo Neira Ayuso 	if ((flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) ||
14868f256622SPablo Neira Ayuso 	     flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_KEYID) ||
14878f256622SPablo Neira Ayuso 	     flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_PORTS)) &&
14888f256622SPablo Neira Ayuso 	    flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_CONTROL)) {
14898f256622SPablo Neira Ayuso 		struct flow_match_control match;
14908f256622SPablo Neira Ayuso 
14918f256622SPablo Neira Ayuso 		flow_rule_match_enc_control(rule, &match);
14928f256622SPablo Neira Ayuso 		switch (match.key->addr_type) {
1493bbd00f7eSHadar Hen Zion 		case FLOW_DISSECTOR_KEY_IPV4_ADDRS:
149419f44401SOr Gerlitz 		case FLOW_DISSECTOR_KEY_IPV6_ADDRS:
14956363651dSOr Gerlitz 			if (parse_tunnel_attr(priv, spec, f, filter_dev, tunnel_match_level))
1496bbd00f7eSHadar Hen Zion 				return -EOPNOTSUPP;
1497bbd00f7eSHadar Hen Zion 			break;
1498bbd00f7eSHadar Hen Zion 		default:
1499bbd00f7eSHadar Hen Zion 			return -EOPNOTSUPP;
1500bbd00f7eSHadar Hen Zion 		}
1501bbd00f7eSHadar Hen Zion 
1502bbd00f7eSHadar Hen Zion 		/* In decap flow, header pointers should point to the inner
1503bbd00f7eSHadar Hen Zion 		 * headers, outer header were already set by parse_tunnel_attr
1504bbd00f7eSHadar Hen Zion 		 */
1505bbd00f7eSHadar Hen Zion 		headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1506bbd00f7eSHadar Hen Zion 					 inner_headers);
1507bbd00f7eSHadar Hen Zion 		headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1508bbd00f7eSHadar Hen Zion 					 inner_headers);
1509bbd00f7eSHadar Hen Zion 	}
1510bbd00f7eSHadar Hen Zion 
15118f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
15128f256622SPablo Neira Ayuso 		struct flow_match_basic match;
1513e3a2b7edSAmir Vadai 
15148f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
15158f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype,
15168f256622SPablo Neira Ayuso 			 ntohs(match.mask->n_proto));
15178f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype,
15188f256622SPablo Neira Ayuso 			 ntohs(match.key->n_proto));
15198f256622SPablo Neira Ayuso 
15208f256622SPablo Neira Ayuso 		if (match.mask->n_proto)
1521d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1522e3a2b7edSAmir Vadai 	}
1523e3a2b7edSAmir Vadai 
15248f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN)) {
15258f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
15268f256622SPablo Neira Ayuso 
15278f256622SPablo Neira Ayuso 		flow_rule_match_vlan(rule, &match);
15288f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
15298f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
15308f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
15318f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1532699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1533699e96ddSJianbo Liu 					 svlan_tag, 1);
1534699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1535699e96ddSJianbo Liu 					 svlan_tag, 1);
1536699e96ddSJianbo Liu 			} else {
1537699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1538699e96ddSJianbo Liu 					 cvlan_tag, 1);
1539699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1540699e96ddSJianbo Liu 					 cvlan_tag, 1);
1541699e96ddSJianbo Liu 			}
1542095b6cfdSOr Gerlitz 
15438f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid,
15448f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
15458f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid,
15468f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1547358d79a4SOr Gerlitz 
15488f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio,
15498f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
15508f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio,
15518f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
155254782900SOr Gerlitz 
1553d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1554095b6cfdSOr Gerlitz 		}
1555d3a80bb5SOr Gerlitz 	} else if (*match_level != MLX5_MATCH_NONE) {
1556cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, svlan_tag, 1);
1557cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1);
1558d3a80bb5SOr Gerlitz 		*match_level = MLX5_MATCH_L2;
1559095b6cfdSOr Gerlitz 	}
1560095b6cfdSOr Gerlitz 
15618f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) {
15628f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
15638f256622SPablo Neira Ayuso 
15648f256622SPablo Neira Ayuso 		flow_rule_match_vlan(rule, &match);
15658f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
15668f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
15678f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
15688f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1569699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1570699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1571699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1572699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1573699e96ddSJianbo Liu 			} else {
1574699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1575699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1576699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1577699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1578699e96ddSJianbo Liu 			}
1579699e96ddSJianbo Liu 
1580699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid,
15818f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
1582699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid,
15838f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1584699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio,
15858f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
1586699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio,
15878f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
1588699e96ddSJianbo Liu 
1589699e96ddSJianbo Liu 			*match_level = MLX5_MATCH_L2;
1590699e96ddSJianbo Liu 		}
1591699e96ddSJianbo Liu 	}
1592699e96ddSJianbo Liu 
15938f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) {
15948f256622SPablo Neira Ayuso 		struct flow_match_eth_addrs match;
159554782900SOr Gerlitz 
15968f256622SPablo Neira Ayuso 		flow_rule_match_eth_addrs(rule, &match);
1597d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1598d3a80bb5SOr Gerlitz 					     dmac_47_16),
15998f256622SPablo Neira Ayuso 				match.mask->dst);
1600d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1601d3a80bb5SOr Gerlitz 					     dmac_47_16),
16028f256622SPablo Neira Ayuso 				match.key->dst);
1603d3a80bb5SOr Gerlitz 
1604d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1605d3a80bb5SOr Gerlitz 					     smac_47_16),
16068f256622SPablo Neira Ayuso 				match.mask->src);
1607d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1608d3a80bb5SOr Gerlitz 					     smac_47_16),
16098f256622SPablo Neira Ayuso 				match.key->src);
1610d3a80bb5SOr Gerlitz 
16118f256622SPablo Neira Ayuso 		if (!is_zero_ether_addr(match.mask->src) ||
16128f256622SPablo Neira Ayuso 		    !is_zero_ether_addr(match.mask->dst))
1613d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
161454782900SOr Gerlitz 	}
161554782900SOr Gerlitz 
16168f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) {
16178f256622SPablo Neira Ayuso 		struct flow_match_control match;
161854782900SOr Gerlitz 
16198f256622SPablo Neira Ayuso 		flow_rule_match_control(rule, &match);
16208f256622SPablo Neira Ayuso 		addr_type = match.key->addr_type;
162154782900SOr Gerlitz 
162254782900SOr Gerlitz 		/* the HW doesn't support frag first/later */
16238f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_FIRST_FRAG)
162454782900SOr Gerlitz 			return -EOPNOTSUPP;
162554782900SOr Gerlitz 
16268f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) {
162754782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
162854782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag,
16298f256622SPablo Neira Ayuso 				 match.key->flags & FLOW_DIS_IS_FRAGMENT);
163054782900SOr Gerlitz 
163154782900SOr Gerlitz 			/* the HW doesn't need L3 inline to match on frag=no */
16328f256622SPablo Neira Ayuso 			if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT))
163383621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L2;
163454782900SOr Gerlitz 	/* ***  L2 attributes parsing up to here *** */
163554782900SOr Gerlitz 			else
163683621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L3;
163754782900SOr Gerlitz 		}
163854782900SOr Gerlitz 	}
163954782900SOr Gerlitz 
16408f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
16418f256622SPablo Neira Ayuso 		struct flow_match_basic match;
16428f256622SPablo Neira Ayuso 
16438f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
16448f256622SPablo Neira Ayuso 		ip_proto = match.key->ip_proto;
164554782900SOr Gerlitz 
164654782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
16478f256622SPablo Neira Ayuso 			 match.mask->ip_proto);
164854782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
16498f256622SPablo Neira Ayuso 			 match.key->ip_proto);
165054782900SOr Gerlitz 
16518f256622SPablo Neira Ayuso 		if (match.mask->ip_proto)
1652d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
165354782900SOr Gerlitz 	}
165454782900SOr Gerlitz 
1655e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
16568f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
1657e3a2b7edSAmir Vadai 
16588f256622SPablo Neira Ayuso 		flow_rule_match_ipv4_addrs(rule, &match);
1659e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1660e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
16618f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1662e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1663e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
16648f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1665e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1666e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
16678f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1668e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1669e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
16708f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1671de0af0bfSRoi Dayan 
16728f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1673d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1674e3a2b7edSAmir Vadai 	}
1675e3a2b7edSAmir Vadai 
1676e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
16778f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
1678e3a2b7edSAmir Vadai 
16798f256622SPablo Neira Ayuso 		flow_rule_match_ipv6_addrs(rule, &match);
1680e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1681e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
16828f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1683e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1684e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
16858f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1686e3a2b7edSAmir Vadai 
1687e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1688e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
16898f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1690e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1691e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
16928f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1693de0af0bfSRoi Dayan 
16948f256622SPablo Neira Ayuso 		if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY ||
16958f256622SPablo Neira Ayuso 		    ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY)
1696d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1697e3a2b7edSAmir Vadai 	}
1698e3a2b7edSAmir Vadai 
16998f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) {
17008f256622SPablo Neira Ayuso 		struct flow_match_ip match;
17011f97a526SOr Gerlitz 
17028f256622SPablo Neira Ayuso 		flow_rule_match_ip(rule, &match);
17038f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
17048f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
17058f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
17068f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
17071f97a526SOr Gerlitz 
17088f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
17098f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
17108f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
17118f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
17121f97a526SOr Gerlitz 
17138f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
17148f256622SPablo Neira Ayuso 			 match.mask->ttl);
17158f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
17168f256622SPablo Neira Ayuso 			 match.key->ttl);
17171f97a526SOr Gerlitz 
17188f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1719a8ade55fSOr Gerlitz 		    !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev,
1720e98bedf5SEli Britstein 						ft_field_support.outer_ipv4_ttl)) {
1721e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1722e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
17231f97a526SOr Gerlitz 			return -EOPNOTSUPP;
1724e98bedf5SEli Britstein 		}
1725a8ade55fSOr Gerlitz 
17268f256622SPablo Neira Ayuso 		if (match.mask->tos || match.mask->ttl)
1727d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
17281f97a526SOr Gerlitz 	}
17291f97a526SOr Gerlitz 
173054782900SOr Gerlitz 	/* ***  L3 attributes parsing up to here *** */
173154782900SOr Gerlitz 
17328f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) {
17338f256622SPablo Neira Ayuso 		struct flow_match_ports match;
17348f256622SPablo Neira Ayuso 
17358f256622SPablo Neira Ayuso 		flow_rule_match_ports(rule, &match);
1736e3a2b7edSAmir Vadai 		switch (ip_proto) {
1737e3a2b7edSAmir Vadai 		case IPPROTO_TCP:
1738e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17398f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.mask->src));
1740e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17418f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.key->src));
1742e3a2b7edSAmir Vadai 
1743e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17448f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.mask->dst));
1745e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17468f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.key->dst));
1747e3a2b7edSAmir Vadai 			break;
1748e3a2b7edSAmir Vadai 
1749e3a2b7edSAmir Vadai 		case IPPROTO_UDP:
1750e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17518f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.mask->src));
1752e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17538f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.key->src));
1754e3a2b7edSAmir Vadai 
1755e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17568f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.mask->dst));
1757e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17588f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.key->dst));
1759e3a2b7edSAmir Vadai 			break;
1760e3a2b7edSAmir Vadai 		default:
1761e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1762e98bedf5SEli Britstein 					   "Only UDP and TCP transports are supported for L4 matching");
1763e3a2b7edSAmir Vadai 			netdev_err(priv->netdev,
1764e3a2b7edSAmir Vadai 				   "Only UDP and TCP transport are supported\n");
1765e3a2b7edSAmir Vadai 			return -EINVAL;
1766e3a2b7edSAmir Vadai 		}
1767de0af0bfSRoi Dayan 
17688f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1769d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1770e3a2b7edSAmir Vadai 	}
1771e3a2b7edSAmir Vadai 
17728f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) {
17738f256622SPablo Neira Ayuso 		struct flow_match_tcp match;
1774e77834ecSOr Gerlitz 
17758f256622SPablo Neira Ayuso 		flow_rule_match_tcp(rule, &match);
1776e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags,
17778f256622SPablo Neira Ayuso 			 ntohs(match.mask->flags));
1778e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags,
17798f256622SPablo Neira Ayuso 			 ntohs(match.key->flags));
1780e77834ecSOr Gerlitz 
17818f256622SPablo Neira Ayuso 		if (match.mask->flags)
1782d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1783e77834ecSOr Gerlitz 	}
1784e77834ecSOr Gerlitz 
1785e3a2b7edSAmir Vadai 	return 0;
1786e3a2b7edSAmir Vadai }
1787e3a2b7edSAmir Vadai 
1788de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv,
178965ba8fb7SOr Gerlitz 			    struct mlx5e_tc_flow *flow,
1790de0af0bfSRoi Dayan 			    struct mlx5_flow_spec *spec,
179154c177caSOz Shlomo 			    struct tc_cls_flower_offload *f,
179254c177caSOz Shlomo 			    struct net_device *filter_dev)
1793de0af0bfSRoi Dayan {
1794e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1795de0af0bfSRoi Dayan 	struct mlx5_core_dev *dev = priv->mdev;
1796de0af0bfSRoi Dayan 	struct mlx5_eswitch *esw = dev->priv.eswitch;
17971d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
17986363651dSOr Gerlitz 	u8 match_level, tunnel_match_level = MLX5_MATCH_NONE;
17991d447a39SSaeed Mahameed 	struct mlx5_eswitch_rep *rep;
1800de0af0bfSRoi Dayan 	int err;
1801de0af0bfSRoi Dayan 
18026363651dSOr Gerlitz 	err = __parse_cls_flower(priv, spec, f, filter_dev, &match_level, &tunnel_match_level);
1803de0af0bfSRoi Dayan 
18041d447a39SSaeed Mahameed 	if (!err && (flow->flags & MLX5E_TC_FLOW_ESWITCH)) {
18051d447a39SSaeed Mahameed 		rep = rpriv->rep;
1806b05af6aaSBodong Wang 		if (rep->vport != MLX5_VPORT_UPLINK &&
18071d447a39SSaeed Mahameed 		    (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE &&
1808d708f902SOr Gerlitz 		    esw->offloads.inline_mode < match_level)) {
1809e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1810e98bedf5SEli Britstein 					   "Flow is not offloaded due to min inline setting");
1811de0af0bfSRoi Dayan 			netdev_warn(priv->netdev,
1812de0af0bfSRoi Dayan 				    "Flow is not offloaded due to min inline setting, required %d actual %d\n",
1813d708f902SOr Gerlitz 				    match_level, esw->offloads.inline_mode);
1814de0af0bfSRoi Dayan 			return -EOPNOTSUPP;
1815de0af0bfSRoi Dayan 		}
1816de0af0bfSRoi Dayan 	}
1817de0af0bfSRoi Dayan 
18186363651dSOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
181938aa51c1SOr Gerlitz 		flow->esw_attr->match_level = match_level;
18206363651dSOr Gerlitz 		flow->esw_attr->tunnel_match_level = tunnel_match_level;
18216363651dSOr Gerlitz 	} else {
182238aa51c1SOr Gerlitz 		flow->nic_attr->match_level = match_level;
18236363651dSOr Gerlitz 	}
182438aa51c1SOr Gerlitz 
1825de0af0bfSRoi Dayan 	return err;
1826de0af0bfSRoi Dayan }
1827de0af0bfSRoi Dayan 
1828d79b6df6SOr Gerlitz struct pedit_headers {
1829d79b6df6SOr Gerlitz 	struct ethhdr  eth;
1830d79b6df6SOr Gerlitz 	struct iphdr   ip4;
1831d79b6df6SOr Gerlitz 	struct ipv6hdr ip6;
1832d79b6df6SOr Gerlitz 	struct tcphdr  tcp;
1833d79b6df6SOr Gerlitz 	struct udphdr  udp;
1834d79b6df6SOr Gerlitz };
1835d79b6df6SOr Gerlitz 
1836c500c86bSPablo Neira Ayuso struct pedit_headers_action {
1837c500c86bSPablo Neira Ayuso 	struct pedit_headers	vals;
1838c500c86bSPablo Neira Ayuso 	struct pedit_headers	masks;
1839c500c86bSPablo Neira Ayuso 	u32			pedits;
1840c500c86bSPablo Neira Ayuso };
1841c500c86bSPablo Neira Ayuso 
1842d79b6df6SOr Gerlitz static int pedit_header_offsets[] = {
184373867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth),
184473867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4),
184573867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6),
184673867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp),
184773867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp),
1848d79b6df6SOr Gerlitz };
1849d79b6df6SOr Gerlitz 
1850d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype])
1851d79b6df6SOr Gerlitz 
1852d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset,
1853c500c86bSPablo Neira Ayuso 			 struct pedit_headers_action *hdrs)
1854d79b6df6SOr Gerlitz {
1855d79b6df6SOr Gerlitz 	u32 *curr_pmask, *curr_pval;
1856d79b6df6SOr Gerlitz 
1857c500c86bSPablo Neira Ayuso 	curr_pmask = (u32 *)(pedit_header(&hdrs->masks, hdr_type) + offset);
1858c500c86bSPablo Neira Ayuso 	curr_pval  = (u32 *)(pedit_header(&hdrs->vals, hdr_type) + offset);
1859d79b6df6SOr Gerlitz 
1860d79b6df6SOr Gerlitz 	if (*curr_pmask & mask)  /* disallow acting twice on the same location */
1861d79b6df6SOr Gerlitz 		goto out_err;
1862d79b6df6SOr Gerlitz 
1863d79b6df6SOr Gerlitz 	*curr_pmask |= mask;
1864d79b6df6SOr Gerlitz 	*curr_pval  |= (val & mask);
1865d79b6df6SOr Gerlitz 
1866d79b6df6SOr Gerlitz 	return 0;
1867d79b6df6SOr Gerlitz 
1868d79b6df6SOr Gerlitz out_err:
1869d79b6df6SOr Gerlitz 	return -EOPNOTSUPP;
1870d79b6df6SOr Gerlitz }
1871d79b6df6SOr Gerlitz 
1872d79b6df6SOr Gerlitz struct mlx5_fields {
1873d79b6df6SOr Gerlitz 	u8  field;
1874d79b6df6SOr Gerlitz 	u8  size;
1875d79b6df6SOr Gerlitz 	u32 offset;
1876d79b6df6SOr Gerlitz };
1877d79b6df6SOr Gerlitz 
1878a8e4f0c4SOr Gerlitz #define OFFLOAD(fw_field, size, field, off) \
1879a8e4f0c4SOr Gerlitz 		{MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, size, offsetof(struct pedit_headers, field) + (off)}
1880a8e4f0c4SOr Gerlitz 
1881d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = {
1882a8e4f0c4SOr Gerlitz 	OFFLOAD(DMAC_47_16, 4, eth.h_dest[0], 0),
1883a8e4f0c4SOr Gerlitz 	OFFLOAD(DMAC_15_0,  2, eth.h_dest[4], 0),
1884a8e4f0c4SOr Gerlitz 	OFFLOAD(SMAC_47_16, 4, eth.h_source[0], 0),
1885a8e4f0c4SOr Gerlitz 	OFFLOAD(SMAC_15_0,  2, eth.h_source[4], 0),
1886a8e4f0c4SOr Gerlitz 	OFFLOAD(ETHERTYPE,  2, eth.h_proto, 0),
1887d79b6df6SOr Gerlitz 
1888a8e4f0c4SOr Gerlitz 	OFFLOAD(IP_TTL, 1, ip4.ttl,   0),
1889a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV4,  4, ip4.saddr, 0),
1890a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV4,  4, ip4.daddr, 0),
1891d79b6df6SOr Gerlitz 
1892a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_127_96, 4, ip6.saddr.s6_addr32[0], 0),
1893a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_95_64,  4, ip6.saddr.s6_addr32[1], 0),
1894a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_63_32,  4, ip6.saddr.s6_addr32[2], 0),
1895a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_31_0,   4, ip6.saddr.s6_addr32[3], 0),
1896a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_127_96, 4, ip6.daddr.s6_addr32[0], 0),
1897a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_95_64,  4, ip6.daddr.s6_addr32[1], 0),
1898a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_63_32,  4, ip6.daddr.s6_addr32[2], 0),
1899a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_31_0,   4, ip6.daddr.s6_addr32[3], 0),
19000c0316f5SOr Gerlitz 	OFFLOAD(IPV6_HOPLIMIT, 1, ip6.hop_limit, 0),
1901d79b6df6SOr Gerlitz 
1902a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_SPORT, 2, tcp.source,  0),
1903a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_DPORT, 2, tcp.dest,    0),
1904a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_FLAGS, 1, tcp.ack_seq, 5),
1905d79b6df6SOr Gerlitz 
1906a8e4f0c4SOr Gerlitz 	OFFLOAD(UDP_SPORT, 2, udp.source, 0),
1907a8e4f0c4SOr Gerlitz 	OFFLOAD(UDP_DPORT, 2, udp.dest,   0),
1908d79b6df6SOr Gerlitz };
1909d79b6df6SOr Gerlitz 
1910218d05ceSTonghao Zhang /* On input attr->max_mod_hdr_actions tells how many HW actions can be parsed at
1911218d05ceSTonghao Zhang  * max from the SW pedit action. On success, attr->num_mod_hdr_actions
1912218d05ceSTonghao Zhang  * says how many HW actions were actually parsed.
1913d79b6df6SOr Gerlitz  */
1914c500c86bSPablo Neira Ayuso static int offload_pedit_fields(struct pedit_headers_action *hdrs,
1915e98bedf5SEli Britstein 				struct mlx5e_tc_flow_parse_attr *parse_attr,
1916e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
1917d79b6df6SOr Gerlitz {
1918d79b6df6SOr Gerlitz 	struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals;
19192b64bebaSOr Gerlitz 	int i, action_size, nactions, max_actions, first, last, next_z;
1920d79b6df6SOr Gerlitz 	void *s_masks_p, *a_masks_p, *vals_p;
1921d79b6df6SOr Gerlitz 	struct mlx5_fields *f;
1922d79b6df6SOr Gerlitz 	u8 cmd, field_bsize;
1923e3ca4e05SOr Gerlitz 	u32 s_mask, a_mask;
1924d79b6df6SOr Gerlitz 	unsigned long mask;
19252b64bebaSOr Gerlitz 	__be32 mask_be32;
19262b64bebaSOr Gerlitz 	__be16 mask_be16;
1927d79b6df6SOr Gerlitz 	void *action;
1928d79b6df6SOr Gerlitz 
192973867881SPablo Neira Ayuso 	set_masks = &hdrs[0].masks;
193073867881SPablo Neira Ayuso 	add_masks = &hdrs[1].masks;
193173867881SPablo Neira Ayuso 	set_vals = &hdrs[0].vals;
193273867881SPablo Neira Ayuso 	add_vals = &hdrs[1].vals;
1933d79b6df6SOr Gerlitz 
1934d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
1935218d05ceSTonghao Zhang 	action = parse_attr->mod_hdr_actions +
1936218d05ceSTonghao Zhang 		 parse_attr->num_mod_hdr_actions * action_size;
1937218d05ceSTonghao Zhang 
1938218d05ceSTonghao Zhang 	max_actions = parse_attr->max_mod_hdr_actions;
1939218d05ceSTonghao Zhang 	nactions = parse_attr->num_mod_hdr_actions;
1940d79b6df6SOr Gerlitz 
1941d79b6df6SOr Gerlitz 	for (i = 0; i < ARRAY_SIZE(fields); i++) {
1942d79b6df6SOr Gerlitz 		f = &fields[i];
1943d79b6df6SOr Gerlitz 		/* avoid seeing bits set from previous iterations */
1944e3ca4e05SOr Gerlitz 		s_mask = 0;
1945e3ca4e05SOr Gerlitz 		a_mask = 0;
1946d79b6df6SOr Gerlitz 
1947d79b6df6SOr Gerlitz 		s_masks_p = (void *)set_masks + f->offset;
1948d79b6df6SOr Gerlitz 		a_masks_p = (void *)add_masks + f->offset;
1949d79b6df6SOr Gerlitz 
1950d79b6df6SOr Gerlitz 		memcpy(&s_mask, s_masks_p, f->size);
1951d79b6df6SOr Gerlitz 		memcpy(&a_mask, a_masks_p, f->size);
1952d79b6df6SOr Gerlitz 
1953d79b6df6SOr Gerlitz 		if (!s_mask && !a_mask) /* nothing to offload here */
1954d79b6df6SOr Gerlitz 			continue;
1955d79b6df6SOr Gerlitz 
1956d79b6df6SOr Gerlitz 		if (s_mask && a_mask) {
1957e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1958e98bedf5SEli Britstein 					   "can't set and add to the same HW field");
1959d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field);
1960d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1961d79b6df6SOr Gerlitz 		}
1962d79b6df6SOr Gerlitz 
1963d79b6df6SOr Gerlitz 		if (nactions == max_actions) {
1964e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1965e98bedf5SEli Britstein 					   "too many pedit actions, can't offload");
1966d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions);
1967d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1968d79b6df6SOr Gerlitz 		}
1969d79b6df6SOr Gerlitz 
1970d79b6df6SOr Gerlitz 		if (s_mask) {
1971d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_SET;
1972d79b6df6SOr Gerlitz 			mask = s_mask;
1973d79b6df6SOr Gerlitz 			vals_p = (void *)set_vals + f->offset;
1974d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
1975d79b6df6SOr Gerlitz 			memset(s_masks_p, 0, f->size);
1976d79b6df6SOr Gerlitz 		} else {
1977d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_ADD;
1978d79b6df6SOr Gerlitz 			mask = a_mask;
1979d79b6df6SOr Gerlitz 			vals_p = (void *)add_vals + f->offset;
1980d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
1981d79b6df6SOr Gerlitz 			memset(a_masks_p, 0, f->size);
1982d79b6df6SOr Gerlitz 		}
1983d79b6df6SOr Gerlitz 
1984d79b6df6SOr Gerlitz 		field_bsize = f->size * BITS_PER_BYTE;
1985e3ca4e05SOr Gerlitz 
19862b64bebaSOr Gerlitz 		if (field_bsize == 32) {
19872b64bebaSOr Gerlitz 			mask_be32 = *(__be32 *)&mask;
19882b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32));
19892b64bebaSOr Gerlitz 		} else if (field_bsize == 16) {
19902b64bebaSOr Gerlitz 			mask_be16 = *(__be16 *)&mask;
19912b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16));
19922b64bebaSOr Gerlitz 		}
19932b64bebaSOr Gerlitz 
1994d79b6df6SOr Gerlitz 		first = find_first_bit(&mask, field_bsize);
19952b64bebaSOr Gerlitz 		next_z = find_next_zero_bit(&mask, field_bsize, first);
1996d79b6df6SOr Gerlitz 		last  = find_last_bit(&mask, field_bsize);
19972b64bebaSOr Gerlitz 		if (first < next_z && next_z < last) {
1998e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1999e98bedf5SEli Britstein 					   "rewrite of few sub-fields isn't supported");
20002b64bebaSOr Gerlitz 			printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n",
2001d79b6df6SOr Gerlitz 			       mask);
2002d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
2003d79b6df6SOr Gerlitz 		}
2004d79b6df6SOr Gerlitz 
2005d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, action_type, cmd);
2006d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, field, f->field);
2007d79b6df6SOr Gerlitz 
2008d79b6df6SOr Gerlitz 		if (cmd == MLX5_ACTION_TYPE_SET) {
20092b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, offset, first);
2010d79b6df6SOr Gerlitz 			/* length is num of bits to be written, zero means length of 32 */
20112b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, length, (last - first + 1));
2012d79b6df6SOr Gerlitz 		}
2013d79b6df6SOr Gerlitz 
2014d79b6df6SOr Gerlitz 		if (field_bsize == 32)
20152b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first);
2016d79b6df6SOr Gerlitz 		else if (field_bsize == 16)
20172b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first);
2018d79b6df6SOr Gerlitz 		else if (field_bsize == 8)
20192b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first);
2020d79b6df6SOr Gerlitz 
2021d79b6df6SOr Gerlitz 		action += action_size;
2022d79b6df6SOr Gerlitz 		nactions++;
2023d79b6df6SOr Gerlitz 	}
2024d79b6df6SOr Gerlitz 
2025d79b6df6SOr Gerlitz 	parse_attr->num_mod_hdr_actions = nactions;
2026d79b6df6SOr Gerlitz 	return 0;
2027d79b6df6SOr Gerlitz }
2028d79b6df6SOr Gerlitz 
2029d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv,
2030c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2031c500c86bSPablo Neira Ayuso 				 int namespace,
2032d79b6df6SOr Gerlitz 				 struct mlx5e_tc_flow_parse_attr *parse_attr)
2033d79b6df6SOr Gerlitz {
2034d79b6df6SOr Gerlitz 	int nkeys, action_size, max_actions;
2035d79b6df6SOr Gerlitz 
2036c500c86bSPablo Neira Ayuso 	nkeys = hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits +
2037c500c86bSPablo Neira Ayuso 		hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits;
2038d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
2039d79b6df6SOr Gerlitz 
2040d79b6df6SOr Gerlitz 	if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */
2041d79b6df6SOr Gerlitz 		max_actions = MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, max_modify_header_actions);
2042d79b6df6SOr Gerlitz 	else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */
2043d79b6df6SOr Gerlitz 		max_actions = MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, max_modify_header_actions);
2044d79b6df6SOr Gerlitz 
2045d79b6df6SOr Gerlitz 	/* can get up to crazingly 16 HW actions in 32 bits pedit SW key */
2046d79b6df6SOr Gerlitz 	max_actions = min(max_actions, nkeys * 16);
2047d79b6df6SOr Gerlitz 
2048d79b6df6SOr Gerlitz 	parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL);
2049d79b6df6SOr Gerlitz 	if (!parse_attr->mod_hdr_actions)
2050d79b6df6SOr Gerlitz 		return -ENOMEM;
2051d79b6df6SOr Gerlitz 
2052218d05ceSTonghao Zhang 	parse_attr->max_mod_hdr_actions = max_actions;
2053d79b6df6SOr Gerlitz 	return 0;
2054d79b6df6SOr Gerlitz }
2055d79b6df6SOr Gerlitz 
2056d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {};
2057d79b6df6SOr Gerlitz 
2058d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv,
205973867881SPablo Neira Ayuso 				 const struct flow_action_entry *act, int namespace,
2060e98bedf5SEli Britstein 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2061c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2062e98bedf5SEli Britstein 				 struct netlink_ext_ack *extack)
2063d79b6df6SOr Gerlitz {
206473867881SPablo Neira Ayuso 	u8 cmd = (act->id == FLOW_ACTION_MANGLE) ? 0 : 1;
206573867881SPablo Neira Ayuso 	int err = -EOPNOTSUPP;
2066d79b6df6SOr Gerlitz 	u32 mask, val, offset;
206773867881SPablo Neira Ayuso 	u8 htype;
2068d79b6df6SOr Gerlitz 
206973867881SPablo Neira Ayuso 	htype = act->mangle.htype;
2070d79b6df6SOr Gerlitz 	err = -EOPNOTSUPP; /* can't be all optimistic */
2071d79b6df6SOr Gerlitz 
207273867881SPablo Neira Ayuso 	if (htype == FLOW_ACT_MANGLE_UNSPEC) {
207373867881SPablo Neira Ayuso 		NL_SET_ERR_MSG_MOD(extack, "legacy pedit isn't offloaded");
2074d79b6df6SOr Gerlitz 		goto out_err;
2075d79b6df6SOr Gerlitz 	}
2076d79b6df6SOr Gerlitz 
207773867881SPablo Neira Ayuso 	mask = act->mangle.mask;
207873867881SPablo Neira Ayuso 	val = act->mangle.val;
207973867881SPablo Neira Ayuso 	offset = act->mangle.offset;
2080d79b6df6SOr Gerlitz 
2081c500c86bSPablo Neira Ayuso 	err = set_pedit_val(htype, ~mask, val, offset, &hdrs[cmd]);
2082d79b6df6SOr Gerlitz 	if (err)
2083d79b6df6SOr Gerlitz 		goto out_err;
2084c500c86bSPablo Neira Ayuso 
2085c500c86bSPablo Neira Ayuso 	hdrs[cmd].pedits++;
2086d79b6df6SOr Gerlitz 
2087c500c86bSPablo Neira Ayuso 	return 0;
2088c500c86bSPablo Neira Ayuso out_err:
2089c500c86bSPablo Neira Ayuso 	return err;
2090c500c86bSPablo Neira Ayuso }
2091c500c86bSPablo Neira Ayuso 
2092c500c86bSPablo Neira Ayuso static int alloc_tc_pedit_action(struct mlx5e_priv *priv, int namespace,
2093c500c86bSPablo Neira Ayuso 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2094c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2095c500c86bSPablo Neira Ayuso 				 struct netlink_ext_ack *extack)
2096c500c86bSPablo Neira Ayuso {
2097c500c86bSPablo Neira Ayuso 	struct pedit_headers *cmd_masks;
2098c500c86bSPablo Neira Ayuso 	int err;
2099c500c86bSPablo Neira Ayuso 	u8 cmd;
2100c500c86bSPablo Neira Ayuso 
2101218d05ceSTonghao Zhang 	if (!parse_attr->mod_hdr_actions) {
2102c500c86bSPablo Neira Ayuso 		err = alloc_mod_hdr_actions(priv, hdrs, namespace, parse_attr);
2103d79b6df6SOr Gerlitz 		if (err)
2104d79b6df6SOr Gerlitz 			goto out_err;
2105218d05ceSTonghao Zhang 	}
2106d79b6df6SOr Gerlitz 
2107c500c86bSPablo Neira Ayuso 	err = offload_pedit_fields(hdrs, parse_attr, extack);
2108d79b6df6SOr Gerlitz 	if (err < 0)
2109d79b6df6SOr Gerlitz 		goto out_dealloc_parsed_actions;
2110d79b6df6SOr Gerlitz 
2111d79b6df6SOr Gerlitz 	for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) {
2112c500c86bSPablo Neira Ayuso 		cmd_masks = &hdrs[cmd].masks;
2113d79b6df6SOr Gerlitz 		if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) {
2114e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2115e98bedf5SEli Britstein 					   "attempt to offload an unsupported field");
2116b3a433deSOr Gerlitz 			netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd);
2117d79b6df6SOr Gerlitz 			print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS,
2118d79b6df6SOr Gerlitz 				       16, 1, cmd_masks, sizeof(zero_masks), true);
2119d79b6df6SOr Gerlitz 			err = -EOPNOTSUPP;
2120d79b6df6SOr Gerlitz 			goto out_dealloc_parsed_actions;
2121d79b6df6SOr Gerlitz 		}
2122d79b6df6SOr Gerlitz 	}
2123d79b6df6SOr Gerlitz 
2124d79b6df6SOr Gerlitz 	return 0;
2125d79b6df6SOr Gerlitz 
2126d79b6df6SOr Gerlitz out_dealloc_parsed_actions:
2127d79b6df6SOr Gerlitz 	kfree(parse_attr->mod_hdr_actions);
2128d79b6df6SOr Gerlitz out_err:
2129d79b6df6SOr Gerlitz 	return err;
2130d79b6df6SOr Gerlitz }
2131d79b6df6SOr Gerlitz 
2132e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv,
2133e98bedf5SEli Britstein 				   u32 action,
2134e98bedf5SEli Britstein 				   u32 update_flags,
2135e98bedf5SEli Britstein 				   struct netlink_ext_ack *extack)
213626c02749SOr Gerlitz {
213726c02749SOr Gerlitz 	u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP |
213826c02749SOr Gerlitz 			 TCA_CSUM_UPDATE_FLAG_UDP;
213926c02749SOr Gerlitz 
214026c02749SOr Gerlitz 	/*  The HW recalcs checksums only if re-writing headers */
214126c02749SOr Gerlitz 	if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) {
2142e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2143e98bedf5SEli Britstein 				   "TC csum action is only offloaded with pedit");
214426c02749SOr Gerlitz 		netdev_warn(priv->netdev,
214526c02749SOr Gerlitz 			    "TC csum action is only offloaded with pedit\n");
214626c02749SOr Gerlitz 		return false;
214726c02749SOr Gerlitz 	}
214826c02749SOr Gerlitz 
214926c02749SOr Gerlitz 	if (update_flags & ~prot_flags) {
2150e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2151e98bedf5SEli Britstein 				   "can't offload TC csum action for some header/s");
215226c02749SOr Gerlitz 		netdev_warn(priv->netdev,
215326c02749SOr Gerlitz 			    "can't offload TC csum action for some header/s - flags %#x\n",
215426c02749SOr Gerlitz 			    update_flags);
215526c02749SOr Gerlitz 		return false;
215626c02749SOr Gerlitz 	}
215726c02749SOr Gerlitz 
215826c02749SOr Gerlitz 	return true;
215926c02749SOr Gerlitz }
216026c02749SOr Gerlitz 
2161bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec,
216273867881SPablo Neira Ayuso 					  struct flow_action *flow_action,
21631651925dSGuy Shattah 					  u32 actions,
2164e98bedf5SEli Britstein 					  struct netlink_ext_ack *extack)
2165bdd66ac0SOr Gerlitz {
216673867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
2167bdd66ac0SOr Gerlitz 	bool modify_ip_header;
2168bdd66ac0SOr Gerlitz 	u8 htype, ip_proto;
2169bdd66ac0SOr Gerlitz 	void *headers_v;
2170bdd66ac0SOr Gerlitz 	u16 ethertype;
217173867881SPablo Neira Ayuso 	int i;
2172bdd66ac0SOr Gerlitz 
21731651925dSGuy Shattah 	if (actions & MLX5_FLOW_CONTEXT_ACTION_DECAP)
21741651925dSGuy Shattah 		headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, inner_headers);
21751651925dSGuy Shattah 	else
2176bdd66ac0SOr Gerlitz 		headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
21771651925dSGuy Shattah 
2178bdd66ac0SOr Gerlitz 	ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype);
2179bdd66ac0SOr Gerlitz 
2180bdd66ac0SOr Gerlitz 	/* for non-IP we only re-write MACs, so we're okay */
2181bdd66ac0SOr Gerlitz 	if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6)
2182bdd66ac0SOr Gerlitz 		goto out_ok;
2183bdd66ac0SOr Gerlitz 
2184bdd66ac0SOr Gerlitz 	modify_ip_header = false;
218573867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
218673867881SPablo Neira Ayuso 		if (act->id != FLOW_ACTION_MANGLE &&
218773867881SPablo Neira Ayuso 		    act->id != FLOW_ACTION_ADD)
2188bdd66ac0SOr Gerlitz 			continue;
2189bdd66ac0SOr Gerlitz 
219073867881SPablo Neira Ayuso 		htype = act->mangle.htype;
219173867881SPablo Neira Ayuso 		if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP4 ||
219273867881SPablo Neira Ayuso 		    htype == FLOW_ACT_MANGLE_HDR_TYPE_IP6) {
2193bdd66ac0SOr Gerlitz 			modify_ip_header = true;
2194bdd66ac0SOr Gerlitz 			break;
2195bdd66ac0SOr Gerlitz 		}
2196bdd66ac0SOr Gerlitz 	}
2197bdd66ac0SOr Gerlitz 
2198bdd66ac0SOr Gerlitz 	ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol);
21991ccef350SJianbo Liu 	if (modify_ip_header && ip_proto != IPPROTO_TCP &&
22001ccef350SJianbo Liu 	    ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) {
2201e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2202e98bedf5SEli Britstein 				   "can't offload re-write of non TCP/UDP");
2203bdd66ac0SOr Gerlitz 		pr_info("can't offload re-write of ip proto %d\n", ip_proto);
2204bdd66ac0SOr Gerlitz 		return false;
2205bdd66ac0SOr Gerlitz 	}
2206bdd66ac0SOr Gerlitz 
2207bdd66ac0SOr Gerlitz out_ok:
2208bdd66ac0SOr Gerlitz 	return true;
2209bdd66ac0SOr Gerlitz }
2210bdd66ac0SOr Gerlitz 
2211bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv,
221273867881SPablo Neira Ayuso 				    struct flow_action *flow_action,
2213bdd66ac0SOr Gerlitz 				    struct mlx5e_tc_flow_parse_attr *parse_attr,
2214e98bedf5SEli Britstein 				    struct mlx5e_tc_flow *flow,
2215e98bedf5SEli Britstein 				    struct netlink_ext_ack *extack)
2216bdd66ac0SOr Gerlitz {
2217bdd66ac0SOr Gerlitz 	u32 actions;
2218bdd66ac0SOr Gerlitz 
2219bdd66ac0SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
2220bdd66ac0SOr Gerlitz 		actions = flow->esw_attr->action;
2221bdd66ac0SOr Gerlitz 	else
2222bdd66ac0SOr Gerlitz 		actions = flow->nic_attr->action;
2223bdd66ac0SOr Gerlitz 
22247e29392eSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_EGRESS &&
22257e29392eSRoi Dayan 	    !(actions & MLX5_FLOW_CONTEXT_ACTION_DECAP))
22267e29392eSRoi Dayan 		return false;
22277e29392eSRoi Dayan 
2228bdd66ac0SOr Gerlitz 	if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
222973867881SPablo Neira Ayuso 		return modify_header_match_supported(&parse_attr->spec,
2230a655fe9fSDavid S. Miller 						     flow_action, actions,
2231e98bedf5SEli Britstein 						     extack);
2232bdd66ac0SOr Gerlitz 
2233bdd66ac0SOr Gerlitz 	return true;
2234bdd66ac0SOr Gerlitz }
2235bdd66ac0SOr Gerlitz 
22365c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv)
22375c65c564SOr Gerlitz {
22385c65c564SOr Gerlitz 	struct mlx5_core_dev *fmdev, *pmdev;
2239816f6706SOr Gerlitz 	u64 fsystem_guid, psystem_guid;
22405c65c564SOr Gerlitz 
22415c65c564SOr Gerlitz 	fmdev = priv->mdev;
22425c65c564SOr Gerlitz 	pmdev = peer_priv->mdev;
22435c65c564SOr Gerlitz 
224459c9d35eSAlaa Hleihel 	fsystem_guid = mlx5_query_nic_system_image_guid(fmdev);
224559c9d35eSAlaa Hleihel 	psystem_guid = mlx5_query_nic_system_image_guid(pmdev);
22465c65c564SOr Gerlitz 
2247816f6706SOr Gerlitz 	return (fsystem_guid == psystem_guid);
22485c65c564SOr Gerlitz }
22495c65c564SOr Gerlitz 
225073867881SPablo Neira Ayuso static int parse_tc_nic_actions(struct mlx5e_priv *priv,
225173867881SPablo Neira Ayuso 				struct flow_action *flow_action,
2252aa0cbbaeSOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr,
2253e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2254e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2255e3a2b7edSAmir Vadai {
2256aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
225773867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
225873867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
22591cab1cd7SOr Gerlitz 	u32 action = 0;
2260244cd96aSCong Wang 	int err, i;
2261e3a2b7edSAmir Vadai 
226273867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
2263e3a2b7edSAmir Vadai 		return -EINVAL;
2264e3a2b7edSAmir Vadai 
22653bc4b7bfSOr Gerlitz 	attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG;
2266e3a2b7edSAmir Vadai 
226773867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
226873867881SPablo Neira Ayuso 		switch (act->id) {
226973867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
22701cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP;
2271aad7e08dSAmir Vadai 			if (MLX5_CAP_FLOWTABLE(priv->mdev,
2272aad7e08dSAmir Vadai 					       flow_table_properties_nic_receive.flow_counter))
22731cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
227473867881SPablo Neira Ayuso 			break;
227573867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
227673867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
227773867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_KERNEL,
2278c500c86bSPablo Neira Ayuso 						    parse_attr, hdrs, extack);
22792f4fe4caSOr Gerlitz 			if (err)
22802f4fe4caSOr Gerlitz 				return err;
22812f4fe4caSOr Gerlitz 
22821cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR |
22832f4fe4caSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
228473867881SPablo Neira Ayuso 			break;
228573867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
22861cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
228773867881SPablo Neira Ayuso 						   act->csum_flags,
2288e98bedf5SEli Britstein 						   extack))
228973867881SPablo Neira Ayuso 				break;
229026c02749SOr Gerlitz 
229126c02749SOr Gerlitz 			return -EOPNOTSUPP;
229273867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT: {
229373867881SPablo Neira Ayuso 			struct net_device *peer_dev = act->dev;
22945c65c564SOr Gerlitz 
22955c65c564SOr Gerlitz 			if (priv->netdev->netdev_ops == peer_dev->netdev_ops &&
22965c65c564SOr Gerlitz 			    same_hw_devs(priv, netdev_priv(peer_dev))) {
229798b66cb1SEli Britstein 				parse_attr->mirred_ifindex[0] = peer_dev->ifindex;
22985c65c564SOr Gerlitz 				flow->flags |= MLX5E_TC_FLOW_HAIRPIN;
22991cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
23005c65c564SOr Gerlitz 					  MLX5_FLOW_CONTEXT_ACTION_COUNT;
23015c65c564SOr Gerlitz 			} else {
2302e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2303e98bedf5SEli Britstein 						   "device is not on same HW, can't offload");
23045c65c564SOr Gerlitz 				netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n",
23055c65c564SOr Gerlitz 					    peer_dev->name);
23065c65c564SOr Gerlitz 				return -EINVAL;
23075c65c564SOr Gerlitz 			}
23085c65c564SOr Gerlitz 			}
230973867881SPablo Neira Ayuso 			break;
231073867881SPablo Neira Ayuso 		case FLOW_ACTION_MARK: {
231173867881SPablo Neira Ayuso 			u32 mark = act->mark;
2312e3a2b7edSAmir Vadai 
2313e3a2b7edSAmir Vadai 			if (mark & ~MLX5E_TC_FLOW_ID_MASK) {
2314e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2315e98bedf5SEli Britstein 						   "Bad flow mark - only 16 bit is supported");
2316e3a2b7edSAmir Vadai 				return -EINVAL;
2317e3a2b7edSAmir Vadai 			}
2318e3a2b7edSAmir Vadai 
23193bc4b7bfSOr Gerlitz 			attr->flow_tag = mark;
23201cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
2321e3a2b7edSAmir Vadai 			}
232273867881SPablo Neira Ayuso 			break;
232373867881SPablo Neira Ayuso 		default:
2324e3a2b7edSAmir Vadai 			return -EINVAL;
2325e3a2b7edSAmir Vadai 		}
232673867881SPablo Neira Ayuso 	}
2327e3a2b7edSAmir Vadai 
2328c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
2329c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
2330c500c86bSPablo Neira Ayuso 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL,
2331c500c86bSPablo Neira Ayuso 					    parse_attr, hdrs, extack);
2332c500c86bSPablo Neira Ayuso 		if (err)
2333c500c86bSPablo Neira Ayuso 			return err;
2334c500c86bSPablo Neira Ayuso 	}
2335c500c86bSPablo Neira Ayuso 
23361cab1cd7SOr Gerlitz 	attr->action = action;
233773867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
2338bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
2339bdd66ac0SOr Gerlitz 
2340e3a2b7edSAmir Vadai 	return 0;
2341e3a2b7edSAmir Vadai }
2342e3a2b7edSAmir Vadai 
234376f7444dSOr Gerlitz static inline int cmp_encap_info(struct ip_tunnel_key *a,
234476f7444dSOr Gerlitz 				 struct ip_tunnel_key *b)
2345a54e20b4SHadar Hen Zion {
2346a54e20b4SHadar Hen Zion 	return memcmp(a, b, sizeof(*a));
2347a54e20b4SHadar Hen Zion }
2348a54e20b4SHadar Hen Zion 
234976f7444dSOr Gerlitz static inline int hash_encap_info(struct ip_tunnel_key *key)
2350a54e20b4SHadar Hen Zion {
235176f7444dSOr Gerlitz 	return jhash(key, sizeof(*key), 0);
2352a54e20b4SHadar Hen Zion }
2353a54e20b4SHadar Hen Zion 
2354a54e20b4SHadar Hen Zion 
2355b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv,
2356b1d90e6bSRabie Loulou 				  struct net_device *peer_netdev)
2357b1d90e6bSRabie Loulou {
2358b1d90e6bSRabie Loulou 	struct mlx5e_priv *peer_priv;
2359b1d90e6bSRabie Loulou 
2360b1d90e6bSRabie Loulou 	peer_priv = netdev_priv(peer_netdev);
2361b1d90e6bSRabie Loulou 
2362b1d90e6bSRabie Loulou 	return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) &&
236368931c7dSRoi Dayan 		mlx5e_eswitch_rep(priv->netdev) &&
236468931c7dSRoi Dayan 		mlx5e_eswitch_rep(peer_netdev) &&
236568931c7dSRoi Dayan 		same_hw_devs(priv, peer_priv));
2366b1d90e6bSRabie Loulou }
2367b1d90e6bSRabie Loulou 
2368ce99f6b9SOr Gerlitz 
236954c177caSOz Shlomo 
2370a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv,
2371e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
2372733d4f36SRoi Dayan 			      struct net_device *mirred_dev,
2373733d4f36SRoi Dayan 			      int out_index,
23748c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
23750ad060eeSRoi Dayan 			      struct net_device **encap_dev,
23760ad060eeSRoi Dayan 			      bool *encap_valid)
237703a9d11eSOr Gerlitz {
2378a54e20b4SHadar Hen Zion 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
237945247bf2SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
2380733d4f36SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2381733d4f36SRoi Dayan 	struct ip_tunnel_info *tun_info;
2382733d4f36SRoi Dayan 	struct ip_tunnel_key *key;
2383c1ae1152SOr Gerlitz 	struct mlx5e_encap_entry *e;
2384733d4f36SRoi Dayan 	unsigned short family;
2385a54e20b4SHadar Hen Zion 	uintptr_t hash_key;
2386a54e20b4SHadar Hen Zion 	bool found = false;
238754c177caSOz Shlomo 	int err = 0;
2388a54e20b4SHadar Hen Zion 
2389733d4f36SRoi Dayan 	parse_attr = attr->parse_attr;
2390733d4f36SRoi Dayan 	tun_info = &parse_attr->tun_info[out_index];
2391733d4f36SRoi Dayan 	family = ip_tunnel_info_af(tun_info);
2392733d4f36SRoi Dayan 	key = &tun_info->key;
2393733d4f36SRoi Dayan 
239476f7444dSOr Gerlitz 	hash_key = hash_encap_info(key);
2395a54e20b4SHadar Hen Zion 
2396a54e20b4SHadar Hen Zion 	hash_for_each_possible_rcu(esw->offloads.encap_tbl, e,
2397a54e20b4SHadar Hen Zion 				   encap_hlist, hash_key) {
239876f7444dSOr Gerlitz 		if (!cmp_encap_info(&e->tun_info.key, key)) {
2399a54e20b4SHadar Hen Zion 			found = true;
2400a54e20b4SHadar Hen Zion 			break;
2401a54e20b4SHadar Hen Zion 		}
2402a54e20b4SHadar Hen Zion 	}
2403a54e20b4SHadar Hen Zion 
2404b2812089SVlad Buslov 	/* must verify if encap is valid or not */
240545247bf2SOr Gerlitz 	if (found)
240645247bf2SOr Gerlitz 		goto attach_flow;
2407a54e20b4SHadar Hen Zion 
2408a54e20b4SHadar Hen Zion 	e = kzalloc(sizeof(*e), GFP_KERNEL);
2409a54e20b4SHadar Hen Zion 	if (!e)
2410a54e20b4SHadar Hen Zion 		return -ENOMEM;
2411a54e20b4SHadar Hen Zion 
241276f7444dSOr Gerlitz 	e->tun_info = *tun_info;
2413101f4de9SOz Shlomo 	err = mlx5e_tc_tun_init_encap_attr(mirred_dev, priv, e, extack);
241454c177caSOz Shlomo 	if (err)
241554c177caSOz Shlomo 		goto out_err;
241654c177caSOz Shlomo 
2417a54e20b4SHadar Hen Zion 	INIT_LIST_HEAD(&e->flows);
2418a54e20b4SHadar Hen Zion 
2419ce99f6b9SOr Gerlitz 	if (family == AF_INET)
2420101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv4(priv, mirred_dev, e);
2421ce99f6b9SOr Gerlitz 	else if (family == AF_INET6)
2422101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv6(priv, mirred_dev, e);
2423ce99f6b9SOr Gerlitz 
24240ad060eeSRoi Dayan 	if (err)
2425a54e20b4SHadar Hen Zion 		goto out_err;
2426a54e20b4SHadar Hen Zion 
2427a54e20b4SHadar Hen Zion 	hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key);
2428a54e20b4SHadar Hen Zion 
242945247bf2SOr Gerlitz attach_flow:
24308c4dc42bSEli Britstein 	list_add(&flow->encaps[out_index].list, &e->flows);
24318c4dc42bSEli Britstein 	flow->encaps[out_index].index = out_index;
243245247bf2SOr Gerlitz 	*encap_dev = e->out_dev;
24338c4dc42bSEli Britstein 	if (e->flags & MLX5_ENCAP_ENTRY_VALID) {
24348c4dc42bSEli Britstein 		attr->dests[out_index].encap_id = e->encap_id;
24358c4dc42bSEli Britstein 		attr->dests[out_index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
24360ad060eeSRoi Dayan 		*encap_valid = true;
24378c4dc42bSEli Britstein 	} else {
24380ad060eeSRoi Dayan 		*encap_valid = false;
24398c4dc42bSEli Britstein 	}
244045247bf2SOr Gerlitz 
2441232c0013SHadar Hen Zion 	return err;
2442a54e20b4SHadar Hen Zion 
2443a54e20b4SHadar Hen Zion out_err:
2444a54e20b4SHadar Hen Zion 	kfree(e);
2445a54e20b4SHadar Hen Zion 	return err;
2446a54e20b4SHadar Hen Zion }
2447a54e20b4SHadar Hen Zion 
24481482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv,
244973867881SPablo Neira Ayuso 				const struct flow_action_entry *act,
24501482bd3dSJianbo Liu 				struct mlx5_esw_flow_attr *attr,
24511482bd3dSJianbo Liu 				u32 *action)
24521482bd3dSJianbo Liu {
2453cc495188SJianbo Liu 	u8 vlan_idx = attr->total_vlan;
2454cc495188SJianbo Liu 
2455cc495188SJianbo Liu 	if (vlan_idx >= MLX5_FS_VLAN_DEPTH)
24561482bd3dSJianbo Liu 		return -EOPNOTSUPP;
2457cc495188SJianbo Liu 
245873867881SPablo Neira Ayuso 	switch (act->id) {
245973867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_POP:
2460cc495188SJianbo Liu 		if (vlan_idx) {
2461cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2462cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2463cc495188SJianbo Liu 				return -EOPNOTSUPP;
2464cc495188SJianbo Liu 
2465cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2;
2466cc495188SJianbo Liu 		} else {
2467cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
2468cc495188SJianbo Liu 		}
246973867881SPablo Neira Ayuso 		break;
247073867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_PUSH:
247173867881SPablo Neira Ayuso 		attr->vlan_vid[vlan_idx] = act->vlan.vid;
247273867881SPablo Neira Ayuso 		attr->vlan_prio[vlan_idx] = act->vlan.prio;
247373867881SPablo Neira Ayuso 		attr->vlan_proto[vlan_idx] = act->vlan.proto;
2474cc495188SJianbo Liu 		if (!attr->vlan_proto[vlan_idx])
2475cc495188SJianbo Liu 			attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q);
2476cc495188SJianbo Liu 
2477cc495188SJianbo Liu 		if (vlan_idx) {
2478cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2479cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2480cc495188SJianbo Liu 				return -EOPNOTSUPP;
2481cc495188SJianbo Liu 
2482cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2;
2483cc495188SJianbo Liu 		} else {
2484cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) &&
248573867881SPablo Neira Ayuso 			    (act->vlan.proto != htons(ETH_P_8021Q) ||
248673867881SPablo Neira Ayuso 			     act->vlan.prio))
2487cc495188SJianbo Liu 				return -EOPNOTSUPP;
2488cc495188SJianbo Liu 
2489cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH;
24901482bd3dSJianbo Liu 		}
249173867881SPablo Neira Ayuso 		break;
249273867881SPablo Neira Ayuso 	default:
249373867881SPablo Neira Ayuso 		/* action is FLOW_ACT_VLAN_MANGLE */
24941482bd3dSJianbo Liu 		return -EOPNOTSUPP;
24951482bd3dSJianbo Liu 	}
24961482bd3dSJianbo Liu 
2497cc495188SJianbo Liu 	attr->total_vlan = vlan_idx + 1;
2498cc495188SJianbo Liu 
24991482bd3dSJianbo Liu 	return 0;
25001482bd3dSJianbo Liu }
25011482bd3dSJianbo Liu 
250273867881SPablo Neira Ayuso static int parse_tc_fdb_actions(struct mlx5e_priv *priv,
250373867881SPablo Neira Ayuso 				struct flow_action *flow_action,
2504d7e75a32SOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr,
2505e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2506e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2507a54e20b4SHadar Hen Zion {
250873867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
2509bf07aa73SPaul Blakey 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2510ecf5bb79SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
25111d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
251273867881SPablo Neira Ayuso 	const struct ip_tunnel_info *info = NULL;
251373867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
2514a54e20b4SHadar Hen Zion 	bool encap = false;
25151cab1cd7SOr Gerlitz 	u32 action = 0;
2516244cd96aSCong Wang 	int err, i;
251703a9d11eSOr Gerlitz 
251873867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
251903a9d11eSOr Gerlitz 		return -EINVAL;
252003a9d11eSOr Gerlitz 
25211d447a39SSaeed Mahameed 	attr->in_rep = rpriv->rep;
252210ff5359SShahar Klein 	attr->in_mdev = priv->mdev;
252303a9d11eSOr Gerlitz 
252473867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
252573867881SPablo Neira Ayuso 		switch (act->id) {
252673867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
25271cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP |
252803a9d11eSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
252973867881SPablo Neira Ayuso 			break;
253073867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
253173867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
253273867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_FDB,
2533c500c86bSPablo Neira Ayuso 						    parse_attr, hdrs, extack);
2534d7e75a32SOr Gerlitz 			if (err)
2535d7e75a32SOr Gerlitz 				return err;
2536d7e75a32SOr Gerlitz 
25371cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
2538e85e02baSEli Britstein 			attr->split_count = attr->out_count;
253973867881SPablo Neira Ayuso 			break;
254073867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
25411cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
254273867881SPablo Neira Ayuso 						   act->csum_flags, extack))
254373867881SPablo Neira Ayuso 				break;
254426c02749SOr Gerlitz 
254526c02749SOr Gerlitz 			return -EOPNOTSUPP;
254673867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT:
254773867881SPablo Neira Ayuso 		case FLOW_ACTION_MIRRED: {
254803a9d11eSOr Gerlitz 			struct mlx5e_priv *out_priv;
2549592d3651SChris Mi 			struct net_device *out_dev;
255003a9d11eSOr Gerlitz 
255173867881SPablo Neira Ayuso 			out_dev = act->dev;
2552ef381359SOz Shlomo 			if (!out_dev) {
2553ef381359SOz Shlomo 				/* out_dev is NULL when filters with
2554ef381359SOz Shlomo 				 * non-existing mirred device are replayed to
2555ef381359SOz Shlomo 				 * the driver.
2556ef381359SOz Shlomo 				 */
2557ef381359SOz Shlomo 				return -EINVAL;
2558ef381359SOz Shlomo 			}
255903a9d11eSOr Gerlitz 
2560592d3651SChris Mi 			if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) {
2561e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2562e98bedf5SEli Britstein 						   "can't support more output ports, can't offload forwarding");
2563592d3651SChris Mi 				pr_err("can't support more than %d output ports, can't offload forwarding\n",
2564592d3651SChris Mi 				       attr->out_count);
2565592d3651SChris Mi 				return -EOPNOTSUPP;
2566592d3651SChris Mi 			}
2567592d3651SChris Mi 
2568f493f155SEli Britstein 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
2569f493f155SEli Britstein 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
25706dcfa234SFlorian Fainelli 			if (netdev_port_same_parent_id(priv->netdev,
2571b1d90e6bSRabie Loulou 						       out_dev) ||
2572b1d90e6bSRabie Loulou 			    is_merged_eswitch_dev(priv, out_dev)) {
25737ba58ba7SRabie Loulou 				struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
25747ba58ba7SRabie Loulou 				struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH);
25757ba58ba7SRabie Loulou 				struct net_device *uplink_upper = netdev_master_upper_dev_get(uplink_dev);
25767ba58ba7SRabie Loulou 
25777ba58ba7SRabie Loulou 				if (uplink_upper &&
25787ba58ba7SRabie Loulou 				    netif_is_lag_master(uplink_upper) &&
25797ba58ba7SRabie Loulou 				    uplink_upper == out_dev)
25807ba58ba7SRabie Loulou 					out_dev = uplink_dev;
25817ba58ba7SRabie Loulou 
2582a0646c88SEli Britstein 				if (!mlx5e_eswitch_rep(out_dev))
2583a0646c88SEli Britstein 					return -EOPNOTSUPP;
2584a0646c88SEli Britstein 
258503a9d11eSOr Gerlitz 				out_priv = netdev_priv(out_dev);
25861d447a39SSaeed Mahameed 				rpriv = out_priv->ppriv;
2587df65a573SEli Britstein 				attr->dests[attr->out_count].rep = rpriv->rep;
2588df65a573SEli Britstein 				attr->dests[attr->out_count].mdev = out_priv->mdev;
2589df65a573SEli Britstein 				attr->out_count++;
2590a54e20b4SHadar Hen Zion 			} else if (encap) {
25918c4dc42bSEli Britstein 				parse_attr->mirred_ifindex[attr->out_count] =
25928c4dc42bSEli Britstein 					out_dev->ifindex;
25938c4dc42bSEli Britstein 				parse_attr->tun_info[attr->out_count] = *info;
25948c4dc42bSEli Britstein 				encap = false;
25953c37745eSOr Gerlitz 				attr->parse_attr = parse_attr;
2596f493f155SEli Britstein 				attr->dests[attr->out_count].flags |=
2597f493f155SEli Britstein 					MLX5_ESW_DEST_ENCAP;
25981cc26d74SEli Britstein 				attr->out_count++;
2599df65a573SEli Britstein 				/* attr->dests[].rep is resolved when we
2600df65a573SEli Britstein 				 * handle encap
2601df65a573SEli Britstein 				 */
2602ef381359SOz Shlomo 			} else if (parse_attr->filter_dev != priv->netdev) {
2603ef381359SOz Shlomo 				/* All mlx5 devices are called to configure
2604ef381359SOz Shlomo 				 * high level device filters. Therefore, the
2605ef381359SOz Shlomo 				 * *attempt* to  install a filter on invalid
2606ef381359SOz Shlomo 				 * eswitch should not trigger an explicit error
2607ef381359SOz Shlomo 				 */
2608ef381359SOz Shlomo 				return -EINVAL;
2609a54e20b4SHadar Hen Zion 			} else {
2610e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2611e98bedf5SEli Britstein 						   "devices are not on same switch HW, can't offload forwarding");
2612a54e20b4SHadar Hen Zion 				pr_err("devices %s %s not on same switch HW, can't offload forwarding\n",
2613a54e20b4SHadar Hen Zion 				       priv->netdev->name, out_dev->name);
2614a54e20b4SHadar Hen Zion 				return -EINVAL;
2615a54e20b4SHadar Hen Zion 			}
2616a54e20b4SHadar Hen Zion 			}
261773867881SPablo Neira Ayuso 			break;
261873867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_ENCAP:
261973867881SPablo Neira Ayuso 			info = act->tunnel;
2620a54e20b4SHadar Hen Zion 			if (info)
2621a54e20b4SHadar Hen Zion 				encap = true;
2622a54e20b4SHadar Hen Zion 			else
2623a54e20b4SHadar Hen Zion 				return -EOPNOTSUPP;
262403a9d11eSOr Gerlitz 
262573867881SPablo Neira Ayuso 			break;
262673867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_PUSH:
262773867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_POP:
262873867881SPablo Neira Ayuso 			err = parse_tc_vlan_action(priv, act, attr, &action);
26291482bd3dSJianbo Liu 			if (err)
26301482bd3dSJianbo Liu 				return err;
26311482bd3dSJianbo Liu 
2632e85e02baSEli Britstein 			attr->split_count = attr->out_count;
263373867881SPablo Neira Ayuso 			break;
263473867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_DECAP:
26351cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DECAP;
263673867881SPablo Neira Ayuso 			break;
263773867881SPablo Neira Ayuso 		case FLOW_ACTION_GOTO: {
263873867881SPablo Neira Ayuso 			u32 dest_chain = act->chain_index;
2639bf07aa73SPaul Blakey 			u32 max_chain = mlx5_eswitch_get_chain_range(esw);
2640bf07aa73SPaul Blakey 
2641bf07aa73SPaul Blakey 			if (dest_chain <= attr->chain) {
2642bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Goto earlier chain isn't supported");
2643bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
2644bf07aa73SPaul Blakey 			}
2645bf07aa73SPaul Blakey 			if (dest_chain > max_chain) {
2646bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Requested destination chain is out of supported range");
2647bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
2648bf07aa73SPaul Blakey 			}
2649e88afe75SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
2650bf07aa73SPaul Blakey 			attr->dest_chain = dest_chain;
265173867881SPablo Neira Ayuso 			break;
2652bf07aa73SPaul Blakey 			}
265373867881SPablo Neira Ayuso 		default:
265403a9d11eSOr Gerlitz 			return -EINVAL;
265503a9d11eSOr Gerlitz 		}
265673867881SPablo Neira Ayuso 	}
2657bdd66ac0SOr Gerlitz 
2658c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
2659c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
2660c500c86bSPablo Neira Ayuso 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL,
2661c500c86bSPablo Neira Ayuso 					    parse_attr, hdrs, extack);
2662c500c86bSPablo Neira Ayuso 		if (err)
2663c500c86bSPablo Neira Ayuso 			return err;
2664c500c86bSPablo Neira Ayuso 	}
2665c500c86bSPablo Neira Ayuso 
26661cab1cd7SOr Gerlitz 	attr->action = action;
266773867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
2668bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
2669bdd66ac0SOr Gerlitz 
2670e88afe75SOr Gerlitz 	if (attr->dest_chain) {
2671e88afe75SOr Gerlitz 		if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
2672e88afe75SOr Gerlitz 			NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported");
2673e88afe75SOr Gerlitz 			return -EOPNOTSUPP;
2674e88afe75SOr Gerlitz 		}
2675e88afe75SOr Gerlitz 		attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
2676e88afe75SOr Gerlitz 	}
2677e88afe75SOr Gerlitz 
2678e85e02baSEli Britstein 	if (attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) {
2679e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2680e98bedf5SEli Britstein 				   "current firmware doesn't support split rule for port mirroring");
2681592d3651SChris Mi 		netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n");
2682592d3651SChris Mi 		return -EOPNOTSUPP;
2683592d3651SChris Mi 	}
2684592d3651SChris Mi 
268531c8eba5SOr Gerlitz 	return 0;
268603a9d11eSOr Gerlitz }
268703a9d11eSOr Gerlitz 
26885dbe906fSPaul Blakey static void get_flags(int flags, u16 *flow_flags)
268960bd4af8SOr Gerlitz {
26905dbe906fSPaul Blakey 	u16 __flow_flags = 0;
269160bd4af8SOr Gerlitz 
269260bd4af8SOr Gerlitz 	if (flags & MLX5E_TC_INGRESS)
269360bd4af8SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_INGRESS;
269460bd4af8SOr Gerlitz 	if (flags & MLX5E_TC_EGRESS)
269560bd4af8SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_EGRESS;
269660bd4af8SOr Gerlitz 
2697d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_ESW_OFFLOAD)
2698d9ee0491SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_ESWITCH;
2699d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_NIC_OFFLOAD)
2700d9ee0491SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_NIC;
2701d9ee0491SOr Gerlitz 
270260bd4af8SOr Gerlitz 	*flow_flags = __flow_flags;
270360bd4af8SOr Gerlitz }
270460bd4af8SOr Gerlitz 
270505866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = {
270605866c82SOr Gerlitz 	.head_offset = offsetof(struct mlx5e_tc_flow, node),
270705866c82SOr Gerlitz 	.key_offset = offsetof(struct mlx5e_tc_flow, cookie),
270805866c82SOr Gerlitz 	.key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie),
270905866c82SOr Gerlitz 	.automatic_shrinking = true,
271005866c82SOr Gerlitz };
271105866c82SOr Gerlitz 
2712d9ee0491SOr Gerlitz static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv, int flags)
271305866c82SOr Gerlitz {
2714655dc3d2SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2715655dc3d2SOr Gerlitz 	struct mlx5e_rep_priv *uplink_rpriv;
2716655dc3d2SOr Gerlitz 
2717d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_ESW_OFFLOAD) {
2718655dc3d2SOr Gerlitz 		uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
2719ec1366c2SOz Shlomo 		return &uplink_rpriv->uplink_priv.tc_ht;
2720d9ee0491SOr Gerlitz 	} else /* NIC offload */
272105866c82SOr Gerlitz 		return &priv->fs.tc.ht;
272205866c82SOr Gerlitz }
272305866c82SOr Gerlitz 
272404de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow)
272504de7ddaSRoi Dayan {
27261418ddd9SAviv Heller 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
2727b05af6aaSBodong Wang 	bool is_rep_ingress = attr->in_rep->vport != MLX5_VPORT_UPLINK &&
27281418ddd9SAviv Heller 			      flow->flags & MLX5E_TC_FLOW_INGRESS;
27291418ddd9SAviv Heller 	bool act_is_encap = !!(attr->action &
27301418ddd9SAviv Heller 			       MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT);
27311418ddd9SAviv Heller 	bool esw_paired = mlx5_devcom_is_paired(attr->in_mdev->priv.devcom,
27321418ddd9SAviv Heller 						MLX5_DEVCOM_ESW_OFFLOADS);
27331418ddd9SAviv Heller 
273410fbb1cdSRoi Dayan 	if (!esw_paired)
273510fbb1cdSRoi Dayan 		return false;
273610fbb1cdSRoi Dayan 
273710fbb1cdSRoi Dayan 	if ((mlx5_lag_is_sriov(attr->in_mdev) ||
273810fbb1cdSRoi Dayan 	     mlx5_lag_is_multipath(attr->in_mdev)) &&
273910fbb1cdSRoi Dayan 	    (is_rep_ingress || act_is_encap))
274010fbb1cdSRoi Dayan 		return true;
274110fbb1cdSRoi Dayan 
274210fbb1cdSRoi Dayan 	return false;
274304de7ddaSRoi Dayan }
274404de7ddaSRoi Dayan 
2745a88780a9SRoi Dayan static int
2746a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size,
27475dbe906fSPaul Blakey 		 struct tc_cls_flower_offload *f, u16 flow_flags,
2748a88780a9SRoi Dayan 		 struct mlx5e_tc_flow_parse_attr **__parse_attr,
2749a88780a9SRoi Dayan 		 struct mlx5e_tc_flow **__flow)
2750e3a2b7edSAmir Vadai {
275117091853SOr Gerlitz 	struct mlx5e_tc_flow_parse_attr *parse_attr;
27523bc4b7bfSOr Gerlitz 	struct mlx5e_tc_flow *flow;
2753a88780a9SRoi Dayan 	int err;
2754776b12b6SOr Gerlitz 
275565ba8fb7SOr Gerlitz 	flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL);
27561b9a07eeSLeon Romanovsky 	parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL);
275717091853SOr Gerlitz 	if (!parse_attr || !flow) {
2758e3a2b7edSAmir Vadai 		err = -ENOMEM;
2759e3a2b7edSAmir Vadai 		goto err_free;
2760e3a2b7edSAmir Vadai 	}
2761e3a2b7edSAmir Vadai 
2762e3a2b7edSAmir Vadai 	flow->cookie = f->cookie;
276365ba8fb7SOr Gerlitz 	flow->flags = flow_flags;
2764655dc3d2SOr Gerlitz 	flow->priv = priv;
2765e3a2b7edSAmir Vadai 
2766a88780a9SRoi Dayan 	*__flow = flow;
2767a88780a9SRoi Dayan 	*__parse_attr = parse_attr;
2768a88780a9SRoi Dayan 
2769a88780a9SRoi Dayan 	return 0;
2770a88780a9SRoi Dayan 
2771a88780a9SRoi Dayan err_free:
2772a88780a9SRoi Dayan 	kfree(flow);
2773a88780a9SRoi Dayan 	kvfree(parse_attr);
2774a88780a9SRoi Dayan 	return err;
2775adb4c123SOr Gerlitz }
2776adb4c123SOr Gerlitz 
2777988ab9c7STonghao Zhang static void
2778988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(struct mlx5_esw_flow_attr *esw_attr,
2779988ab9c7STonghao Zhang 			 struct mlx5e_priv *priv,
2780988ab9c7STonghao Zhang 			 struct mlx5e_tc_flow_parse_attr *parse_attr,
2781988ab9c7STonghao Zhang 			 struct tc_cls_flower_offload *f,
2782988ab9c7STonghao Zhang 			 struct mlx5_eswitch_rep *in_rep,
2783988ab9c7STonghao Zhang 			 struct mlx5_core_dev *in_mdev)
2784988ab9c7STonghao Zhang {
2785988ab9c7STonghao Zhang 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2786988ab9c7STonghao Zhang 
2787988ab9c7STonghao Zhang 	esw_attr->parse_attr = parse_attr;
2788988ab9c7STonghao Zhang 	esw_attr->chain = f->common.chain_index;
2789988ab9c7STonghao Zhang 	esw_attr->prio = TC_H_MAJ(f->common.prio) >> 16;
2790988ab9c7STonghao Zhang 
2791988ab9c7STonghao Zhang 	esw_attr->in_rep = in_rep;
2792988ab9c7STonghao Zhang 	esw_attr->in_mdev = in_mdev;
2793988ab9c7STonghao Zhang 
2794988ab9c7STonghao Zhang 	if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) ==
2795988ab9c7STonghao Zhang 	    MLX5_COUNTER_SOURCE_ESWITCH)
2796988ab9c7STonghao Zhang 		esw_attr->counter_dev = in_mdev;
2797988ab9c7STonghao Zhang 	else
2798988ab9c7STonghao Zhang 		esw_attr->counter_dev = priv->mdev;
2799988ab9c7STonghao Zhang }
2800988ab9c7STonghao Zhang 
280171129676SJason Gunthorpe static struct mlx5e_tc_flow *
280204de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
2803a88780a9SRoi Dayan 		     struct tc_cls_flower_offload *f,
28045dbe906fSPaul Blakey 		     u16 flow_flags,
2805d11afc26SOz Shlomo 		     struct net_device *filter_dev,
280604de7ddaSRoi Dayan 		     struct mlx5_eswitch_rep *in_rep,
280771129676SJason Gunthorpe 		     struct mlx5_core_dev *in_mdev)
2808a88780a9SRoi Dayan {
280973867881SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
2810a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
2811a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2812a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
2813a88780a9SRoi Dayan 	int attr_size, err;
2814a88780a9SRoi Dayan 
2815a88780a9SRoi Dayan 	flow_flags |= MLX5E_TC_FLOW_ESWITCH;
2816a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_esw_flow_attr);
2817a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
2818a88780a9SRoi Dayan 			       &parse_attr, &flow);
2819a88780a9SRoi Dayan 	if (err)
2820a88780a9SRoi Dayan 		goto out;
2821988ab9c7STonghao Zhang 
2822d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
2823988ab9c7STonghao Zhang 	mlx5e_flow_esw_attr_init(flow->esw_attr,
2824988ab9c7STonghao Zhang 				 priv, parse_attr,
2825988ab9c7STonghao Zhang 				 f, in_rep, in_mdev);
2826988ab9c7STonghao Zhang 
282754c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
282854c177caSOz Shlomo 			       f, filter_dev);
2829d11afc26SOz Shlomo 	if (err)
2830d11afc26SOz Shlomo 		goto err_free;
2831a88780a9SRoi Dayan 
283273867881SPablo Neira Ayuso 	err = parse_tc_fdb_actions(priv, &rule->action, parse_attr, flow, extack);
2833a88780a9SRoi Dayan 	if (err)
2834a88780a9SRoi Dayan 		goto err_free;
2835a88780a9SRoi Dayan 
28367040632dSTonghao Zhang 	err = mlx5e_tc_add_fdb_flow(priv, flow, extack);
2837ef06c9eeSRoi Dayan 	if (err) {
2838ef06c9eeSRoi Dayan 		if (!(err == -ENETUNREACH && mlx5_lag_is_multipath(in_mdev)))
2839aa0cbbaeSOr Gerlitz 			goto err_free;
28405c40348cSOr Gerlitz 
2841b4a23329SRoi Dayan 		add_unready_flow(flow);
2842ef06c9eeSRoi Dayan 	}
2843ef06c9eeSRoi Dayan 
284471129676SJason Gunthorpe 	return flow;
2845e3a2b7edSAmir Vadai 
2846e3a2b7edSAmir Vadai err_free:
2847232c0013SHadar Hen Zion 	kfree(flow);
2848a88780a9SRoi Dayan 	kvfree(parse_attr);
2849a88780a9SRoi Dayan out:
285071129676SJason Gunthorpe 	return ERR_PTR(err);
2851a88780a9SRoi Dayan }
2852a88780a9SRoi Dayan 
285304de7ddaSRoi Dayan static int mlx5e_tc_add_fdb_peer_flow(struct tc_cls_flower_offload *f,
285495dc1902SRoi Dayan 				      struct mlx5e_tc_flow *flow,
285595dc1902SRoi Dayan 				      u16 flow_flags)
285604de7ddaSRoi Dayan {
285704de7ddaSRoi Dayan 	struct mlx5e_priv *priv = flow->priv, *peer_priv;
285804de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw;
285904de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
286004de7ddaSRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
286104de7ddaSRoi Dayan 	struct mlx5e_rep_priv *peer_urpriv;
286204de7ddaSRoi Dayan 	struct mlx5e_tc_flow *peer_flow;
286304de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev;
286404de7ddaSRoi Dayan 	int err = 0;
286504de7ddaSRoi Dayan 
286604de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
286704de7ddaSRoi Dayan 	if (!peer_esw)
286804de7ddaSRoi Dayan 		return -ENODEV;
286904de7ddaSRoi Dayan 
287004de7ddaSRoi Dayan 	peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH);
287104de7ddaSRoi Dayan 	peer_priv = netdev_priv(peer_urpriv->netdev);
287204de7ddaSRoi Dayan 
287304de7ddaSRoi Dayan 	/* in_mdev is assigned of which the packet originated from.
287404de7ddaSRoi Dayan 	 * So packets redirected to uplink use the same mdev of the
287504de7ddaSRoi Dayan 	 * original flow and packets redirected from uplink use the
287604de7ddaSRoi Dayan 	 * peer mdev.
287704de7ddaSRoi Dayan 	 */
2878b05af6aaSBodong Wang 	if (flow->esw_attr->in_rep->vport == MLX5_VPORT_UPLINK)
287904de7ddaSRoi Dayan 		in_mdev = peer_priv->mdev;
288004de7ddaSRoi Dayan 	else
288104de7ddaSRoi Dayan 		in_mdev = priv->mdev;
288204de7ddaSRoi Dayan 
288304de7ddaSRoi Dayan 	parse_attr = flow->esw_attr->parse_attr;
288495dc1902SRoi Dayan 	peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow_flags,
288504de7ddaSRoi Dayan 					 parse_attr->filter_dev,
288671129676SJason Gunthorpe 					 flow->esw_attr->in_rep, in_mdev);
288771129676SJason Gunthorpe 	if (IS_ERR(peer_flow)) {
288871129676SJason Gunthorpe 		err = PTR_ERR(peer_flow);
288904de7ddaSRoi Dayan 		goto out;
289071129676SJason Gunthorpe 	}
289104de7ddaSRoi Dayan 
289204de7ddaSRoi Dayan 	flow->peer_flow = peer_flow;
289304de7ddaSRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_DUP;
289404de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
289504de7ddaSRoi Dayan 	list_add_tail(&flow->peer, &esw->offloads.peer_flows);
289604de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
289704de7ddaSRoi Dayan 
289804de7ddaSRoi Dayan out:
289904de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
290004de7ddaSRoi Dayan 	return err;
290104de7ddaSRoi Dayan }
290204de7ddaSRoi Dayan 
290304de7ddaSRoi Dayan static int
290404de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
290504de7ddaSRoi Dayan 		   struct tc_cls_flower_offload *f,
290604de7ddaSRoi Dayan 		   u16 flow_flags,
290704de7ddaSRoi Dayan 		   struct net_device *filter_dev,
290804de7ddaSRoi Dayan 		   struct mlx5e_tc_flow **__flow)
290904de7ddaSRoi Dayan {
291004de7ddaSRoi Dayan 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
291104de7ddaSRoi Dayan 	struct mlx5_eswitch_rep *in_rep = rpriv->rep;
291204de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev = priv->mdev;
291304de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow;
291404de7ddaSRoi Dayan 	int err;
291504de7ddaSRoi Dayan 
291671129676SJason Gunthorpe 	flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep,
291771129676SJason Gunthorpe 				    in_mdev);
291871129676SJason Gunthorpe 	if (IS_ERR(flow))
291971129676SJason Gunthorpe 		return PTR_ERR(flow);
292004de7ddaSRoi Dayan 
292104de7ddaSRoi Dayan 	if (is_peer_flow_needed(flow)) {
292295dc1902SRoi Dayan 		err = mlx5e_tc_add_fdb_peer_flow(f, flow, flow_flags);
292304de7ddaSRoi Dayan 		if (err) {
292404de7ddaSRoi Dayan 			mlx5e_tc_del_fdb_flow(priv, flow);
292504de7ddaSRoi Dayan 			goto out;
292604de7ddaSRoi Dayan 		}
292704de7ddaSRoi Dayan 	}
292804de7ddaSRoi Dayan 
292904de7ddaSRoi Dayan 	*__flow = flow;
293004de7ddaSRoi Dayan 
293104de7ddaSRoi Dayan 	return 0;
293204de7ddaSRoi Dayan 
293304de7ddaSRoi Dayan out:
293404de7ddaSRoi Dayan 	return err;
293504de7ddaSRoi Dayan }
293604de7ddaSRoi Dayan 
2937a88780a9SRoi Dayan static int
2938a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv,
2939a88780a9SRoi Dayan 		   struct tc_cls_flower_offload *f,
29405dbe906fSPaul Blakey 		   u16 flow_flags,
2941d11afc26SOz Shlomo 		   struct net_device *filter_dev,
2942a88780a9SRoi Dayan 		   struct mlx5e_tc_flow **__flow)
2943a88780a9SRoi Dayan {
294473867881SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
2945a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
2946a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2947a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
2948a88780a9SRoi Dayan 	int attr_size, err;
2949a88780a9SRoi Dayan 
2950bf07aa73SPaul Blakey 	/* multi-chain not supported for NIC rules */
2951bf07aa73SPaul Blakey 	if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common))
2952bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
2953bf07aa73SPaul Blakey 
2954a88780a9SRoi Dayan 	flow_flags |= MLX5E_TC_FLOW_NIC;
2955a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_nic_flow_attr);
2956a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
2957a88780a9SRoi Dayan 			       &parse_attr, &flow);
2958a88780a9SRoi Dayan 	if (err)
2959a88780a9SRoi Dayan 		goto out;
2960a88780a9SRoi Dayan 
2961d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
296254c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
296354c177caSOz Shlomo 			       f, filter_dev);
2964d11afc26SOz Shlomo 	if (err)
2965d11afc26SOz Shlomo 		goto err_free;
2966d11afc26SOz Shlomo 
296773867881SPablo Neira Ayuso 	err = parse_tc_nic_actions(priv, &rule->action, parse_attr, flow, extack);
2968a88780a9SRoi Dayan 	if (err)
2969a88780a9SRoi Dayan 		goto err_free;
2970a88780a9SRoi Dayan 
2971a88780a9SRoi Dayan 	err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack);
2972a88780a9SRoi Dayan 	if (err)
2973a88780a9SRoi Dayan 		goto err_free;
2974a88780a9SRoi Dayan 
2975a88780a9SRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_OFFLOADED;
2976a88780a9SRoi Dayan 	kvfree(parse_attr);
2977a88780a9SRoi Dayan 	*__flow = flow;
2978a88780a9SRoi Dayan 
2979a88780a9SRoi Dayan 	return 0;
2980a88780a9SRoi Dayan 
2981a88780a9SRoi Dayan err_free:
2982a88780a9SRoi Dayan 	kfree(flow);
2983a88780a9SRoi Dayan 	kvfree(parse_attr);
2984a88780a9SRoi Dayan out:
2985a88780a9SRoi Dayan 	return err;
2986a88780a9SRoi Dayan }
2987a88780a9SRoi Dayan 
2988a88780a9SRoi Dayan static int
2989a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv,
2990a88780a9SRoi Dayan 		  struct tc_cls_flower_offload *f,
2991a88780a9SRoi Dayan 		  int flags,
2992d11afc26SOz Shlomo 		  struct net_device *filter_dev,
2993a88780a9SRoi Dayan 		  struct mlx5e_tc_flow **flow)
2994a88780a9SRoi Dayan {
2995a88780a9SRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
29965dbe906fSPaul Blakey 	u16 flow_flags;
2997a88780a9SRoi Dayan 	int err;
2998a88780a9SRoi Dayan 
2999a88780a9SRoi Dayan 	get_flags(flags, &flow_flags);
3000a88780a9SRoi Dayan 
3001bf07aa73SPaul Blakey 	if (!tc_can_offload_extack(priv->netdev, f->common.extack))
3002bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
3003bf07aa73SPaul Blakey 
3004a88780a9SRoi Dayan 	if (esw && esw->mode == SRIOV_OFFLOADS)
3005d11afc26SOz Shlomo 		err = mlx5e_add_fdb_flow(priv, f, flow_flags,
3006d11afc26SOz Shlomo 					 filter_dev, flow);
3007a88780a9SRoi Dayan 	else
3008d11afc26SOz Shlomo 		err = mlx5e_add_nic_flow(priv, f, flow_flags,
3009d11afc26SOz Shlomo 					 filter_dev, flow);
3010a88780a9SRoi Dayan 
3011a88780a9SRoi Dayan 	return err;
3012a88780a9SRoi Dayan }
3013a88780a9SRoi Dayan 
301471d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv,
3015a88780a9SRoi Dayan 			   struct tc_cls_flower_offload *f, int flags)
3016a88780a9SRoi Dayan {
3017a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
3018d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
3019a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
3020a88780a9SRoi Dayan 	int err = 0;
3021a88780a9SRoi Dayan 
3022a88780a9SRoi Dayan 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
3023a88780a9SRoi Dayan 	if (flow) {
3024a88780a9SRoi Dayan 		NL_SET_ERR_MSG_MOD(extack,
3025a88780a9SRoi Dayan 				   "flow cookie already exists, ignoring");
3026a88780a9SRoi Dayan 		netdev_warn_once(priv->netdev,
3027a88780a9SRoi Dayan 				 "flow cookie %lx already exists, ignoring\n",
3028a88780a9SRoi Dayan 				 f->cookie);
3029a88780a9SRoi Dayan 		goto out;
3030a88780a9SRoi Dayan 	}
3031a88780a9SRoi Dayan 
3032d11afc26SOz Shlomo 	err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow);
3033a88780a9SRoi Dayan 	if (err)
3034a88780a9SRoi Dayan 		goto out;
3035a88780a9SRoi Dayan 
3036a88780a9SRoi Dayan 	err = rhashtable_insert_fast(tc_ht, &flow->node, tc_ht_params);
3037a88780a9SRoi Dayan 	if (err)
3038a88780a9SRoi Dayan 		goto err_free;
3039a88780a9SRoi Dayan 
3040a88780a9SRoi Dayan 	return 0;
3041a88780a9SRoi Dayan 
3042a88780a9SRoi Dayan err_free:
3043a88780a9SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3044a88780a9SRoi Dayan 	kfree(flow);
3045a88780a9SRoi Dayan out:
3046e3a2b7edSAmir Vadai 	return err;
3047e3a2b7edSAmir Vadai }
3048e3a2b7edSAmir Vadai 
30498f8ae895SOr Gerlitz #define DIRECTION_MASK (MLX5E_TC_INGRESS | MLX5E_TC_EGRESS)
30508f8ae895SOr Gerlitz #define FLOW_DIRECTION_MASK (MLX5E_TC_FLOW_INGRESS | MLX5E_TC_FLOW_EGRESS)
30518f8ae895SOr Gerlitz 
30528f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags)
30538f8ae895SOr Gerlitz {
30548f8ae895SOr Gerlitz 	if ((flow->flags & FLOW_DIRECTION_MASK) == (flags & DIRECTION_MASK))
30558f8ae895SOr Gerlitz 		return true;
30568f8ae895SOr Gerlitz 
30578f8ae895SOr Gerlitz 	return false;
30588f8ae895SOr Gerlitz }
30598f8ae895SOr Gerlitz 
306071d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv,
306160bd4af8SOr Gerlitz 			struct tc_cls_flower_offload *f, int flags)
3062e3a2b7edSAmir Vadai {
3063d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
3064e3a2b7edSAmir Vadai 	struct mlx5e_tc_flow *flow;
3065e3a2b7edSAmir Vadai 
306605866c82SOr Gerlitz 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
30678f8ae895SOr Gerlitz 	if (!flow || !same_flow_direction(flow, flags))
3068e3a2b7edSAmir Vadai 		return -EINVAL;
3069e3a2b7edSAmir Vadai 
307005866c82SOr Gerlitz 	rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params);
3071e3a2b7edSAmir Vadai 
3072961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3073e3a2b7edSAmir Vadai 
3074e3a2b7edSAmir Vadai 	kfree(flow);
3075e3a2b7edSAmir Vadai 
3076e3a2b7edSAmir Vadai 	return 0;
3077e3a2b7edSAmir Vadai }
3078e3a2b7edSAmir Vadai 
307971d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv,
308060bd4af8SOr Gerlitz 		       struct tc_cls_flower_offload *f, int flags)
3081aad7e08dSAmir Vadai {
308204de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
3083d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
308404de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
3085aad7e08dSAmir Vadai 	struct mlx5e_tc_flow *flow;
3086aad7e08dSAmir Vadai 	struct mlx5_fc *counter;
3087316d5f72SRoi Dayan 	u64 lastuse = 0;
3088316d5f72SRoi Dayan 	u64 packets = 0;
3089316d5f72SRoi Dayan 	u64 bytes = 0;
3090aad7e08dSAmir Vadai 
309105866c82SOr Gerlitz 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
30928f8ae895SOr Gerlitz 	if (!flow || !same_flow_direction(flow, flags))
3093aad7e08dSAmir Vadai 		return -EINVAL;
3094aad7e08dSAmir Vadai 
3095316d5f72SRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
3096b8aee822SMark Bloch 		counter = mlx5e_tc_get_counter(flow);
3097aad7e08dSAmir Vadai 		if (!counter)
3098aad7e08dSAmir Vadai 			return 0;
3099aad7e08dSAmir Vadai 
3100aad7e08dSAmir Vadai 		mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
3101316d5f72SRoi Dayan 	}
3102aad7e08dSAmir Vadai 
3103316d5f72SRoi Dayan 	/* Under multipath it's possible for one rule to be currently
3104316d5f72SRoi Dayan 	 * un-offloaded while the other rule is offloaded.
3105316d5f72SRoi Dayan 	 */
310604de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
310704de7ddaSRoi Dayan 	if (!peer_esw)
310804de7ddaSRoi Dayan 		goto out;
310904de7ddaSRoi Dayan 
311004de7ddaSRoi Dayan 	if ((flow->flags & MLX5E_TC_FLOW_DUP) &&
311104de7ddaSRoi Dayan 	    (flow->peer_flow->flags & MLX5E_TC_FLOW_OFFLOADED)) {
311204de7ddaSRoi Dayan 		u64 bytes2;
311304de7ddaSRoi Dayan 		u64 packets2;
311404de7ddaSRoi Dayan 		u64 lastuse2;
311504de7ddaSRoi Dayan 
311604de7ddaSRoi Dayan 		counter = mlx5e_tc_get_counter(flow->peer_flow);
3117316d5f72SRoi Dayan 		if (!counter)
3118316d5f72SRoi Dayan 			goto no_peer_counter;
311904de7ddaSRoi Dayan 		mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2);
312004de7ddaSRoi Dayan 
312104de7ddaSRoi Dayan 		bytes += bytes2;
312204de7ddaSRoi Dayan 		packets += packets2;
312304de7ddaSRoi Dayan 		lastuse = max_t(u64, lastuse, lastuse2);
312404de7ddaSRoi Dayan 	}
312504de7ddaSRoi Dayan 
3126316d5f72SRoi Dayan no_peer_counter:
312704de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
312804de7ddaSRoi Dayan out:
31293b1903efSPablo Neira Ayuso 	flow_stats_update(&f->stats, bytes, packets, lastuse);
3130fed06ee8SOr Gerlitz 
3131aad7e08dSAmir Vadai 	return 0;
3132aad7e08dSAmir Vadai }
3133aad7e08dSAmir Vadai 
31344d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv,
31354d8fcf21SAlaa Hleihel 					      struct mlx5e_priv *peer_priv)
31364d8fcf21SAlaa Hleihel {
31374d8fcf21SAlaa Hleihel 	struct mlx5_core_dev *peer_mdev = peer_priv->mdev;
31384d8fcf21SAlaa Hleihel 	struct mlx5e_hairpin_entry *hpe;
31394d8fcf21SAlaa Hleihel 	u16 peer_vhca_id;
31404d8fcf21SAlaa Hleihel 	int bkt;
31414d8fcf21SAlaa Hleihel 
31424d8fcf21SAlaa Hleihel 	if (!same_hw_devs(priv, peer_priv))
31434d8fcf21SAlaa Hleihel 		return;
31444d8fcf21SAlaa Hleihel 
31454d8fcf21SAlaa Hleihel 	peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
31464d8fcf21SAlaa Hleihel 
31474d8fcf21SAlaa Hleihel 	hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) {
31484d8fcf21SAlaa Hleihel 		if (hpe->peer_vhca_id == peer_vhca_id)
31494d8fcf21SAlaa Hleihel 			hpe->hp->pair->peer_gone = true;
31504d8fcf21SAlaa Hleihel 	}
31514d8fcf21SAlaa Hleihel }
31524d8fcf21SAlaa Hleihel 
31534d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this,
31544d8fcf21SAlaa Hleihel 				 unsigned long event, void *ptr)
31554d8fcf21SAlaa Hleihel {
31564d8fcf21SAlaa Hleihel 	struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
31574d8fcf21SAlaa Hleihel 	struct mlx5e_flow_steering *fs;
31584d8fcf21SAlaa Hleihel 	struct mlx5e_priv *peer_priv;
31594d8fcf21SAlaa Hleihel 	struct mlx5e_tc_table *tc;
31604d8fcf21SAlaa Hleihel 	struct mlx5e_priv *priv;
31614d8fcf21SAlaa Hleihel 
31624d8fcf21SAlaa Hleihel 	if (ndev->netdev_ops != &mlx5e_netdev_ops ||
31634d8fcf21SAlaa Hleihel 	    event != NETDEV_UNREGISTER ||
31644d8fcf21SAlaa Hleihel 	    ndev->reg_state == NETREG_REGISTERED)
31654d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
31664d8fcf21SAlaa Hleihel 
31674d8fcf21SAlaa Hleihel 	tc = container_of(this, struct mlx5e_tc_table, netdevice_nb);
31684d8fcf21SAlaa Hleihel 	fs = container_of(tc, struct mlx5e_flow_steering, tc);
31694d8fcf21SAlaa Hleihel 	priv = container_of(fs, struct mlx5e_priv, fs);
31704d8fcf21SAlaa Hleihel 	peer_priv = netdev_priv(ndev);
31714d8fcf21SAlaa Hleihel 	if (priv == peer_priv ||
31724d8fcf21SAlaa Hleihel 	    !(priv->netdev->features & NETIF_F_HW_TC))
31734d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
31744d8fcf21SAlaa Hleihel 
31754d8fcf21SAlaa Hleihel 	mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv);
31764d8fcf21SAlaa Hleihel 
31774d8fcf21SAlaa Hleihel 	return NOTIFY_DONE;
31784d8fcf21SAlaa Hleihel }
31794d8fcf21SAlaa Hleihel 
3180655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv)
3181e8f887acSAmir Vadai {
3182acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
31834d8fcf21SAlaa Hleihel 	int err;
3184e8f887acSAmir Vadai 
318511c9c548SOr Gerlitz 	hash_init(tc->mod_hdr_tbl);
31865c65c564SOr Gerlitz 	hash_init(tc->hairpin_tbl);
318711c9c548SOr Gerlitz 
31884d8fcf21SAlaa Hleihel 	err = rhashtable_init(&tc->ht, &tc_ht_params);
31894d8fcf21SAlaa Hleihel 	if (err)
31904d8fcf21SAlaa Hleihel 		return err;
31914d8fcf21SAlaa Hleihel 
31924d8fcf21SAlaa Hleihel 	tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event;
31934d8fcf21SAlaa Hleihel 	if (register_netdevice_notifier(&tc->netdevice_nb)) {
31944d8fcf21SAlaa Hleihel 		tc->netdevice_nb.notifier_call = NULL;
31954d8fcf21SAlaa Hleihel 		mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n");
31964d8fcf21SAlaa Hleihel 	}
31974d8fcf21SAlaa Hleihel 
31984d8fcf21SAlaa Hleihel 	return err;
3199e8f887acSAmir Vadai }
3200e8f887acSAmir Vadai 
3201e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg)
3202e8f887acSAmir Vadai {
3203e8f887acSAmir Vadai 	struct mlx5e_tc_flow *flow = ptr;
3204655dc3d2SOr Gerlitz 	struct mlx5e_priv *priv = flow->priv;
3205e8f887acSAmir Vadai 
3206961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3207e8f887acSAmir Vadai 	kfree(flow);
3208e8f887acSAmir Vadai }
3209e8f887acSAmir Vadai 
3210655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv)
3211e8f887acSAmir Vadai {
3212acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
3213e8f887acSAmir Vadai 
32144d8fcf21SAlaa Hleihel 	if (tc->netdevice_nb.notifier_call)
32154d8fcf21SAlaa Hleihel 		unregister_netdevice_notifier(&tc->netdevice_nb);
32164d8fcf21SAlaa Hleihel 
3217d9ee0491SOr Gerlitz 	rhashtable_destroy(&tc->ht);
3218e8f887acSAmir Vadai 
3219acff797cSMaor Gottlieb 	if (!IS_ERR_OR_NULL(tc->t)) {
3220acff797cSMaor Gottlieb 		mlx5_destroy_flow_table(tc->t);
3221acff797cSMaor Gottlieb 		tc->t = NULL;
3222e8f887acSAmir Vadai 	}
3223e8f887acSAmir Vadai }
3224655dc3d2SOr Gerlitz 
3225655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht)
3226655dc3d2SOr Gerlitz {
3227655dc3d2SOr Gerlitz 	return rhashtable_init(tc_ht, &tc_ht_params);
3228655dc3d2SOr Gerlitz }
3229655dc3d2SOr Gerlitz 
3230655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht)
3231655dc3d2SOr Gerlitz {
3232655dc3d2SOr Gerlitz 	rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL);
3233655dc3d2SOr Gerlitz }
323401252a27SOr Gerlitz 
3235d9ee0491SOr Gerlitz int mlx5e_tc_num_filters(struct mlx5e_priv *priv, int flags)
323601252a27SOr Gerlitz {
3237d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
323801252a27SOr Gerlitz 
323901252a27SOr Gerlitz 	return atomic_read(&tc_ht->nelems);
324001252a27SOr Gerlitz }
324104de7ddaSRoi Dayan 
324204de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw)
324304de7ddaSRoi Dayan {
324404de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
324504de7ddaSRoi Dayan 
324604de7ddaSRoi Dayan 	list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer)
324704de7ddaSRoi Dayan 		__mlx5e_tc_del_fdb_peer_flow(flow);
324804de7ddaSRoi Dayan }
3249b4a23329SRoi Dayan 
3250b4a23329SRoi Dayan void mlx5e_tc_reoffload_flows_work(struct work_struct *work)
3251b4a23329SRoi Dayan {
3252b4a23329SRoi Dayan 	struct mlx5_rep_uplink_priv *rpriv =
3253b4a23329SRoi Dayan 		container_of(work, struct mlx5_rep_uplink_priv,
3254b4a23329SRoi Dayan 			     reoffload_flows_work);
3255b4a23329SRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
3256b4a23329SRoi Dayan 
3257b4a23329SRoi Dayan 	rtnl_lock();
3258b4a23329SRoi Dayan 	list_for_each_entry_safe(flow, tmp, &rpriv->unready_flows, unready) {
3259b4a23329SRoi Dayan 		if (!mlx5e_tc_add_fdb_flow(flow->priv, flow, NULL))
3260b4a23329SRoi Dayan 			remove_unready_flow(flow);
3261b4a23329SRoi Dayan 	}
3262b4a23329SRoi Dayan 	rtnl_unlock();
3263b4a23329SRoi Dayan }
3264