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),
7865ba8fb7SOr Gerlitz };
7965ba8fb7SOr Gerlitz 
80e4ad91f2SChris Mi #define MLX5E_TC_MAX_SPLITS 1
81e4ad91f2SChris Mi 
8279baaec7SEli Britstein /* Helper struct for accessing a struct containing list_head array.
8379baaec7SEli Britstein  * Containing struct
8479baaec7SEli Britstein  *   |- Helper array
8579baaec7SEli Britstein  *      [0] Helper item 0
8679baaec7SEli Britstein  *          |- list_head item 0
8779baaec7SEli Britstein  *          |- index (0)
8879baaec7SEli Britstein  *      [1] Helper item 1
8979baaec7SEli Britstein  *          |- list_head item 1
9079baaec7SEli Britstein  *          |- index (1)
9179baaec7SEli Britstein  * To access the containing struct from one of the list_head items:
9279baaec7SEli Britstein  * 1. Get the helper item from the list_head item using
9379baaec7SEli Britstein  *    helper item =
9479baaec7SEli Britstein  *        container_of(list_head item, helper struct type, list_head field)
9579baaec7SEli Britstein  * 2. Get the contining struct from the helper item and its index in the array:
9679baaec7SEli Britstein  *    containing struct =
9779baaec7SEli Britstein  *        container_of(helper item, containing struct type, helper field[index])
9879baaec7SEli Britstein  */
9979baaec7SEli Britstein struct encap_flow_item {
10079baaec7SEli Britstein 	struct list_head list;
10179baaec7SEli Britstein 	int index;
10279baaec7SEli Britstein };
10379baaec7SEli Britstein 
104e8f887acSAmir Vadai struct mlx5e_tc_flow {
105e8f887acSAmir Vadai 	struct rhash_head	node;
106655dc3d2SOr Gerlitz 	struct mlx5e_priv	*priv;
107e8f887acSAmir Vadai 	u64			cookie;
1085dbe906fSPaul Blakey 	u16			flags;
109e4ad91f2SChris Mi 	struct mlx5_flow_handle *rule[MLX5E_TC_MAX_SPLITS + 1];
11079baaec7SEli Britstein 	/* Flow can be associated with multiple encap IDs.
11179baaec7SEli Britstein 	 * The number of encaps is bounded by the number of supported
11279baaec7SEli Britstein 	 * destinations.
11379baaec7SEli Britstein 	 */
11479baaec7SEli Britstein 	struct encap_flow_item encaps[MLX5_MAX_FLOW_FWD_VPORTS];
11504de7ddaSRoi Dayan 	struct mlx5e_tc_flow    *peer_flow;
11611c9c548SOr Gerlitz 	struct list_head	mod_hdr; /* flows sharing the same mod hdr ID */
1175c65c564SOr Gerlitz 	struct list_head	hairpin; /* flows sharing the same hairpin */
11804de7ddaSRoi Dayan 	struct list_head	peer;    /* flows with peer flow */
1193bc4b7bfSOr Gerlitz 	union {
120ecf5bb79SOr Gerlitz 		struct mlx5_esw_flow_attr esw_attr[0];
1213bc4b7bfSOr Gerlitz 		struct mlx5_nic_flow_attr nic_attr[0];
1223bc4b7bfSOr Gerlitz 	};
123e8f887acSAmir Vadai };
124e8f887acSAmir Vadai 
12517091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr {
12698b66cb1SEli Britstein 	struct ip_tunnel_info tun_info[MLX5_MAX_FLOW_FWD_VPORTS];
127d11afc26SOz Shlomo 	struct net_device *filter_dev;
12817091853SOr Gerlitz 	struct mlx5_flow_spec spec;
129d79b6df6SOr Gerlitz 	int num_mod_hdr_actions;
130218d05ceSTonghao Zhang 	int max_mod_hdr_actions;
131d79b6df6SOr Gerlitz 	void *mod_hdr_actions;
13298b66cb1SEli Britstein 	int mirred_ifindex[MLX5_MAX_FLOW_FWD_VPORTS];
13317091853SOr Gerlitz };
13417091853SOr Gerlitz 
135acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4
136b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16)
137e8f887acSAmir Vadai 
13877ab67b7SOr Gerlitz struct mlx5e_hairpin {
13977ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
14077ab67b7SOr Gerlitz 
14177ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev;
1423f6d08d1SOr Gerlitz 	struct mlx5e_priv *func_priv;
14377ab67b7SOr Gerlitz 	u32 tdn;
14477ab67b7SOr Gerlitz 	u32 tirn;
1453f6d08d1SOr Gerlitz 
1463f6d08d1SOr Gerlitz 	int num_channels;
1473f6d08d1SOr Gerlitz 	struct mlx5e_rqt indir_rqt;
1483f6d08d1SOr Gerlitz 	u32 indir_tirn[MLX5E_NUM_INDIR_TIRS];
1493f6d08d1SOr Gerlitz 	struct mlx5e_ttc_table ttc;
15077ab67b7SOr Gerlitz };
15177ab67b7SOr Gerlitz 
1525c65c564SOr Gerlitz struct mlx5e_hairpin_entry {
1535c65c564SOr Gerlitz 	/* a node of a hash table which keeps all the  hairpin entries */
1545c65c564SOr Gerlitz 	struct hlist_node hairpin_hlist;
1555c65c564SOr Gerlitz 
1565c65c564SOr Gerlitz 	/* flows sharing the same hairpin */
1575c65c564SOr Gerlitz 	struct list_head flows;
1585c65c564SOr Gerlitz 
159d8822868SOr Gerlitz 	u16 peer_vhca_id;
160106be53bSOr Gerlitz 	u8 prio;
1615c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
1625c65c564SOr Gerlitz };
1635c65c564SOr Gerlitz 
16411c9c548SOr Gerlitz struct mod_hdr_key {
16511c9c548SOr Gerlitz 	int num_actions;
16611c9c548SOr Gerlitz 	void *actions;
16711c9c548SOr Gerlitz };
16811c9c548SOr Gerlitz 
16911c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry {
17011c9c548SOr Gerlitz 	/* a node of a hash table which keeps all the mod_hdr entries */
17111c9c548SOr Gerlitz 	struct hlist_node mod_hdr_hlist;
17211c9c548SOr Gerlitz 
17311c9c548SOr Gerlitz 	/* flows sharing the same mod_hdr entry */
17411c9c548SOr Gerlitz 	struct list_head flows;
17511c9c548SOr Gerlitz 
17611c9c548SOr Gerlitz 	struct mod_hdr_key key;
17711c9c548SOr Gerlitz 
17811c9c548SOr Gerlitz 	u32 mod_hdr_id;
17911c9c548SOr Gerlitz };
18011c9c548SOr Gerlitz 
18111c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto)
18211c9c548SOr Gerlitz 
18311c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key)
18411c9c548SOr Gerlitz {
18511c9c548SOr Gerlitz 	return jhash(key->actions,
18611c9c548SOr Gerlitz 		     key->num_actions * MLX5_MH_ACT_SZ, 0);
18711c9c548SOr Gerlitz }
18811c9c548SOr Gerlitz 
18911c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a,
19011c9c548SOr Gerlitz 				   struct mod_hdr_key *b)
19111c9c548SOr Gerlitz {
19211c9c548SOr Gerlitz 	if (a->num_actions != b->num_actions)
19311c9c548SOr Gerlitz 		return 1;
19411c9c548SOr Gerlitz 
19511c9c548SOr Gerlitz 	return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ);
19611c9c548SOr Gerlitz }
19711c9c548SOr Gerlitz 
19811c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv,
19911c9c548SOr Gerlitz 				struct mlx5e_tc_flow *flow,
20011c9c548SOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr)
20111c9c548SOr Gerlitz {
20211c9c548SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
20311c9c548SOr Gerlitz 	int num_actions, actions_size, namespace, err;
20411c9c548SOr Gerlitz 	struct mlx5e_mod_hdr_entry *mh;
20511c9c548SOr Gerlitz 	struct mod_hdr_key key;
20611c9c548SOr Gerlitz 	bool found = false;
20711c9c548SOr Gerlitz 	u32 hash_key;
20811c9c548SOr Gerlitz 
20911c9c548SOr Gerlitz 	num_actions  = parse_attr->num_mod_hdr_actions;
21011c9c548SOr Gerlitz 	actions_size = MLX5_MH_ACT_SZ * num_actions;
21111c9c548SOr Gerlitz 
21211c9c548SOr Gerlitz 	key.actions = parse_attr->mod_hdr_actions;
21311c9c548SOr Gerlitz 	key.num_actions = num_actions;
21411c9c548SOr Gerlitz 
21511c9c548SOr Gerlitz 	hash_key = hash_mod_hdr_info(&key);
21611c9c548SOr Gerlitz 
21711c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
21811c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_FDB;
21911c9c548SOr Gerlitz 		hash_for_each_possible(esw->offloads.mod_hdr_tbl, mh,
22011c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
22111c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
22211c9c548SOr Gerlitz 				found = true;
22311c9c548SOr Gerlitz 				break;
22411c9c548SOr Gerlitz 			}
22511c9c548SOr Gerlitz 		}
22611c9c548SOr Gerlitz 	} else {
22711c9c548SOr Gerlitz 		namespace = MLX5_FLOW_NAMESPACE_KERNEL;
22811c9c548SOr Gerlitz 		hash_for_each_possible(priv->fs.tc.mod_hdr_tbl, mh,
22911c9c548SOr Gerlitz 				       mod_hdr_hlist, hash_key) {
23011c9c548SOr Gerlitz 			if (!cmp_mod_hdr_info(&mh->key, &key)) {
23111c9c548SOr Gerlitz 				found = true;
23211c9c548SOr Gerlitz 				break;
23311c9c548SOr Gerlitz 			}
23411c9c548SOr Gerlitz 		}
23511c9c548SOr Gerlitz 	}
23611c9c548SOr Gerlitz 
23711c9c548SOr Gerlitz 	if (found)
23811c9c548SOr Gerlitz 		goto attach_flow;
23911c9c548SOr Gerlitz 
24011c9c548SOr Gerlitz 	mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL);
24111c9c548SOr Gerlitz 	if (!mh)
24211c9c548SOr Gerlitz 		return -ENOMEM;
24311c9c548SOr Gerlitz 
24411c9c548SOr Gerlitz 	mh->key.actions = (void *)mh + sizeof(*mh);
24511c9c548SOr Gerlitz 	memcpy(mh->key.actions, key.actions, actions_size);
24611c9c548SOr Gerlitz 	mh->key.num_actions = num_actions;
24711c9c548SOr Gerlitz 	INIT_LIST_HEAD(&mh->flows);
24811c9c548SOr Gerlitz 
24911c9c548SOr Gerlitz 	err = mlx5_modify_header_alloc(priv->mdev, namespace,
25011c9c548SOr Gerlitz 				       mh->key.num_actions,
25111c9c548SOr Gerlitz 				       mh->key.actions,
25211c9c548SOr Gerlitz 				       &mh->mod_hdr_id);
25311c9c548SOr Gerlitz 	if (err)
25411c9c548SOr Gerlitz 		goto out_err;
25511c9c548SOr Gerlitz 
25611c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
25711c9c548SOr Gerlitz 		hash_add(esw->offloads.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
25811c9c548SOr Gerlitz 	else
25911c9c548SOr Gerlitz 		hash_add(priv->fs.tc.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key);
26011c9c548SOr Gerlitz 
26111c9c548SOr Gerlitz attach_flow:
26211c9c548SOr Gerlitz 	list_add(&flow->mod_hdr, &mh->flows);
26311c9c548SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
26411c9c548SOr Gerlitz 		flow->esw_attr->mod_hdr_id = mh->mod_hdr_id;
26511c9c548SOr Gerlitz 	else
26611c9c548SOr Gerlitz 		flow->nic_attr->mod_hdr_id = mh->mod_hdr_id;
26711c9c548SOr Gerlitz 
26811c9c548SOr Gerlitz 	return 0;
26911c9c548SOr Gerlitz 
27011c9c548SOr Gerlitz out_err:
27111c9c548SOr Gerlitz 	kfree(mh);
27211c9c548SOr Gerlitz 	return err;
27311c9c548SOr Gerlitz }
27411c9c548SOr Gerlitz 
27511c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv,
27611c9c548SOr Gerlitz 				 struct mlx5e_tc_flow *flow)
27711c9c548SOr Gerlitz {
27811c9c548SOr Gerlitz 	struct list_head *next = flow->mod_hdr.next;
27911c9c548SOr Gerlitz 
28011c9c548SOr Gerlitz 	list_del(&flow->mod_hdr);
28111c9c548SOr Gerlitz 
28211c9c548SOr Gerlitz 	if (list_empty(next)) {
28311c9c548SOr Gerlitz 		struct mlx5e_mod_hdr_entry *mh;
28411c9c548SOr Gerlitz 
28511c9c548SOr Gerlitz 		mh = list_entry(next, struct mlx5e_mod_hdr_entry, flows);
28611c9c548SOr Gerlitz 
28711c9c548SOr Gerlitz 		mlx5_modify_header_dealloc(priv->mdev, mh->mod_hdr_id);
28811c9c548SOr Gerlitz 		hash_del(&mh->mod_hdr_hlist);
28911c9c548SOr Gerlitz 		kfree(mh);
29011c9c548SOr Gerlitz 	}
29111c9c548SOr Gerlitz }
29211c9c548SOr Gerlitz 
29377ab67b7SOr Gerlitz static
29477ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex)
29577ab67b7SOr Gerlitz {
29677ab67b7SOr Gerlitz 	struct net_device *netdev;
29777ab67b7SOr Gerlitz 	struct mlx5e_priv *priv;
29877ab67b7SOr Gerlitz 
29977ab67b7SOr Gerlitz 	netdev = __dev_get_by_index(net, ifindex);
30077ab67b7SOr Gerlitz 	priv = netdev_priv(netdev);
30177ab67b7SOr Gerlitz 	return priv->mdev;
30277ab67b7SOr Gerlitz }
30377ab67b7SOr Gerlitz 
30477ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp)
30577ab67b7SOr Gerlitz {
30677ab67b7SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0};
30777ab67b7SOr Gerlitz 	void *tirc;
30877ab67b7SOr Gerlitz 	int err;
30977ab67b7SOr Gerlitz 
31077ab67b7SOr Gerlitz 	err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn);
31177ab67b7SOr Gerlitz 	if (err)
31277ab67b7SOr Gerlitz 		goto alloc_tdn_err;
31377ab67b7SOr Gerlitz 
31477ab67b7SOr Gerlitz 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
31577ab67b7SOr Gerlitz 
31677ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT);
317ddae74acSOr Gerlitz 	MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]);
31877ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
31977ab67b7SOr Gerlitz 
32077ab67b7SOr Gerlitz 	err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn);
32177ab67b7SOr Gerlitz 	if (err)
32277ab67b7SOr Gerlitz 		goto create_tir_err;
32377ab67b7SOr Gerlitz 
32477ab67b7SOr Gerlitz 	return 0;
32577ab67b7SOr Gerlitz 
32677ab67b7SOr Gerlitz create_tir_err:
32777ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
32877ab67b7SOr Gerlitz alloc_tdn_err:
32977ab67b7SOr Gerlitz 	return err;
33077ab67b7SOr Gerlitz }
33177ab67b7SOr Gerlitz 
33277ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp)
33377ab67b7SOr Gerlitz {
33477ab67b7SOr Gerlitz 	mlx5_core_destroy_tir(hp->func_mdev, hp->tirn);
33577ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
33677ab67b7SOr Gerlitz }
33777ab67b7SOr Gerlitz 
3383f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc)
3393f6d08d1SOr Gerlitz {
3403f6d08d1SOr Gerlitz 	u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn;
3413f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3423f6d08d1SOr Gerlitz 	int i, ix, sz = MLX5E_INDIR_RQT_SIZE;
3433f6d08d1SOr Gerlitz 
3443f6d08d1SOr Gerlitz 	mlx5e_build_default_indir_rqt(indirection_rqt, sz,
3453f6d08d1SOr Gerlitz 				      hp->num_channels);
3463f6d08d1SOr Gerlitz 
3473f6d08d1SOr Gerlitz 	for (i = 0; i < sz; i++) {
3483f6d08d1SOr Gerlitz 		ix = i;
349bbeb53b8SAya Levin 		if (priv->rss_params.hfunc == ETH_RSS_HASH_XOR)
3503f6d08d1SOr Gerlitz 			ix = mlx5e_bits_invert(i, ilog2(sz));
3513f6d08d1SOr Gerlitz 		ix = indirection_rqt[ix];
3523f6d08d1SOr Gerlitz 		rqn = hp->pair->rqn[ix];
3533f6d08d1SOr Gerlitz 		MLX5_SET(rqtc, rqtc, rq_num[i], rqn);
3543f6d08d1SOr Gerlitz 	}
3553f6d08d1SOr Gerlitz }
3563f6d08d1SOr Gerlitz 
3573f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp)
3583f6d08d1SOr Gerlitz {
3593f6d08d1SOr Gerlitz 	int inlen, err, sz = MLX5E_INDIR_RQT_SIZE;
3603f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3613f6d08d1SOr Gerlitz 	struct mlx5_core_dev *mdev = priv->mdev;
3623f6d08d1SOr Gerlitz 	void *rqtc;
3633f6d08d1SOr Gerlitz 	u32 *in;
3643f6d08d1SOr Gerlitz 
3653f6d08d1SOr Gerlitz 	inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz;
3663f6d08d1SOr Gerlitz 	in = kvzalloc(inlen, GFP_KERNEL);
3673f6d08d1SOr Gerlitz 	if (!in)
3683f6d08d1SOr Gerlitz 		return -ENOMEM;
3693f6d08d1SOr Gerlitz 
3703f6d08d1SOr Gerlitz 	rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context);
3713f6d08d1SOr Gerlitz 
3723f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_actual_size, sz);
3733f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_max_size, sz);
3743f6d08d1SOr Gerlitz 
3753f6d08d1SOr Gerlitz 	mlx5e_hairpin_fill_rqt_rqns(hp, rqtc);
3763f6d08d1SOr Gerlitz 
3773f6d08d1SOr Gerlitz 	err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn);
3783f6d08d1SOr Gerlitz 	if (!err)
3793f6d08d1SOr Gerlitz 		hp->indir_rqt.enabled = true;
3803f6d08d1SOr Gerlitz 
3813f6d08d1SOr Gerlitz 	kvfree(in);
3823f6d08d1SOr Gerlitz 	return err;
3833f6d08d1SOr Gerlitz }
3843f6d08d1SOr Gerlitz 
3853f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp)
3863f6d08d1SOr Gerlitz {
3873f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
3883f6d08d1SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)];
3893f6d08d1SOr Gerlitz 	int tt, i, err;
3903f6d08d1SOr Gerlitz 	void *tirc;
3913f6d08d1SOr Gerlitz 
3923f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) {
393d930ac79SAya Levin 		struct mlx5e_tirc_config ttconfig = mlx5e_tirc_get_default_config(tt);
394d930ac79SAya Levin 
3953f6d08d1SOr Gerlitz 		memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in));
3963f6d08d1SOr Gerlitz 		tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
3973f6d08d1SOr Gerlitz 
3983f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
3993f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT);
4003f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn);
401bbeb53b8SAya Levin 		mlx5e_build_indir_tir_ctx_hash(&priv->rss_params, &ttconfig, tirc, false);
402bbeb53b8SAya Levin 
4033f6d08d1SOr Gerlitz 		err = mlx5_core_create_tir(hp->func_mdev, in,
4043f6d08d1SOr Gerlitz 					   MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]);
4053f6d08d1SOr Gerlitz 		if (err) {
4063f6d08d1SOr Gerlitz 			mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err);
4073f6d08d1SOr Gerlitz 			goto err_destroy_tirs;
4083f6d08d1SOr Gerlitz 		}
4093f6d08d1SOr Gerlitz 	}
4103f6d08d1SOr Gerlitz 	return 0;
4113f6d08d1SOr Gerlitz 
4123f6d08d1SOr Gerlitz err_destroy_tirs:
4133f6d08d1SOr Gerlitz 	for (i = 0; i < tt; i++)
4143f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]);
4153f6d08d1SOr Gerlitz 	return err;
4163f6d08d1SOr Gerlitz }
4173f6d08d1SOr Gerlitz 
4183f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp)
4193f6d08d1SOr Gerlitz {
4203f6d08d1SOr Gerlitz 	int tt;
4213f6d08d1SOr Gerlitz 
4223f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
4233f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]);
4243f6d08d1SOr Gerlitz }
4253f6d08d1SOr Gerlitz 
4263f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp,
4273f6d08d1SOr Gerlitz 					 struct ttc_params *ttc_params)
4283f6d08d1SOr Gerlitz {
4293f6d08d1SOr Gerlitz 	struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
4303f6d08d1SOr Gerlitz 	int tt;
4313f6d08d1SOr Gerlitz 
4323f6d08d1SOr Gerlitz 	memset(ttc_params, 0, sizeof(*ttc_params));
4333f6d08d1SOr Gerlitz 
4343f6d08d1SOr Gerlitz 	ttc_params->any_tt_tirn = hp->tirn;
4353f6d08d1SOr Gerlitz 
4363f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
4373f6d08d1SOr Gerlitz 		ttc_params->indir_tirn[tt] = hp->indir_tirn[tt];
4383f6d08d1SOr Gerlitz 
4393f6d08d1SOr Gerlitz 	ft_attr->max_fte = MLX5E_NUM_TT;
4403f6d08d1SOr Gerlitz 	ft_attr->level = MLX5E_TC_TTC_FT_LEVEL;
4413f6d08d1SOr Gerlitz 	ft_attr->prio = MLX5E_TC_PRIO;
4423f6d08d1SOr Gerlitz }
4433f6d08d1SOr Gerlitz 
4443f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp)
4453f6d08d1SOr Gerlitz {
4463f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4473f6d08d1SOr Gerlitz 	struct ttc_params ttc_params;
4483f6d08d1SOr Gerlitz 	int err;
4493f6d08d1SOr Gerlitz 
4503f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_rqt(hp);
4513f6d08d1SOr Gerlitz 	if (err)
4523f6d08d1SOr Gerlitz 		return err;
4533f6d08d1SOr Gerlitz 
4543f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_tirs(hp);
4553f6d08d1SOr Gerlitz 	if (err)
4563f6d08d1SOr Gerlitz 		goto err_create_indirect_tirs;
4573f6d08d1SOr Gerlitz 
4583f6d08d1SOr Gerlitz 	mlx5e_hairpin_set_ttc_params(hp, &ttc_params);
4593f6d08d1SOr Gerlitz 	err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc);
4603f6d08d1SOr Gerlitz 	if (err)
4613f6d08d1SOr Gerlitz 		goto err_create_ttc_table;
4623f6d08d1SOr Gerlitz 
4633f6d08d1SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n",
4643f6d08d1SOr Gerlitz 		   hp->num_channels, hp->ttc.ft.t->id);
4653f6d08d1SOr Gerlitz 
4663f6d08d1SOr Gerlitz 	return 0;
4673f6d08d1SOr Gerlitz 
4683f6d08d1SOr Gerlitz err_create_ttc_table:
4693f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
4703f6d08d1SOr Gerlitz err_create_indirect_tirs:
4713f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
4723f6d08d1SOr Gerlitz 
4733f6d08d1SOr Gerlitz 	return err;
4743f6d08d1SOr Gerlitz }
4753f6d08d1SOr Gerlitz 
4763f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp)
4773f6d08d1SOr Gerlitz {
4783f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4793f6d08d1SOr Gerlitz 
4803f6d08d1SOr Gerlitz 	mlx5e_destroy_ttc_table(priv, &hp->ttc);
4813f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
4823f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
4833f6d08d1SOr Gerlitz }
4843f6d08d1SOr Gerlitz 
48577ab67b7SOr Gerlitz static struct mlx5e_hairpin *
48677ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params,
48777ab67b7SOr Gerlitz 		     int peer_ifindex)
48877ab67b7SOr Gerlitz {
48977ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev, *peer_mdev;
49077ab67b7SOr Gerlitz 	struct mlx5e_hairpin *hp;
49177ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
49277ab67b7SOr Gerlitz 	int err;
49377ab67b7SOr Gerlitz 
49477ab67b7SOr Gerlitz 	hp = kzalloc(sizeof(*hp), GFP_KERNEL);
49577ab67b7SOr Gerlitz 	if (!hp)
49677ab67b7SOr Gerlitz 		return ERR_PTR(-ENOMEM);
49777ab67b7SOr Gerlitz 
49877ab67b7SOr Gerlitz 	func_mdev = priv->mdev;
49977ab67b7SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
50077ab67b7SOr Gerlitz 
50177ab67b7SOr Gerlitz 	pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params);
50277ab67b7SOr Gerlitz 	if (IS_ERR(pair)) {
50377ab67b7SOr Gerlitz 		err = PTR_ERR(pair);
50477ab67b7SOr Gerlitz 		goto create_pair_err;
50577ab67b7SOr Gerlitz 	}
50677ab67b7SOr Gerlitz 	hp->pair = pair;
50777ab67b7SOr Gerlitz 	hp->func_mdev = func_mdev;
5083f6d08d1SOr Gerlitz 	hp->func_priv = priv;
5093f6d08d1SOr Gerlitz 	hp->num_channels = params->num_channels;
51077ab67b7SOr Gerlitz 
51177ab67b7SOr Gerlitz 	err = mlx5e_hairpin_create_transport(hp);
51277ab67b7SOr Gerlitz 	if (err)
51377ab67b7SOr Gerlitz 		goto create_transport_err;
51477ab67b7SOr Gerlitz 
5153f6d08d1SOr Gerlitz 	if (hp->num_channels > 1) {
5163f6d08d1SOr Gerlitz 		err = mlx5e_hairpin_rss_init(hp);
5173f6d08d1SOr Gerlitz 		if (err)
5183f6d08d1SOr Gerlitz 			goto rss_init_err;
5193f6d08d1SOr Gerlitz 	}
5203f6d08d1SOr Gerlitz 
52177ab67b7SOr Gerlitz 	return hp;
52277ab67b7SOr Gerlitz 
5233f6d08d1SOr Gerlitz rss_init_err:
5243f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
52577ab67b7SOr Gerlitz create_transport_err:
52677ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
52777ab67b7SOr Gerlitz create_pair_err:
52877ab67b7SOr Gerlitz 	kfree(hp);
52977ab67b7SOr Gerlitz 	return ERR_PTR(err);
53077ab67b7SOr Gerlitz }
53177ab67b7SOr Gerlitz 
53277ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp)
53377ab67b7SOr Gerlitz {
5343f6d08d1SOr Gerlitz 	if (hp->num_channels > 1)
5353f6d08d1SOr Gerlitz 		mlx5e_hairpin_rss_cleanup(hp);
53677ab67b7SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
53777ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
53877ab67b7SOr Gerlitz 	kvfree(hp);
53977ab67b7SOr Gerlitz }
54077ab67b7SOr Gerlitz 
541106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio)
542106be53bSOr Gerlitz {
543106be53bSOr Gerlitz 	return (peer_vhca_id << 16 | prio);
544106be53bSOr Gerlitz }
545106be53bSOr Gerlitz 
5465c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv,
547106be53bSOr Gerlitz 						     u16 peer_vhca_id, u8 prio)
5485c65c564SOr Gerlitz {
5495c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
550106be53bSOr Gerlitz 	u32 hash_key = hash_hairpin_info(peer_vhca_id, prio);
5515c65c564SOr Gerlitz 
5525c65c564SOr Gerlitz 	hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe,
553106be53bSOr Gerlitz 			       hairpin_hlist, hash_key) {
554106be53bSOr Gerlitz 		if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio)
5555c65c564SOr Gerlitz 			return hpe;
5565c65c564SOr Gerlitz 	}
5575c65c564SOr Gerlitz 
5585c65c564SOr Gerlitz 	return NULL;
5595c65c564SOr Gerlitz }
5605c65c564SOr Gerlitz 
561106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8
562106be53bSOr Gerlitz 
563106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv,
564e98bedf5SEli Britstein 				  struct mlx5_flow_spec *spec, u8 *match_prio,
565e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
566106be53bSOr Gerlitz {
567106be53bSOr Gerlitz 	void *headers_c, *headers_v;
568106be53bSOr Gerlitz 	u8 prio_val, prio_mask = 0;
569106be53bSOr Gerlitz 	bool vlan_present;
570106be53bSOr Gerlitz 
571106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB
572106be53bSOr Gerlitz 	if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) {
573e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
574e98bedf5SEli Britstein 				   "only PCP trust state supported for hairpin");
575106be53bSOr Gerlitz 		return -EOPNOTSUPP;
576106be53bSOr Gerlitz 	}
577106be53bSOr Gerlitz #endif
578106be53bSOr Gerlitz 	headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers);
579106be53bSOr Gerlitz 	headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
580106be53bSOr Gerlitz 
581106be53bSOr Gerlitz 	vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag);
582106be53bSOr Gerlitz 	if (vlan_present) {
583106be53bSOr Gerlitz 		prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio);
584106be53bSOr Gerlitz 		prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio);
585106be53bSOr Gerlitz 	}
586106be53bSOr Gerlitz 
587106be53bSOr Gerlitz 	if (!vlan_present || !prio_mask) {
588106be53bSOr Gerlitz 		prio_val = UNKNOWN_MATCH_PRIO;
589106be53bSOr Gerlitz 	} else if (prio_mask != 0x7) {
590e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
591e98bedf5SEli Britstein 				   "masked priority match not supported for hairpin");
592106be53bSOr Gerlitz 		return -EOPNOTSUPP;
593106be53bSOr Gerlitz 	}
594106be53bSOr Gerlitz 
595106be53bSOr Gerlitz 	*match_prio = prio_val;
596106be53bSOr Gerlitz 	return 0;
597106be53bSOr Gerlitz }
598106be53bSOr Gerlitz 
5995c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv,
6005c65c564SOr Gerlitz 				  struct mlx5e_tc_flow *flow,
601e98bedf5SEli Britstein 				  struct mlx5e_tc_flow_parse_attr *parse_attr,
602e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
6035c65c564SOr Gerlitz {
60498b66cb1SEli Britstein 	int peer_ifindex = parse_attr->mirred_ifindex[0];
6055c65c564SOr Gerlitz 	struct mlx5_hairpin_params params;
606d8822868SOr Gerlitz 	struct mlx5_core_dev *peer_mdev;
6075c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
6085c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
6093f6d08d1SOr Gerlitz 	u64 link_speed64;
6103f6d08d1SOr Gerlitz 	u32 link_speed;
611106be53bSOr Gerlitz 	u8 match_prio;
612d8822868SOr Gerlitz 	u16 peer_id;
6135c65c564SOr Gerlitz 	int err;
6145c65c564SOr Gerlitz 
615d8822868SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
616d8822868SOr Gerlitz 	if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) {
617e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported");
6185c65c564SOr Gerlitz 		return -EOPNOTSUPP;
6195c65c564SOr Gerlitz 	}
6205c65c564SOr Gerlitz 
621d8822868SOr Gerlitz 	peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
622e98bedf5SEli Britstein 	err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio,
623e98bedf5SEli Britstein 				     extack);
624106be53bSOr Gerlitz 	if (err)
625106be53bSOr Gerlitz 		return err;
626106be53bSOr Gerlitz 	hpe = mlx5e_hairpin_get(priv, peer_id, match_prio);
6275c65c564SOr Gerlitz 	if (hpe)
6285c65c564SOr Gerlitz 		goto attach_flow;
6295c65c564SOr Gerlitz 
6305c65c564SOr Gerlitz 	hpe = kzalloc(sizeof(*hpe), GFP_KERNEL);
6315c65c564SOr Gerlitz 	if (!hpe)
6325c65c564SOr Gerlitz 		return -ENOMEM;
6335c65c564SOr Gerlitz 
6345c65c564SOr Gerlitz 	INIT_LIST_HEAD(&hpe->flows);
635d8822868SOr Gerlitz 	hpe->peer_vhca_id = peer_id;
636106be53bSOr Gerlitz 	hpe->prio = match_prio;
6375c65c564SOr Gerlitz 
6385c65c564SOr Gerlitz 	params.log_data_size = 15;
6395c65c564SOr Gerlitz 	params.log_data_size = min_t(u8, params.log_data_size,
6405c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz));
6415c65c564SOr Gerlitz 	params.log_data_size = max_t(u8, params.log_data_size,
6425c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz));
6435c65c564SOr Gerlitz 
644eb9180f7SOr Gerlitz 	params.log_num_packets = params.log_data_size -
645eb9180f7SOr Gerlitz 				 MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev);
646eb9180f7SOr Gerlitz 	params.log_num_packets = min_t(u8, params.log_num_packets,
647eb9180f7SOr Gerlitz 				       MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets));
648eb9180f7SOr Gerlitz 
649eb9180f7SOr Gerlitz 	params.q_counter = priv->q_counter;
6503f6d08d1SOr Gerlitz 	/* set hairpin pair per each 50Gbs share of the link */
6512c81bfd5SHuy Nguyen 	mlx5e_port_max_linkspeed(priv->mdev, &link_speed);
6523f6d08d1SOr Gerlitz 	link_speed = max_t(u32, link_speed, 50000);
6533f6d08d1SOr Gerlitz 	link_speed64 = link_speed;
6543f6d08d1SOr Gerlitz 	do_div(link_speed64, 50000);
6553f6d08d1SOr Gerlitz 	params.num_channels = link_speed64;
6563f6d08d1SOr Gerlitz 
6575c65c564SOr Gerlitz 	hp = mlx5e_hairpin_create(priv, &params, peer_ifindex);
6585c65c564SOr Gerlitz 	if (IS_ERR(hp)) {
6595c65c564SOr Gerlitz 		err = PTR_ERR(hp);
6605c65c564SOr Gerlitz 		goto create_hairpin_err;
6615c65c564SOr Gerlitz 	}
6625c65c564SOr Gerlitz 
663eb9180f7SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n",
664ddae74acSOr Gerlitz 		   hp->tirn, hp->pair->rqn[0], hp->pair->peer_mdev->priv.name,
665eb9180f7SOr Gerlitz 		   hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets);
6665c65c564SOr Gerlitz 
6675c65c564SOr Gerlitz 	hpe->hp = hp;
668106be53bSOr Gerlitz 	hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist,
669106be53bSOr Gerlitz 		 hash_hairpin_info(peer_id, match_prio));
6705c65c564SOr Gerlitz 
6715c65c564SOr Gerlitz attach_flow:
6723f6d08d1SOr Gerlitz 	if (hpe->hp->num_channels > 1) {
6733f6d08d1SOr Gerlitz 		flow->flags |= MLX5E_TC_FLOW_HAIRPIN_RSS;
6743f6d08d1SOr Gerlitz 		flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t;
6753f6d08d1SOr Gerlitz 	} else {
6765c65c564SOr Gerlitz 		flow->nic_attr->hairpin_tirn = hpe->hp->tirn;
6773f6d08d1SOr Gerlitz 	}
6785c65c564SOr Gerlitz 	list_add(&flow->hairpin, &hpe->flows);
6793f6d08d1SOr Gerlitz 
6805c65c564SOr Gerlitz 	return 0;
6815c65c564SOr Gerlitz 
6825c65c564SOr Gerlitz create_hairpin_err:
6835c65c564SOr Gerlitz 	kfree(hpe);
6845c65c564SOr Gerlitz 	return err;
6855c65c564SOr Gerlitz }
6865c65c564SOr Gerlitz 
6875c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv,
6885c65c564SOr Gerlitz 				   struct mlx5e_tc_flow *flow)
6895c65c564SOr Gerlitz {
6905c65c564SOr Gerlitz 	struct list_head *next = flow->hairpin.next;
6915c65c564SOr Gerlitz 
6925c65c564SOr Gerlitz 	list_del(&flow->hairpin);
6935c65c564SOr Gerlitz 
6945c65c564SOr Gerlitz 	/* no more hairpin flows for us, release the hairpin pair */
6955c65c564SOr Gerlitz 	if (list_empty(next)) {
6965c65c564SOr Gerlitz 		struct mlx5e_hairpin_entry *hpe;
6975c65c564SOr Gerlitz 
6985c65c564SOr Gerlitz 		hpe = list_entry(next, struct mlx5e_hairpin_entry, flows);
6995c65c564SOr Gerlitz 
7005c65c564SOr Gerlitz 		netdev_dbg(priv->netdev, "del hairpin: peer %s\n",
7015c65c564SOr Gerlitz 			   hpe->hp->pair->peer_mdev->priv.name);
7025c65c564SOr Gerlitz 
7035c65c564SOr Gerlitz 		mlx5e_hairpin_destroy(hpe->hp);
7045c65c564SOr Gerlitz 		hash_del(&hpe->hairpin_hlist);
7055c65c564SOr Gerlitz 		kfree(hpe);
7065c65c564SOr Gerlitz 	}
7075c65c564SOr Gerlitz }
7085c65c564SOr Gerlitz 
709c83954abSRabie Loulou static int
71074491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv,
71117091853SOr Gerlitz 		      struct mlx5e_tc_flow_parse_attr *parse_attr,
712e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
713e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
714e8f887acSAmir Vadai {
715aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
716aad7e08dSAmir Vadai 	struct mlx5_core_dev *dev = priv->mdev;
7175c65c564SOr Gerlitz 	struct mlx5_flow_destination dest[2] = {};
71866958ed9SHadar Hen Zion 	struct mlx5_flow_act flow_act = {
7193bc4b7bfSOr Gerlitz 		.action = attr->action,
7203bc4b7bfSOr Gerlitz 		.flow_tag = attr->flow_tag,
72160786f09SMark Bloch 		.reformat_id = 0,
72242f7ad67SPaul Blakey 		.flags    = FLOW_ACT_HAS_TAG | FLOW_ACT_NO_APPEND,
72366958ed9SHadar Hen Zion 	};
724aad7e08dSAmir Vadai 	struct mlx5_fc *counter = NULL;
725e8f887acSAmir Vadai 	bool table_created = false;
7265c65c564SOr Gerlitz 	int err, dest_ix = 0;
727e8f887acSAmir Vadai 
7285c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) {
729e98bedf5SEli Britstein 		err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack);
7305c65c564SOr Gerlitz 		if (err) {
7315c65c564SOr Gerlitz 			goto err_add_hairpin_flow;
7325c65c564SOr Gerlitz 		}
7333f6d08d1SOr Gerlitz 		if (flow->flags & MLX5E_TC_FLOW_HAIRPIN_RSS) {
7343f6d08d1SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
7353f6d08d1SOr Gerlitz 			dest[dest_ix].ft = attr->hairpin_ft;
7363f6d08d1SOr Gerlitz 		} else {
7375c65c564SOr Gerlitz 			dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR;
7385c65c564SOr Gerlitz 			dest[dest_ix].tir_num = attr->hairpin_tirn;
7393f6d08d1SOr Gerlitz 		}
7403f6d08d1SOr Gerlitz 		dest_ix++;
7413f6d08d1SOr Gerlitz 	} else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
7425c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
7435c65c564SOr Gerlitz 		dest[dest_ix].ft = priv->fs.vlan.ft.t;
7445c65c564SOr Gerlitz 		dest_ix++;
7455c65c564SOr Gerlitz 	}
746aad7e08dSAmir Vadai 
7475c65c564SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
7485c65c564SOr Gerlitz 		counter = mlx5_fc_create(dev, true);
7495c65c564SOr Gerlitz 		if (IS_ERR(counter)) {
750c83954abSRabie Loulou 			err = PTR_ERR(counter);
7515c65c564SOr Gerlitz 			goto err_fc_create;
7525c65c564SOr Gerlitz 		}
7535c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
754171c7625SMark Bloch 		dest[dest_ix].counter_id = mlx5_fc_id(counter);
7555c65c564SOr Gerlitz 		dest_ix++;
756b8aee822SMark Bloch 		attr->counter = counter;
757aad7e08dSAmir Vadai 	}
758aad7e08dSAmir Vadai 
7592f4fe4caSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
7603099eb5aSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
761d7e75a32SOr Gerlitz 		flow_act.modify_id = attr->mod_hdr_id;
7622f4fe4caSOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
763c83954abSRabie Loulou 		if (err)
7642f4fe4caSOr Gerlitz 			goto err_create_mod_hdr_id;
7652f4fe4caSOr Gerlitz 	}
7662f4fe4caSOr Gerlitz 
767acff797cSMaor Gottlieb 	if (IS_ERR_OR_NULL(priv->fs.tc.t)) {
76821b9c144SOr Gerlitz 		int tc_grp_size, tc_tbl_size;
76921b9c144SOr Gerlitz 		u32 max_flow_counter;
77021b9c144SOr Gerlitz 
77121b9c144SOr Gerlitz 		max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) |
77221b9c144SOr Gerlitz 				    MLX5_CAP_GEN(dev, max_flow_counter_15_0);
77321b9c144SOr Gerlitz 
77421b9c144SOr Gerlitz 		tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE);
77521b9c144SOr Gerlitz 
77621b9c144SOr Gerlitz 		tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS,
77721b9c144SOr Gerlitz 				    BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size)));
77821b9c144SOr Gerlitz 
779acff797cSMaor Gottlieb 		priv->fs.tc.t =
780acff797cSMaor Gottlieb 			mlx5_create_auto_grouped_flow_table(priv->fs.ns,
781acff797cSMaor Gottlieb 							    MLX5E_TC_PRIO,
78221b9c144SOr Gerlitz 							    tc_tbl_size,
783acff797cSMaor Gottlieb 							    MLX5E_TC_TABLE_NUM_GROUPS,
7843f6d08d1SOr Gerlitz 							    MLX5E_TC_FT_LEVEL, 0);
785acff797cSMaor Gottlieb 		if (IS_ERR(priv->fs.tc.t)) {
786e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
787e98bedf5SEli Britstein 					   "Failed to create tc offload table\n");
788e8f887acSAmir Vadai 			netdev_err(priv->netdev,
789e8f887acSAmir Vadai 				   "Failed to create tc offload table\n");
790c83954abSRabie Loulou 			err = PTR_ERR(priv->fs.tc.t);
791aad7e08dSAmir Vadai 			goto err_create_ft;
792e8f887acSAmir Vadai 		}
793e8f887acSAmir Vadai 
794e8f887acSAmir Vadai 		table_created = true;
795e8f887acSAmir Vadai 	}
796e8f887acSAmir Vadai 
79738aa51c1SOr Gerlitz 	if (attr->match_level != MLX5_MATCH_NONE)
79817091853SOr Gerlitz 		parse_attr->spec.match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
79938aa51c1SOr Gerlitz 
800c83954abSRabie Loulou 	flow->rule[0] = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec,
8015c65c564SOr Gerlitz 					    &flow_act, dest, dest_ix);
802e8f887acSAmir Vadai 
803c83954abSRabie Loulou 	if (IS_ERR(flow->rule[0])) {
804c83954abSRabie Loulou 		err = PTR_ERR(flow->rule[0]);
805aad7e08dSAmir Vadai 		goto err_add_rule;
806c83954abSRabie Loulou 	}
807aad7e08dSAmir Vadai 
808c83954abSRabie Loulou 	return 0;
809aad7e08dSAmir Vadai 
810aad7e08dSAmir Vadai err_add_rule:
811aad7e08dSAmir Vadai 	if (table_created) {
812acff797cSMaor Gottlieb 		mlx5_destroy_flow_table(priv->fs.tc.t);
813acff797cSMaor Gottlieb 		priv->fs.tc.t = NULL;
814e8f887acSAmir Vadai 	}
815aad7e08dSAmir Vadai err_create_ft:
8162f4fe4caSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
8173099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
8182f4fe4caSOr Gerlitz err_create_mod_hdr_id:
819aad7e08dSAmir Vadai 	mlx5_fc_destroy(dev, counter);
8205c65c564SOr Gerlitz err_fc_create:
8215c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN)
8225c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
8235c65c564SOr Gerlitz err_add_hairpin_flow:
824c83954abSRabie Loulou 	return err;
825e8f887acSAmir Vadai }
826e8f887acSAmir Vadai 
827d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv,
828d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
829d85cdccbSOr Gerlitz {
830513f8f7fSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
831d85cdccbSOr Gerlitz 	struct mlx5_fc *counter = NULL;
832d85cdccbSOr Gerlitz 
833b8aee822SMark Bloch 	counter = attr->counter;
834e4ad91f2SChris Mi 	mlx5_del_flow_rules(flow->rule[0]);
835d85cdccbSOr Gerlitz 	mlx5_fc_destroy(priv->mdev, counter);
836d85cdccbSOr Gerlitz 
837d9ee0491SOr Gerlitz 	if (!mlx5e_tc_num_filters(priv, MLX5E_TC_NIC_OFFLOAD)  && priv->fs.tc.t) {
838d85cdccbSOr Gerlitz 		mlx5_destroy_flow_table(priv->fs.tc.t);
839d85cdccbSOr Gerlitz 		priv->fs.tc.t = NULL;
840d85cdccbSOr Gerlitz 	}
8412f4fe4caSOr Gerlitz 
842513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
8433099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
8445c65c564SOr Gerlitz 
8455c65c564SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_HAIRPIN)
8465c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
847d85cdccbSOr Gerlitz }
848d85cdccbSOr Gerlitz 
849aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
8508c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index);
851aa0cbbaeSOr Gerlitz 
8523c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv,
853e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
854733d4f36SRoi Dayan 			      struct net_device *mirred_dev,
855733d4f36SRoi Dayan 			      int out_index,
8568c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
8570ad060eeSRoi Dayan 			      struct net_device **encap_dev,
8580ad060eeSRoi Dayan 			      bool *encap_valid);
8593c37745eSOr Gerlitz 
8606d2a3ed0SOr Gerlitz static struct mlx5_flow_handle *
8616d2a3ed0SOr Gerlitz mlx5e_tc_offload_fdb_rules(struct mlx5_eswitch *esw,
8626d2a3ed0SOr Gerlitz 			   struct mlx5e_tc_flow *flow,
8636d2a3ed0SOr Gerlitz 			   struct mlx5_flow_spec *spec,
8646d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
8656d2a3ed0SOr Gerlitz {
8666d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
8676d2a3ed0SOr Gerlitz 
8686d2a3ed0SOr Gerlitz 	rule = mlx5_eswitch_add_offloaded_rule(esw, spec, attr);
8696d2a3ed0SOr Gerlitz 	if (IS_ERR(rule))
8706d2a3ed0SOr Gerlitz 		return rule;
8716d2a3ed0SOr Gerlitz 
872e85e02baSEli Britstein 	if (attr->split_count) {
8736d2a3ed0SOr Gerlitz 		flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, spec, attr);
8746d2a3ed0SOr Gerlitz 		if (IS_ERR(flow->rule[1])) {
8756d2a3ed0SOr Gerlitz 			mlx5_eswitch_del_offloaded_rule(esw, rule, attr);
8766d2a3ed0SOr Gerlitz 			return flow->rule[1];
8776d2a3ed0SOr Gerlitz 		}
8786d2a3ed0SOr Gerlitz 	}
8796d2a3ed0SOr Gerlitz 
8806d2a3ed0SOr Gerlitz 	flow->flags |= MLX5E_TC_FLOW_OFFLOADED;
8816d2a3ed0SOr Gerlitz 	return rule;
8826d2a3ed0SOr Gerlitz }
8836d2a3ed0SOr Gerlitz 
8846d2a3ed0SOr Gerlitz static void
8856d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(struct mlx5_eswitch *esw,
8866d2a3ed0SOr Gerlitz 			     struct mlx5e_tc_flow *flow,
8876d2a3ed0SOr Gerlitz 			   struct mlx5_esw_flow_attr *attr)
8886d2a3ed0SOr Gerlitz {
8896d2a3ed0SOr Gerlitz 	flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED;
8906d2a3ed0SOr Gerlitz 
891e85e02baSEli Britstein 	if (attr->split_count)
8926d2a3ed0SOr Gerlitz 		mlx5_eswitch_del_fwd_rule(esw, flow->rule[1], attr);
8936d2a3ed0SOr Gerlitz 
8946d2a3ed0SOr Gerlitz 	mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr);
8956d2a3ed0SOr Gerlitz }
8966d2a3ed0SOr Gerlitz 
8975dbe906fSPaul Blakey static struct mlx5_flow_handle *
8985dbe906fSPaul Blakey mlx5e_tc_offload_to_slow_path(struct mlx5_eswitch *esw,
8995dbe906fSPaul Blakey 			      struct mlx5e_tc_flow *flow,
9005dbe906fSPaul Blakey 			      struct mlx5_flow_spec *spec,
9015dbe906fSPaul Blakey 			      struct mlx5_esw_flow_attr *slow_attr)
9025dbe906fSPaul Blakey {
9035dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
9045dbe906fSPaul Blakey 
9055dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
906154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9072be09de7SDavid S. Miller 	slow_attr->split_count = 0;
908154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
9095dbe906fSPaul Blakey 
9105dbe906fSPaul Blakey 	rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, slow_attr);
9115dbe906fSPaul Blakey 	if (!IS_ERR(rule))
9125dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_SLOW;
9135dbe906fSPaul Blakey 
9145dbe906fSPaul Blakey 	return rule;
9155dbe906fSPaul Blakey }
9165dbe906fSPaul Blakey 
9175dbe906fSPaul Blakey static void
9185dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(struct mlx5_eswitch *esw,
9195dbe906fSPaul Blakey 				  struct mlx5e_tc_flow *flow,
9205dbe906fSPaul Blakey 				  struct mlx5_esw_flow_attr *slow_attr)
9215dbe906fSPaul Blakey {
9225dbe906fSPaul Blakey 	memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr));
923154e62abSOr Gerlitz 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
9242be09de7SDavid S. Miller 	slow_attr->split_count = 0;
925154e62abSOr Gerlitz 	slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN;
9265dbe906fSPaul Blakey 	mlx5e_tc_unoffload_fdb_rules(esw, flow, slow_attr);
9275dbe906fSPaul Blakey 	flow->flags &= ~MLX5E_TC_FLOW_SLOW;
9285dbe906fSPaul Blakey }
9295dbe906fSPaul Blakey 
930c83954abSRabie Loulou static int
93174491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv,
932e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
933e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
934adb4c123SOr Gerlitz {
935adb4c123SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
936bf07aa73SPaul Blakey 	u32 max_chain = mlx5_eswitch_get_chain_range(esw);
937aa0cbbaeSOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
9387040632dSTonghao Zhang 	struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr;
939bf07aa73SPaul Blakey 	u16 max_prio = mlx5_eswitch_get_prio_range(esw);
9403c37745eSOr Gerlitz 	struct net_device *out_dev, *encap_dev = NULL;
941b8aee822SMark Bloch 	struct mlx5_fc *counter = NULL;
9423c37745eSOr Gerlitz 	struct mlx5e_rep_priv *rpriv;
9433c37745eSOr Gerlitz 	struct mlx5e_priv *out_priv;
9440ad060eeSRoi Dayan 	bool encap_valid = true;
9450ad060eeSRoi Dayan 	int err = 0;
946f493f155SEli Britstein 	int out_index;
9478b32580dSOr Gerlitz 
948d14f6f2aSOr Gerlitz 	if (!mlx5_eswitch_prios_supported(esw) && attr->prio != 1) {
949d14f6f2aSOr Gerlitz 		NL_SET_ERR_MSG(extack, "E-switch priorities unsupported, upgrade FW");
950d14f6f2aSOr Gerlitz 		return -EOPNOTSUPP;
951d14f6f2aSOr Gerlitz 	}
952e52c2802SPaul Blakey 
953bf07aa73SPaul Blakey 	if (attr->chain > max_chain) {
954bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested chain is out of supported range");
955bf07aa73SPaul Blakey 		err = -EOPNOTSUPP;
956bf07aa73SPaul Blakey 		goto err_max_prio_chain;
957bf07aa73SPaul Blakey 	}
958bf07aa73SPaul Blakey 
959bf07aa73SPaul Blakey 	if (attr->prio > max_prio) {
960bf07aa73SPaul Blakey 		NL_SET_ERR_MSG(extack, "Requested priority is out of supported range");
961bf07aa73SPaul Blakey 		err = -EOPNOTSUPP;
962bf07aa73SPaul Blakey 		goto err_max_prio_chain;
963bf07aa73SPaul Blakey 	}
964bf07aa73SPaul Blakey 
965f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) {
9668c4dc42bSEli Britstein 		int mirred_ifindex;
9678c4dc42bSEli Britstein 
968f493f155SEli Britstein 		if (!(attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP))
969f493f155SEli Britstein 			continue;
970f493f155SEli Britstein 
9717040632dSTonghao Zhang 		mirred_ifindex = parse_attr->mirred_ifindex[out_index];
9723c37745eSOr Gerlitz 		out_dev = __dev_get_by_index(dev_net(priv->netdev),
9738c4dc42bSEli Britstein 					     mirred_ifindex);
974733d4f36SRoi Dayan 		err = mlx5e_attach_encap(priv, flow, out_dev, out_index,
9750ad060eeSRoi Dayan 					 extack, &encap_dev, &encap_valid);
9760ad060eeSRoi Dayan 		if (err)
9773c37745eSOr Gerlitz 			goto err_attach_encap;
9780ad060eeSRoi Dayan 
9793c37745eSOr Gerlitz 		out_priv = netdev_priv(encap_dev);
9803c37745eSOr Gerlitz 		rpriv = out_priv->ppriv;
9811cc26d74SEli Britstein 		attr->dests[out_index].rep = rpriv->rep;
9821cc26d74SEli Britstein 		attr->dests[out_index].mdev = out_priv->mdev;
9833c37745eSOr Gerlitz 	}
9843c37745eSOr Gerlitz 
9858b32580dSOr Gerlitz 	err = mlx5_eswitch_add_vlan_action(esw, attr);
986c83954abSRabie Loulou 	if (err)
987aa0cbbaeSOr Gerlitz 		goto err_add_vlan;
988adb4c123SOr Gerlitz 
989d7e75a32SOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
9901a9527bbSOr Gerlitz 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
991d7e75a32SOr Gerlitz 		kfree(parse_attr->mod_hdr_actions);
992c83954abSRabie Loulou 		if (err)
993d7e75a32SOr Gerlitz 			goto err_mod_hdr;
994d7e75a32SOr Gerlitz 	}
995d7e75a32SOr Gerlitz 
996b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
997f9392795SShahar Klein 		counter = mlx5_fc_create(attr->counter_dev, true);
998b8aee822SMark Bloch 		if (IS_ERR(counter)) {
999c83954abSRabie Loulou 			err = PTR_ERR(counter);
1000b8aee822SMark Bloch 			goto err_create_counter;
1001b8aee822SMark Bloch 		}
1002b8aee822SMark Bloch 
1003b8aee822SMark Bloch 		attr->counter = counter;
1004b8aee822SMark Bloch 	}
1005b8aee822SMark Bloch 
10060ad060eeSRoi Dayan 	/* we get here if one of the following takes place:
10070ad060eeSRoi Dayan 	 * (1) there's no error
10080ad060eeSRoi Dayan 	 * (2) there's an encap action and we don't have valid neigh
10093c37745eSOr Gerlitz 	 */
10100ad060eeSRoi Dayan 	if (!encap_valid) {
10115dbe906fSPaul Blakey 		/* continue with goto slow path rule instead */
10125dbe906fSPaul Blakey 		struct mlx5_esw_flow_attr slow_attr;
10135dbe906fSPaul Blakey 
10145dbe906fSPaul Blakey 		flow->rule[0] = mlx5e_tc_offload_to_slow_path(esw, flow, &parse_attr->spec, &slow_attr);
10155dbe906fSPaul Blakey 	} else {
10166d2a3ed0SOr Gerlitz 		flow->rule[0] = mlx5e_tc_offload_fdb_rules(esw, flow, &parse_attr->spec, attr);
10175dbe906fSPaul Blakey 	}
10185dbe906fSPaul Blakey 
1019c83954abSRabie Loulou 	if (IS_ERR(flow->rule[0])) {
1020c83954abSRabie Loulou 		err = PTR_ERR(flow->rule[0]);
1021aa0cbbaeSOr Gerlitz 		goto err_add_rule;
1022c83954abSRabie Loulou 	}
1023c83954abSRabie Loulou 
10245dbe906fSPaul Blakey 	return 0;
1025aa0cbbaeSOr Gerlitz 
1026aa0cbbaeSOr Gerlitz err_add_rule:
1027f9392795SShahar Klein 	mlx5_fc_destroy(attr->counter_dev, counter);
1028b8aee822SMark Bloch err_create_counter:
1029513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
10301a9527bbSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
1031d7e75a32SOr Gerlitz err_mod_hdr:
1032aa0cbbaeSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1033aa0cbbaeSOr Gerlitz err_add_vlan:
1034f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
10358c4dc42bSEli Britstein 		if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)
10368c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
10373c37745eSOr Gerlitz err_attach_encap:
1038bf07aa73SPaul Blakey err_max_prio_chain:
1039c83954abSRabie Loulou 	return err;
1040aa0cbbaeSOr Gerlitz }
1041d85cdccbSOr Gerlitz 
1042d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv,
1043d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
1044d85cdccbSOr Gerlitz {
1045d85cdccbSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
1046d7e75a32SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
10475dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
1048f493f155SEli Britstein 	int out_index;
1049d85cdccbSOr Gerlitz 
10505dbe906fSPaul Blakey 	if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
10515dbe906fSPaul Blakey 		if (flow->flags & MLX5E_TC_FLOW_SLOW)
10525dbe906fSPaul Blakey 			mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
10535dbe906fSPaul Blakey 		else
10545dbe906fSPaul Blakey 			mlx5e_tc_unoffload_fdb_rules(esw, flow, attr);
10555dbe906fSPaul Blakey 	}
1056d85cdccbSOr Gerlitz 
1057513f8f7fSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1058d85cdccbSOr Gerlitz 
1059f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
10608c4dc42bSEli Britstein 		if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)
10618c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
1062f493f155SEli Britstein 	kvfree(attr->parse_attr);
1063d7e75a32SOr Gerlitz 
1064513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
10651a9527bbSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
1066b8aee822SMark Bloch 
1067b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT)
1068f9392795SShahar Klein 		mlx5_fc_destroy(attr->counter_dev, attr->counter);
1069d85cdccbSOr Gerlitz }
1070d85cdccbSOr Gerlitz 
1071232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv,
1072232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1073232c0013SHadar Hen Zion {
10743c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
10755dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr, *esw_attr;
10766d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
10776d2a3ed0SOr Gerlitz 	struct mlx5_flow_spec *spec;
107879baaec7SEli Britstein 	struct encap_flow_item *efi;
1079232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1080232c0013SHadar Hen Zion 	int err;
1081232c0013SHadar Hen Zion 
108254c177caSOz Shlomo 	err = mlx5_packet_reformat_alloc(priv->mdev,
108354c177caSOz Shlomo 					 e->reformat_type,
1084232c0013SHadar Hen Zion 					 e->encap_size, e->encap_header,
108531ca3648SMark Bloch 					 MLX5_FLOW_NAMESPACE_FDB,
1086232c0013SHadar Hen Zion 					 &e->encap_id);
1087232c0013SHadar Hen Zion 	if (err) {
1088232c0013SHadar Hen Zion 		mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n",
1089232c0013SHadar Hen Zion 			       err);
1090232c0013SHadar Hen Zion 		return;
1091232c0013SHadar Hen Zion 	}
1092232c0013SHadar Hen Zion 	e->flags |= MLX5_ENCAP_ENTRY_VALID;
1093f6dfb4c3SHadar Hen Zion 	mlx5e_rep_queue_neigh_stats_work(priv);
1094232c0013SHadar Hen Zion 
109579baaec7SEli Britstein 	list_for_each_entry(efi, &e->flows, list) {
10968c4dc42bSEli Britstein 		bool all_flow_encaps_valid = true;
10978c4dc42bSEli Britstein 		int i;
10988c4dc42bSEli Britstein 
109979baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
11003c37745eSOr Gerlitz 		esw_attr = flow->esw_attr;
11016d2a3ed0SOr Gerlitz 		spec = &esw_attr->parse_attr->spec;
11026d2a3ed0SOr Gerlitz 
11038c4dc42bSEli Britstein 		esw_attr->dests[efi->index].encap_id = e->encap_id;
11048c4dc42bSEli Britstein 		esw_attr->dests[efi->index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
11058c4dc42bSEli Britstein 		/* Flow can be associated with multiple encap entries.
11068c4dc42bSEli Britstein 		 * Before offloading the flow verify that all of them have
11078c4dc42bSEli Britstein 		 * a valid neighbour.
11088c4dc42bSEli Britstein 		 */
11098c4dc42bSEli Britstein 		for (i = 0; i < MLX5_MAX_FLOW_FWD_VPORTS; i++) {
11108c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP))
11118c4dc42bSEli Britstein 				continue;
11128c4dc42bSEli Britstein 			if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP_VALID)) {
11138c4dc42bSEli Britstein 				all_flow_encaps_valid = false;
11148c4dc42bSEli Britstein 				break;
11158c4dc42bSEli Britstein 			}
11168c4dc42bSEli Britstein 		}
11178c4dc42bSEli Britstein 		/* Do not offload flows with unresolved neighbors */
11188c4dc42bSEli Britstein 		if (!all_flow_encaps_valid)
11198c4dc42bSEli Britstein 			continue;
11205dbe906fSPaul Blakey 		/* update from slow path rule to encap rule */
11216d2a3ed0SOr Gerlitz 		rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, esw_attr);
11226d2a3ed0SOr Gerlitz 		if (IS_ERR(rule)) {
11236d2a3ed0SOr Gerlitz 			err = PTR_ERR(rule);
1124232c0013SHadar Hen Zion 			mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n",
1125232c0013SHadar Hen Zion 				       err);
1126232c0013SHadar Hen Zion 			continue;
1127232c0013SHadar Hen Zion 		}
11285dbe906fSPaul Blakey 
11295dbe906fSPaul Blakey 		mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr);
11305dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when slow path rule removed */
11316d2a3ed0SOr Gerlitz 		flow->rule[0] = rule;
1132232c0013SHadar Hen Zion 	}
1133232c0013SHadar Hen Zion }
1134232c0013SHadar Hen Zion 
1135232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv,
1136232c0013SHadar Hen Zion 			      struct mlx5e_encap_entry *e)
1137232c0013SHadar Hen Zion {
11383c37745eSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
11395dbe906fSPaul Blakey 	struct mlx5_esw_flow_attr slow_attr;
11405dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
11415dbe906fSPaul Blakey 	struct mlx5_flow_spec *spec;
114279baaec7SEli Britstein 	struct encap_flow_item *efi;
1143232c0013SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
11445dbe906fSPaul Blakey 	int err;
1145232c0013SHadar Hen Zion 
114679baaec7SEli Britstein 	list_for_each_entry(efi, &e->flows, list) {
114779baaec7SEli Britstein 		flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]);
11485dbe906fSPaul Blakey 		spec = &flow->esw_attr->parse_attr->spec;
11495dbe906fSPaul Blakey 
11505dbe906fSPaul Blakey 		/* update from encap rule to slow path rule */
11515dbe906fSPaul Blakey 		rule = mlx5e_tc_offload_to_slow_path(esw, flow, spec, &slow_attr);
11528c4dc42bSEli Britstein 		/* mark the flow's encap dest as non-valid */
11538c4dc42bSEli Britstein 		flow->esw_attr->dests[efi->index].flags &= ~MLX5_ESW_DEST_ENCAP_VALID;
11545dbe906fSPaul Blakey 
11555dbe906fSPaul Blakey 		if (IS_ERR(rule)) {
11565dbe906fSPaul Blakey 			err = PTR_ERR(rule);
11575dbe906fSPaul Blakey 			mlx5_core_warn(priv->mdev, "Failed to update slow path (encap) flow, %d\n",
11585dbe906fSPaul Blakey 				       err);
11595dbe906fSPaul Blakey 			continue;
11605dbe906fSPaul Blakey 		}
11615dbe906fSPaul Blakey 
11626d2a3ed0SOr Gerlitz 		mlx5e_tc_unoffload_fdb_rules(esw, flow, flow->esw_attr);
11635dbe906fSPaul Blakey 		flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when fast path rule removed */
11645dbe906fSPaul Blakey 		flow->rule[0] = rule;
1165232c0013SHadar Hen Zion 	}
1166232c0013SHadar Hen Zion 
116761c806daSOr Gerlitz 	/* we know that the encap is valid */
1168232c0013SHadar Hen Zion 	e->flags &= ~MLX5_ENCAP_ENTRY_VALID;
116960786f09SMark Bloch 	mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1170232c0013SHadar Hen Zion }
1171232c0013SHadar Hen Zion 
1172b8aee822SMark Bloch static struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow)
1173b8aee822SMark Bloch {
1174b8aee822SMark Bloch 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
1175b8aee822SMark Bloch 		return flow->esw_attr->counter;
1176b8aee822SMark Bloch 	else
1177b8aee822SMark Bloch 		return flow->nic_attr->counter;
1178b8aee822SMark Bloch }
1179b8aee822SMark Bloch 
1180f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe)
1181f6dfb4c3SHadar Hen Zion {
1182f6dfb4c3SHadar Hen Zion 	struct mlx5e_neigh *m_neigh = &nhe->m_neigh;
1183f6dfb4c3SHadar Hen Zion 	u64 bytes, packets, lastuse = 0;
1184f6dfb4c3SHadar Hen Zion 	struct mlx5e_tc_flow *flow;
1185f6dfb4c3SHadar Hen Zion 	struct mlx5e_encap_entry *e;
1186f6dfb4c3SHadar Hen Zion 	struct mlx5_fc *counter;
1187f6dfb4c3SHadar Hen Zion 	struct neigh_table *tbl;
1188f6dfb4c3SHadar Hen Zion 	bool neigh_used = false;
1189f6dfb4c3SHadar Hen Zion 	struct neighbour *n;
1190f6dfb4c3SHadar Hen Zion 
1191f6dfb4c3SHadar Hen Zion 	if (m_neigh->family == AF_INET)
1192f6dfb4c3SHadar Hen Zion 		tbl = &arp_tbl;
1193f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6)
1194f6dfb4c3SHadar Hen Zion 	else if (m_neigh->family == AF_INET6)
1195423c9db2SOr Gerlitz 		tbl = &nd_tbl;
1196f6dfb4c3SHadar Hen Zion #endif
1197f6dfb4c3SHadar Hen Zion 	else
1198f6dfb4c3SHadar Hen Zion 		return;
1199f6dfb4c3SHadar Hen Zion 
1200f6dfb4c3SHadar Hen Zion 	list_for_each_entry(e, &nhe->encap_list, encap_list) {
120179baaec7SEli Britstein 		struct encap_flow_item *efi;
1202f6dfb4c3SHadar Hen Zion 		if (!(e->flags & MLX5_ENCAP_ENTRY_VALID))
1203f6dfb4c3SHadar Hen Zion 			continue;
120479baaec7SEli Britstein 		list_for_each_entry(efi, &e->flows, list) {
120579baaec7SEli Britstein 			flow = container_of(efi, struct mlx5e_tc_flow,
120679baaec7SEli Britstein 					    encaps[efi->index]);
1207f6dfb4c3SHadar Hen Zion 			if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) {
1208b8aee822SMark Bloch 				counter = mlx5e_tc_get_counter(flow);
1209f6dfb4c3SHadar Hen Zion 				mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
1210f6dfb4c3SHadar Hen Zion 				if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) {
1211f6dfb4c3SHadar Hen Zion 					neigh_used = true;
1212f6dfb4c3SHadar Hen Zion 					break;
1213f6dfb4c3SHadar Hen Zion 				}
1214f6dfb4c3SHadar Hen Zion 			}
1215f6dfb4c3SHadar Hen Zion 		}
1216e36d4810SRoi Dayan 		if (neigh_used)
1217e36d4810SRoi Dayan 			break;
1218f6dfb4c3SHadar Hen Zion 	}
1219f6dfb4c3SHadar Hen Zion 
1220f6dfb4c3SHadar Hen Zion 	if (neigh_used) {
1221f6dfb4c3SHadar Hen Zion 		nhe->reported_lastuse = jiffies;
1222f6dfb4c3SHadar Hen Zion 
1223f6dfb4c3SHadar Hen Zion 		/* find the relevant neigh according to the cached device and
1224f6dfb4c3SHadar Hen Zion 		 * dst ip pair
1225f6dfb4c3SHadar Hen Zion 		 */
1226f6dfb4c3SHadar Hen Zion 		n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev);
1227c7f7ba8dSRoi Dayan 		if (!n)
1228f6dfb4c3SHadar Hen Zion 			return;
1229f6dfb4c3SHadar Hen Zion 
1230f6dfb4c3SHadar Hen Zion 		neigh_event_send(n, NULL);
1231f6dfb4c3SHadar Hen Zion 		neigh_release(n);
1232f6dfb4c3SHadar Hen Zion 	}
1233f6dfb4c3SHadar Hen Zion }
1234f6dfb4c3SHadar Hen Zion 
1235d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv,
12368c4dc42bSEli Britstein 			       struct mlx5e_tc_flow *flow, int out_index)
1237d85cdccbSOr Gerlitz {
12388c4dc42bSEli Britstein 	struct list_head *next = flow->encaps[out_index].list.next;
12395067b602SRoi Dayan 
12408c4dc42bSEli Britstein 	list_del(&flow->encaps[out_index].list);
12415067b602SRoi Dayan 	if (list_empty(next)) {
1242c1ae1152SOr Gerlitz 		struct mlx5e_encap_entry *e;
12435067b602SRoi Dayan 
1244c1ae1152SOr Gerlitz 		e = list_entry(next, struct mlx5e_encap_entry, flows);
1245232c0013SHadar Hen Zion 		mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e);
1246232c0013SHadar Hen Zion 
1247232c0013SHadar Hen Zion 		if (e->flags & MLX5_ENCAP_ENTRY_VALID)
124860786f09SMark Bloch 			mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id);
1249232c0013SHadar Hen Zion 
1250cdc5a7f3SOr Gerlitz 		hash_del_rcu(&e->encap_hlist);
1251232c0013SHadar Hen Zion 		kfree(e->encap_header);
12525067b602SRoi Dayan 		kfree(e);
12535067b602SRoi Dayan 	}
12545067b602SRoi Dayan }
12555067b602SRoi Dayan 
125604de7ddaSRoi Dayan static void __mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
125704de7ddaSRoi Dayan {
125804de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = flow->priv->mdev->priv.eswitch;
125904de7ddaSRoi Dayan 
126004de7ddaSRoi Dayan 	if (!(flow->flags & MLX5E_TC_FLOW_ESWITCH) ||
126104de7ddaSRoi Dayan 	    !(flow->flags & MLX5E_TC_FLOW_DUP))
126204de7ddaSRoi Dayan 		return;
126304de7ddaSRoi Dayan 
126404de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
126504de7ddaSRoi Dayan 	list_del(&flow->peer);
126604de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
126704de7ddaSRoi Dayan 
126804de7ddaSRoi Dayan 	flow->flags &= ~MLX5E_TC_FLOW_DUP;
126904de7ddaSRoi Dayan 
127004de7ddaSRoi Dayan 	mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow);
127104de7ddaSRoi Dayan 	kvfree(flow->peer_flow);
127204de7ddaSRoi Dayan 	flow->peer_flow = NULL;
127304de7ddaSRoi Dayan }
127404de7ddaSRoi Dayan 
127504de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
127604de7ddaSRoi Dayan {
127704de7ddaSRoi Dayan 	struct mlx5_core_dev *dev = flow->priv->mdev;
127804de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = dev->priv.devcom;
127904de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
128004de7ddaSRoi Dayan 
128104de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
128204de7ddaSRoi Dayan 	if (!peer_esw)
128304de7ddaSRoi Dayan 		return;
128404de7ddaSRoi Dayan 
128504de7ddaSRoi Dayan 	__mlx5e_tc_del_fdb_peer_flow(flow);
128604de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
128704de7ddaSRoi Dayan }
128804de7ddaSRoi Dayan 
1289e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv,
1290961e8979SRoi Dayan 			      struct mlx5e_tc_flow *flow)
1291e8f887acSAmir Vadai {
129204de7ddaSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
129304de7ddaSRoi Dayan 		mlx5e_tc_del_fdb_peer_flow(flow);
1294d85cdccbSOr Gerlitz 		mlx5e_tc_del_fdb_flow(priv, flow);
129504de7ddaSRoi Dayan 	} else {
1296d85cdccbSOr Gerlitz 		mlx5e_tc_del_nic_flow(priv, flow);
1297e8f887acSAmir Vadai 	}
129804de7ddaSRoi Dayan }
1299e8f887acSAmir Vadai 
1300bbd00f7eSHadar Hen Zion 
1301bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv,
1302bbd00f7eSHadar Hen Zion 			     struct mlx5_flow_spec *spec,
130354c177caSOz Shlomo 			     struct tc_cls_flower_offload *f,
13046363651dSOr Gerlitz 			     struct net_device *filter_dev, u8 *match_level)
1305bbd00f7eSHadar Hen Zion {
1306e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1307bbd00f7eSHadar Hen Zion 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1308bbd00f7eSHadar Hen Zion 				       outer_headers);
1309bbd00f7eSHadar Hen Zion 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1310bbd00f7eSHadar Hen Zion 				       outer_headers);
13118f256622SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
13128f256622SPablo Neira Ayuso 	struct flow_match_control enc_control;
13138f256622SPablo Neira Ayuso 	int err;
1314bbd00f7eSHadar Hen Zion 
1315101f4de9SOz Shlomo 	err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f,
13166363651dSOr Gerlitz 				 headers_c, headers_v, match_level);
131754c177caSOz Shlomo 	if (err) {
131854c177caSOz Shlomo 		NL_SET_ERR_MSG_MOD(extack,
131954c177caSOz Shlomo 				   "failed to parse tunnel attributes");
1320101f4de9SOz Shlomo 		return err;
1321bbd00f7eSHadar Hen Zion 	}
1322bbd00f7eSHadar Hen Zion 
13238f256622SPablo Neira Ayuso 	flow_rule_match_enc_control(rule, &enc_control);
13248f256622SPablo Neira Ayuso 
13258f256622SPablo Neira Ayuso 	if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
13268f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
13278f256622SPablo Neira Ayuso 
13288f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv4_addrs(rule, &match);
1329bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1330bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
13318f256622SPablo Neira Ayuso 			 ntohl(match.mask->src));
1332bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1333bbd00f7eSHadar Hen Zion 			 src_ipv4_src_ipv6.ipv4_layout.ipv4,
13348f256622SPablo Neira Ayuso 			 ntohl(match.key->src));
1335bbd00f7eSHadar Hen Zion 
1336bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1337bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
13388f256622SPablo Neira Ayuso 			 ntohl(match.mask->dst));
1339bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1340bbd00f7eSHadar Hen Zion 			 dst_ipv4_dst_ipv6.ipv4_layout.ipv4,
13418f256622SPablo Neira Ayuso 			 ntohl(match.key->dst));
1342bbd00f7eSHadar Hen Zion 
1343bbd00f7eSHadar Hen Zion 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
1344bbd00f7eSHadar Hen Zion 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP);
13458f256622SPablo Neira Ayuso 	} else if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
13468f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
134719f44401SOr Gerlitz 
13488f256622SPablo Neira Ayuso 		flow_rule_match_enc_ipv6_addrs(rule, &match);
134919f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
135019f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
13518f256622SPablo Neira Ayuso 		       &match.mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
135219f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
135319f44401SOr Gerlitz 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
13548f256622SPablo Neira Ayuso 		       &match.key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
135519f44401SOr Gerlitz 
135619f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
135719f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
13588f256622SPablo Neira Ayuso 		       &match.mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
135919f44401SOr Gerlitz 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
136019f44401SOr Gerlitz 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
13618f256622SPablo Neira Ayuso 		       &match.key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6));
136219f44401SOr Gerlitz 
136319f44401SOr Gerlitz 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype);
136419f44401SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6);
13652e72eb43SOr Gerlitz 	}
1366bbd00f7eSHadar Hen Zion 
13678f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) {
13688f256622SPablo Neira Ayuso 		struct flow_match_ip match;
1369bcef735cSOr Gerlitz 
13708f256622SPablo Neira Ayuso 		flow_rule_match_enc_ip(rule, &match);
13718f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
13728f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
13738f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
13748f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
1375bcef735cSOr Gerlitz 
13768f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
13778f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
13788f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
13798f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
1380bcef735cSOr Gerlitz 
13818f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
13828f256622SPablo Neira Ayuso 			 match.mask->ttl);
13838f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
13848f256622SPablo Neira Ayuso 			 match.key->ttl);
1385e98bedf5SEli Britstein 
13868f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1387e98bedf5SEli Britstein 		    !MLX5_CAP_ESW_FLOWTABLE_FDB
1388e98bedf5SEli Britstein 			(priv->mdev,
1389e98bedf5SEli Britstein 			 ft_field_support.outer_ipv4_ttl)) {
1390e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1391e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
1392e98bedf5SEli Britstein 			return -EOPNOTSUPP;
1393e98bedf5SEli Britstein 		}
1394e98bedf5SEli Britstein 
1395bcef735cSOr Gerlitz 	}
1396bcef735cSOr Gerlitz 
1397bbd00f7eSHadar Hen Zion 	/* Enforce DMAC when offloading incoming tunneled flows.
1398bbd00f7eSHadar Hen Zion 	 * Flow counters require a match on the DMAC.
1399bbd00f7eSHadar Hen Zion 	 */
1400bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16);
1401bbd00f7eSHadar Hen Zion 	MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0);
1402bbd00f7eSHadar Hen Zion 	ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1403bbd00f7eSHadar Hen Zion 				     dmac_47_16), priv->netdev->dev_addr);
1404bbd00f7eSHadar Hen Zion 
1405bbd00f7eSHadar Hen Zion 	/* let software handle IP fragments */
1406bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
1407bbd00f7eSHadar Hen Zion 	MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0);
1408bbd00f7eSHadar Hen Zion 
1409bbd00f7eSHadar Hen Zion 	return 0;
1410bbd00f7eSHadar Hen Zion }
1411bbd00f7eSHadar Hen Zion 
1412de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv,
1413de0af0bfSRoi Dayan 			      struct mlx5_flow_spec *spec,
1414de0af0bfSRoi Dayan 			      struct tc_cls_flower_offload *f,
141554c177caSOz Shlomo 			      struct net_device *filter_dev,
14166363651dSOr Gerlitz 			      u8 *match_level, u8 *tunnel_match_level)
1417e3a2b7edSAmir Vadai {
1418e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1419c5bb1730SMaor Gottlieb 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1420c5bb1730SMaor Gottlieb 				       outer_headers);
1421c5bb1730SMaor Gottlieb 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1422c5bb1730SMaor Gottlieb 				       outer_headers);
1423699e96ddSJianbo Liu 	void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1424699e96ddSJianbo Liu 				    misc_parameters);
1425699e96ddSJianbo Liu 	void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1426699e96ddSJianbo Liu 				    misc_parameters);
14278f256622SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
14288f256622SPablo Neira Ayuso 	struct flow_dissector *dissector = rule->match.dissector;
1429e3a2b7edSAmir Vadai 	u16 addr_type = 0;
1430e3a2b7edSAmir Vadai 	u8 ip_proto = 0;
1431e3a2b7edSAmir Vadai 
1432d708f902SOr Gerlitz 	*match_level = MLX5_MATCH_NONE;
1433de0af0bfSRoi Dayan 
14348f256622SPablo Neira Ayuso 	if (dissector->used_keys &
1435e3a2b7edSAmir Vadai 	    ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) |
1436e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_BASIC) |
1437e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) |
1438095b6cfdSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_VLAN) |
1439699e96ddSJianbo Liu 	      BIT(FLOW_DISSECTOR_KEY_CVLAN) |
1440e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) |
1441e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) |
1442bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_PORTS) |
1443bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) |
1444bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) |
1445bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) |
1446bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_PORTS)	|
1447e77834ecSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) |
1448fd7da28bSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_TCP) |
1449bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_IP)  |
1450bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_IP))) {
1451e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "Unsupported key");
1452e3a2b7edSAmir Vadai 		netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n",
14538f256622SPablo Neira Ayuso 			    dissector->used_keys);
1454e3a2b7edSAmir Vadai 		return -EOPNOTSUPP;
1455e3a2b7edSAmir Vadai 	}
1456e3a2b7edSAmir Vadai 
14578f256622SPablo Neira Ayuso 	if ((flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) ||
14588f256622SPablo Neira Ayuso 	     flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_KEYID) ||
14598f256622SPablo Neira Ayuso 	     flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_PORTS)) &&
14608f256622SPablo Neira Ayuso 	    flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_CONTROL)) {
14618f256622SPablo Neira Ayuso 		struct flow_match_control match;
14628f256622SPablo Neira Ayuso 
14638f256622SPablo Neira Ayuso 		flow_rule_match_enc_control(rule, &match);
14648f256622SPablo Neira Ayuso 		switch (match.key->addr_type) {
1465bbd00f7eSHadar Hen Zion 		case FLOW_DISSECTOR_KEY_IPV4_ADDRS:
146619f44401SOr Gerlitz 		case FLOW_DISSECTOR_KEY_IPV6_ADDRS:
14676363651dSOr Gerlitz 			if (parse_tunnel_attr(priv, spec, f, filter_dev, tunnel_match_level))
1468bbd00f7eSHadar Hen Zion 				return -EOPNOTSUPP;
1469bbd00f7eSHadar Hen Zion 			break;
1470bbd00f7eSHadar Hen Zion 		default:
1471bbd00f7eSHadar Hen Zion 			return -EOPNOTSUPP;
1472bbd00f7eSHadar Hen Zion 		}
1473bbd00f7eSHadar Hen Zion 
1474bbd00f7eSHadar Hen Zion 		/* In decap flow, header pointers should point to the inner
1475bbd00f7eSHadar Hen Zion 		 * headers, outer header were already set by parse_tunnel_attr
1476bbd00f7eSHadar Hen Zion 		 */
1477bbd00f7eSHadar Hen Zion 		headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1478bbd00f7eSHadar Hen Zion 					 inner_headers);
1479bbd00f7eSHadar Hen Zion 		headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1480bbd00f7eSHadar Hen Zion 					 inner_headers);
1481bbd00f7eSHadar Hen Zion 	}
1482bbd00f7eSHadar Hen Zion 
14838f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
14848f256622SPablo Neira Ayuso 		struct flow_match_basic match;
1485e3a2b7edSAmir Vadai 
14868f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
14878f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype,
14888f256622SPablo Neira Ayuso 			 ntohs(match.mask->n_proto));
14898f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype,
14908f256622SPablo Neira Ayuso 			 ntohs(match.key->n_proto));
14918f256622SPablo Neira Ayuso 
14928f256622SPablo Neira Ayuso 		if (match.mask->n_proto)
1493d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1494e3a2b7edSAmir Vadai 	}
1495e3a2b7edSAmir Vadai 
14968f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN)) {
14978f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
14988f256622SPablo Neira Ayuso 
14998f256622SPablo Neira Ayuso 		flow_rule_match_vlan(rule, &match);
15008f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
15018f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
15028f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
15038f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1504699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1505699e96ddSJianbo Liu 					 svlan_tag, 1);
1506699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1507699e96ddSJianbo Liu 					 svlan_tag, 1);
1508699e96ddSJianbo Liu 			} else {
1509699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1510699e96ddSJianbo Liu 					 cvlan_tag, 1);
1511699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1512699e96ddSJianbo Liu 					 cvlan_tag, 1);
1513699e96ddSJianbo Liu 			}
1514095b6cfdSOr Gerlitz 
15158f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid,
15168f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
15178f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid,
15188f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1519358d79a4SOr Gerlitz 
15208f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio,
15218f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
15228f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio,
15238f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
152454782900SOr Gerlitz 
1525d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
1526095b6cfdSOr Gerlitz 		}
1527d3a80bb5SOr Gerlitz 	} else if (*match_level != MLX5_MATCH_NONE) {
1528cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, svlan_tag, 1);
1529cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1);
1530d3a80bb5SOr Gerlitz 		*match_level = MLX5_MATCH_L2;
1531095b6cfdSOr Gerlitz 	}
1532095b6cfdSOr Gerlitz 
15338f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) {
15348f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
15358f256622SPablo Neira Ayuso 
15368f256622SPablo Neira Ayuso 		flow_rule_match_vlan(rule, &match);
15378f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
15388f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
15398f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
15408f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
1541699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1542699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1543699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1544699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
1545699e96ddSJianbo Liu 			} else {
1546699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
1547699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1548699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
1549699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
1550699e96ddSJianbo Liu 			}
1551699e96ddSJianbo Liu 
1552699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid,
15538f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
1554699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid,
15558f256622SPablo Neira Ayuso 				 match.key->vlan_id);
1556699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio,
15578f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
1558699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio,
15598f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
1560699e96ddSJianbo Liu 
1561699e96ddSJianbo Liu 			*match_level = MLX5_MATCH_L2;
1562699e96ddSJianbo Liu 		}
1563699e96ddSJianbo Liu 	}
1564699e96ddSJianbo Liu 
15658f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) {
15668f256622SPablo Neira Ayuso 		struct flow_match_eth_addrs match;
156754782900SOr Gerlitz 
15688f256622SPablo Neira Ayuso 		flow_rule_match_eth_addrs(rule, &match);
1569d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1570d3a80bb5SOr Gerlitz 					     dmac_47_16),
15718f256622SPablo Neira Ayuso 				match.mask->dst);
1572d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1573d3a80bb5SOr Gerlitz 					     dmac_47_16),
15748f256622SPablo Neira Ayuso 				match.key->dst);
1575d3a80bb5SOr Gerlitz 
1576d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1577d3a80bb5SOr Gerlitz 					     smac_47_16),
15788f256622SPablo Neira Ayuso 				match.mask->src);
1579d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1580d3a80bb5SOr Gerlitz 					     smac_47_16),
15818f256622SPablo Neira Ayuso 				match.key->src);
1582d3a80bb5SOr Gerlitz 
15838f256622SPablo Neira Ayuso 		if (!is_zero_ether_addr(match.mask->src) ||
15848f256622SPablo Neira Ayuso 		    !is_zero_ether_addr(match.mask->dst))
1585d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
158654782900SOr Gerlitz 	}
158754782900SOr Gerlitz 
15888f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) {
15898f256622SPablo Neira Ayuso 		struct flow_match_control match;
159054782900SOr Gerlitz 
15918f256622SPablo Neira Ayuso 		flow_rule_match_control(rule, &match);
15928f256622SPablo Neira Ayuso 		addr_type = match.key->addr_type;
159354782900SOr Gerlitz 
159454782900SOr Gerlitz 		/* the HW doesn't support frag first/later */
15958f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_FIRST_FRAG)
159654782900SOr Gerlitz 			return -EOPNOTSUPP;
159754782900SOr Gerlitz 
15988f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) {
159954782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
160054782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag,
16018f256622SPablo Neira Ayuso 				 match.key->flags & FLOW_DIS_IS_FRAGMENT);
160254782900SOr Gerlitz 
160354782900SOr Gerlitz 			/* the HW doesn't need L3 inline to match on frag=no */
16048f256622SPablo Neira Ayuso 			if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT))
160583621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L2;
160654782900SOr Gerlitz 	/* ***  L2 attributes parsing up to here *** */
160754782900SOr Gerlitz 			else
160883621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L3;
160954782900SOr Gerlitz 		}
161054782900SOr Gerlitz 	}
161154782900SOr Gerlitz 
16128f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
16138f256622SPablo Neira Ayuso 		struct flow_match_basic match;
16148f256622SPablo Neira Ayuso 
16158f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
16168f256622SPablo Neira Ayuso 		ip_proto = match.key->ip_proto;
161754782900SOr Gerlitz 
161854782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
16198f256622SPablo Neira Ayuso 			 match.mask->ip_proto);
162054782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
16218f256622SPablo Neira Ayuso 			 match.key->ip_proto);
162254782900SOr Gerlitz 
16238f256622SPablo Neira Ayuso 		if (match.mask->ip_proto)
1624d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
162554782900SOr Gerlitz 	}
162654782900SOr Gerlitz 
1627e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
16288f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
1629e3a2b7edSAmir Vadai 
16308f256622SPablo Neira Ayuso 		flow_rule_match_ipv4_addrs(rule, &match);
1631e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1632e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
16338f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1634e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1635e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
16368f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1637e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1638e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
16398f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1640e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1641e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
16428f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1643de0af0bfSRoi Dayan 
16448f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1645d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1646e3a2b7edSAmir Vadai 	}
1647e3a2b7edSAmir Vadai 
1648e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
16498f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
1650e3a2b7edSAmir Vadai 
16518f256622SPablo Neira Ayuso 		flow_rule_match_ipv6_addrs(rule, &match);
1652e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1653e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
16548f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
1655e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1656e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
16578f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
1658e3a2b7edSAmir Vadai 
1659e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1660e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
16618f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
1662e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1663e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
16648f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
1665de0af0bfSRoi Dayan 
16668f256622SPablo Neira Ayuso 		if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY ||
16678f256622SPablo Neira Ayuso 		    ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY)
1668d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
1669e3a2b7edSAmir Vadai 	}
1670e3a2b7edSAmir Vadai 
16718f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) {
16728f256622SPablo Neira Ayuso 		struct flow_match_ip match;
16731f97a526SOr Gerlitz 
16748f256622SPablo Neira Ayuso 		flow_rule_match_ip(rule, &match);
16758f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
16768f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
16778f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
16788f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
16791f97a526SOr Gerlitz 
16808f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
16818f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
16828f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
16838f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
16841f97a526SOr Gerlitz 
16858f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
16868f256622SPablo Neira Ayuso 			 match.mask->ttl);
16878f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
16888f256622SPablo Neira Ayuso 			 match.key->ttl);
16891f97a526SOr Gerlitz 
16908f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
1691a8ade55fSOr Gerlitz 		    !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev,
1692e98bedf5SEli Britstein 						ft_field_support.outer_ipv4_ttl)) {
1693e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1694e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
16951f97a526SOr Gerlitz 			return -EOPNOTSUPP;
1696e98bedf5SEli Britstein 		}
1697a8ade55fSOr Gerlitz 
16988f256622SPablo Neira Ayuso 		if (match.mask->tos || match.mask->ttl)
1699d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
17001f97a526SOr Gerlitz 	}
17011f97a526SOr Gerlitz 
170254782900SOr Gerlitz 	/* ***  L3 attributes parsing up to here *** */
170354782900SOr Gerlitz 
17048f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) {
17058f256622SPablo Neira Ayuso 		struct flow_match_ports match;
17068f256622SPablo Neira Ayuso 
17078f256622SPablo Neira Ayuso 		flow_rule_match_ports(rule, &match);
1708e3a2b7edSAmir Vadai 		switch (ip_proto) {
1709e3a2b7edSAmir Vadai 		case IPPROTO_TCP:
1710e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17118f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.mask->src));
1712e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17138f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.key->src));
1714e3a2b7edSAmir Vadai 
1715e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17168f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.mask->dst));
1717e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17188f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.key->dst));
1719e3a2b7edSAmir Vadai 			break;
1720e3a2b7edSAmir Vadai 
1721e3a2b7edSAmir Vadai 		case IPPROTO_UDP:
1722e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17238f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.mask->src));
1724e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17258f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.key->src));
1726e3a2b7edSAmir Vadai 
1727e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
17288f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.mask->dst));
1729e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
17308f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.key->dst));
1731e3a2b7edSAmir Vadai 			break;
1732e3a2b7edSAmir Vadai 		default:
1733e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1734e98bedf5SEli Britstein 					   "Only UDP and TCP transports are supported for L4 matching");
1735e3a2b7edSAmir Vadai 			netdev_err(priv->netdev,
1736e3a2b7edSAmir Vadai 				   "Only UDP and TCP transport are supported\n");
1737e3a2b7edSAmir Vadai 			return -EINVAL;
1738e3a2b7edSAmir Vadai 		}
1739de0af0bfSRoi Dayan 
17408f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
1741d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1742e3a2b7edSAmir Vadai 	}
1743e3a2b7edSAmir Vadai 
17448f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) {
17458f256622SPablo Neira Ayuso 		struct flow_match_tcp match;
1746e77834ecSOr Gerlitz 
17478f256622SPablo Neira Ayuso 		flow_rule_match_tcp(rule, &match);
1748e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags,
17498f256622SPablo Neira Ayuso 			 ntohs(match.mask->flags));
1750e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags,
17518f256622SPablo Neira Ayuso 			 ntohs(match.key->flags));
1752e77834ecSOr Gerlitz 
17538f256622SPablo Neira Ayuso 		if (match.mask->flags)
1754d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
1755e77834ecSOr Gerlitz 	}
1756e77834ecSOr Gerlitz 
1757e3a2b7edSAmir Vadai 	return 0;
1758e3a2b7edSAmir Vadai }
1759e3a2b7edSAmir Vadai 
1760de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv,
176165ba8fb7SOr Gerlitz 			    struct mlx5e_tc_flow *flow,
1762de0af0bfSRoi Dayan 			    struct mlx5_flow_spec *spec,
176354c177caSOz Shlomo 			    struct tc_cls_flower_offload *f,
176454c177caSOz Shlomo 			    struct net_device *filter_dev)
1765de0af0bfSRoi Dayan {
1766e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
1767de0af0bfSRoi Dayan 	struct mlx5_core_dev *dev = priv->mdev;
1768de0af0bfSRoi Dayan 	struct mlx5_eswitch *esw = dev->priv.eswitch;
17691d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
17706363651dSOr Gerlitz 	u8 match_level, tunnel_match_level = MLX5_MATCH_NONE;
17711d447a39SSaeed Mahameed 	struct mlx5_eswitch_rep *rep;
1772de0af0bfSRoi Dayan 	int err;
1773de0af0bfSRoi Dayan 
17746363651dSOr Gerlitz 	err = __parse_cls_flower(priv, spec, f, filter_dev, &match_level, &tunnel_match_level);
1775de0af0bfSRoi Dayan 
17761d447a39SSaeed Mahameed 	if (!err && (flow->flags & MLX5E_TC_FLOW_ESWITCH)) {
17771d447a39SSaeed Mahameed 		rep = rpriv->rep;
1778b05af6aaSBodong Wang 		if (rep->vport != MLX5_VPORT_UPLINK &&
17791d447a39SSaeed Mahameed 		    (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE &&
1780d708f902SOr Gerlitz 		    esw->offloads.inline_mode < match_level)) {
1781e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1782e98bedf5SEli Britstein 					   "Flow is not offloaded due to min inline setting");
1783de0af0bfSRoi Dayan 			netdev_warn(priv->netdev,
1784de0af0bfSRoi Dayan 				    "Flow is not offloaded due to min inline setting, required %d actual %d\n",
1785d708f902SOr Gerlitz 				    match_level, esw->offloads.inline_mode);
1786de0af0bfSRoi Dayan 			return -EOPNOTSUPP;
1787de0af0bfSRoi Dayan 		}
1788de0af0bfSRoi Dayan 	}
1789de0af0bfSRoi Dayan 
17906363651dSOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH) {
179138aa51c1SOr Gerlitz 		flow->esw_attr->match_level = match_level;
17926363651dSOr Gerlitz 		flow->esw_attr->tunnel_match_level = tunnel_match_level;
17936363651dSOr Gerlitz 	} else {
179438aa51c1SOr Gerlitz 		flow->nic_attr->match_level = match_level;
17956363651dSOr Gerlitz 	}
179638aa51c1SOr Gerlitz 
1797de0af0bfSRoi Dayan 	return err;
1798de0af0bfSRoi Dayan }
1799de0af0bfSRoi Dayan 
1800d79b6df6SOr Gerlitz struct pedit_headers {
1801d79b6df6SOr Gerlitz 	struct ethhdr  eth;
1802d79b6df6SOr Gerlitz 	struct iphdr   ip4;
1803d79b6df6SOr Gerlitz 	struct ipv6hdr ip6;
1804d79b6df6SOr Gerlitz 	struct tcphdr  tcp;
1805d79b6df6SOr Gerlitz 	struct udphdr  udp;
1806d79b6df6SOr Gerlitz };
1807d79b6df6SOr Gerlitz 
1808c500c86bSPablo Neira Ayuso struct pedit_headers_action {
1809c500c86bSPablo Neira Ayuso 	struct pedit_headers	vals;
1810c500c86bSPablo Neira Ayuso 	struct pedit_headers	masks;
1811c500c86bSPablo Neira Ayuso 	u32			pedits;
1812c500c86bSPablo Neira Ayuso };
1813c500c86bSPablo Neira Ayuso 
1814d79b6df6SOr Gerlitz static int pedit_header_offsets[] = {
181573867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth),
181673867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4),
181773867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6),
181873867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp),
181973867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp),
1820d79b6df6SOr Gerlitz };
1821d79b6df6SOr Gerlitz 
1822d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype])
1823d79b6df6SOr Gerlitz 
1824d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset,
1825c500c86bSPablo Neira Ayuso 			 struct pedit_headers_action *hdrs)
1826d79b6df6SOr Gerlitz {
1827d79b6df6SOr Gerlitz 	u32 *curr_pmask, *curr_pval;
1828d79b6df6SOr Gerlitz 
1829c500c86bSPablo Neira Ayuso 	curr_pmask = (u32 *)(pedit_header(&hdrs->masks, hdr_type) + offset);
1830c500c86bSPablo Neira Ayuso 	curr_pval  = (u32 *)(pedit_header(&hdrs->vals, hdr_type) + offset);
1831d79b6df6SOr Gerlitz 
1832d79b6df6SOr Gerlitz 	if (*curr_pmask & mask)  /* disallow acting twice on the same location */
1833d79b6df6SOr Gerlitz 		goto out_err;
1834d79b6df6SOr Gerlitz 
1835d79b6df6SOr Gerlitz 	*curr_pmask |= mask;
1836d79b6df6SOr Gerlitz 	*curr_pval  |= (val & mask);
1837d79b6df6SOr Gerlitz 
1838d79b6df6SOr Gerlitz 	return 0;
1839d79b6df6SOr Gerlitz 
1840d79b6df6SOr Gerlitz out_err:
1841d79b6df6SOr Gerlitz 	return -EOPNOTSUPP;
1842d79b6df6SOr Gerlitz }
1843d79b6df6SOr Gerlitz 
1844d79b6df6SOr Gerlitz struct mlx5_fields {
1845d79b6df6SOr Gerlitz 	u8  field;
1846d79b6df6SOr Gerlitz 	u8  size;
1847d79b6df6SOr Gerlitz 	u32 offset;
1848d79b6df6SOr Gerlitz };
1849d79b6df6SOr Gerlitz 
1850a8e4f0c4SOr Gerlitz #define OFFLOAD(fw_field, size, field, off) \
1851a8e4f0c4SOr Gerlitz 		{MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, size, offsetof(struct pedit_headers, field) + (off)}
1852a8e4f0c4SOr Gerlitz 
1853d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = {
1854a8e4f0c4SOr Gerlitz 	OFFLOAD(DMAC_47_16, 4, eth.h_dest[0], 0),
1855a8e4f0c4SOr Gerlitz 	OFFLOAD(DMAC_15_0,  2, eth.h_dest[4], 0),
1856a8e4f0c4SOr Gerlitz 	OFFLOAD(SMAC_47_16, 4, eth.h_source[0], 0),
1857a8e4f0c4SOr Gerlitz 	OFFLOAD(SMAC_15_0,  2, eth.h_source[4], 0),
1858a8e4f0c4SOr Gerlitz 	OFFLOAD(ETHERTYPE,  2, eth.h_proto, 0),
1859d79b6df6SOr Gerlitz 
1860a8e4f0c4SOr Gerlitz 	OFFLOAD(IP_TTL, 1, ip4.ttl,   0),
1861a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV4,  4, ip4.saddr, 0),
1862a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV4,  4, ip4.daddr, 0),
1863d79b6df6SOr Gerlitz 
1864a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_127_96, 4, ip6.saddr.s6_addr32[0], 0),
1865a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_95_64,  4, ip6.saddr.s6_addr32[1], 0),
1866a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_63_32,  4, ip6.saddr.s6_addr32[2], 0),
1867a8e4f0c4SOr Gerlitz 	OFFLOAD(SIPV6_31_0,   4, ip6.saddr.s6_addr32[3], 0),
1868a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_127_96, 4, ip6.daddr.s6_addr32[0], 0),
1869a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_95_64,  4, ip6.daddr.s6_addr32[1], 0),
1870a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_63_32,  4, ip6.daddr.s6_addr32[2], 0),
1871a8e4f0c4SOr Gerlitz 	OFFLOAD(DIPV6_31_0,   4, ip6.daddr.s6_addr32[3], 0),
18720c0316f5SOr Gerlitz 	OFFLOAD(IPV6_HOPLIMIT, 1, ip6.hop_limit, 0),
1873d79b6df6SOr Gerlitz 
1874a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_SPORT, 2, tcp.source,  0),
1875a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_DPORT, 2, tcp.dest,    0),
1876a8e4f0c4SOr Gerlitz 	OFFLOAD(TCP_FLAGS, 1, tcp.ack_seq, 5),
1877d79b6df6SOr Gerlitz 
1878a8e4f0c4SOr Gerlitz 	OFFLOAD(UDP_SPORT, 2, udp.source, 0),
1879a8e4f0c4SOr Gerlitz 	OFFLOAD(UDP_DPORT, 2, udp.dest,   0),
1880d79b6df6SOr Gerlitz };
1881d79b6df6SOr Gerlitz 
1882218d05ceSTonghao Zhang /* On input attr->max_mod_hdr_actions tells how many HW actions can be parsed at
1883218d05ceSTonghao Zhang  * max from the SW pedit action. On success, attr->num_mod_hdr_actions
1884218d05ceSTonghao Zhang  * says how many HW actions were actually parsed.
1885d79b6df6SOr Gerlitz  */
1886c500c86bSPablo Neira Ayuso static int offload_pedit_fields(struct pedit_headers_action *hdrs,
1887e98bedf5SEli Britstein 				struct mlx5e_tc_flow_parse_attr *parse_attr,
1888e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
1889d79b6df6SOr Gerlitz {
1890d79b6df6SOr Gerlitz 	struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals;
18912b64bebaSOr Gerlitz 	int i, action_size, nactions, max_actions, first, last, next_z;
1892d79b6df6SOr Gerlitz 	void *s_masks_p, *a_masks_p, *vals_p;
1893d79b6df6SOr Gerlitz 	struct mlx5_fields *f;
1894d79b6df6SOr Gerlitz 	u8 cmd, field_bsize;
1895e3ca4e05SOr Gerlitz 	u32 s_mask, a_mask;
1896d79b6df6SOr Gerlitz 	unsigned long mask;
18972b64bebaSOr Gerlitz 	__be32 mask_be32;
18982b64bebaSOr Gerlitz 	__be16 mask_be16;
1899d79b6df6SOr Gerlitz 	void *action;
1900d79b6df6SOr Gerlitz 
190173867881SPablo Neira Ayuso 	set_masks = &hdrs[0].masks;
190273867881SPablo Neira Ayuso 	add_masks = &hdrs[1].masks;
190373867881SPablo Neira Ayuso 	set_vals = &hdrs[0].vals;
190473867881SPablo Neira Ayuso 	add_vals = &hdrs[1].vals;
1905d79b6df6SOr Gerlitz 
1906d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
1907218d05ceSTonghao Zhang 	action = parse_attr->mod_hdr_actions +
1908218d05ceSTonghao Zhang 		 parse_attr->num_mod_hdr_actions * action_size;
1909218d05ceSTonghao Zhang 
1910218d05ceSTonghao Zhang 	max_actions = parse_attr->max_mod_hdr_actions;
1911218d05ceSTonghao Zhang 	nactions = parse_attr->num_mod_hdr_actions;
1912d79b6df6SOr Gerlitz 
1913d79b6df6SOr Gerlitz 	for (i = 0; i < ARRAY_SIZE(fields); i++) {
1914d79b6df6SOr Gerlitz 		f = &fields[i];
1915d79b6df6SOr Gerlitz 		/* avoid seeing bits set from previous iterations */
1916e3ca4e05SOr Gerlitz 		s_mask = 0;
1917e3ca4e05SOr Gerlitz 		a_mask = 0;
1918d79b6df6SOr Gerlitz 
1919d79b6df6SOr Gerlitz 		s_masks_p = (void *)set_masks + f->offset;
1920d79b6df6SOr Gerlitz 		a_masks_p = (void *)add_masks + f->offset;
1921d79b6df6SOr Gerlitz 
1922d79b6df6SOr Gerlitz 		memcpy(&s_mask, s_masks_p, f->size);
1923d79b6df6SOr Gerlitz 		memcpy(&a_mask, a_masks_p, f->size);
1924d79b6df6SOr Gerlitz 
1925d79b6df6SOr Gerlitz 		if (!s_mask && !a_mask) /* nothing to offload here */
1926d79b6df6SOr Gerlitz 			continue;
1927d79b6df6SOr Gerlitz 
1928d79b6df6SOr Gerlitz 		if (s_mask && a_mask) {
1929e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1930e98bedf5SEli Britstein 					   "can't set and add to the same HW field");
1931d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field);
1932d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1933d79b6df6SOr Gerlitz 		}
1934d79b6df6SOr Gerlitz 
1935d79b6df6SOr Gerlitz 		if (nactions == max_actions) {
1936e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1937e98bedf5SEli Britstein 					   "too many pedit actions, can't offload");
1938d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions);
1939d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1940d79b6df6SOr Gerlitz 		}
1941d79b6df6SOr Gerlitz 
1942d79b6df6SOr Gerlitz 		if (s_mask) {
1943d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_SET;
1944d79b6df6SOr Gerlitz 			mask = s_mask;
1945d79b6df6SOr Gerlitz 			vals_p = (void *)set_vals + f->offset;
1946d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
1947d79b6df6SOr Gerlitz 			memset(s_masks_p, 0, f->size);
1948d79b6df6SOr Gerlitz 		} else {
1949d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_ADD;
1950d79b6df6SOr Gerlitz 			mask = a_mask;
1951d79b6df6SOr Gerlitz 			vals_p = (void *)add_vals + f->offset;
1952d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
1953d79b6df6SOr Gerlitz 			memset(a_masks_p, 0, f->size);
1954d79b6df6SOr Gerlitz 		}
1955d79b6df6SOr Gerlitz 
1956d79b6df6SOr Gerlitz 		field_bsize = f->size * BITS_PER_BYTE;
1957e3ca4e05SOr Gerlitz 
19582b64bebaSOr Gerlitz 		if (field_bsize == 32) {
19592b64bebaSOr Gerlitz 			mask_be32 = *(__be32 *)&mask;
19602b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32));
19612b64bebaSOr Gerlitz 		} else if (field_bsize == 16) {
19622b64bebaSOr Gerlitz 			mask_be16 = *(__be16 *)&mask;
19632b64bebaSOr Gerlitz 			mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16));
19642b64bebaSOr Gerlitz 		}
19652b64bebaSOr Gerlitz 
1966d79b6df6SOr Gerlitz 		first = find_first_bit(&mask, field_bsize);
19672b64bebaSOr Gerlitz 		next_z = find_next_zero_bit(&mask, field_bsize, first);
1968d79b6df6SOr Gerlitz 		last  = find_last_bit(&mask, field_bsize);
19692b64bebaSOr Gerlitz 		if (first < next_z && next_z < last) {
1970e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
1971e98bedf5SEli Britstein 					   "rewrite of few sub-fields isn't supported");
19722b64bebaSOr Gerlitz 			printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n",
1973d79b6df6SOr Gerlitz 			       mask);
1974d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
1975d79b6df6SOr Gerlitz 		}
1976d79b6df6SOr Gerlitz 
1977d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, action_type, cmd);
1978d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, field, f->field);
1979d79b6df6SOr Gerlitz 
1980d79b6df6SOr Gerlitz 		if (cmd == MLX5_ACTION_TYPE_SET) {
19812b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, offset, first);
1982d79b6df6SOr Gerlitz 			/* length is num of bits to be written, zero means length of 32 */
19832b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, length, (last - first + 1));
1984d79b6df6SOr Gerlitz 		}
1985d79b6df6SOr Gerlitz 
1986d79b6df6SOr Gerlitz 		if (field_bsize == 32)
19872b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first);
1988d79b6df6SOr Gerlitz 		else if (field_bsize == 16)
19892b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first);
1990d79b6df6SOr Gerlitz 		else if (field_bsize == 8)
19912b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first);
1992d79b6df6SOr Gerlitz 
1993d79b6df6SOr Gerlitz 		action += action_size;
1994d79b6df6SOr Gerlitz 		nactions++;
1995d79b6df6SOr Gerlitz 	}
1996d79b6df6SOr Gerlitz 
1997d79b6df6SOr Gerlitz 	parse_attr->num_mod_hdr_actions = nactions;
1998d79b6df6SOr Gerlitz 	return 0;
1999d79b6df6SOr Gerlitz }
2000d79b6df6SOr Gerlitz 
2001d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv,
2002c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2003c500c86bSPablo Neira Ayuso 				 int namespace,
2004d79b6df6SOr Gerlitz 				 struct mlx5e_tc_flow_parse_attr *parse_attr)
2005d79b6df6SOr Gerlitz {
2006d79b6df6SOr Gerlitz 	int nkeys, action_size, max_actions;
2007d79b6df6SOr Gerlitz 
2008c500c86bSPablo Neira Ayuso 	nkeys = hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits +
2009c500c86bSPablo Neira Ayuso 		hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits;
2010d79b6df6SOr Gerlitz 	action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto);
2011d79b6df6SOr Gerlitz 
2012d79b6df6SOr Gerlitz 	if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */
2013d79b6df6SOr Gerlitz 		max_actions = MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, max_modify_header_actions);
2014d79b6df6SOr Gerlitz 	else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */
2015d79b6df6SOr Gerlitz 		max_actions = MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, max_modify_header_actions);
2016d79b6df6SOr Gerlitz 
2017d79b6df6SOr Gerlitz 	/* can get up to crazingly 16 HW actions in 32 bits pedit SW key */
2018d79b6df6SOr Gerlitz 	max_actions = min(max_actions, nkeys * 16);
2019d79b6df6SOr Gerlitz 
2020d79b6df6SOr Gerlitz 	parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL);
2021d79b6df6SOr Gerlitz 	if (!parse_attr->mod_hdr_actions)
2022d79b6df6SOr Gerlitz 		return -ENOMEM;
2023d79b6df6SOr Gerlitz 
2024218d05ceSTonghao Zhang 	parse_attr->max_mod_hdr_actions = max_actions;
2025d79b6df6SOr Gerlitz 	return 0;
2026d79b6df6SOr Gerlitz }
2027d79b6df6SOr Gerlitz 
2028d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {};
2029d79b6df6SOr Gerlitz 
2030d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv,
203173867881SPablo Neira Ayuso 				 const struct flow_action_entry *act, int namespace,
2032e98bedf5SEli Britstein 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2033c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2034e98bedf5SEli Britstein 				 struct netlink_ext_ack *extack)
2035d79b6df6SOr Gerlitz {
203673867881SPablo Neira Ayuso 	u8 cmd = (act->id == FLOW_ACTION_MANGLE) ? 0 : 1;
203773867881SPablo Neira Ayuso 	int err = -EOPNOTSUPP;
2038d79b6df6SOr Gerlitz 	u32 mask, val, offset;
203973867881SPablo Neira Ayuso 	u8 htype;
2040d79b6df6SOr Gerlitz 
204173867881SPablo Neira Ayuso 	htype = act->mangle.htype;
2042d79b6df6SOr Gerlitz 	err = -EOPNOTSUPP; /* can't be all optimistic */
2043d79b6df6SOr Gerlitz 
204473867881SPablo Neira Ayuso 	if (htype == FLOW_ACT_MANGLE_UNSPEC) {
204573867881SPablo Neira Ayuso 		NL_SET_ERR_MSG_MOD(extack, "legacy pedit isn't offloaded");
2046d79b6df6SOr Gerlitz 		goto out_err;
2047d79b6df6SOr Gerlitz 	}
2048d79b6df6SOr Gerlitz 
204973867881SPablo Neira Ayuso 	mask = act->mangle.mask;
205073867881SPablo Neira Ayuso 	val = act->mangle.val;
205173867881SPablo Neira Ayuso 	offset = act->mangle.offset;
2052d79b6df6SOr Gerlitz 
2053c500c86bSPablo Neira Ayuso 	err = set_pedit_val(htype, ~mask, val, offset, &hdrs[cmd]);
2054d79b6df6SOr Gerlitz 	if (err)
2055d79b6df6SOr Gerlitz 		goto out_err;
2056c500c86bSPablo Neira Ayuso 
2057c500c86bSPablo Neira Ayuso 	hdrs[cmd].pedits++;
2058d79b6df6SOr Gerlitz 
2059c500c86bSPablo Neira Ayuso 	return 0;
2060c500c86bSPablo Neira Ayuso out_err:
2061c500c86bSPablo Neira Ayuso 	return err;
2062c500c86bSPablo Neira Ayuso }
2063c500c86bSPablo Neira Ayuso 
2064c500c86bSPablo Neira Ayuso static int alloc_tc_pedit_action(struct mlx5e_priv *priv, int namespace,
2065c500c86bSPablo Neira Ayuso 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2066c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
2067c500c86bSPablo Neira Ayuso 				 struct netlink_ext_ack *extack)
2068c500c86bSPablo Neira Ayuso {
2069c500c86bSPablo Neira Ayuso 	struct pedit_headers *cmd_masks;
2070c500c86bSPablo Neira Ayuso 	int err;
2071c500c86bSPablo Neira Ayuso 	u8 cmd;
2072c500c86bSPablo Neira Ayuso 
2073218d05ceSTonghao Zhang 	if (!parse_attr->mod_hdr_actions) {
2074c500c86bSPablo Neira Ayuso 		err = alloc_mod_hdr_actions(priv, hdrs, namespace, parse_attr);
2075d79b6df6SOr Gerlitz 		if (err)
2076d79b6df6SOr Gerlitz 			goto out_err;
2077218d05ceSTonghao Zhang 	}
2078d79b6df6SOr Gerlitz 
2079c500c86bSPablo Neira Ayuso 	err = offload_pedit_fields(hdrs, parse_attr, extack);
2080d79b6df6SOr Gerlitz 	if (err < 0)
2081d79b6df6SOr Gerlitz 		goto out_dealloc_parsed_actions;
2082d79b6df6SOr Gerlitz 
2083d79b6df6SOr Gerlitz 	for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) {
2084c500c86bSPablo Neira Ayuso 		cmd_masks = &hdrs[cmd].masks;
2085d79b6df6SOr Gerlitz 		if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) {
2086e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2087e98bedf5SEli Britstein 					   "attempt to offload an unsupported field");
2088b3a433deSOr Gerlitz 			netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd);
2089d79b6df6SOr Gerlitz 			print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS,
2090d79b6df6SOr Gerlitz 				       16, 1, cmd_masks, sizeof(zero_masks), true);
2091d79b6df6SOr Gerlitz 			err = -EOPNOTSUPP;
2092d79b6df6SOr Gerlitz 			goto out_dealloc_parsed_actions;
2093d79b6df6SOr Gerlitz 		}
2094d79b6df6SOr Gerlitz 	}
2095d79b6df6SOr Gerlitz 
2096d79b6df6SOr Gerlitz 	return 0;
2097d79b6df6SOr Gerlitz 
2098d79b6df6SOr Gerlitz out_dealloc_parsed_actions:
2099d79b6df6SOr Gerlitz 	kfree(parse_attr->mod_hdr_actions);
2100d79b6df6SOr Gerlitz out_err:
2101d79b6df6SOr Gerlitz 	return err;
2102d79b6df6SOr Gerlitz }
2103d79b6df6SOr Gerlitz 
2104e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv,
2105e98bedf5SEli Britstein 				   u32 action,
2106e98bedf5SEli Britstein 				   u32 update_flags,
2107e98bedf5SEli Britstein 				   struct netlink_ext_ack *extack)
210826c02749SOr Gerlitz {
210926c02749SOr Gerlitz 	u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP |
211026c02749SOr Gerlitz 			 TCA_CSUM_UPDATE_FLAG_UDP;
211126c02749SOr Gerlitz 
211226c02749SOr Gerlitz 	/*  The HW recalcs checksums only if re-writing headers */
211326c02749SOr Gerlitz 	if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) {
2114e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2115e98bedf5SEli Britstein 				   "TC csum action is only offloaded with pedit");
211626c02749SOr Gerlitz 		netdev_warn(priv->netdev,
211726c02749SOr Gerlitz 			    "TC csum action is only offloaded with pedit\n");
211826c02749SOr Gerlitz 		return false;
211926c02749SOr Gerlitz 	}
212026c02749SOr Gerlitz 
212126c02749SOr Gerlitz 	if (update_flags & ~prot_flags) {
2122e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2123e98bedf5SEli Britstein 				   "can't offload TC csum action for some header/s");
212426c02749SOr Gerlitz 		netdev_warn(priv->netdev,
212526c02749SOr Gerlitz 			    "can't offload TC csum action for some header/s - flags %#x\n",
212626c02749SOr Gerlitz 			    update_flags);
212726c02749SOr Gerlitz 		return false;
212826c02749SOr Gerlitz 	}
212926c02749SOr Gerlitz 
213026c02749SOr Gerlitz 	return true;
213126c02749SOr Gerlitz }
213226c02749SOr Gerlitz 
2133bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec,
213473867881SPablo Neira Ayuso 					  struct flow_action *flow_action,
21351651925dSGuy Shattah 					  u32 actions,
2136e98bedf5SEli Britstein 					  struct netlink_ext_ack *extack)
2137bdd66ac0SOr Gerlitz {
213873867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
2139bdd66ac0SOr Gerlitz 	bool modify_ip_header;
2140bdd66ac0SOr Gerlitz 	u8 htype, ip_proto;
2141bdd66ac0SOr Gerlitz 	void *headers_v;
2142bdd66ac0SOr Gerlitz 	u16 ethertype;
214373867881SPablo Neira Ayuso 	int i;
2144bdd66ac0SOr Gerlitz 
21451651925dSGuy Shattah 	if (actions & MLX5_FLOW_CONTEXT_ACTION_DECAP)
21461651925dSGuy Shattah 		headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, inner_headers);
21471651925dSGuy Shattah 	else
2148bdd66ac0SOr Gerlitz 		headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
21491651925dSGuy Shattah 
2150bdd66ac0SOr Gerlitz 	ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype);
2151bdd66ac0SOr Gerlitz 
2152bdd66ac0SOr Gerlitz 	/* for non-IP we only re-write MACs, so we're okay */
2153bdd66ac0SOr Gerlitz 	if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6)
2154bdd66ac0SOr Gerlitz 		goto out_ok;
2155bdd66ac0SOr Gerlitz 
2156bdd66ac0SOr Gerlitz 	modify_ip_header = false;
215773867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
215873867881SPablo Neira Ayuso 		if (act->id != FLOW_ACTION_MANGLE &&
215973867881SPablo Neira Ayuso 		    act->id != FLOW_ACTION_ADD)
2160bdd66ac0SOr Gerlitz 			continue;
2161bdd66ac0SOr Gerlitz 
216273867881SPablo Neira Ayuso 		htype = act->mangle.htype;
216373867881SPablo Neira Ayuso 		if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP4 ||
216473867881SPablo Neira Ayuso 		    htype == FLOW_ACT_MANGLE_HDR_TYPE_IP6) {
2165bdd66ac0SOr Gerlitz 			modify_ip_header = true;
2166bdd66ac0SOr Gerlitz 			break;
2167bdd66ac0SOr Gerlitz 		}
2168bdd66ac0SOr Gerlitz 	}
2169bdd66ac0SOr Gerlitz 
2170bdd66ac0SOr Gerlitz 	ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol);
21711ccef350SJianbo Liu 	if (modify_ip_header && ip_proto != IPPROTO_TCP &&
21721ccef350SJianbo Liu 	    ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) {
2173e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2174e98bedf5SEli Britstein 				   "can't offload re-write of non TCP/UDP");
2175bdd66ac0SOr Gerlitz 		pr_info("can't offload re-write of ip proto %d\n", ip_proto);
2176bdd66ac0SOr Gerlitz 		return false;
2177bdd66ac0SOr Gerlitz 	}
2178bdd66ac0SOr Gerlitz 
2179bdd66ac0SOr Gerlitz out_ok:
2180bdd66ac0SOr Gerlitz 	return true;
2181bdd66ac0SOr Gerlitz }
2182bdd66ac0SOr Gerlitz 
2183bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv,
218473867881SPablo Neira Ayuso 				    struct flow_action *flow_action,
2185bdd66ac0SOr Gerlitz 				    struct mlx5e_tc_flow_parse_attr *parse_attr,
2186e98bedf5SEli Britstein 				    struct mlx5e_tc_flow *flow,
2187e98bedf5SEli Britstein 				    struct netlink_ext_ack *extack)
2188bdd66ac0SOr Gerlitz {
2189bdd66ac0SOr Gerlitz 	u32 actions;
2190bdd66ac0SOr Gerlitz 
2191bdd66ac0SOr Gerlitz 	if (flow->flags & MLX5E_TC_FLOW_ESWITCH)
2192bdd66ac0SOr Gerlitz 		actions = flow->esw_attr->action;
2193bdd66ac0SOr Gerlitz 	else
2194bdd66ac0SOr Gerlitz 		actions = flow->nic_attr->action;
2195bdd66ac0SOr Gerlitz 
21967e29392eSRoi Dayan 	if (flow->flags & MLX5E_TC_FLOW_EGRESS &&
21977e29392eSRoi Dayan 	    !(actions & MLX5_FLOW_CONTEXT_ACTION_DECAP))
21987e29392eSRoi Dayan 		return false;
21997e29392eSRoi Dayan 
2200bdd66ac0SOr Gerlitz 	if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
220173867881SPablo Neira Ayuso 		return modify_header_match_supported(&parse_attr->spec,
2202a655fe9fSDavid S. Miller 						     flow_action, actions,
2203e98bedf5SEli Britstein 						     extack);
2204bdd66ac0SOr Gerlitz 
2205bdd66ac0SOr Gerlitz 	return true;
2206bdd66ac0SOr Gerlitz }
2207bdd66ac0SOr Gerlitz 
22085c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv)
22095c65c564SOr Gerlitz {
22105c65c564SOr Gerlitz 	struct mlx5_core_dev *fmdev, *pmdev;
2211816f6706SOr Gerlitz 	u64 fsystem_guid, psystem_guid;
22125c65c564SOr Gerlitz 
22135c65c564SOr Gerlitz 	fmdev = priv->mdev;
22145c65c564SOr Gerlitz 	pmdev = peer_priv->mdev;
22155c65c564SOr Gerlitz 
221659c9d35eSAlaa Hleihel 	fsystem_guid = mlx5_query_nic_system_image_guid(fmdev);
221759c9d35eSAlaa Hleihel 	psystem_guid = mlx5_query_nic_system_image_guid(pmdev);
22185c65c564SOr Gerlitz 
2219816f6706SOr Gerlitz 	return (fsystem_guid == psystem_guid);
22205c65c564SOr Gerlitz }
22215c65c564SOr Gerlitz 
222273867881SPablo Neira Ayuso static int parse_tc_nic_actions(struct mlx5e_priv *priv,
222373867881SPablo Neira Ayuso 				struct flow_action *flow_action,
2224aa0cbbaeSOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr,
2225e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2226e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2227e3a2b7edSAmir Vadai {
2228aa0cbbaeSOr Gerlitz 	struct mlx5_nic_flow_attr *attr = flow->nic_attr;
222973867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
223073867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
22311cab1cd7SOr Gerlitz 	u32 action = 0;
2232244cd96aSCong Wang 	int err, i;
2233e3a2b7edSAmir Vadai 
223473867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
2235e3a2b7edSAmir Vadai 		return -EINVAL;
2236e3a2b7edSAmir Vadai 
22373bc4b7bfSOr Gerlitz 	attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG;
2238e3a2b7edSAmir Vadai 
223973867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
224073867881SPablo Neira Ayuso 		switch (act->id) {
224173867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
22421cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP;
2243aad7e08dSAmir Vadai 			if (MLX5_CAP_FLOWTABLE(priv->mdev,
2244aad7e08dSAmir Vadai 					       flow_table_properties_nic_receive.flow_counter))
22451cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
224673867881SPablo Neira Ayuso 			break;
224773867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
224873867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
224973867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_KERNEL,
2250c500c86bSPablo Neira Ayuso 						    parse_attr, hdrs, extack);
22512f4fe4caSOr Gerlitz 			if (err)
22522f4fe4caSOr Gerlitz 				return err;
22532f4fe4caSOr Gerlitz 
22541cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR |
22552f4fe4caSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
225673867881SPablo Neira Ayuso 			break;
225773867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
22581cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
225973867881SPablo Neira Ayuso 						   act->csum_flags,
2260e98bedf5SEli Britstein 						   extack))
226173867881SPablo Neira Ayuso 				break;
226226c02749SOr Gerlitz 
226326c02749SOr Gerlitz 			return -EOPNOTSUPP;
226473867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT: {
226573867881SPablo Neira Ayuso 			struct net_device *peer_dev = act->dev;
22665c65c564SOr Gerlitz 
22675c65c564SOr Gerlitz 			if (priv->netdev->netdev_ops == peer_dev->netdev_ops &&
22685c65c564SOr Gerlitz 			    same_hw_devs(priv, netdev_priv(peer_dev))) {
226998b66cb1SEli Britstein 				parse_attr->mirred_ifindex[0] = peer_dev->ifindex;
22705c65c564SOr Gerlitz 				flow->flags |= MLX5E_TC_FLOW_HAIRPIN;
22711cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
22725c65c564SOr Gerlitz 					  MLX5_FLOW_CONTEXT_ACTION_COUNT;
22735c65c564SOr Gerlitz 			} else {
2274e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2275e98bedf5SEli Britstein 						   "device is not on same HW, can't offload");
22765c65c564SOr Gerlitz 				netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n",
22775c65c564SOr Gerlitz 					    peer_dev->name);
22785c65c564SOr Gerlitz 				return -EINVAL;
22795c65c564SOr Gerlitz 			}
22805c65c564SOr Gerlitz 			}
228173867881SPablo Neira Ayuso 			break;
228273867881SPablo Neira Ayuso 		case FLOW_ACTION_MARK: {
228373867881SPablo Neira Ayuso 			u32 mark = act->mark;
2284e3a2b7edSAmir Vadai 
2285e3a2b7edSAmir Vadai 			if (mark & ~MLX5E_TC_FLOW_ID_MASK) {
2286e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2287e98bedf5SEli Britstein 						   "Bad flow mark - only 16 bit is supported");
2288e3a2b7edSAmir Vadai 				return -EINVAL;
2289e3a2b7edSAmir Vadai 			}
2290e3a2b7edSAmir Vadai 
22913bc4b7bfSOr Gerlitz 			attr->flow_tag = mark;
22921cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
2293e3a2b7edSAmir Vadai 			}
229473867881SPablo Neira Ayuso 			break;
229573867881SPablo Neira Ayuso 		default:
2296e3a2b7edSAmir Vadai 			return -EINVAL;
2297e3a2b7edSAmir Vadai 		}
229873867881SPablo Neira Ayuso 	}
2299e3a2b7edSAmir Vadai 
2300c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
2301c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
2302c500c86bSPablo Neira Ayuso 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL,
2303c500c86bSPablo Neira Ayuso 					    parse_attr, hdrs, extack);
2304c500c86bSPablo Neira Ayuso 		if (err)
2305c500c86bSPablo Neira Ayuso 			return err;
2306c500c86bSPablo Neira Ayuso 	}
2307c500c86bSPablo Neira Ayuso 
23081cab1cd7SOr Gerlitz 	attr->action = action;
230973867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
2310bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
2311bdd66ac0SOr Gerlitz 
2312e3a2b7edSAmir Vadai 	return 0;
2313e3a2b7edSAmir Vadai }
2314e3a2b7edSAmir Vadai 
231576f7444dSOr Gerlitz static inline int cmp_encap_info(struct ip_tunnel_key *a,
231676f7444dSOr Gerlitz 				 struct ip_tunnel_key *b)
2317a54e20b4SHadar Hen Zion {
2318a54e20b4SHadar Hen Zion 	return memcmp(a, b, sizeof(*a));
2319a54e20b4SHadar Hen Zion }
2320a54e20b4SHadar Hen Zion 
232176f7444dSOr Gerlitz static inline int hash_encap_info(struct ip_tunnel_key *key)
2322a54e20b4SHadar Hen Zion {
232376f7444dSOr Gerlitz 	return jhash(key, sizeof(*key), 0);
2324a54e20b4SHadar Hen Zion }
2325a54e20b4SHadar Hen Zion 
2326a54e20b4SHadar Hen Zion 
2327b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv,
2328b1d90e6bSRabie Loulou 				  struct net_device *peer_netdev)
2329b1d90e6bSRabie Loulou {
2330b1d90e6bSRabie Loulou 	struct mlx5e_priv *peer_priv;
2331b1d90e6bSRabie Loulou 
2332b1d90e6bSRabie Loulou 	peer_priv = netdev_priv(peer_netdev);
2333b1d90e6bSRabie Loulou 
2334b1d90e6bSRabie Loulou 	return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) &&
2335b1d90e6bSRabie Loulou 		(priv->netdev->netdev_ops == peer_netdev->netdev_ops) &&
2336b1d90e6bSRabie Loulou 		same_hw_devs(priv, peer_priv) &&
2337b1d90e6bSRabie Loulou 		MLX5_VPORT_MANAGER(peer_priv->mdev) &&
2338b1d90e6bSRabie Loulou 		(peer_priv->mdev->priv.eswitch->mode == SRIOV_OFFLOADS));
2339b1d90e6bSRabie Loulou }
2340b1d90e6bSRabie Loulou 
2341ce99f6b9SOr Gerlitz 
234254c177caSOz Shlomo 
2343a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv,
2344e98bedf5SEli Britstein 			      struct mlx5e_tc_flow *flow,
2345733d4f36SRoi Dayan 			      struct net_device *mirred_dev,
2346733d4f36SRoi Dayan 			      int out_index,
23478c4dc42bSEli Britstein 			      struct netlink_ext_ack *extack,
23480ad060eeSRoi Dayan 			      struct net_device **encap_dev,
23490ad060eeSRoi Dayan 			      bool *encap_valid)
235003a9d11eSOr Gerlitz {
2351a54e20b4SHadar Hen Zion 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
235245247bf2SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
2353733d4f36SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2354733d4f36SRoi Dayan 	struct ip_tunnel_info *tun_info;
2355733d4f36SRoi Dayan 	struct ip_tunnel_key *key;
2356c1ae1152SOr Gerlitz 	struct mlx5e_encap_entry *e;
2357733d4f36SRoi Dayan 	unsigned short family;
2358a54e20b4SHadar Hen Zion 	uintptr_t hash_key;
2359a54e20b4SHadar Hen Zion 	bool found = false;
236054c177caSOz Shlomo 	int err = 0;
2361a54e20b4SHadar Hen Zion 
2362733d4f36SRoi Dayan 	parse_attr = attr->parse_attr;
2363733d4f36SRoi Dayan 	tun_info = &parse_attr->tun_info[out_index];
2364733d4f36SRoi Dayan 	family = ip_tunnel_info_af(tun_info);
2365733d4f36SRoi Dayan 	key = &tun_info->key;
2366733d4f36SRoi Dayan 
236776f7444dSOr Gerlitz 	hash_key = hash_encap_info(key);
2368a54e20b4SHadar Hen Zion 
2369a54e20b4SHadar Hen Zion 	hash_for_each_possible_rcu(esw->offloads.encap_tbl, e,
2370a54e20b4SHadar Hen Zion 				   encap_hlist, hash_key) {
237176f7444dSOr Gerlitz 		if (!cmp_encap_info(&e->tun_info.key, key)) {
2372a54e20b4SHadar Hen Zion 			found = true;
2373a54e20b4SHadar Hen Zion 			break;
2374a54e20b4SHadar Hen Zion 		}
2375a54e20b4SHadar Hen Zion 	}
2376a54e20b4SHadar Hen Zion 
2377b2812089SVlad Buslov 	/* must verify if encap is valid or not */
237845247bf2SOr Gerlitz 	if (found)
237945247bf2SOr Gerlitz 		goto attach_flow;
2380a54e20b4SHadar Hen Zion 
2381a54e20b4SHadar Hen Zion 	e = kzalloc(sizeof(*e), GFP_KERNEL);
2382a54e20b4SHadar Hen Zion 	if (!e)
2383a54e20b4SHadar Hen Zion 		return -ENOMEM;
2384a54e20b4SHadar Hen Zion 
238576f7444dSOr Gerlitz 	e->tun_info = *tun_info;
2386101f4de9SOz Shlomo 	err = mlx5e_tc_tun_init_encap_attr(mirred_dev, priv, e, extack);
238754c177caSOz Shlomo 	if (err)
238854c177caSOz Shlomo 		goto out_err;
238954c177caSOz Shlomo 
2390a54e20b4SHadar Hen Zion 	INIT_LIST_HEAD(&e->flows);
2391a54e20b4SHadar Hen Zion 
2392ce99f6b9SOr Gerlitz 	if (family == AF_INET)
2393101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv4(priv, mirred_dev, e);
2394ce99f6b9SOr Gerlitz 	else if (family == AF_INET6)
2395101f4de9SOz Shlomo 		err = mlx5e_tc_tun_create_header_ipv6(priv, mirred_dev, e);
2396ce99f6b9SOr Gerlitz 
23970ad060eeSRoi Dayan 	if (err)
2398a54e20b4SHadar Hen Zion 		goto out_err;
2399a54e20b4SHadar Hen Zion 
2400a54e20b4SHadar Hen Zion 	hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key);
2401a54e20b4SHadar Hen Zion 
240245247bf2SOr Gerlitz attach_flow:
24038c4dc42bSEli Britstein 	list_add(&flow->encaps[out_index].list, &e->flows);
24048c4dc42bSEli Britstein 	flow->encaps[out_index].index = out_index;
240545247bf2SOr Gerlitz 	*encap_dev = e->out_dev;
24068c4dc42bSEli Britstein 	if (e->flags & MLX5_ENCAP_ENTRY_VALID) {
24078c4dc42bSEli Britstein 		attr->dests[out_index].encap_id = e->encap_id;
24088c4dc42bSEli Britstein 		attr->dests[out_index].flags |= MLX5_ESW_DEST_ENCAP_VALID;
24090ad060eeSRoi Dayan 		*encap_valid = true;
24108c4dc42bSEli Britstein 	} else {
24110ad060eeSRoi Dayan 		*encap_valid = false;
24128c4dc42bSEli Britstein 	}
241345247bf2SOr Gerlitz 
2414232c0013SHadar Hen Zion 	return err;
2415a54e20b4SHadar Hen Zion 
2416a54e20b4SHadar Hen Zion out_err:
2417a54e20b4SHadar Hen Zion 	kfree(e);
2418a54e20b4SHadar Hen Zion 	return err;
2419a54e20b4SHadar Hen Zion }
2420a54e20b4SHadar Hen Zion 
24211482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv,
242273867881SPablo Neira Ayuso 				const struct flow_action_entry *act,
24231482bd3dSJianbo Liu 				struct mlx5_esw_flow_attr *attr,
24241482bd3dSJianbo Liu 				u32 *action)
24251482bd3dSJianbo Liu {
2426cc495188SJianbo Liu 	u8 vlan_idx = attr->total_vlan;
2427cc495188SJianbo Liu 
2428cc495188SJianbo Liu 	if (vlan_idx >= MLX5_FS_VLAN_DEPTH)
24291482bd3dSJianbo Liu 		return -EOPNOTSUPP;
2430cc495188SJianbo Liu 
243173867881SPablo Neira Ayuso 	switch (act->id) {
243273867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_POP:
2433cc495188SJianbo Liu 		if (vlan_idx) {
2434cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2435cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2436cc495188SJianbo Liu 				return -EOPNOTSUPP;
2437cc495188SJianbo Liu 
2438cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2;
2439cc495188SJianbo Liu 		} else {
2440cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
2441cc495188SJianbo Liu 		}
244273867881SPablo Neira Ayuso 		break;
244373867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_PUSH:
244473867881SPablo Neira Ayuso 		attr->vlan_vid[vlan_idx] = act->vlan.vid;
244573867881SPablo Neira Ayuso 		attr->vlan_prio[vlan_idx] = act->vlan.prio;
244673867881SPablo Neira Ayuso 		attr->vlan_proto[vlan_idx] = act->vlan.proto;
2447cc495188SJianbo Liu 		if (!attr->vlan_proto[vlan_idx])
2448cc495188SJianbo Liu 			attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q);
2449cc495188SJianbo Liu 
2450cc495188SJianbo Liu 		if (vlan_idx) {
2451cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
2452cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
2453cc495188SJianbo Liu 				return -EOPNOTSUPP;
2454cc495188SJianbo Liu 
2455cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2;
2456cc495188SJianbo Liu 		} else {
2457cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) &&
245873867881SPablo Neira Ayuso 			    (act->vlan.proto != htons(ETH_P_8021Q) ||
245973867881SPablo Neira Ayuso 			     act->vlan.prio))
2460cc495188SJianbo Liu 				return -EOPNOTSUPP;
2461cc495188SJianbo Liu 
2462cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH;
24631482bd3dSJianbo Liu 		}
246473867881SPablo Neira Ayuso 		break;
246573867881SPablo Neira Ayuso 	default:
246673867881SPablo Neira Ayuso 		/* action is FLOW_ACT_VLAN_MANGLE */
24671482bd3dSJianbo Liu 		return -EOPNOTSUPP;
24681482bd3dSJianbo Liu 	}
24691482bd3dSJianbo Liu 
2470cc495188SJianbo Liu 	attr->total_vlan = vlan_idx + 1;
2471cc495188SJianbo Liu 
24721482bd3dSJianbo Liu 	return 0;
24731482bd3dSJianbo Liu }
24741482bd3dSJianbo Liu 
247573867881SPablo Neira Ayuso static int parse_tc_fdb_actions(struct mlx5e_priv *priv,
247673867881SPablo Neira Ayuso 				struct flow_action *flow_action,
2477d7e75a32SOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr,
2478e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
2479e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2480a54e20b4SHadar Hen Zion {
248173867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
2482bf07aa73SPaul Blakey 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2483ecf5bb79SOr Gerlitz 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
24841d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
248573867881SPablo Neira Ayuso 	const struct ip_tunnel_info *info = NULL;
248673867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
2487a54e20b4SHadar Hen Zion 	bool encap = false;
24881cab1cd7SOr Gerlitz 	u32 action = 0;
2489244cd96aSCong Wang 	int err, i;
249003a9d11eSOr Gerlitz 
249173867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
249203a9d11eSOr Gerlitz 		return -EINVAL;
249303a9d11eSOr Gerlitz 
24941d447a39SSaeed Mahameed 	attr->in_rep = rpriv->rep;
249510ff5359SShahar Klein 	attr->in_mdev = priv->mdev;
249603a9d11eSOr Gerlitz 
249773867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
249873867881SPablo Neira Ayuso 		switch (act->id) {
249973867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
25001cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP |
250103a9d11eSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
250273867881SPablo Neira Ayuso 			break;
250373867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
250473867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
250573867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_FDB,
2506c500c86bSPablo Neira Ayuso 						    parse_attr, hdrs, extack);
2507d7e75a32SOr Gerlitz 			if (err)
2508d7e75a32SOr Gerlitz 				return err;
2509d7e75a32SOr Gerlitz 
25101cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
2511e85e02baSEli Britstein 			attr->split_count = attr->out_count;
251273867881SPablo Neira Ayuso 			break;
251373867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
25141cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
251573867881SPablo Neira Ayuso 						   act->csum_flags, extack))
251673867881SPablo Neira Ayuso 				break;
251726c02749SOr Gerlitz 
251826c02749SOr Gerlitz 			return -EOPNOTSUPP;
251973867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT:
252073867881SPablo Neira Ayuso 		case FLOW_ACTION_MIRRED: {
252103a9d11eSOr Gerlitz 			struct mlx5e_priv *out_priv;
2522592d3651SChris Mi 			struct net_device *out_dev;
252303a9d11eSOr Gerlitz 
252473867881SPablo Neira Ayuso 			out_dev = act->dev;
2525ef381359SOz Shlomo 			if (!out_dev) {
2526ef381359SOz Shlomo 				/* out_dev is NULL when filters with
2527ef381359SOz Shlomo 				 * non-existing mirred device are replayed to
2528ef381359SOz Shlomo 				 * the driver.
2529ef381359SOz Shlomo 				 */
2530ef381359SOz Shlomo 				return -EINVAL;
2531ef381359SOz Shlomo 			}
253203a9d11eSOr Gerlitz 
2533592d3651SChris Mi 			if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) {
2534e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2535e98bedf5SEli Britstein 						   "can't support more output ports, can't offload forwarding");
2536592d3651SChris Mi 				pr_err("can't support more than %d output ports, can't offload forwarding\n",
2537592d3651SChris Mi 				       attr->out_count);
2538592d3651SChris Mi 				return -EOPNOTSUPP;
2539592d3651SChris Mi 			}
2540592d3651SChris Mi 
2541f493f155SEli Britstein 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
2542f493f155SEli Britstein 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
25436dcfa234SFlorian Fainelli 			if (netdev_port_same_parent_id(priv->netdev,
2544b1d90e6bSRabie Loulou 						       out_dev) ||
2545b1d90e6bSRabie Loulou 			    is_merged_eswitch_dev(priv, out_dev)) {
25467ba58ba7SRabie Loulou 				struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
25477ba58ba7SRabie Loulou 				struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH);
25487ba58ba7SRabie Loulou 				struct net_device *uplink_upper = netdev_master_upper_dev_get(uplink_dev);
25497ba58ba7SRabie Loulou 
25507ba58ba7SRabie Loulou 				if (uplink_upper &&
25517ba58ba7SRabie Loulou 				    netif_is_lag_master(uplink_upper) &&
25527ba58ba7SRabie Loulou 				    uplink_upper == out_dev)
25537ba58ba7SRabie Loulou 					out_dev = uplink_dev;
25547ba58ba7SRabie Loulou 
2555a0646c88SEli Britstein 				if (!mlx5e_eswitch_rep(out_dev))
2556a0646c88SEli Britstein 					return -EOPNOTSUPP;
2557a0646c88SEli Britstein 
255803a9d11eSOr Gerlitz 				out_priv = netdev_priv(out_dev);
25591d447a39SSaeed Mahameed 				rpriv = out_priv->ppriv;
2560df65a573SEli Britstein 				attr->dests[attr->out_count].rep = rpriv->rep;
2561df65a573SEli Britstein 				attr->dests[attr->out_count].mdev = out_priv->mdev;
2562df65a573SEli Britstein 				attr->out_count++;
2563a54e20b4SHadar Hen Zion 			} else if (encap) {
25648c4dc42bSEli Britstein 				parse_attr->mirred_ifindex[attr->out_count] =
25658c4dc42bSEli Britstein 					out_dev->ifindex;
25668c4dc42bSEli Britstein 				parse_attr->tun_info[attr->out_count] = *info;
25678c4dc42bSEli Britstein 				encap = false;
25683c37745eSOr Gerlitz 				attr->parse_attr = parse_attr;
2569f493f155SEli Britstein 				attr->dests[attr->out_count].flags |=
2570f493f155SEli Britstein 					MLX5_ESW_DEST_ENCAP;
25711cc26d74SEli Britstein 				attr->out_count++;
2572df65a573SEli Britstein 				/* attr->dests[].rep is resolved when we
2573df65a573SEli Britstein 				 * handle encap
2574df65a573SEli Britstein 				 */
2575ef381359SOz Shlomo 			} else if (parse_attr->filter_dev != priv->netdev) {
2576ef381359SOz Shlomo 				/* All mlx5 devices are called to configure
2577ef381359SOz Shlomo 				 * high level device filters. Therefore, the
2578ef381359SOz Shlomo 				 * *attempt* to  install a filter on invalid
2579ef381359SOz Shlomo 				 * eswitch should not trigger an explicit error
2580ef381359SOz Shlomo 				 */
2581ef381359SOz Shlomo 				return -EINVAL;
2582a54e20b4SHadar Hen Zion 			} else {
2583e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
2584e98bedf5SEli Britstein 						   "devices are not on same switch HW, can't offload forwarding");
2585a54e20b4SHadar Hen Zion 				pr_err("devices %s %s not on same switch HW, can't offload forwarding\n",
2586a54e20b4SHadar Hen Zion 				       priv->netdev->name, out_dev->name);
2587a54e20b4SHadar Hen Zion 				return -EINVAL;
2588a54e20b4SHadar Hen Zion 			}
2589a54e20b4SHadar Hen Zion 			}
259073867881SPablo Neira Ayuso 			break;
259173867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_ENCAP:
259273867881SPablo Neira Ayuso 			info = act->tunnel;
2593a54e20b4SHadar Hen Zion 			if (info)
2594a54e20b4SHadar Hen Zion 				encap = true;
2595a54e20b4SHadar Hen Zion 			else
2596a54e20b4SHadar Hen Zion 				return -EOPNOTSUPP;
259703a9d11eSOr Gerlitz 
259873867881SPablo Neira Ayuso 			break;
259973867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_PUSH:
260073867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_POP:
260173867881SPablo Neira Ayuso 			err = parse_tc_vlan_action(priv, act, attr, &action);
26021482bd3dSJianbo Liu 			if (err)
26031482bd3dSJianbo Liu 				return err;
26041482bd3dSJianbo Liu 
2605e85e02baSEli Britstein 			attr->split_count = attr->out_count;
260673867881SPablo Neira Ayuso 			break;
260773867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_DECAP:
26081cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DECAP;
260973867881SPablo Neira Ayuso 			break;
261073867881SPablo Neira Ayuso 		case FLOW_ACTION_GOTO: {
261173867881SPablo Neira Ayuso 			u32 dest_chain = act->chain_index;
2612bf07aa73SPaul Blakey 			u32 max_chain = mlx5_eswitch_get_chain_range(esw);
2613bf07aa73SPaul Blakey 
2614bf07aa73SPaul Blakey 			if (dest_chain <= attr->chain) {
2615bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Goto earlier chain isn't supported");
2616bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
2617bf07aa73SPaul Blakey 			}
2618bf07aa73SPaul Blakey 			if (dest_chain > max_chain) {
2619bf07aa73SPaul Blakey 				NL_SET_ERR_MSG(extack, "Requested destination chain is out of supported range");
2620bf07aa73SPaul Blakey 				return -EOPNOTSUPP;
2621bf07aa73SPaul Blakey 			}
2622e88afe75SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
2623bf07aa73SPaul Blakey 			attr->dest_chain = dest_chain;
262473867881SPablo Neira Ayuso 			break;
2625bf07aa73SPaul Blakey 			}
262673867881SPablo Neira Ayuso 		default:
262703a9d11eSOr Gerlitz 			return -EINVAL;
262803a9d11eSOr Gerlitz 		}
262973867881SPablo Neira Ayuso 	}
2630bdd66ac0SOr Gerlitz 
2631c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
2632c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
2633c500c86bSPablo Neira Ayuso 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL,
2634c500c86bSPablo Neira Ayuso 					    parse_attr, hdrs, extack);
2635c500c86bSPablo Neira Ayuso 		if (err)
2636c500c86bSPablo Neira Ayuso 			return err;
2637c500c86bSPablo Neira Ayuso 	}
2638c500c86bSPablo Neira Ayuso 
26391cab1cd7SOr Gerlitz 	attr->action = action;
264073867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
2641bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
2642bdd66ac0SOr Gerlitz 
2643e88afe75SOr Gerlitz 	if (attr->dest_chain) {
2644e88afe75SOr Gerlitz 		if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
2645e88afe75SOr Gerlitz 			NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported");
2646e88afe75SOr Gerlitz 			return -EOPNOTSUPP;
2647e88afe75SOr Gerlitz 		}
2648e88afe75SOr Gerlitz 		attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
2649e88afe75SOr Gerlitz 	}
2650e88afe75SOr Gerlitz 
2651e85e02baSEli Britstein 	if (attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) {
2652e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2653e98bedf5SEli Britstein 				   "current firmware doesn't support split rule for port mirroring");
2654592d3651SChris Mi 		netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n");
2655592d3651SChris Mi 		return -EOPNOTSUPP;
2656592d3651SChris Mi 	}
2657592d3651SChris Mi 
265831c8eba5SOr Gerlitz 	return 0;
265903a9d11eSOr Gerlitz }
266003a9d11eSOr Gerlitz 
26615dbe906fSPaul Blakey static void get_flags(int flags, u16 *flow_flags)
266260bd4af8SOr Gerlitz {
26635dbe906fSPaul Blakey 	u16 __flow_flags = 0;
266460bd4af8SOr Gerlitz 
266560bd4af8SOr Gerlitz 	if (flags & MLX5E_TC_INGRESS)
266660bd4af8SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_INGRESS;
266760bd4af8SOr Gerlitz 	if (flags & MLX5E_TC_EGRESS)
266860bd4af8SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_EGRESS;
266960bd4af8SOr Gerlitz 
2670d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_ESW_OFFLOAD)
2671d9ee0491SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_ESWITCH;
2672d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_NIC_OFFLOAD)
2673d9ee0491SOr Gerlitz 		__flow_flags |= MLX5E_TC_FLOW_NIC;
2674d9ee0491SOr Gerlitz 
267560bd4af8SOr Gerlitz 	*flow_flags = __flow_flags;
267660bd4af8SOr Gerlitz }
267760bd4af8SOr Gerlitz 
267805866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = {
267905866c82SOr Gerlitz 	.head_offset = offsetof(struct mlx5e_tc_flow, node),
268005866c82SOr Gerlitz 	.key_offset = offsetof(struct mlx5e_tc_flow, cookie),
268105866c82SOr Gerlitz 	.key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie),
268205866c82SOr Gerlitz 	.automatic_shrinking = true,
268305866c82SOr Gerlitz };
268405866c82SOr Gerlitz 
2685d9ee0491SOr Gerlitz static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv, int flags)
268605866c82SOr Gerlitz {
2687655dc3d2SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2688655dc3d2SOr Gerlitz 	struct mlx5e_rep_priv *uplink_rpriv;
2689655dc3d2SOr Gerlitz 
2690d9ee0491SOr Gerlitz 	if (flags & MLX5E_TC_ESW_OFFLOAD) {
2691655dc3d2SOr Gerlitz 		uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
2692ec1366c2SOz Shlomo 		return &uplink_rpriv->uplink_priv.tc_ht;
2693d9ee0491SOr Gerlitz 	} else /* NIC offload */
269405866c82SOr Gerlitz 		return &priv->fs.tc.ht;
269505866c82SOr Gerlitz }
269605866c82SOr Gerlitz 
269704de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow)
269804de7ddaSRoi Dayan {
26991418ddd9SAviv Heller 	struct mlx5_esw_flow_attr *attr = flow->esw_attr;
2700b05af6aaSBodong Wang 	bool is_rep_ingress = attr->in_rep->vport != MLX5_VPORT_UPLINK &&
27011418ddd9SAviv Heller 			      flow->flags & MLX5E_TC_FLOW_INGRESS;
27021418ddd9SAviv Heller 	bool act_is_encap = !!(attr->action &
27031418ddd9SAviv Heller 			       MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT);
27041418ddd9SAviv Heller 	bool esw_paired = mlx5_devcom_is_paired(attr->in_mdev->priv.devcom,
27051418ddd9SAviv Heller 						MLX5_DEVCOM_ESW_OFFLOADS);
27061418ddd9SAviv Heller 
27077c34ec19SAviv Heller 	return esw_paired && mlx5_lag_is_sriov(attr->in_mdev) &&
27081418ddd9SAviv Heller 	       (is_rep_ingress || act_is_encap);
270904de7ddaSRoi Dayan }
271004de7ddaSRoi Dayan 
2711a88780a9SRoi Dayan static int
2712a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size,
27135dbe906fSPaul Blakey 		 struct tc_cls_flower_offload *f, u16 flow_flags,
2714a88780a9SRoi Dayan 		 struct mlx5e_tc_flow_parse_attr **__parse_attr,
2715a88780a9SRoi Dayan 		 struct mlx5e_tc_flow **__flow)
2716e3a2b7edSAmir Vadai {
271717091853SOr Gerlitz 	struct mlx5e_tc_flow_parse_attr *parse_attr;
27183bc4b7bfSOr Gerlitz 	struct mlx5e_tc_flow *flow;
2719a88780a9SRoi Dayan 	int err;
2720776b12b6SOr Gerlitz 
272165ba8fb7SOr Gerlitz 	flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL);
27221b9a07eeSLeon Romanovsky 	parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL);
272317091853SOr Gerlitz 	if (!parse_attr || !flow) {
2724e3a2b7edSAmir Vadai 		err = -ENOMEM;
2725e3a2b7edSAmir Vadai 		goto err_free;
2726e3a2b7edSAmir Vadai 	}
2727e3a2b7edSAmir Vadai 
2728e3a2b7edSAmir Vadai 	flow->cookie = f->cookie;
272965ba8fb7SOr Gerlitz 	flow->flags = flow_flags;
2730655dc3d2SOr Gerlitz 	flow->priv = priv;
2731e3a2b7edSAmir Vadai 
2732a88780a9SRoi Dayan 	*__flow = flow;
2733a88780a9SRoi Dayan 	*__parse_attr = parse_attr;
2734a88780a9SRoi Dayan 
2735a88780a9SRoi Dayan 	return 0;
2736a88780a9SRoi Dayan 
2737a88780a9SRoi Dayan err_free:
2738a88780a9SRoi Dayan 	kfree(flow);
2739a88780a9SRoi Dayan 	kvfree(parse_attr);
2740a88780a9SRoi Dayan 	return err;
2741adb4c123SOr Gerlitz }
2742adb4c123SOr Gerlitz 
2743988ab9c7STonghao Zhang static void
2744988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(struct mlx5_esw_flow_attr *esw_attr,
2745988ab9c7STonghao Zhang 			 struct mlx5e_priv *priv,
2746988ab9c7STonghao Zhang 			 struct mlx5e_tc_flow_parse_attr *parse_attr,
2747988ab9c7STonghao Zhang 			 struct tc_cls_flower_offload *f,
2748988ab9c7STonghao Zhang 			 struct mlx5_eswitch_rep *in_rep,
2749988ab9c7STonghao Zhang 			 struct mlx5_core_dev *in_mdev)
2750988ab9c7STonghao Zhang {
2751988ab9c7STonghao Zhang 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
2752988ab9c7STonghao Zhang 
2753988ab9c7STonghao Zhang 	esw_attr->parse_attr = parse_attr;
2754988ab9c7STonghao Zhang 	esw_attr->chain = f->common.chain_index;
2755988ab9c7STonghao Zhang 	esw_attr->prio = TC_H_MAJ(f->common.prio) >> 16;
2756988ab9c7STonghao Zhang 
2757988ab9c7STonghao Zhang 	esw_attr->in_rep = in_rep;
2758988ab9c7STonghao Zhang 	esw_attr->in_mdev = in_mdev;
2759988ab9c7STonghao Zhang 
2760988ab9c7STonghao Zhang 	if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) ==
2761988ab9c7STonghao Zhang 	    MLX5_COUNTER_SOURCE_ESWITCH)
2762988ab9c7STonghao Zhang 		esw_attr->counter_dev = in_mdev;
2763988ab9c7STonghao Zhang 	else
2764988ab9c7STonghao Zhang 		esw_attr->counter_dev = priv->mdev;
2765988ab9c7STonghao Zhang }
2766988ab9c7STonghao Zhang 
276771129676SJason Gunthorpe static struct mlx5e_tc_flow *
276804de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
2769a88780a9SRoi Dayan 		     struct tc_cls_flower_offload *f,
27705dbe906fSPaul Blakey 		     u16 flow_flags,
2771d11afc26SOz Shlomo 		     struct net_device *filter_dev,
277204de7ddaSRoi Dayan 		     struct mlx5_eswitch_rep *in_rep,
277371129676SJason Gunthorpe 		     struct mlx5_core_dev *in_mdev)
2774a88780a9SRoi Dayan {
277573867881SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
2776a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
2777a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2778a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
2779a88780a9SRoi Dayan 	int attr_size, err;
2780a88780a9SRoi Dayan 
2781a88780a9SRoi Dayan 	flow_flags |= MLX5E_TC_FLOW_ESWITCH;
2782a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_esw_flow_attr);
2783a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
2784a88780a9SRoi Dayan 			       &parse_attr, &flow);
2785a88780a9SRoi Dayan 	if (err)
2786a88780a9SRoi Dayan 		goto out;
2787988ab9c7STonghao Zhang 
2788d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
2789988ab9c7STonghao Zhang 	mlx5e_flow_esw_attr_init(flow->esw_attr,
2790988ab9c7STonghao Zhang 				 priv, parse_attr,
2791988ab9c7STonghao Zhang 				 f, in_rep, in_mdev);
2792988ab9c7STonghao Zhang 
279354c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
279454c177caSOz Shlomo 			       f, filter_dev);
2795d11afc26SOz Shlomo 	if (err)
2796d11afc26SOz Shlomo 		goto err_free;
2797a88780a9SRoi Dayan 
279873867881SPablo Neira Ayuso 	err = parse_tc_fdb_actions(priv, &rule->action, parse_attr, flow, extack);
2799a88780a9SRoi Dayan 	if (err)
2800a88780a9SRoi Dayan 		goto err_free;
2801a88780a9SRoi Dayan 
28027040632dSTonghao Zhang 	err = mlx5e_tc_add_fdb_flow(priv, flow, extack);
28035dbe906fSPaul Blakey 	if (err)
2804aa0cbbaeSOr Gerlitz 		goto err_free;
28055c40348cSOr Gerlitz 
280671129676SJason Gunthorpe 	return flow;
2807e3a2b7edSAmir Vadai 
2808e3a2b7edSAmir Vadai err_free:
2809232c0013SHadar Hen Zion 	kfree(flow);
2810a88780a9SRoi Dayan 	kvfree(parse_attr);
2811a88780a9SRoi Dayan out:
281271129676SJason Gunthorpe 	return ERR_PTR(err);
2813a88780a9SRoi Dayan }
2814a88780a9SRoi Dayan 
281504de7ddaSRoi Dayan static int mlx5e_tc_add_fdb_peer_flow(struct tc_cls_flower_offload *f,
281604de7ddaSRoi Dayan 				      struct mlx5e_tc_flow *flow)
281704de7ddaSRoi Dayan {
281804de7ddaSRoi Dayan 	struct mlx5e_priv *priv = flow->priv, *peer_priv;
281904de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw;
282004de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
282104de7ddaSRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
282204de7ddaSRoi Dayan 	struct mlx5e_rep_priv *peer_urpriv;
282304de7ddaSRoi Dayan 	struct mlx5e_tc_flow *peer_flow;
282404de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev;
282504de7ddaSRoi Dayan 	int err = 0;
282604de7ddaSRoi Dayan 
282704de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
282804de7ddaSRoi Dayan 	if (!peer_esw)
282904de7ddaSRoi Dayan 		return -ENODEV;
283004de7ddaSRoi Dayan 
283104de7ddaSRoi Dayan 	peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH);
283204de7ddaSRoi Dayan 	peer_priv = netdev_priv(peer_urpriv->netdev);
283304de7ddaSRoi Dayan 
283404de7ddaSRoi Dayan 	/* in_mdev is assigned of which the packet originated from.
283504de7ddaSRoi Dayan 	 * So packets redirected to uplink use the same mdev of the
283604de7ddaSRoi Dayan 	 * original flow and packets redirected from uplink use the
283704de7ddaSRoi Dayan 	 * peer mdev.
283804de7ddaSRoi Dayan 	 */
2839b05af6aaSBodong Wang 	if (flow->esw_attr->in_rep->vport == MLX5_VPORT_UPLINK)
284004de7ddaSRoi Dayan 		in_mdev = peer_priv->mdev;
284104de7ddaSRoi Dayan 	else
284204de7ddaSRoi Dayan 		in_mdev = priv->mdev;
284304de7ddaSRoi Dayan 
284404de7ddaSRoi Dayan 	parse_attr = flow->esw_attr->parse_attr;
284571129676SJason Gunthorpe 	peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow->flags,
284604de7ddaSRoi Dayan 					 parse_attr->filter_dev,
284771129676SJason Gunthorpe 					 flow->esw_attr->in_rep, in_mdev);
284871129676SJason Gunthorpe 	if (IS_ERR(peer_flow)) {
284971129676SJason Gunthorpe 		err = PTR_ERR(peer_flow);
285004de7ddaSRoi Dayan 		goto out;
285171129676SJason Gunthorpe 	}
285204de7ddaSRoi Dayan 
285304de7ddaSRoi Dayan 	flow->peer_flow = peer_flow;
285404de7ddaSRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_DUP;
285504de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
285604de7ddaSRoi Dayan 	list_add_tail(&flow->peer, &esw->offloads.peer_flows);
285704de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
285804de7ddaSRoi Dayan 
285904de7ddaSRoi Dayan out:
286004de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
286104de7ddaSRoi Dayan 	return err;
286204de7ddaSRoi Dayan }
286304de7ddaSRoi Dayan 
286404de7ddaSRoi Dayan static int
286504de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
286604de7ddaSRoi Dayan 		   struct tc_cls_flower_offload *f,
286704de7ddaSRoi Dayan 		   u16 flow_flags,
286804de7ddaSRoi Dayan 		   struct net_device *filter_dev,
286904de7ddaSRoi Dayan 		   struct mlx5e_tc_flow **__flow)
287004de7ddaSRoi Dayan {
287104de7ddaSRoi Dayan 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
287204de7ddaSRoi Dayan 	struct mlx5_eswitch_rep *in_rep = rpriv->rep;
287304de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev = priv->mdev;
287404de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow;
287504de7ddaSRoi Dayan 	int err;
287604de7ddaSRoi Dayan 
287771129676SJason Gunthorpe 	flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep,
287871129676SJason Gunthorpe 				    in_mdev);
287971129676SJason Gunthorpe 	if (IS_ERR(flow))
288071129676SJason Gunthorpe 		return PTR_ERR(flow);
288104de7ddaSRoi Dayan 
288204de7ddaSRoi Dayan 	if (is_peer_flow_needed(flow)) {
288304de7ddaSRoi Dayan 		err = mlx5e_tc_add_fdb_peer_flow(f, flow);
288404de7ddaSRoi Dayan 		if (err) {
288504de7ddaSRoi Dayan 			mlx5e_tc_del_fdb_flow(priv, flow);
288604de7ddaSRoi Dayan 			goto out;
288704de7ddaSRoi Dayan 		}
288804de7ddaSRoi Dayan 	}
288904de7ddaSRoi Dayan 
289004de7ddaSRoi Dayan 	*__flow = flow;
289104de7ddaSRoi Dayan 
289204de7ddaSRoi Dayan 	return 0;
289304de7ddaSRoi Dayan 
289404de7ddaSRoi Dayan out:
289504de7ddaSRoi Dayan 	return err;
289604de7ddaSRoi Dayan }
289704de7ddaSRoi Dayan 
2898a88780a9SRoi Dayan static int
2899a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv,
2900a88780a9SRoi Dayan 		   struct tc_cls_flower_offload *f,
29015dbe906fSPaul Blakey 		   u16 flow_flags,
2902d11afc26SOz Shlomo 		   struct net_device *filter_dev,
2903a88780a9SRoi Dayan 		   struct mlx5e_tc_flow **__flow)
2904a88780a9SRoi Dayan {
290573867881SPablo Neira Ayuso 	struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f);
2906a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
2907a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
2908a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
2909a88780a9SRoi Dayan 	int attr_size, err;
2910a88780a9SRoi Dayan 
2911bf07aa73SPaul Blakey 	/* multi-chain not supported for NIC rules */
2912bf07aa73SPaul Blakey 	if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common))
2913bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
2914bf07aa73SPaul Blakey 
2915a88780a9SRoi Dayan 	flow_flags |= MLX5E_TC_FLOW_NIC;
2916a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_nic_flow_attr);
2917a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
2918a88780a9SRoi Dayan 			       &parse_attr, &flow);
2919a88780a9SRoi Dayan 	if (err)
2920a88780a9SRoi Dayan 		goto out;
2921a88780a9SRoi Dayan 
2922d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
292354c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
292454c177caSOz Shlomo 			       f, filter_dev);
2925d11afc26SOz Shlomo 	if (err)
2926d11afc26SOz Shlomo 		goto err_free;
2927d11afc26SOz Shlomo 
292873867881SPablo Neira Ayuso 	err = parse_tc_nic_actions(priv, &rule->action, parse_attr, flow, extack);
2929a88780a9SRoi Dayan 	if (err)
2930a88780a9SRoi Dayan 		goto err_free;
2931a88780a9SRoi Dayan 
2932a88780a9SRoi Dayan 	err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack);
2933a88780a9SRoi Dayan 	if (err)
2934a88780a9SRoi Dayan 		goto err_free;
2935a88780a9SRoi Dayan 
2936a88780a9SRoi Dayan 	flow->flags |= MLX5E_TC_FLOW_OFFLOADED;
2937a88780a9SRoi Dayan 	kvfree(parse_attr);
2938a88780a9SRoi Dayan 	*__flow = flow;
2939a88780a9SRoi Dayan 
2940a88780a9SRoi Dayan 	return 0;
2941a88780a9SRoi Dayan 
2942a88780a9SRoi Dayan err_free:
2943a88780a9SRoi Dayan 	kfree(flow);
2944a88780a9SRoi Dayan 	kvfree(parse_attr);
2945a88780a9SRoi Dayan out:
2946a88780a9SRoi Dayan 	return err;
2947a88780a9SRoi Dayan }
2948a88780a9SRoi Dayan 
2949a88780a9SRoi Dayan static int
2950a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv,
2951a88780a9SRoi Dayan 		  struct tc_cls_flower_offload *f,
2952a88780a9SRoi Dayan 		  int flags,
2953d11afc26SOz Shlomo 		  struct net_device *filter_dev,
2954a88780a9SRoi Dayan 		  struct mlx5e_tc_flow **flow)
2955a88780a9SRoi Dayan {
2956a88780a9SRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
29575dbe906fSPaul Blakey 	u16 flow_flags;
2958a88780a9SRoi Dayan 	int err;
2959a88780a9SRoi Dayan 
2960a88780a9SRoi Dayan 	get_flags(flags, &flow_flags);
2961a88780a9SRoi Dayan 
2962bf07aa73SPaul Blakey 	if (!tc_can_offload_extack(priv->netdev, f->common.extack))
2963bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
2964bf07aa73SPaul Blakey 
2965a88780a9SRoi Dayan 	if (esw && esw->mode == SRIOV_OFFLOADS)
2966d11afc26SOz Shlomo 		err = mlx5e_add_fdb_flow(priv, f, flow_flags,
2967d11afc26SOz Shlomo 					 filter_dev, flow);
2968a88780a9SRoi Dayan 	else
2969d11afc26SOz Shlomo 		err = mlx5e_add_nic_flow(priv, f, flow_flags,
2970d11afc26SOz Shlomo 					 filter_dev, flow);
2971a88780a9SRoi Dayan 
2972a88780a9SRoi Dayan 	return err;
2973a88780a9SRoi Dayan }
2974a88780a9SRoi Dayan 
297571d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv,
2976a88780a9SRoi Dayan 			   struct tc_cls_flower_offload *f, int flags)
2977a88780a9SRoi Dayan {
2978a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
2979d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
2980a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
2981a88780a9SRoi Dayan 	int err = 0;
2982a88780a9SRoi Dayan 
2983a88780a9SRoi Dayan 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
2984a88780a9SRoi Dayan 	if (flow) {
2985a88780a9SRoi Dayan 		NL_SET_ERR_MSG_MOD(extack,
2986a88780a9SRoi Dayan 				   "flow cookie already exists, ignoring");
2987a88780a9SRoi Dayan 		netdev_warn_once(priv->netdev,
2988a88780a9SRoi Dayan 				 "flow cookie %lx already exists, ignoring\n",
2989a88780a9SRoi Dayan 				 f->cookie);
2990a88780a9SRoi Dayan 		goto out;
2991a88780a9SRoi Dayan 	}
2992a88780a9SRoi Dayan 
2993d11afc26SOz Shlomo 	err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow);
2994a88780a9SRoi Dayan 	if (err)
2995a88780a9SRoi Dayan 		goto out;
2996a88780a9SRoi Dayan 
2997a88780a9SRoi Dayan 	err = rhashtable_insert_fast(tc_ht, &flow->node, tc_ht_params);
2998a88780a9SRoi Dayan 	if (err)
2999a88780a9SRoi Dayan 		goto err_free;
3000a88780a9SRoi Dayan 
3001a88780a9SRoi Dayan 	return 0;
3002a88780a9SRoi Dayan 
3003a88780a9SRoi Dayan err_free:
3004a88780a9SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3005a88780a9SRoi Dayan 	kfree(flow);
3006a88780a9SRoi Dayan out:
3007e3a2b7edSAmir Vadai 	return err;
3008e3a2b7edSAmir Vadai }
3009e3a2b7edSAmir Vadai 
30108f8ae895SOr Gerlitz #define DIRECTION_MASK (MLX5E_TC_INGRESS | MLX5E_TC_EGRESS)
30118f8ae895SOr Gerlitz #define FLOW_DIRECTION_MASK (MLX5E_TC_FLOW_INGRESS | MLX5E_TC_FLOW_EGRESS)
30128f8ae895SOr Gerlitz 
30138f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags)
30148f8ae895SOr Gerlitz {
30158f8ae895SOr Gerlitz 	if ((flow->flags & FLOW_DIRECTION_MASK) == (flags & DIRECTION_MASK))
30168f8ae895SOr Gerlitz 		return true;
30178f8ae895SOr Gerlitz 
30188f8ae895SOr Gerlitz 	return false;
30198f8ae895SOr Gerlitz }
30208f8ae895SOr Gerlitz 
302171d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv,
302260bd4af8SOr Gerlitz 			struct tc_cls_flower_offload *f, int flags)
3023e3a2b7edSAmir Vadai {
3024d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
3025e3a2b7edSAmir Vadai 	struct mlx5e_tc_flow *flow;
3026e3a2b7edSAmir Vadai 
302705866c82SOr Gerlitz 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
30288f8ae895SOr Gerlitz 	if (!flow || !same_flow_direction(flow, flags))
3029e3a2b7edSAmir Vadai 		return -EINVAL;
3030e3a2b7edSAmir Vadai 
303105866c82SOr Gerlitz 	rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params);
3032e3a2b7edSAmir Vadai 
3033961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3034e3a2b7edSAmir Vadai 
3035e3a2b7edSAmir Vadai 	kfree(flow);
3036e3a2b7edSAmir Vadai 
3037e3a2b7edSAmir Vadai 	return 0;
3038e3a2b7edSAmir Vadai }
3039e3a2b7edSAmir Vadai 
304071d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv,
304160bd4af8SOr Gerlitz 		       struct tc_cls_flower_offload *f, int flags)
3042aad7e08dSAmir Vadai {
304304de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
3044d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
304504de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
3046aad7e08dSAmir Vadai 	struct mlx5e_tc_flow *flow;
3047aad7e08dSAmir Vadai 	struct mlx5_fc *counter;
3048aad7e08dSAmir Vadai 	u64 bytes;
3049aad7e08dSAmir Vadai 	u64 packets;
3050aad7e08dSAmir Vadai 	u64 lastuse;
3051aad7e08dSAmir Vadai 
305205866c82SOr Gerlitz 	flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params);
30538f8ae895SOr Gerlitz 	if (!flow || !same_flow_direction(flow, flags))
3054aad7e08dSAmir Vadai 		return -EINVAL;
3055aad7e08dSAmir Vadai 
30560b67a38fSHadar Hen Zion 	if (!(flow->flags & MLX5E_TC_FLOW_OFFLOADED))
30570b67a38fSHadar Hen Zion 		return 0;
30580b67a38fSHadar Hen Zion 
3059b8aee822SMark Bloch 	counter = mlx5e_tc_get_counter(flow);
3060aad7e08dSAmir Vadai 	if (!counter)
3061aad7e08dSAmir Vadai 		return 0;
3062aad7e08dSAmir Vadai 
3063aad7e08dSAmir Vadai 	mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
3064aad7e08dSAmir Vadai 
306504de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
306604de7ddaSRoi Dayan 	if (!peer_esw)
306704de7ddaSRoi Dayan 		goto out;
306804de7ddaSRoi Dayan 
306904de7ddaSRoi Dayan 	if ((flow->flags & MLX5E_TC_FLOW_DUP) &&
307004de7ddaSRoi Dayan 	    (flow->peer_flow->flags & MLX5E_TC_FLOW_OFFLOADED)) {
307104de7ddaSRoi Dayan 		u64 bytes2;
307204de7ddaSRoi Dayan 		u64 packets2;
307304de7ddaSRoi Dayan 		u64 lastuse2;
307404de7ddaSRoi Dayan 
307504de7ddaSRoi Dayan 		counter = mlx5e_tc_get_counter(flow->peer_flow);
307604de7ddaSRoi Dayan 		mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2);
307704de7ddaSRoi Dayan 
307804de7ddaSRoi Dayan 		bytes += bytes2;
307904de7ddaSRoi Dayan 		packets += packets2;
308004de7ddaSRoi Dayan 		lastuse = max_t(u64, lastuse, lastuse2);
308104de7ddaSRoi Dayan 	}
308204de7ddaSRoi Dayan 
308304de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
308404de7ddaSRoi Dayan 
308504de7ddaSRoi Dayan out:
30863b1903efSPablo Neira Ayuso 	flow_stats_update(&f->stats, bytes, packets, lastuse);
3087fed06ee8SOr Gerlitz 
3088aad7e08dSAmir Vadai 	return 0;
3089aad7e08dSAmir Vadai }
3090aad7e08dSAmir Vadai 
30914d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv,
30924d8fcf21SAlaa Hleihel 					      struct mlx5e_priv *peer_priv)
30934d8fcf21SAlaa Hleihel {
30944d8fcf21SAlaa Hleihel 	struct mlx5_core_dev *peer_mdev = peer_priv->mdev;
30954d8fcf21SAlaa Hleihel 	struct mlx5e_hairpin_entry *hpe;
30964d8fcf21SAlaa Hleihel 	u16 peer_vhca_id;
30974d8fcf21SAlaa Hleihel 	int bkt;
30984d8fcf21SAlaa Hleihel 
30994d8fcf21SAlaa Hleihel 	if (!same_hw_devs(priv, peer_priv))
31004d8fcf21SAlaa Hleihel 		return;
31014d8fcf21SAlaa Hleihel 
31024d8fcf21SAlaa Hleihel 	peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
31034d8fcf21SAlaa Hleihel 
31044d8fcf21SAlaa Hleihel 	hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) {
31054d8fcf21SAlaa Hleihel 		if (hpe->peer_vhca_id == peer_vhca_id)
31064d8fcf21SAlaa Hleihel 			hpe->hp->pair->peer_gone = true;
31074d8fcf21SAlaa Hleihel 	}
31084d8fcf21SAlaa Hleihel }
31094d8fcf21SAlaa Hleihel 
31104d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this,
31114d8fcf21SAlaa Hleihel 				 unsigned long event, void *ptr)
31124d8fcf21SAlaa Hleihel {
31134d8fcf21SAlaa Hleihel 	struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
31144d8fcf21SAlaa Hleihel 	struct mlx5e_flow_steering *fs;
31154d8fcf21SAlaa Hleihel 	struct mlx5e_priv *peer_priv;
31164d8fcf21SAlaa Hleihel 	struct mlx5e_tc_table *tc;
31174d8fcf21SAlaa Hleihel 	struct mlx5e_priv *priv;
31184d8fcf21SAlaa Hleihel 
31194d8fcf21SAlaa Hleihel 	if (ndev->netdev_ops != &mlx5e_netdev_ops ||
31204d8fcf21SAlaa Hleihel 	    event != NETDEV_UNREGISTER ||
31214d8fcf21SAlaa Hleihel 	    ndev->reg_state == NETREG_REGISTERED)
31224d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
31234d8fcf21SAlaa Hleihel 
31244d8fcf21SAlaa Hleihel 	tc = container_of(this, struct mlx5e_tc_table, netdevice_nb);
31254d8fcf21SAlaa Hleihel 	fs = container_of(tc, struct mlx5e_flow_steering, tc);
31264d8fcf21SAlaa Hleihel 	priv = container_of(fs, struct mlx5e_priv, fs);
31274d8fcf21SAlaa Hleihel 	peer_priv = netdev_priv(ndev);
31284d8fcf21SAlaa Hleihel 	if (priv == peer_priv ||
31294d8fcf21SAlaa Hleihel 	    !(priv->netdev->features & NETIF_F_HW_TC))
31304d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
31314d8fcf21SAlaa Hleihel 
31324d8fcf21SAlaa Hleihel 	mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv);
31334d8fcf21SAlaa Hleihel 
31344d8fcf21SAlaa Hleihel 	return NOTIFY_DONE;
31354d8fcf21SAlaa Hleihel }
31364d8fcf21SAlaa Hleihel 
3137655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv)
3138e8f887acSAmir Vadai {
3139acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
31404d8fcf21SAlaa Hleihel 	int err;
3141e8f887acSAmir Vadai 
314211c9c548SOr Gerlitz 	hash_init(tc->mod_hdr_tbl);
31435c65c564SOr Gerlitz 	hash_init(tc->hairpin_tbl);
314411c9c548SOr Gerlitz 
31454d8fcf21SAlaa Hleihel 	err = rhashtable_init(&tc->ht, &tc_ht_params);
31464d8fcf21SAlaa Hleihel 	if (err)
31474d8fcf21SAlaa Hleihel 		return err;
31484d8fcf21SAlaa Hleihel 
31494d8fcf21SAlaa Hleihel 	tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event;
31504d8fcf21SAlaa Hleihel 	if (register_netdevice_notifier(&tc->netdevice_nb)) {
31514d8fcf21SAlaa Hleihel 		tc->netdevice_nb.notifier_call = NULL;
31524d8fcf21SAlaa Hleihel 		mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n");
31534d8fcf21SAlaa Hleihel 	}
31544d8fcf21SAlaa Hleihel 
31554d8fcf21SAlaa Hleihel 	return err;
3156e8f887acSAmir Vadai }
3157e8f887acSAmir Vadai 
3158e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg)
3159e8f887acSAmir Vadai {
3160e8f887acSAmir Vadai 	struct mlx5e_tc_flow *flow = ptr;
3161655dc3d2SOr Gerlitz 	struct mlx5e_priv *priv = flow->priv;
3162e8f887acSAmir Vadai 
3163961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
3164e8f887acSAmir Vadai 	kfree(flow);
3165e8f887acSAmir Vadai }
3166e8f887acSAmir Vadai 
3167655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv)
3168e8f887acSAmir Vadai {
3169acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
3170e8f887acSAmir Vadai 
31714d8fcf21SAlaa Hleihel 	if (tc->netdevice_nb.notifier_call)
31724d8fcf21SAlaa Hleihel 		unregister_netdevice_notifier(&tc->netdevice_nb);
31734d8fcf21SAlaa Hleihel 
3174d9ee0491SOr Gerlitz 	rhashtable_destroy(&tc->ht);
3175e8f887acSAmir Vadai 
3176acff797cSMaor Gottlieb 	if (!IS_ERR_OR_NULL(tc->t)) {
3177acff797cSMaor Gottlieb 		mlx5_destroy_flow_table(tc->t);
3178acff797cSMaor Gottlieb 		tc->t = NULL;
3179e8f887acSAmir Vadai 	}
3180e8f887acSAmir Vadai }
3181655dc3d2SOr Gerlitz 
3182655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht)
3183655dc3d2SOr Gerlitz {
3184655dc3d2SOr Gerlitz 	return rhashtable_init(tc_ht, &tc_ht_params);
3185655dc3d2SOr Gerlitz }
3186655dc3d2SOr Gerlitz 
3187655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht)
3188655dc3d2SOr Gerlitz {
3189655dc3d2SOr Gerlitz 	rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL);
3190655dc3d2SOr Gerlitz }
319101252a27SOr Gerlitz 
3192d9ee0491SOr Gerlitz int mlx5e_tc_num_filters(struct mlx5e_priv *priv, int flags)
319301252a27SOr Gerlitz {
3194d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
319501252a27SOr Gerlitz 
319601252a27SOr Gerlitz 	return atomic_read(&tc_ht->nelems);
319701252a27SOr Gerlitz }
319804de7ddaSRoi Dayan 
319904de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw)
320004de7ddaSRoi Dayan {
320104de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
320204de7ddaSRoi Dayan 
320304de7ddaSRoi Dayan 	list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer)
320404de7ddaSRoi Dayan 		__mlx5e_tc_del_fdb_peer_flow(flow);
320504de7ddaSRoi Dayan }
3206