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>
34e2394a61SVlad Buslov #include <net/flow_offload.h>
353f7d0eb4SOr Gerlitz #include <net/sch_generic.h>
36e3a2b7edSAmir Vadai #include <net/pkt_cls.h>
37e3a2b7edSAmir Vadai #include <net/tc_act/tc_gact.h>
3812185a9fSAmir Vadai #include <net/tc_act/tc_skbedit.h>
39e8f887acSAmir Vadai #include <linux/mlx5/fs.h>
40e8f887acSAmir Vadai #include <linux/mlx5/device.h>
41e8f887acSAmir Vadai #include <linux/rhashtable.h>
425a7e5bcbSVlad Buslov #include <linux/refcount.h>
43db76ca24SVlad Buslov #include <linux/completion.h>
4403a9d11eSOr Gerlitz #include <net/tc_act/tc_mirred.h>
45776b12b6SOr Gerlitz #include <net/tc_act/tc_vlan.h>
46bbd00f7eSHadar Hen Zion #include <net/tc_act/tc_tunnel_key.h>
47d79b6df6SOr Gerlitz #include <net/tc_act/tc_pedit.h>
4826c02749SOr Gerlitz #include <net/tc_act/tc_csum.h>
4914e6b038SEli Cohen #include <net/tc_act/tc_mpls.h>
5041c2fd94SChris Mi #include <net/psample.h>
51f6dfb4c3SHadar Hen Zion #include <net/arp.h>
523616d08bSDavid Ahern #include <net/ipv6_stubs.h>
53f828ca6aSEli Cohen #include <net/bareudp.h>
54d34eb2fcSOr Gerlitz #include <net/bonding.h>
55e8f887acSAmir Vadai #include "en.h"
561d447a39SSaeed Mahameed #include "en_rep.h"
57768c3667SVlad Buslov #include "en/rep/tc.h"
58e2394a61SVlad Buslov #include "en/rep/neigh.h"
59232c0013SHadar Hen Zion #include "en_tc.h"
6003a9d11eSOr Gerlitz #include "eswitch.h"
613f6d08d1SOr Gerlitz #include "fs_core.h"
622c81bfd5SHuy Nguyen #include "en/port.h"
63101f4de9SOz Shlomo #include "en/tc_tun.h"
640a7fcb78SPaul Blakey #include "en/mapping.h"
654c3844d9SPaul Blakey #include "en/tc_ct.h"
66b2fdf3d0SPaul Blakey #include "en/mod_hdr.h"
670d9f9647SVlad Buslov #include "en/tc_priv.h"
680d9f9647SVlad Buslov #include "en/tc_tun_encap.h"
692a9ab10aSChris Mi #include "esw/sample.h"
7004de7ddaSRoi Dayan #include "lib/devcom.h"
719272e3dfSYevgeny Kliteynik #include "lib/geneve.h"
72ae430332SAriel Levkovich #include "lib/fs_chains.h"
737a978759SDmytro Linkin #include "diag/en_tc_tracepoint.h"
741fe3e316SParav Pandit #include <asm/div64.h>
75e8f887acSAmir Vadai 
766a064674SAriel Levkovich #define nic_chains(priv) ((priv)->fs.tc.chains)
77d65dbedfSHuy Nguyen #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_add_copy_action_in_auto)
7817091853SOr Gerlitz 
79acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4
806a064674SAriel Levkovich #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(18)
81e8f887acSAmir Vadai 
828f1e0b97SPaul Blakey struct mlx5e_tc_attr_to_reg_mapping mlx5e_tc_attr_to_reg_mappings[] = {
838f1e0b97SPaul Blakey 	[CHAIN_TO_REG] = {
848f1e0b97SPaul Blakey 		.mfield = MLX5_ACTION_IN_FIELD_METADATA_REG_C_0,
858f1e0b97SPaul Blakey 		.moffset = 0,
868f1e0b97SPaul Blakey 		.mlen = 2,
878f1e0b97SPaul Blakey 	},
8810742efcSVlad Buslov 	[VPORT_TO_REG] = {
8910742efcSVlad Buslov 		.mfield = MLX5_ACTION_IN_FIELD_METADATA_REG_C_0,
9010742efcSVlad Buslov 		.moffset = 2,
9110742efcSVlad Buslov 		.mlen = 2,
9210742efcSVlad Buslov 	},
930a7fcb78SPaul Blakey 	[TUNNEL_TO_REG] = {
940a7fcb78SPaul Blakey 		.mfield = MLX5_ACTION_IN_FIELD_METADATA_REG_C_1,
95d12f4521SPaul Blakey 		.moffset = 1,
9648d216e5SVlad Buslov 		.mlen = ((ESW_TUN_OPTS_BITS + ESW_TUN_ID_BITS) / 8),
970a7fcb78SPaul Blakey 		.soffset = MLX5_BYTE_OFF(fte_match_param,
980a7fcb78SPaul Blakey 					 misc_parameters_2.metadata_reg_c_1),
990a7fcb78SPaul Blakey 	},
1004c3844d9SPaul Blakey 	[ZONE_TO_REG] = zone_to_reg_ct,
101a8eb919bSPaul Blakey 	[ZONE_RESTORE_TO_REG] = zone_restore_to_reg_ct,
1024c3844d9SPaul Blakey 	[CTSTATE_TO_REG] = ctstate_to_reg_ct,
1034c3844d9SPaul Blakey 	[MARK_TO_REG] = mark_to_reg_ct,
1044c3844d9SPaul Blakey 	[LABELS_TO_REG] = labels_to_reg_ct,
1054c3844d9SPaul Blakey 	[FTEID_TO_REG] = fteid_to_reg_ct,
106c7569097SAriel Levkovich 	/* For NIC rules we store the retore metadata directly
107c7569097SAriel Levkovich 	 * into reg_b that is passed to SW since we don't
108c7569097SAriel Levkovich 	 * jump between steering domains.
109c7569097SAriel Levkovich 	 */
110c7569097SAriel Levkovich 	[NIC_CHAIN_TO_REG] = {
111c7569097SAriel Levkovich 		.mfield = MLX5_ACTION_IN_FIELD_METADATA_REG_B,
112c7569097SAriel Levkovich 		.moffset = 0,
113c7569097SAriel Levkovich 		.mlen = 2,
114c7569097SAriel Levkovich 	},
115aedd133dSAriel Levkovich 	[NIC_ZONE_RESTORE_TO_REG] = nic_zone_restore_to_reg_ct,
1168f1e0b97SPaul Blakey };
1178f1e0b97SPaul Blakey 
1189ba33339SRoi Dayan /* To avoid false lock dependency warning set the tc_ht lock
1199ba33339SRoi Dayan  * class different than the lock class of the ht being used when deleting
1209ba33339SRoi Dayan  * last flow from a group and then deleting a group, we get into del_sw_flow_group()
1219ba33339SRoi Dayan  * which call rhashtable_destroy on fg->ftes_hash which will take ht->mutex but
1229ba33339SRoi Dayan  * it's different than the ht->mutex here.
1239ba33339SRoi Dayan  */
1249ba33339SRoi Dayan static struct lock_class_key tc_ht_lock_key;
1259ba33339SRoi Dayan 
1260a7fcb78SPaul Blakey static void mlx5e_put_flow_tunnel_id(struct mlx5e_tc_flow *flow);
1270a7fcb78SPaul Blakey 
1280a7fcb78SPaul Blakey void
1290a7fcb78SPaul Blakey mlx5e_tc_match_to_reg_match(struct mlx5_flow_spec *spec,
1300a7fcb78SPaul Blakey 			    enum mlx5e_tc_attr_to_reg type,
1310a7fcb78SPaul Blakey 			    u32 data,
1320a7fcb78SPaul Blakey 			    u32 mask)
1330a7fcb78SPaul Blakey {
1340a7fcb78SPaul Blakey 	int soffset = mlx5e_tc_attr_to_reg_mappings[type].soffset;
1350a7fcb78SPaul Blakey 	int match_len = mlx5e_tc_attr_to_reg_mappings[type].mlen;
1360a7fcb78SPaul Blakey 	void *headers_c = spec->match_criteria;
1370a7fcb78SPaul Blakey 	void *headers_v = spec->match_value;
1380a7fcb78SPaul Blakey 	void *fmask, *fval;
1390a7fcb78SPaul Blakey 
1400a7fcb78SPaul Blakey 	fmask = headers_c + soffset;
1410a7fcb78SPaul Blakey 	fval = headers_v + soffset;
1420a7fcb78SPaul Blakey 
14358ff18e1SSaeed Mahameed 	mask = (__force u32)(cpu_to_be32(mask)) >> (32 - (match_len * 8));
14458ff18e1SSaeed Mahameed 	data = (__force u32)(cpu_to_be32(data)) >> (32 - (match_len * 8));
1450a7fcb78SPaul Blakey 
1460a7fcb78SPaul Blakey 	memcpy(fmask, &mask, match_len);
1470a7fcb78SPaul Blakey 	memcpy(fval, &data, match_len);
1480a7fcb78SPaul Blakey 
1490a7fcb78SPaul Blakey 	spec->match_criteria_enable |= MLX5_MATCH_MISC_PARAMETERS_2;
1500a7fcb78SPaul Blakey }
1510a7fcb78SPaul Blakey 
1527e36feebSPaul Blakey void
1537e36feebSPaul Blakey mlx5e_tc_match_to_reg_get_match(struct mlx5_flow_spec *spec,
1547e36feebSPaul Blakey 				enum mlx5e_tc_attr_to_reg type,
1557e36feebSPaul Blakey 				u32 *data,
1567e36feebSPaul Blakey 				u32 *mask)
1577e36feebSPaul Blakey {
1587e36feebSPaul Blakey 	int soffset = mlx5e_tc_attr_to_reg_mappings[type].soffset;
1597e36feebSPaul Blakey 	int match_len = mlx5e_tc_attr_to_reg_mappings[type].mlen;
1607e36feebSPaul Blakey 	void *headers_c = spec->match_criteria;
1617e36feebSPaul Blakey 	void *headers_v = spec->match_value;
1627e36feebSPaul Blakey 	void *fmask, *fval;
1637e36feebSPaul Blakey 
1647e36feebSPaul Blakey 	fmask = headers_c + soffset;
1657e36feebSPaul Blakey 	fval = headers_v + soffset;
1667e36feebSPaul Blakey 
1677e36feebSPaul Blakey 	memcpy(mask, fmask, match_len);
1687e36feebSPaul Blakey 	memcpy(data, fval, match_len);
1697e36feebSPaul Blakey 
1707e36feebSPaul Blakey 	*mask = be32_to_cpu((__force __be32)(*mask << (32 - (match_len * 8))));
1717e36feebSPaul Blakey 	*data = be32_to_cpu((__force __be32)(*data << (32 - (match_len * 8))));
1727e36feebSPaul Blakey }
1737e36feebSPaul Blakey 
1740a7fcb78SPaul Blakey int
175c7b9038dSVlad Buslov mlx5e_tc_match_to_reg_set_and_get_id(struct mlx5_core_dev *mdev,
1760a7fcb78SPaul Blakey 				     struct mlx5e_tc_mod_hdr_acts *mod_hdr_acts,
177aedd133dSAriel Levkovich 				     enum mlx5_flow_namespace_type ns,
1780a7fcb78SPaul Blakey 				     enum mlx5e_tc_attr_to_reg type,
1790a7fcb78SPaul Blakey 				     u32 data)
1800a7fcb78SPaul Blakey {
1810a7fcb78SPaul Blakey 	int moffset = mlx5e_tc_attr_to_reg_mappings[type].moffset;
1820a7fcb78SPaul Blakey 	int mfield = mlx5e_tc_attr_to_reg_mappings[type].mfield;
1830a7fcb78SPaul Blakey 	int mlen = mlx5e_tc_attr_to_reg_mappings[type].mlen;
1840a7fcb78SPaul Blakey 	char *modact;
1850a7fcb78SPaul Blakey 	int err;
1860a7fcb78SPaul Blakey 
187aedd133dSAriel Levkovich 	err = alloc_mod_hdr_actions(mdev, ns, mod_hdr_acts);
1880a7fcb78SPaul Blakey 	if (err)
1890a7fcb78SPaul Blakey 		return err;
1900a7fcb78SPaul Blakey 
1910a7fcb78SPaul Blakey 	modact = mod_hdr_acts->actions +
1920a7fcb78SPaul Blakey 		 (mod_hdr_acts->num_actions * MLX5_MH_ACT_SZ);
1930a7fcb78SPaul Blakey 
1940a7fcb78SPaul Blakey 	/* Firmware has 5bit length field and 0 means 32bits */
1950a7fcb78SPaul Blakey 	if (mlen == 4)
1960a7fcb78SPaul Blakey 		mlen = 0;
1970a7fcb78SPaul Blakey 
1980a7fcb78SPaul Blakey 	MLX5_SET(set_action_in, modact, action_type, MLX5_ACTION_TYPE_SET);
1990a7fcb78SPaul Blakey 	MLX5_SET(set_action_in, modact, field, mfield);
2000a7fcb78SPaul Blakey 	MLX5_SET(set_action_in, modact, offset, moffset * 8);
2010a7fcb78SPaul Blakey 	MLX5_SET(set_action_in, modact, length, mlen * 8);
2020a7fcb78SPaul Blakey 	MLX5_SET(set_action_in, modact, data, data);
203c7b9038dSVlad Buslov 	err = mod_hdr_acts->num_actions;
2040a7fcb78SPaul Blakey 	mod_hdr_acts->num_actions++;
2050a7fcb78SPaul Blakey 
206c7b9038dSVlad Buslov 	return err;
2070a7fcb78SPaul Blakey }
2080a7fcb78SPaul Blakey 
209aedd133dSAriel Levkovich static struct mlx5_tc_ct_priv *
210aedd133dSAriel Levkovich get_ct_priv(struct mlx5e_priv *priv)
211aedd133dSAriel Levkovich {
212aedd133dSAriel Levkovich 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
213aedd133dSAriel Levkovich 	struct mlx5_rep_uplink_priv *uplink_priv;
214aedd133dSAriel Levkovich 	struct mlx5e_rep_priv *uplink_rpriv;
215aedd133dSAriel Levkovich 
216e8711402SLeon Romanovsky 	if (is_mdev_switchdev_mode(priv->mdev)) {
217aedd133dSAriel Levkovich 		uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
218aedd133dSAriel Levkovich 		uplink_priv = &uplink_rpriv->uplink_priv;
219aedd133dSAriel Levkovich 
220aedd133dSAriel Levkovich 		return uplink_priv->ct_priv;
221aedd133dSAriel Levkovich 	}
222aedd133dSAriel Levkovich 
223aedd133dSAriel Levkovich 	return priv->fs.tc.ct;
224aedd133dSAriel Levkovich }
225aedd133dSAriel Levkovich 
226f94d6389SChris Mi #if IS_ENABLED(CONFIG_MLX5_TC_SAMPLE)
227f94d6389SChris Mi static struct mlx5_esw_psample *
228f94d6389SChris Mi get_sample_priv(struct mlx5e_priv *priv)
229f94d6389SChris Mi {
230f94d6389SChris Mi 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
231f94d6389SChris Mi 	struct mlx5_rep_uplink_priv *uplink_priv;
232f94d6389SChris Mi 	struct mlx5e_rep_priv *uplink_rpriv;
233f94d6389SChris Mi 
234f94d6389SChris Mi 	if (is_mdev_switchdev_mode(priv->mdev)) {
235f94d6389SChris Mi 		uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
236f94d6389SChris Mi 		uplink_priv = &uplink_rpriv->uplink_priv;
237f94d6389SChris Mi 
238f94d6389SChris Mi 		return uplink_priv->esw_psample;
239f94d6389SChris Mi 	}
240f94d6389SChris Mi 
241f94d6389SChris Mi 	return NULL;
242f94d6389SChris Mi }
243f94d6389SChris Mi #endif
244f94d6389SChris Mi 
245aedd133dSAriel Levkovich struct mlx5_flow_handle *
246aedd133dSAriel Levkovich mlx5_tc_rule_insert(struct mlx5e_priv *priv,
247aedd133dSAriel Levkovich 		    struct mlx5_flow_spec *spec,
248aedd133dSAriel Levkovich 		    struct mlx5_flow_attr *attr)
249aedd133dSAriel Levkovich {
250aedd133dSAriel Levkovich 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
251aedd133dSAriel Levkovich 
252e8711402SLeon Romanovsky 	if (is_mdev_switchdev_mode(priv->mdev))
253aedd133dSAriel Levkovich 		return mlx5_eswitch_add_offloaded_rule(esw, spec, attr);
254aedd133dSAriel Levkovich 
255aedd133dSAriel Levkovich 	return	mlx5e_add_offloaded_nic_rule(priv, spec, attr);
256aedd133dSAriel Levkovich }
257aedd133dSAriel Levkovich 
258aedd133dSAriel Levkovich void
259aedd133dSAriel Levkovich mlx5_tc_rule_delete(struct mlx5e_priv *priv,
260aedd133dSAriel Levkovich 		    struct mlx5_flow_handle *rule,
261aedd133dSAriel Levkovich 		    struct mlx5_flow_attr *attr)
262aedd133dSAriel Levkovich {
263aedd133dSAriel Levkovich 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
264aedd133dSAriel Levkovich 
265e8711402SLeon Romanovsky 	if (is_mdev_switchdev_mode(priv->mdev)) {
266aedd133dSAriel Levkovich 		mlx5_eswitch_del_offloaded_rule(esw, rule, attr);
267aedd133dSAriel Levkovich 
268aedd133dSAriel Levkovich 		return;
269aedd133dSAriel Levkovich 	}
270aedd133dSAriel Levkovich 
271aedd133dSAriel Levkovich 	mlx5e_del_offloaded_nic_rule(priv, rule, attr);
272aedd133dSAriel Levkovich }
273aedd133dSAriel Levkovich 
274c7b9038dSVlad Buslov int
275c7b9038dSVlad Buslov mlx5e_tc_match_to_reg_set(struct mlx5_core_dev *mdev,
276c7b9038dSVlad Buslov 			  struct mlx5e_tc_mod_hdr_acts *mod_hdr_acts,
277c7b9038dSVlad Buslov 			  enum mlx5_flow_namespace_type ns,
278c7b9038dSVlad Buslov 			  enum mlx5e_tc_attr_to_reg type,
279c7b9038dSVlad Buslov 			  u32 data)
280c7b9038dSVlad Buslov {
281c7b9038dSVlad Buslov 	int ret = mlx5e_tc_match_to_reg_set_and_get_id(mdev, mod_hdr_acts, ns, type, data);
282c7b9038dSVlad Buslov 
283c7b9038dSVlad Buslov 	return ret < 0 ? ret : 0;
284c7b9038dSVlad Buslov }
285c7b9038dSVlad Buslov 
286c7b9038dSVlad Buslov void mlx5e_tc_match_to_reg_mod_hdr_change(struct mlx5_core_dev *mdev,
287c7b9038dSVlad Buslov 					  struct mlx5e_tc_mod_hdr_acts *mod_hdr_acts,
288c7b9038dSVlad Buslov 					  enum mlx5e_tc_attr_to_reg type,
289c7b9038dSVlad Buslov 					  int act_id, u32 data)
290c7b9038dSVlad Buslov {
291c7b9038dSVlad Buslov 	int moffset = mlx5e_tc_attr_to_reg_mappings[type].moffset;
292c7b9038dSVlad Buslov 	int mfield = mlx5e_tc_attr_to_reg_mappings[type].mfield;
293c7b9038dSVlad Buslov 	int mlen = mlx5e_tc_attr_to_reg_mappings[type].mlen;
294c7b9038dSVlad Buslov 	char *modact;
295c7b9038dSVlad Buslov 
296c7b9038dSVlad Buslov 	modact = mod_hdr_acts->actions + (act_id * MLX5_MH_ACT_SZ);
297c7b9038dSVlad Buslov 
298c7b9038dSVlad Buslov 	/* Firmware has 5bit length field and 0 means 32bits */
299c7b9038dSVlad Buslov 	if (mlen == 4)
300c7b9038dSVlad Buslov 		mlen = 0;
301c7b9038dSVlad Buslov 
302c7b9038dSVlad Buslov 	MLX5_SET(set_action_in, modact, action_type, MLX5_ACTION_TYPE_SET);
303c7b9038dSVlad Buslov 	MLX5_SET(set_action_in, modact, field, mfield);
304c7b9038dSVlad Buslov 	MLX5_SET(set_action_in, modact, offset, moffset * 8);
305c7b9038dSVlad Buslov 	MLX5_SET(set_action_in, modact, length, mlen * 8);
306c7b9038dSVlad Buslov 	MLX5_SET(set_action_in, modact, data, data);
307c7b9038dSVlad Buslov }
308c7b9038dSVlad Buslov 
30977ab67b7SOr Gerlitz struct mlx5e_hairpin {
31077ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
31177ab67b7SOr Gerlitz 
31277ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev;
3133f6d08d1SOr Gerlitz 	struct mlx5e_priv *func_priv;
31477ab67b7SOr Gerlitz 	u32 tdn;
31577ab67b7SOr Gerlitz 	u32 tirn;
3163f6d08d1SOr Gerlitz 
3173f6d08d1SOr Gerlitz 	int num_channels;
3183f6d08d1SOr Gerlitz 	struct mlx5e_rqt indir_rqt;
3193f6d08d1SOr Gerlitz 	u32 indir_tirn[MLX5E_NUM_INDIR_TIRS];
3203f6d08d1SOr Gerlitz 	struct mlx5e_ttc_table ttc;
32177ab67b7SOr Gerlitz };
32277ab67b7SOr Gerlitz 
3235c65c564SOr Gerlitz struct mlx5e_hairpin_entry {
3245c65c564SOr Gerlitz 	/* a node of a hash table which keeps all the  hairpin entries */
3255c65c564SOr Gerlitz 	struct hlist_node hairpin_hlist;
3265c65c564SOr Gerlitz 
32773edca73SVlad Buslov 	/* protects flows list */
32873edca73SVlad Buslov 	spinlock_t flows_lock;
3295c65c564SOr Gerlitz 	/* flows sharing the same hairpin */
3305c65c564SOr Gerlitz 	struct list_head flows;
331db76ca24SVlad Buslov 	/* hpe's that were not fully initialized when dead peer update event
332db76ca24SVlad Buslov 	 * function traversed them.
333db76ca24SVlad Buslov 	 */
334db76ca24SVlad Buslov 	struct list_head dead_peer_wait_list;
3355c65c564SOr Gerlitz 
336d8822868SOr Gerlitz 	u16 peer_vhca_id;
337106be53bSOr Gerlitz 	u8 prio;
3385c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
339e4f9abbdSVlad Buslov 	refcount_t refcnt;
340db76ca24SVlad Buslov 	struct completion res_ready;
3415c65c564SOr Gerlitz };
3425c65c564SOr Gerlitz 
3435a7e5bcbSVlad Buslov static void mlx5e_tc_del_flow(struct mlx5e_priv *priv,
3445a7e5bcbSVlad Buslov 			      struct mlx5e_tc_flow *flow);
3455a7e5bcbSVlad Buslov 
3460d9f9647SVlad Buslov struct mlx5e_tc_flow *mlx5e_flow_get(struct mlx5e_tc_flow *flow)
3475a7e5bcbSVlad Buslov {
3485a7e5bcbSVlad Buslov 	if (!flow || !refcount_inc_not_zero(&flow->refcnt))
3495a7e5bcbSVlad Buslov 		return ERR_PTR(-EINVAL);
3505a7e5bcbSVlad Buslov 	return flow;
3515a7e5bcbSVlad Buslov }
3525a7e5bcbSVlad Buslov 
3530d9f9647SVlad Buslov void mlx5e_flow_put(struct mlx5e_priv *priv, struct mlx5e_tc_flow *flow)
3545a7e5bcbSVlad Buslov {
3555a7e5bcbSVlad Buslov 	if (refcount_dec_and_test(&flow->refcnt)) {
3565a7e5bcbSVlad Buslov 		mlx5e_tc_del_flow(priv, flow);
357c5d326b2SVlad Buslov 		kfree_rcu(flow, rcu_head);
3585a7e5bcbSVlad Buslov 	}
3595a7e5bcbSVlad Buslov }
3605a7e5bcbSVlad Buslov 
361aedd133dSAriel Levkovich bool mlx5e_is_eswitch_flow(struct mlx5e_tc_flow *flow)
362226f2ca3SVlad Buslov {
363226f2ca3SVlad Buslov 	return flow_flag_test(flow, ESWITCH);
364226f2ca3SVlad Buslov }
365226f2ca3SVlad Buslov 
36684179981SPaul Blakey static bool mlx5e_is_ft_flow(struct mlx5e_tc_flow *flow)
36784179981SPaul Blakey {
36884179981SPaul Blakey 	return flow_flag_test(flow, FT);
36984179981SPaul Blakey }
37084179981SPaul Blakey 
3710d9f9647SVlad Buslov bool mlx5e_is_offloaded_flow(struct mlx5e_tc_flow *flow)
372226f2ca3SVlad Buslov {
373226f2ca3SVlad Buslov 	return flow_flag_test(flow, OFFLOADED);
374226f2ca3SVlad Buslov }
375226f2ca3SVlad Buslov 
376d2faae25SVlad Buslov static int get_flow_name_space(struct mlx5e_tc_flow *flow)
377d2faae25SVlad Buslov {
378d2faae25SVlad Buslov 	return mlx5e_is_eswitch_flow(flow) ?
379d2faae25SVlad Buslov 		MLX5_FLOW_NAMESPACE_FDB : MLX5_FLOW_NAMESPACE_KERNEL;
380d2faae25SVlad Buslov }
381b2fdf3d0SPaul Blakey 
382b2fdf3d0SPaul Blakey static struct mod_hdr_tbl *
383b2fdf3d0SPaul Blakey get_mod_hdr_table(struct mlx5e_priv *priv, struct mlx5e_tc_flow *flow)
384b2fdf3d0SPaul Blakey {
385b2fdf3d0SPaul Blakey 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
386b2fdf3d0SPaul Blakey 
387b2fdf3d0SPaul Blakey 	return get_flow_name_space(flow) == MLX5_FLOW_NAMESPACE_FDB ?
388b2fdf3d0SPaul Blakey 		&esw->offloads.mod_hdr :
389b2fdf3d0SPaul Blakey 		&priv->fs.tc.mod_hdr;
390b2fdf3d0SPaul Blakey }
391b2fdf3d0SPaul Blakey 
39211c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv,
39311c9c548SOr Gerlitz 				struct mlx5e_tc_flow *flow,
39411c9c548SOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr)
39511c9c548SOr Gerlitz {
396b2fdf3d0SPaul Blakey 	struct mlx5_modify_hdr *modify_hdr;
397b2fdf3d0SPaul Blakey 	struct mlx5e_mod_hdr_handle *mh;
39811c9c548SOr Gerlitz 
399b2fdf3d0SPaul Blakey 	mh = mlx5e_mod_hdr_attach(priv->mdev, get_mod_hdr_table(priv, flow),
400b2fdf3d0SPaul Blakey 				  get_flow_name_space(flow),
401b2fdf3d0SPaul Blakey 				  &parse_attr->mod_hdr_acts);
402b2fdf3d0SPaul Blakey 	if (IS_ERR(mh))
403b2fdf3d0SPaul Blakey 		return PTR_ERR(mh);
40411c9c548SOr Gerlitz 
405b2fdf3d0SPaul Blakey 	modify_hdr = mlx5e_mod_hdr_get(mh);
406c620b772SAriel Levkovich 	flow->attr->modify_hdr = modify_hdr;
407b2fdf3d0SPaul Blakey 	flow->mh = mh;
40811c9c548SOr Gerlitz 
40911c9c548SOr Gerlitz 	return 0;
41011c9c548SOr Gerlitz }
41111c9c548SOr Gerlitz 
41211c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv,
41311c9c548SOr Gerlitz 				 struct mlx5e_tc_flow *flow)
41411c9c548SOr Gerlitz {
4155a7e5bcbSVlad Buslov 	/* flow wasn't fully initialized */
416dd58edc3SVlad Buslov 	if (!flow->mh)
4175a7e5bcbSVlad Buslov 		return;
4185a7e5bcbSVlad Buslov 
419b2fdf3d0SPaul Blakey 	mlx5e_mod_hdr_detach(priv->mdev, get_mod_hdr_table(priv, flow),
420b2fdf3d0SPaul Blakey 			     flow->mh);
421dd58edc3SVlad Buslov 	flow->mh = NULL;
42211c9c548SOr Gerlitz }
42311c9c548SOr Gerlitz 
42477ab67b7SOr Gerlitz static
42577ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex)
42677ab67b7SOr Gerlitz {
42777ab67b7SOr Gerlitz 	struct net_device *netdev;
42877ab67b7SOr Gerlitz 	struct mlx5e_priv *priv;
42977ab67b7SOr Gerlitz 
43077ab67b7SOr Gerlitz 	netdev = __dev_get_by_index(net, ifindex);
43177ab67b7SOr Gerlitz 	priv = netdev_priv(netdev);
43277ab67b7SOr Gerlitz 	return priv->mdev;
43377ab67b7SOr Gerlitz }
43477ab67b7SOr Gerlitz 
43577ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp)
43677ab67b7SOr Gerlitz {
437e0b4b472SLeon Romanovsky 	u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {};
43877ab67b7SOr Gerlitz 	void *tirc;
43977ab67b7SOr Gerlitz 	int err;
44077ab67b7SOr Gerlitz 
44177ab67b7SOr Gerlitz 	err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn);
44277ab67b7SOr Gerlitz 	if (err)
44377ab67b7SOr Gerlitz 		goto alloc_tdn_err;
44477ab67b7SOr Gerlitz 
44577ab67b7SOr Gerlitz 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
44677ab67b7SOr Gerlitz 
44777ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT);
448ddae74acSOr Gerlitz 	MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]);
44977ab67b7SOr Gerlitz 	MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
45077ab67b7SOr Gerlitz 
451e0b4b472SLeon Romanovsky 	err = mlx5_core_create_tir(hp->func_mdev, in, &hp->tirn);
45277ab67b7SOr Gerlitz 	if (err)
45377ab67b7SOr Gerlitz 		goto create_tir_err;
45477ab67b7SOr Gerlitz 
45577ab67b7SOr Gerlitz 	return 0;
45677ab67b7SOr Gerlitz 
45777ab67b7SOr Gerlitz create_tir_err:
45877ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
45977ab67b7SOr Gerlitz alloc_tdn_err:
46077ab67b7SOr Gerlitz 	return err;
46177ab67b7SOr Gerlitz }
46277ab67b7SOr Gerlitz 
46377ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp)
46477ab67b7SOr Gerlitz {
46577ab67b7SOr Gerlitz 	mlx5_core_destroy_tir(hp->func_mdev, hp->tirn);
46677ab67b7SOr Gerlitz 	mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn);
46777ab67b7SOr Gerlitz }
46877ab67b7SOr Gerlitz 
4692119bda6SArnd Bergmann static int mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc)
4703f6d08d1SOr Gerlitz {
4713f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4723f6d08d1SOr Gerlitz 	int i, ix, sz = MLX5E_INDIR_RQT_SIZE;
4736def6e47SSaeed Mahameed 	u32 *indirection_rqt, rqn;
4743f6d08d1SOr Gerlitz 
4756def6e47SSaeed Mahameed 	indirection_rqt = kcalloc(sz, sizeof(*indirection_rqt), GFP_KERNEL);
4762119bda6SArnd Bergmann 	if (!indirection_rqt)
4772119bda6SArnd Bergmann 		return -ENOMEM;
4782119bda6SArnd Bergmann 
4793f6d08d1SOr Gerlitz 	mlx5e_build_default_indir_rqt(indirection_rqt, sz,
4803f6d08d1SOr Gerlitz 				      hp->num_channels);
4813f6d08d1SOr Gerlitz 
4823f6d08d1SOr Gerlitz 	for (i = 0; i < sz; i++) {
4833f6d08d1SOr Gerlitz 		ix = i;
484bbeb53b8SAya Levin 		if (priv->rss_params.hfunc == ETH_RSS_HASH_XOR)
4853f6d08d1SOr Gerlitz 			ix = mlx5e_bits_invert(i, ilog2(sz));
4863f6d08d1SOr Gerlitz 		ix = indirection_rqt[ix];
4873f6d08d1SOr Gerlitz 		rqn = hp->pair->rqn[ix];
4883f6d08d1SOr Gerlitz 		MLX5_SET(rqtc, rqtc, rq_num[i], rqn);
4893f6d08d1SOr Gerlitz 	}
4902119bda6SArnd Bergmann 
4912119bda6SArnd Bergmann 	kfree(indirection_rqt);
4922119bda6SArnd Bergmann 	return 0;
4933f6d08d1SOr Gerlitz }
4943f6d08d1SOr Gerlitz 
4953f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp)
4963f6d08d1SOr Gerlitz {
4973f6d08d1SOr Gerlitz 	int inlen, err, sz = MLX5E_INDIR_RQT_SIZE;
4983f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
4993f6d08d1SOr Gerlitz 	struct mlx5_core_dev *mdev = priv->mdev;
5003f6d08d1SOr Gerlitz 	void *rqtc;
5013f6d08d1SOr Gerlitz 	u32 *in;
5023f6d08d1SOr Gerlitz 
5033f6d08d1SOr Gerlitz 	inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz;
5043f6d08d1SOr Gerlitz 	in = kvzalloc(inlen, GFP_KERNEL);
5053f6d08d1SOr Gerlitz 	if (!in)
5063f6d08d1SOr Gerlitz 		return -ENOMEM;
5073f6d08d1SOr Gerlitz 
5083f6d08d1SOr Gerlitz 	rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context);
5093f6d08d1SOr Gerlitz 
5103f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_actual_size, sz);
5113f6d08d1SOr Gerlitz 	MLX5_SET(rqtc, rqtc, rqt_max_size, sz);
5123f6d08d1SOr Gerlitz 
5132119bda6SArnd Bergmann 	err = mlx5e_hairpin_fill_rqt_rqns(hp, rqtc);
5142119bda6SArnd Bergmann 	if (err)
5152119bda6SArnd Bergmann 		goto out;
5163f6d08d1SOr Gerlitz 
5173f6d08d1SOr Gerlitz 	err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn);
5183f6d08d1SOr Gerlitz 	if (!err)
5193f6d08d1SOr Gerlitz 		hp->indir_rqt.enabled = true;
5203f6d08d1SOr Gerlitz 
5212119bda6SArnd Bergmann out:
5223f6d08d1SOr Gerlitz 	kvfree(in);
5233f6d08d1SOr Gerlitz 	return err;
5243f6d08d1SOr Gerlitz }
5253f6d08d1SOr Gerlitz 
5263f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp)
5273f6d08d1SOr Gerlitz {
5283f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
5293f6d08d1SOr Gerlitz 	u32 in[MLX5_ST_SZ_DW(create_tir_in)];
5303f6d08d1SOr Gerlitz 	int tt, i, err;
5313f6d08d1SOr Gerlitz 	void *tirc;
5323f6d08d1SOr Gerlitz 
5333f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) {
534d930ac79SAya Levin 		struct mlx5e_tirc_config ttconfig = mlx5e_tirc_get_default_config(tt);
535d930ac79SAya Levin 
5363f6d08d1SOr Gerlitz 		memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in));
5373f6d08d1SOr Gerlitz 		tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
5383f6d08d1SOr Gerlitz 
5393f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, transport_domain, hp->tdn);
5403f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT);
5413f6d08d1SOr Gerlitz 		MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn);
542bbeb53b8SAya Levin 		mlx5e_build_indir_tir_ctx_hash(&priv->rss_params, &ttconfig, tirc, false);
543bbeb53b8SAya Levin 
5443f6d08d1SOr Gerlitz 		err = mlx5_core_create_tir(hp->func_mdev, in,
545e0b4b472SLeon Romanovsky 					   &hp->indir_tirn[tt]);
5463f6d08d1SOr Gerlitz 		if (err) {
5473f6d08d1SOr Gerlitz 			mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err);
5483f6d08d1SOr Gerlitz 			goto err_destroy_tirs;
5493f6d08d1SOr Gerlitz 		}
5503f6d08d1SOr Gerlitz 	}
5513f6d08d1SOr Gerlitz 	return 0;
5523f6d08d1SOr Gerlitz 
5533f6d08d1SOr Gerlitz err_destroy_tirs:
5543f6d08d1SOr Gerlitz 	for (i = 0; i < tt; i++)
5553f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]);
5563f6d08d1SOr Gerlitz 	return err;
5573f6d08d1SOr Gerlitz }
5583f6d08d1SOr Gerlitz 
5593f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp)
5603f6d08d1SOr Gerlitz {
5613f6d08d1SOr Gerlitz 	int tt;
5623f6d08d1SOr Gerlitz 
5633f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
5643f6d08d1SOr Gerlitz 		mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]);
5653f6d08d1SOr Gerlitz }
5663f6d08d1SOr Gerlitz 
5673f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp,
5683f6d08d1SOr Gerlitz 					 struct ttc_params *ttc_params)
5693f6d08d1SOr Gerlitz {
5703f6d08d1SOr Gerlitz 	struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
5713f6d08d1SOr Gerlitz 	int tt;
5723f6d08d1SOr Gerlitz 
5733f6d08d1SOr Gerlitz 	memset(ttc_params, 0, sizeof(*ttc_params));
5743f6d08d1SOr Gerlitz 
5753f6d08d1SOr Gerlitz 	ttc_params->any_tt_tirn = hp->tirn;
5763f6d08d1SOr Gerlitz 
5773f6d08d1SOr Gerlitz 	for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
5783f6d08d1SOr Gerlitz 		ttc_params->indir_tirn[tt] = hp->indir_tirn[tt];
5793f6d08d1SOr Gerlitz 
5806412bb39SEli Cohen 	ft_attr->max_fte = MLX5E_TTC_TABLE_SIZE;
5813f6d08d1SOr Gerlitz 	ft_attr->level = MLX5E_TC_TTC_FT_LEVEL;
5823f6d08d1SOr Gerlitz 	ft_attr->prio = MLX5E_TC_PRIO;
5833f6d08d1SOr Gerlitz }
5843f6d08d1SOr Gerlitz 
5853f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp)
5863f6d08d1SOr Gerlitz {
5873f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
5883f6d08d1SOr Gerlitz 	struct ttc_params ttc_params;
5893f6d08d1SOr Gerlitz 	int err;
5903f6d08d1SOr Gerlitz 
5913f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_rqt(hp);
5923f6d08d1SOr Gerlitz 	if (err)
5933f6d08d1SOr Gerlitz 		return err;
5943f6d08d1SOr Gerlitz 
5953f6d08d1SOr Gerlitz 	err = mlx5e_hairpin_create_indirect_tirs(hp);
5963f6d08d1SOr Gerlitz 	if (err)
5973f6d08d1SOr Gerlitz 		goto err_create_indirect_tirs;
5983f6d08d1SOr Gerlitz 
5993f6d08d1SOr Gerlitz 	mlx5e_hairpin_set_ttc_params(hp, &ttc_params);
6003f6d08d1SOr Gerlitz 	err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc);
6013f6d08d1SOr Gerlitz 	if (err)
6023f6d08d1SOr Gerlitz 		goto err_create_ttc_table;
6033f6d08d1SOr Gerlitz 
6043f6d08d1SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n",
6053f6d08d1SOr Gerlitz 		   hp->num_channels, hp->ttc.ft.t->id);
6063f6d08d1SOr Gerlitz 
6073f6d08d1SOr Gerlitz 	return 0;
6083f6d08d1SOr Gerlitz 
6093f6d08d1SOr Gerlitz err_create_ttc_table:
6103f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
6113f6d08d1SOr Gerlitz err_create_indirect_tirs:
6123f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
6133f6d08d1SOr Gerlitz 
6143f6d08d1SOr Gerlitz 	return err;
6153f6d08d1SOr Gerlitz }
6163f6d08d1SOr Gerlitz 
6173f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp)
6183f6d08d1SOr Gerlitz {
6193f6d08d1SOr Gerlitz 	struct mlx5e_priv *priv = hp->func_priv;
6203f6d08d1SOr Gerlitz 
6213f6d08d1SOr Gerlitz 	mlx5e_destroy_ttc_table(priv, &hp->ttc);
6223f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_indirect_tirs(hp);
6233f6d08d1SOr Gerlitz 	mlx5e_destroy_rqt(priv, &hp->indir_rqt);
6243f6d08d1SOr Gerlitz }
6253f6d08d1SOr Gerlitz 
62677ab67b7SOr Gerlitz static struct mlx5e_hairpin *
62777ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params,
62877ab67b7SOr Gerlitz 		     int peer_ifindex)
62977ab67b7SOr Gerlitz {
63077ab67b7SOr Gerlitz 	struct mlx5_core_dev *func_mdev, *peer_mdev;
63177ab67b7SOr Gerlitz 	struct mlx5e_hairpin *hp;
63277ab67b7SOr Gerlitz 	struct mlx5_hairpin *pair;
63377ab67b7SOr Gerlitz 	int err;
63477ab67b7SOr Gerlitz 
63577ab67b7SOr Gerlitz 	hp = kzalloc(sizeof(*hp), GFP_KERNEL);
63677ab67b7SOr Gerlitz 	if (!hp)
63777ab67b7SOr Gerlitz 		return ERR_PTR(-ENOMEM);
63877ab67b7SOr Gerlitz 
63977ab67b7SOr Gerlitz 	func_mdev = priv->mdev;
64077ab67b7SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
64177ab67b7SOr Gerlitz 
64277ab67b7SOr Gerlitz 	pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params);
64377ab67b7SOr Gerlitz 	if (IS_ERR(pair)) {
64477ab67b7SOr Gerlitz 		err = PTR_ERR(pair);
64577ab67b7SOr Gerlitz 		goto create_pair_err;
64677ab67b7SOr Gerlitz 	}
64777ab67b7SOr Gerlitz 	hp->pair = pair;
64877ab67b7SOr Gerlitz 	hp->func_mdev = func_mdev;
6493f6d08d1SOr Gerlitz 	hp->func_priv = priv;
6503f6d08d1SOr Gerlitz 	hp->num_channels = params->num_channels;
65177ab67b7SOr Gerlitz 
65277ab67b7SOr Gerlitz 	err = mlx5e_hairpin_create_transport(hp);
65377ab67b7SOr Gerlitz 	if (err)
65477ab67b7SOr Gerlitz 		goto create_transport_err;
65577ab67b7SOr Gerlitz 
6563f6d08d1SOr Gerlitz 	if (hp->num_channels > 1) {
6573f6d08d1SOr Gerlitz 		err = mlx5e_hairpin_rss_init(hp);
6583f6d08d1SOr Gerlitz 		if (err)
6593f6d08d1SOr Gerlitz 			goto rss_init_err;
6603f6d08d1SOr Gerlitz 	}
6613f6d08d1SOr Gerlitz 
66277ab67b7SOr Gerlitz 	return hp;
66377ab67b7SOr Gerlitz 
6643f6d08d1SOr Gerlitz rss_init_err:
6653f6d08d1SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
66677ab67b7SOr Gerlitz create_transport_err:
66777ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
66877ab67b7SOr Gerlitz create_pair_err:
66977ab67b7SOr Gerlitz 	kfree(hp);
67077ab67b7SOr Gerlitz 	return ERR_PTR(err);
67177ab67b7SOr Gerlitz }
67277ab67b7SOr Gerlitz 
67377ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp)
67477ab67b7SOr Gerlitz {
6753f6d08d1SOr Gerlitz 	if (hp->num_channels > 1)
6763f6d08d1SOr Gerlitz 		mlx5e_hairpin_rss_cleanup(hp);
67777ab67b7SOr Gerlitz 	mlx5e_hairpin_destroy_transport(hp);
67877ab67b7SOr Gerlitz 	mlx5_core_hairpin_destroy(hp->pair);
67977ab67b7SOr Gerlitz 	kvfree(hp);
68077ab67b7SOr Gerlitz }
68177ab67b7SOr Gerlitz 
682106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio)
683106be53bSOr Gerlitz {
684106be53bSOr Gerlitz 	return (peer_vhca_id << 16 | prio);
685106be53bSOr Gerlitz }
686106be53bSOr Gerlitz 
6875c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv,
688106be53bSOr Gerlitz 						     u16 peer_vhca_id, u8 prio)
6895c65c564SOr Gerlitz {
6905c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
691106be53bSOr Gerlitz 	u32 hash_key = hash_hairpin_info(peer_vhca_id, prio);
6925c65c564SOr Gerlitz 
6935c65c564SOr Gerlitz 	hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe,
694106be53bSOr Gerlitz 			       hairpin_hlist, hash_key) {
695e4f9abbdSVlad Buslov 		if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio) {
696e4f9abbdSVlad Buslov 			refcount_inc(&hpe->refcnt);
6975c65c564SOr Gerlitz 			return hpe;
6985c65c564SOr Gerlitz 		}
699e4f9abbdSVlad Buslov 	}
7005c65c564SOr Gerlitz 
7015c65c564SOr Gerlitz 	return NULL;
7025c65c564SOr Gerlitz }
7035c65c564SOr Gerlitz 
704e4f9abbdSVlad Buslov static void mlx5e_hairpin_put(struct mlx5e_priv *priv,
705e4f9abbdSVlad Buslov 			      struct mlx5e_hairpin_entry *hpe)
706e4f9abbdSVlad Buslov {
707e4f9abbdSVlad Buslov 	/* no more hairpin flows for us, release the hairpin pair */
708b32accdaSVlad Buslov 	if (!refcount_dec_and_mutex_lock(&hpe->refcnt, &priv->fs.tc.hairpin_tbl_lock))
709e4f9abbdSVlad Buslov 		return;
710b32accdaSVlad Buslov 	hash_del(&hpe->hairpin_hlist);
711b32accdaSVlad Buslov 	mutex_unlock(&priv->fs.tc.hairpin_tbl_lock);
712e4f9abbdSVlad Buslov 
713db76ca24SVlad Buslov 	if (!IS_ERR_OR_NULL(hpe->hp)) {
714e4f9abbdSVlad Buslov 		netdev_dbg(priv->netdev, "del hairpin: peer %s\n",
715e4f9abbdSVlad Buslov 			   dev_name(hpe->hp->pair->peer_mdev->device));
716e4f9abbdSVlad Buslov 
717e4f9abbdSVlad Buslov 		mlx5e_hairpin_destroy(hpe->hp);
718db76ca24SVlad Buslov 	}
719db76ca24SVlad Buslov 
720db76ca24SVlad Buslov 	WARN_ON(!list_empty(&hpe->flows));
721e4f9abbdSVlad Buslov 	kfree(hpe);
722e4f9abbdSVlad Buslov }
723e4f9abbdSVlad Buslov 
724106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8
725106be53bSOr Gerlitz 
726106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv,
727e98bedf5SEli Britstein 				  struct mlx5_flow_spec *spec, u8 *match_prio,
728e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
729106be53bSOr Gerlitz {
730106be53bSOr Gerlitz 	void *headers_c, *headers_v;
731106be53bSOr Gerlitz 	u8 prio_val, prio_mask = 0;
732106be53bSOr Gerlitz 	bool vlan_present;
733106be53bSOr Gerlitz 
734106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB
735106be53bSOr Gerlitz 	if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) {
736e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
737e98bedf5SEli Britstein 				   "only PCP trust state supported for hairpin");
738106be53bSOr Gerlitz 		return -EOPNOTSUPP;
739106be53bSOr Gerlitz 	}
740106be53bSOr Gerlitz #endif
741106be53bSOr Gerlitz 	headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers);
742106be53bSOr Gerlitz 	headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
743106be53bSOr Gerlitz 
744106be53bSOr Gerlitz 	vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag);
745106be53bSOr Gerlitz 	if (vlan_present) {
746106be53bSOr Gerlitz 		prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio);
747106be53bSOr Gerlitz 		prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio);
748106be53bSOr Gerlitz 	}
749106be53bSOr Gerlitz 
750106be53bSOr Gerlitz 	if (!vlan_present || !prio_mask) {
751106be53bSOr Gerlitz 		prio_val = UNKNOWN_MATCH_PRIO;
752106be53bSOr Gerlitz 	} else if (prio_mask != 0x7) {
753e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
754e98bedf5SEli Britstein 				   "masked priority match not supported for hairpin");
755106be53bSOr Gerlitz 		return -EOPNOTSUPP;
756106be53bSOr Gerlitz 	}
757106be53bSOr Gerlitz 
758106be53bSOr Gerlitz 	*match_prio = prio_val;
759106be53bSOr Gerlitz 	return 0;
760106be53bSOr Gerlitz }
761106be53bSOr Gerlitz 
7625c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv,
7635c65c564SOr Gerlitz 				  struct mlx5e_tc_flow *flow,
764e98bedf5SEli Britstein 				  struct mlx5e_tc_flow_parse_attr *parse_attr,
765e98bedf5SEli Britstein 				  struct netlink_ext_ack *extack)
7665c65c564SOr Gerlitz {
76798b66cb1SEli Britstein 	int peer_ifindex = parse_attr->mirred_ifindex[0];
7685c65c564SOr Gerlitz 	struct mlx5_hairpin_params params;
769d8822868SOr Gerlitz 	struct mlx5_core_dev *peer_mdev;
7705c65c564SOr Gerlitz 	struct mlx5e_hairpin_entry *hpe;
7715c65c564SOr Gerlitz 	struct mlx5e_hairpin *hp;
7723f6d08d1SOr Gerlitz 	u64 link_speed64;
7733f6d08d1SOr Gerlitz 	u32 link_speed;
774106be53bSOr Gerlitz 	u8 match_prio;
775d8822868SOr Gerlitz 	u16 peer_id;
7765c65c564SOr Gerlitz 	int err;
7775c65c564SOr Gerlitz 
778d8822868SOr Gerlitz 	peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex);
779d8822868SOr Gerlitz 	if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) {
780e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported");
7815c65c564SOr Gerlitz 		return -EOPNOTSUPP;
7825c65c564SOr Gerlitz 	}
7835c65c564SOr Gerlitz 
784d8822868SOr Gerlitz 	peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
785e98bedf5SEli Britstein 	err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio,
786e98bedf5SEli Britstein 				     extack);
787106be53bSOr Gerlitz 	if (err)
788106be53bSOr Gerlitz 		return err;
789b32accdaSVlad Buslov 
790b32accdaSVlad Buslov 	mutex_lock(&priv->fs.tc.hairpin_tbl_lock);
791106be53bSOr Gerlitz 	hpe = mlx5e_hairpin_get(priv, peer_id, match_prio);
792db76ca24SVlad Buslov 	if (hpe) {
793db76ca24SVlad Buslov 		mutex_unlock(&priv->fs.tc.hairpin_tbl_lock);
794db76ca24SVlad Buslov 		wait_for_completion(&hpe->res_ready);
795db76ca24SVlad Buslov 
796db76ca24SVlad Buslov 		if (IS_ERR(hpe->hp)) {
797db76ca24SVlad Buslov 			err = -EREMOTEIO;
798db76ca24SVlad Buslov 			goto out_err;
799db76ca24SVlad Buslov 		}
8005c65c564SOr Gerlitz 		goto attach_flow;
801db76ca24SVlad Buslov 	}
8025c65c564SOr Gerlitz 
8035c65c564SOr Gerlitz 	hpe = kzalloc(sizeof(*hpe), GFP_KERNEL);
804b32accdaSVlad Buslov 	if (!hpe) {
805db76ca24SVlad Buslov 		mutex_unlock(&priv->fs.tc.hairpin_tbl_lock);
806db76ca24SVlad Buslov 		return -ENOMEM;
807b32accdaSVlad Buslov 	}
8085c65c564SOr Gerlitz 
80973edca73SVlad Buslov 	spin_lock_init(&hpe->flows_lock);
8105c65c564SOr Gerlitz 	INIT_LIST_HEAD(&hpe->flows);
811db76ca24SVlad Buslov 	INIT_LIST_HEAD(&hpe->dead_peer_wait_list);
812d8822868SOr Gerlitz 	hpe->peer_vhca_id = peer_id;
813106be53bSOr Gerlitz 	hpe->prio = match_prio;
814e4f9abbdSVlad Buslov 	refcount_set(&hpe->refcnt, 1);
815db76ca24SVlad Buslov 	init_completion(&hpe->res_ready);
816db76ca24SVlad Buslov 
817db76ca24SVlad Buslov 	hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist,
818db76ca24SVlad Buslov 		 hash_hairpin_info(peer_id, match_prio));
819db76ca24SVlad Buslov 	mutex_unlock(&priv->fs.tc.hairpin_tbl_lock);
8205c65c564SOr Gerlitz 
8215c65c564SOr Gerlitz 	params.log_data_size = 15;
8225c65c564SOr Gerlitz 	params.log_data_size = min_t(u8, params.log_data_size,
8235c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz));
8245c65c564SOr Gerlitz 	params.log_data_size = max_t(u8, params.log_data_size,
8255c65c564SOr Gerlitz 				     MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz));
8265c65c564SOr Gerlitz 
827eb9180f7SOr Gerlitz 	params.log_num_packets = params.log_data_size -
828eb9180f7SOr Gerlitz 				 MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev);
829eb9180f7SOr Gerlitz 	params.log_num_packets = min_t(u8, params.log_num_packets,
830eb9180f7SOr Gerlitz 				       MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets));
831eb9180f7SOr Gerlitz 
832eb9180f7SOr Gerlitz 	params.q_counter = priv->q_counter;
8333f6d08d1SOr Gerlitz 	/* set hairpin pair per each 50Gbs share of the link */
8342c81bfd5SHuy Nguyen 	mlx5e_port_max_linkspeed(priv->mdev, &link_speed);
8353f6d08d1SOr Gerlitz 	link_speed = max_t(u32, link_speed, 50000);
8363f6d08d1SOr Gerlitz 	link_speed64 = link_speed;
8373f6d08d1SOr Gerlitz 	do_div(link_speed64, 50000);
8383f6d08d1SOr Gerlitz 	params.num_channels = link_speed64;
8393f6d08d1SOr Gerlitz 
8405c65c564SOr Gerlitz 	hp = mlx5e_hairpin_create(priv, &params, peer_ifindex);
841db76ca24SVlad Buslov 	hpe->hp = hp;
842db76ca24SVlad Buslov 	complete_all(&hpe->res_ready);
8435c65c564SOr Gerlitz 	if (IS_ERR(hp)) {
8445c65c564SOr Gerlitz 		err = PTR_ERR(hp);
845db76ca24SVlad Buslov 		goto out_err;
8465c65c564SOr Gerlitz 	}
8475c65c564SOr Gerlitz 
848eb9180f7SOr Gerlitz 	netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n",
84927b942fbSParav Pandit 		   hp->tirn, hp->pair->rqn[0],
85027b942fbSParav Pandit 		   dev_name(hp->pair->peer_mdev->device),
851eb9180f7SOr Gerlitz 		   hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets);
8525c65c564SOr Gerlitz 
8535c65c564SOr Gerlitz attach_flow:
8543f6d08d1SOr Gerlitz 	if (hpe->hp->num_channels > 1) {
855226f2ca3SVlad Buslov 		flow_flag_set(flow, HAIRPIN_RSS);
856c620b772SAriel Levkovich 		flow->attr->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t;
8573f6d08d1SOr Gerlitz 	} else {
858c620b772SAriel Levkovich 		flow->attr->nic_attr->hairpin_tirn = hpe->hp->tirn;
8593f6d08d1SOr Gerlitz 	}
860b32accdaSVlad Buslov 
861e4f9abbdSVlad Buslov 	flow->hpe = hpe;
86273edca73SVlad Buslov 	spin_lock(&hpe->flows_lock);
8635c65c564SOr Gerlitz 	list_add(&flow->hairpin, &hpe->flows);
86473edca73SVlad Buslov 	spin_unlock(&hpe->flows_lock);
8653f6d08d1SOr Gerlitz 
8665c65c564SOr Gerlitz 	return 0;
8675c65c564SOr Gerlitz 
868db76ca24SVlad Buslov out_err:
869db76ca24SVlad Buslov 	mlx5e_hairpin_put(priv, hpe);
8705c65c564SOr Gerlitz 	return err;
8715c65c564SOr Gerlitz }
8725c65c564SOr Gerlitz 
8735c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv,
8745c65c564SOr Gerlitz 				   struct mlx5e_tc_flow *flow)
8755c65c564SOr Gerlitz {
8765a7e5bcbSVlad Buslov 	/* flow wasn't fully initialized */
877e4f9abbdSVlad Buslov 	if (!flow->hpe)
8785a7e5bcbSVlad Buslov 		return;
8795a7e5bcbSVlad Buslov 
88073edca73SVlad Buslov 	spin_lock(&flow->hpe->flows_lock);
8815c65c564SOr Gerlitz 	list_del(&flow->hairpin);
88273edca73SVlad Buslov 	spin_unlock(&flow->hpe->flows_lock);
88373edca73SVlad Buslov 
884e4f9abbdSVlad Buslov 	mlx5e_hairpin_put(priv, flow->hpe);
885e4f9abbdSVlad Buslov 	flow->hpe = NULL;
8865c65c564SOr Gerlitz }
8875c65c564SOr Gerlitz 
88808247066SAriel Levkovich struct mlx5_flow_handle *
88908247066SAriel Levkovich mlx5e_add_offloaded_nic_rule(struct mlx5e_priv *priv,
89008247066SAriel Levkovich 			     struct mlx5_flow_spec *spec,
891c620b772SAriel Levkovich 			     struct mlx5_flow_attr *attr)
892e8f887acSAmir Vadai {
89308247066SAriel Levkovich 	struct mlx5_flow_context *flow_context = &spec->flow_context;
894c7569097SAriel Levkovich 	struct mlx5_fs_chains *nic_chains = nic_chains(priv);
895c620b772SAriel Levkovich 	struct mlx5_nic_flow_attr *nic_attr = attr->nic_attr;
8966a064674SAriel Levkovich 	struct mlx5e_tc_table *tc = &priv->fs.tc;
8975c65c564SOr Gerlitz 	struct mlx5_flow_destination dest[2] = {};
89866958ed9SHadar Hen Zion 	struct mlx5_flow_act flow_act = {
8993bc4b7bfSOr Gerlitz 		.action = attr->action,
900bb0ee7dcSJianbo Liu 		.flags    = FLOW_ACT_NO_APPEND,
90166958ed9SHadar Hen Zion 	};
90208247066SAriel Levkovich 	struct mlx5_flow_handle *rule;
903c7569097SAriel Levkovich 	struct mlx5_flow_table *ft;
90408247066SAriel Levkovich 	int dest_ix = 0;
905e8f887acSAmir Vadai 
906bb0ee7dcSJianbo Liu 	flow_context->flags |= FLOW_CONTEXT_HAS_TAG;
907c620b772SAriel Levkovich 	flow_context->flow_tag = nic_attr->flow_tag;
908bb0ee7dcSJianbo Liu 
909aedd133dSAriel Levkovich 	if (attr->dest_ft) {
910aedd133dSAriel Levkovich 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
911aedd133dSAriel Levkovich 		dest[dest_ix].ft = attr->dest_ft;
912aedd133dSAriel Levkovich 		dest_ix++;
913aedd133dSAriel Levkovich 	} else if (nic_attr->hairpin_ft) {
9143f6d08d1SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
915c620b772SAriel Levkovich 		dest[dest_ix].ft = nic_attr->hairpin_ft;
91608247066SAriel Levkovich 		dest_ix++;
917c620b772SAriel Levkovich 	} else if (nic_attr->hairpin_tirn) {
9185c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR;
919c620b772SAriel Levkovich 		dest[dest_ix].tir_num = nic_attr->hairpin_tirn;
9203f6d08d1SOr Gerlitz 		dest_ix++;
9213f6d08d1SOr Gerlitz 	} else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
9225c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
923c7569097SAriel Levkovich 		if (attr->dest_chain) {
924c7569097SAriel Levkovich 			dest[dest_ix].ft = mlx5_chains_get_table(nic_chains,
925c7569097SAriel Levkovich 								 attr->dest_chain, 1,
926c7569097SAriel Levkovich 								 MLX5E_TC_FT_LEVEL);
927c7569097SAriel Levkovich 			if (IS_ERR(dest[dest_ix].ft))
928c7569097SAriel Levkovich 				return ERR_CAST(dest[dest_ix].ft);
929c7569097SAriel Levkovich 		} else {
9306783f0a2SVu Pham 			dest[dest_ix].ft = mlx5e_vlan_get_flowtable(priv->fs.vlan);
931c7569097SAriel Levkovich 		}
9325c65c564SOr Gerlitz 		dest_ix++;
9335c65c564SOr Gerlitz 	}
934aad7e08dSAmir Vadai 
935c7569097SAriel Levkovich 	if (dest[0].type == MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE &&
936c7569097SAriel Levkovich 	    MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, ignore_flow_level))
937c7569097SAriel Levkovich 		flow_act.flags |= FLOW_ACT_IGNORE_FLOW_LEVEL;
938c7569097SAriel Levkovich 
93908247066SAriel Levkovich 	if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
9405c65c564SOr Gerlitz 		dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
94108247066SAriel Levkovich 		dest[dest_ix].counter_id = mlx5_fc_id(attr->counter);
9425c65c564SOr Gerlitz 		dest_ix++;
943aad7e08dSAmir Vadai 	}
944aad7e08dSAmir Vadai 
94508247066SAriel Levkovich 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
9462b688ea5SMaor Gottlieb 		flow_act.modify_hdr = attr->modify_hdr;
9472f4fe4caSOr Gerlitz 
9486a064674SAriel Levkovich 	mutex_lock(&tc->t_lock);
9496a064674SAriel Levkovich 	if (IS_ERR_OR_NULL(tc->t)) {
9506a064674SAriel Levkovich 		/* Create the root table here if doesn't exist yet */
9516a064674SAriel Levkovich 		tc->t =
952c7569097SAriel Levkovich 			mlx5_chains_get_table(nic_chains, 0, 1, MLX5E_TC_FT_LEVEL);
95321b9c144SOr Gerlitz 
9546a064674SAriel Levkovich 		if (IS_ERR(tc->t)) {
9556a064674SAriel Levkovich 			mutex_unlock(&tc->t_lock);
956e8f887acSAmir Vadai 			netdev_err(priv->netdev,
957e8f887acSAmir Vadai 				   "Failed to create tc offload table\n");
958c7569097SAriel Levkovich 			rule = ERR_CAST(priv->fs.tc.t);
959c7569097SAriel Levkovich 			goto err_ft_get;
960e8f887acSAmir Vadai 		}
961e8f887acSAmir Vadai 	}
96208247066SAriel Levkovich 	mutex_unlock(&tc->t_lock);
963e8f887acSAmir Vadai 
964aedd133dSAriel Levkovich 	if (attr->chain || attr->prio)
965c7569097SAriel Levkovich 		ft = mlx5_chains_get_table(nic_chains,
966c7569097SAriel Levkovich 					   attr->chain, attr->prio,
967c7569097SAriel Levkovich 					   MLX5E_TC_FT_LEVEL);
968aedd133dSAriel Levkovich 	else
969aedd133dSAriel Levkovich 		ft = attr->ft;
970aedd133dSAriel Levkovich 
971c7569097SAriel Levkovich 	if (IS_ERR(ft)) {
972c7569097SAriel Levkovich 		rule = ERR_CAST(ft);
973c7569097SAriel Levkovich 		goto err_ft_get;
974c7569097SAriel Levkovich 	}
975c7569097SAriel Levkovich 
976c620b772SAriel Levkovich 	if (attr->outer_match_level != MLX5_MATCH_NONE)
97708247066SAriel Levkovich 		spec->match_criteria_enable |= MLX5_MATCH_OUTER_HEADERS;
97838aa51c1SOr Gerlitz 
979c7569097SAriel Levkovich 	rule = mlx5_add_flow_rules(ft, spec,
9805c65c564SOr Gerlitz 				   &flow_act, dest, dest_ix);
98108247066SAriel Levkovich 	if (IS_ERR(rule))
982c7569097SAriel Levkovich 		goto err_rule;
98308247066SAriel Levkovich 
98408247066SAriel Levkovich 	return rule;
985c7569097SAriel Levkovich 
986c7569097SAriel Levkovich err_rule:
987aedd133dSAriel Levkovich 	if (attr->chain || attr->prio)
988c7569097SAriel Levkovich 		mlx5_chains_put_table(nic_chains,
989c7569097SAriel Levkovich 				      attr->chain, attr->prio,
990c7569097SAriel Levkovich 				      MLX5E_TC_FT_LEVEL);
991c7569097SAriel Levkovich err_ft_get:
992c7569097SAriel Levkovich 	if (attr->dest_chain)
993c7569097SAriel Levkovich 		mlx5_chains_put_table(nic_chains,
994c7569097SAriel Levkovich 				      attr->dest_chain, 1,
995c7569097SAriel Levkovich 				      MLX5E_TC_FT_LEVEL);
996c7569097SAriel Levkovich 
997c7569097SAriel Levkovich 	return ERR_CAST(rule);
99808247066SAriel Levkovich }
99908247066SAriel Levkovich 
100008247066SAriel Levkovich static int
100108247066SAriel Levkovich mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv,
100208247066SAriel Levkovich 		      struct mlx5e_tc_flow_parse_attr *parse_attr,
100308247066SAriel Levkovich 		      struct mlx5e_tc_flow *flow,
100408247066SAriel Levkovich 		      struct netlink_ext_ack *extack)
100508247066SAriel Levkovich {
1006c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr = flow->attr;
100708247066SAriel Levkovich 	struct mlx5_core_dev *dev = priv->mdev;
100808247066SAriel Levkovich 	struct mlx5_fc *counter = NULL;
100908247066SAriel Levkovich 	int err;
101008247066SAriel Levkovich 
101108247066SAriel Levkovich 	if (flow_flag_test(flow, HAIRPIN)) {
101208247066SAriel Levkovich 		err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack);
101308247066SAriel Levkovich 		if (err)
101408247066SAriel Levkovich 			return err;
101508247066SAriel Levkovich 	}
101608247066SAriel Levkovich 
101708247066SAriel Levkovich 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
101808247066SAriel Levkovich 		counter = mlx5_fc_create(dev, true);
101908247066SAriel Levkovich 		if (IS_ERR(counter))
102008247066SAriel Levkovich 			return PTR_ERR(counter);
102108247066SAriel Levkovich 
102208247066SAriel Levkovich 		attr->counter = counter;
102308247066SAriel Levkovich 	}
102408247066SAriel Levkovich 
102508247066SAriel Levkovich 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
102608247066SAriel Levkovich 		err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
102708247066SAriel Levkovich 		dealloc_mod_hdr_actions(&parse_attr->mod_hdr_acts);
102808247066SAriel Levkovich 		if (err)
102908247066SAriel Levkovich 			return err;
103008247066SAriel Levkovich 	}
103108247066SAriel Levkovich 
1032aedd133dSAriel Levkovich 	if (flow_flag_test(flow, CT))
1033aedd133dSAriel Levkovich 		flow->rule[0] = mlx5_tc_ct_flow_offload(get_ct_priv(priv), flow, &parse_attr->spec,
1034aedd133dSAriel Levkovich 							attr, &parse_attr->mod_hdr_acts);
1035aedd133dSAriel Levkovich 	else
103608247066SAriel Levkovich 		flow->rule[0] = mlx5e_add_offloaded_nic_rule(priv, &parse_attr->spec,
103708247066SAriel Levkovich 							     attr);
1038e8f887acSAmir Vadai 
1039a2b7189bSzhong jiang 	return PTR_ERR_OR_ZERO(flow->rule[0]);
1040e8f887acSAmir Vadai }
1041e8f887acSAmir Vadai 
104208247066SAriel Levkovich void mlx5e_del_offloaded_nic_rule(struct mlx5e_priv *priv,
1043c7569097SAriel Levkovich 				  struct mlx5_flow_handle *rule,
1044c7569097SAriel Levkovich 				  struct mlx5_flow_attr *attr)
104508247066SAriel Levkovich {
1046c7569097SAriel Levkovich 	struct mlx5_fs_chains *nic_chains = nic_chains(priv);
1047c7569097SAriel Levkovich 
104808247066SAriel Levkovich 	mlx5_del_flow_rules(rule);
1049c7569097SAriel Levkovich 
1050aedd133dSAriel Levkovich 	if (attr->chain || attr->prio)
1051c7569097SAriel Levkovich 		mlx5_chains_put_table(nic_chains, attr->chain, attr->prio,
1052c7569097SAriel Levkovich 				      MLX5E_TC_FT_LEVEL);
1053c7569097SAriel Levkovich 
1054c7569097SAriel Levkovich 	if (attr->dest_chain)
1055c7569097SAriel Levkovich 		mlx5_chains_put_table(nic_chains, attr->dest_chain, 1,
1056c7569097SAriel Levkovich 				      MLX5E_TC_FT_LEVEL);
105708247066SAriel Levkovich }
105808247066SAriel Levkovich 
1059d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv,
1060d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
1061d85cdccbSOr Gerlitz {
1062c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr = flow->attr;
10636a064674SAriel Levkovich 	struct mlx5e_tc_table *tc = &priv->fs.tc;
1064d85cdccbSOr Gerlitz 
1065c7569097SAriel Levkovich 	flow_flag_clear(flow, OFFLOADED);
1066c7569097SAriel Levkovich 
1067aedd133dSAriel Levkovich 	if (flow_flag_test(flow, CT))
1068aedd133dSAriel Levkovich 		mlx5_tc_ct_delete_flow(get_ct_priv(flow->priv), flow, attr);
1069aedd133dSAriel Levkovich 	else if (!IS_ERR_OR_NULL(flow->rule[0]))
1070aedd133dSAriel Levkovich 		mlx5e_del_offloaded_nic_rule(priv, flow->rule[0], attr);
1071aedd133dSAriel Levkovich 
1072c7569097SAriel Levkovich 	/* Remove root table if no rules are left to avoid
1073c7569097SAriel Levkovich 	 * extra steering hops.
1074c7569097SAriel Levkovich 	 */
1075b6fac0b4SVlad Buslov 	mutex_lock(&priv->fs.tc.t_lock);
10766a064674SAriel Levkovich 	if (!mlx5e_tc_num_filters(priv, MLX5_TC_FLAG(NIC_OFFLOAD)) &&
10776a064674SAriel Levkovich 	    !IS_ERR_OR_NULL(tc->t)) {
10786a064674SAriel Levkovich 		mlx5_chains_put_table(nic_chains(priv), 0, 1, MLX5E_TC_FT_LEVEL);
1079d85cdccbSOr Gerlitz 		priv->fs.tc.t = NULL;
1080d85cdccbSOr Gerlitz 	}
1081b6fac0b4SVlad Buslov 	mutex_unlock(&priv->fs.tc.t_lock);
10822f4fe4caSOr Gerlitz 
1083aedd133dSAriel Levkovich 	kvfree(attr->parse_attr);
1084aedd133dSAriel Levkovich 
1085513f8f7fSOr Gerlitz 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
10863099eb5aSOr Gerlitz 		mlx5e_detach_mod_hdr(priv, flow);
10875c65c564SOr Gerlitz 
1088aedd133dSAriel Levkovich 	mlx5_fc_destroy(priv->mdev, attr->counter);
1089aedd133dSAriel Levkovich 
1090226f2ca3SVlad Buslov 	if (flow_flag_test(flow, HAIRPIN))
10915c65c564SOr Gerlitz 		mlx5e_hairpin_flow_del(priv, flow);
1092c620b772SAriel Levkovich 
1093c620b772SAriel Levkovich 	kfree(flow->attr);
1094d85cdccbSOr Gerlitz }
1095d85cdccbSOr Gerlitz 
10960d9f9647SVlad Buslov struct mlx5_flow_handle *
10976d2a3ed0SOr Gerlitz mlx5e_tc_offload_fdb_rules(struct mlx5_eswitch *esw,
10986d2a3ed0SOr Gerlitz 			   struct mlx5e_tc_flow *flow,
10996d2a3ed0SOr Gerlitz 			   struct mlx5_flow_spec *spec,
1100c620b772SAriel Levkovich 			   struct mlx5_flow_attr *attr)
11016d2a3ed0SOr Gerlitz {
11021ef3018fSPaul Blakey 	struct mlx5e_tc_mod_hdr_acts *mod_hdr_acts;
11036d2a3ed0SOr Gerlitz 	struct mlx5_flow_handle *rule;
11044c3844d9SPaul Blakey 
110589e39467SPaul Blakey 	if (attr->flags & MLX5_ESW_ATTR_FLAG_SLOW_PATH)
110689e39467SPaul Blakey 		return mlx5_eswitch_add_offloaded_rule(esw, spec, attr);
110789e39467SPaul Blakey 
11081ef3018fSPaul Blakey 	if (flow_flag_test(flow, CT)) {
11091ef3018fSPaul Blakey 		mod_hdr_acts = &attr->parse_attr->mod_hdr_acts;
11101ef3018fSPaul Blakey 
111169e2916eSPaul Blakey 		rule = mlx5_tc_ct_flow_offload(get_ct_priv(flow->priv),
1112aedd133dSAriel Levkovich 					       flow, spec, attr,
11131ef3018fSPaul Blakey 					       mod_hdr_acts);
1114f94d6389SChris Mi #if IS_ENABLED(CONFIG_MLX5_TC_SAMPLE)
1115f94d6389SChris Mi 	} else if (flow_flag_test(flow, SAMPLE)) {
1116f94d6389SChris Mi 		rule = mlx5_esw_sample_offload(get_sample_priv(flow->priv), spec, attr);
1117f94d6389SChris Mi #endif
111869e2916eSPaul Blakey 	} else {
111969e2916eSPaul Blakey 		rule = mlx5_eswitch_add_offloaded_rule(esw, spec, attr);
11201ef3018fSPaul Blakey 	}
11216d2a3ed0SOr Gerlitz 
11226d2a3ed0SOr Gerlitz 	if (IS_ERR(rule))
11236d2a3ed0SOr Gerlitz 		return rule;
11246d2a3ed0SOr Gerlitz 
1125c620b772SAriel Levkovich 	if (attr->esw_attr->split_count) {
11266d2a3ed0SOr Gerlitz 		flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, spec, attr);
11276d2a3ed0SOr Gerlitz 		if (IS_ERR(flow->rule[1])) {
112869e2916eSPaul Blakey 			if (flow_flag_test(flow, CT))
112969e2916eSPaul Blakey 				mlx5_tc_ct_delete_flow(get_ct_priv(flow->priv), flow, attr);
113069e2916eSPaul Blakey 			else
11316d2a3ed0SOr Gerlitz 				mlx5_eswitch_del_offloaded_rule(esw, rule, attr);
11326d2a3ed0SOr Gerlitz 			return flow->rule[1];
11336d2a3ed0SOr Gerlitz 		}
11346d2a3ed0SOr Gerlitz 	}
11356d2a3ed0SOr Gerlitz 
11366d2a3ed0SOr Gerlitz 	return rule;
11376d2a3ed0SOr Gerlitz }
11386d2a3ed0SOr Gerlitz 
11390d9f9647SVlad Buslov void mlx5e_tc_unoffload_fdb_rules(struct mlx5_eswitch *esw,
11406d2a3ed0SOr Gerlitz 				  struct mlx5e_tc_flow *flow,
1141c620b772SAriel Levkovich 				  struct mlx5_flow_attr *attr)
11426d2a3ed0SOr Gerlitz {
1143226f2ca3SVlad Buslov 	flow_flag_clear(flow, OFFLOADED);
11446d2a3ed0SOr Gerlitz 
114589e39467SPaul Blakey 	if (attr->flags & MLX5_ESW_ATTR_FLAG_SLOW_PATH)
114689e39467SPaul Blakey 		goto offload_rule_0;
114789e39467SPaul Blakey 
11484c3844d9SPaul Blakey 	if (flow_flag_test(flow, CT)) {
1149aedd133dSAriel Levkovich 		mlx5_tc_ct_delete_flow(get_ct_priv(flow->priv), flow, attr);
11504c3844d9SPaul Blakey 		return;
11514c3844d9SPaul Blakey 	}
11524c3844d9SPaul Blakey 
1153f94d6389SChris Mi #if IS_ENABLED(CONFIG_MLX5_TC_SAMPLE)
1154f94d6389SChris Mi 	if (flow_flag_test(flow, SAMPLE)) {
1155f94d6389SChris Mi 		mlx5_esw_sample_unoffload(get_sample_priv(flow->priv), flow->rule[0], attr);
1156f94d6389SChris Mi 		return;
1157f94d6389SChris Mi 	}
1158f94d6389SChris Mi #endif
1159f94d6389SChris Mi 
1160c620b772SAriel Levkovich 	if (attr->esw_attr->split_count)
11616d2a3ed0SOr Gerlitz 		mlx5_eswitch_del_fwd_rule(esw, flow->rule[1], attr);
11626d2a3ed0SOr Gerlitz 
116389e39467SPaul Blakey offload_rule_0:
11646d2a3ed0SOr Gerlitz 	mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr);
11656d2a3ed0SOr Gerlitz }
11666d2a3ed0SOr Gerlitz 
11670d9f9647SVlad Buslov struct mlx5_flow_handle *
11685dbe906fSPaul Blakey mlx5e_tc_offload_to_slow_path(struct mlx5_eswitch *esw,
11695dbe906fSPaul Blakey 			      struct mlx5e_tc_flow *flow,
1170178f69b4SEli Cohen 			      struct mlx5_flow_spec *spec)
11715dbe906fSPaul Blakey {
1172c620b772SAriel Levkovich 	struct mlx5_flow_attr *slow_attr;
11735dbe906fSPaul Blakey 	struct mlx5_flow_handle *rule;
11745dbe906fSPaul Blakey 
1175c620b772SAriel Levkovich 	slow_attr = mlx5_alloc_flow_attr(MLX5_FLOW_NAMESPACE_FDB);
1176c620b772SAriel Levkovich 	if (!slow_attr)
1177c620b772SAriel Levkovich 		return ERR_PTR(-ENOMEM);
11785dbe906fSPaul Blakey 
1179c620b772SAriel Levkovich 	memcpy(slow_attr, flow->attr, ESW_FLOW_ATTR_SZ);
1180c620b772SAriel Levkovich 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
1181c620b772SAriel Levkovich 	slow_attr->esw_attr->split_count = 0;
1182c620b772SAriel Levkovich 	slow_attr->flags |= MLX5_ESW_ATTR_FLAG_SLOW_PATH;
1183c620b772SAriel Levkovich 
1184c620b772SAriel Levkovich 	rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, slow_attr);
11855dbe906fSPaul Blakey 	if (!IS_ERR(rule))
1186226f2ca3SVlad Buslov 		flow_flag_set(flow, SLOW);
11875dbe906fSPaul Blakey 
1188c620b772SAriel Levkovich 	kfree(slow_attr);
1189c620b772SAriel Levkovich 
11905dbe906fSPaul Blakey 	return rule;
11915dbe906fSPaul Blakey }
11925dbe906fSPaul Blakey 
11930d9f9647SVlad Buslov void mlx5e_tc_unoffload_from_slow_path(struct mlx5_eswitch *esw,
1194178f69b4SEli Cohen 				       struct mlx5e_tc_flow *flow)
11955dbe906fSPaul Blakey {
1196c620b772SAriel Levkovich 	struct mlx5_flow_attr *slow_attr;
1197178f69b4SEli Cohen 
1198c620b772SAriel Levkovich 	slow_attr = mlx5_alloc_flow_attr(MLX5_FLOW_NAMESPACE_FDB);
11995efbe617SAriel Levkovich 	if (!slow_attr) {
12005efbe617SAriel Levkovich 		mlx5_core_warn(flow->priv->mdev, "Unable to alloc attr to unoffload slow path rule\n");
12015efbe617SAriel Levkovich 		return;
12025efbe617SAriel Levkovich 	}
1203c620b772SAriel Levkovich 
1204c620b772SAriel Levkovich 	memcpy(slow_attr, flow->attr, ESW_FLOW_ATTR_SZ);
1205c620b772SAriel Levkovich 	slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
1206c620b772SAriel Levkovich 	slow_attr->esw_attr->split_count = 0;
1207c620b772SAriel Levkovich 	slow_attr->flags |= MLX5_ESW_ATTR_FLAG_SLOW_PATH;
1208c620b772SAriel Levkovich 	mlx5e_tc_unoffload_fdb_rules(esw, flow, slow_attr);
1209226f2ca3SVlad Buslov 	flow_flag_clear(flow, SLOW);
1210c620b772SAriel Levkovich 	kfree(slow_attr);
12115dbe906fSPaul Blakey }
12125dbe906fSPaul Blakey 
1213ad86755bSVlad Buslov /* Caller must obtain uplink_priv->unready_flows_lock mutex before calling this
1214ad86755bSVlad Buslov  * function.
1215ad86755bSVlad Buslov  */
1216ad86755bSVlad Buslov static void unready_flow_add(struct mlx5e_tc_flow *flow,
1217ad86755bSVlad Buslov 			     struct list_head *unready_flows)
1218ad86755bSVlad Buslov {
1219ad86755bSVlad Buslov 	flow_flag_set(flow, NOT_READY);
1220ad86755bSVlad Buslov 	list_add_tail(&flow->unready, unready_flows);
1221ad86755bSVlad Buslov }
1222ad86755bSVlad Buslov 
1223ad86755bSVlad Buslov /* Caller must obtain uplink_priv->unready_flows_lock mutex before calling this
1224ad86755bSVlad Buslov  * function.
1225ad86755bSVlad Buslov  */
1226ad86755bSVlad Buslov static void unready_flow_del(struct mlx5e_tc_flow *flow)
1227ad86755bSVlad Buslov {
1228ad86755bSVlad Buslov 	list_del(&flow->unready);
1229ad86755bSVlad Buslov 	flow_flag_clear(flow, NOT_READY);
1230ad86755bSVlad Buslov }
1231ad86755bSVlad Buslov 
1232b4a23329SRoi Dayan static void add_unready_flow(struct mlx5e_tc_flow *flow)
1233b4a23329SRoi Dayan {
1234b4a23329SRoi Dayan 	struct mlx5_rep_uplink_priv *uplink_priv;
1235b4a23329SRoi Dayan 	struct mlx5e_rep_priv *rpriv;
1236b4a23329SRoi Dayan 	struct mlx5_eswitch *esw;
1237b4a23329SRoi Dayan 
1238b4a23329SRoi Dayan 	esw = flow->priv->mdev->priv.eswitch;
1239b4a23329SRoi Dayan 	rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
1240b4a23329SRoi Dayan 	uplink_priv = &rpriv->uplink_priv;
1241b4a23329SRoi Dayan 
1242ad86755bSVlad Buslov 	mutex_lock(&uplink_priv->unready_flows_lock);
1243ad86755bSVlad Buslov 	unready_flow_add(flow, &uplink_priv->unready_flows);
1244ad86755bSVlad Buslov 	mutex_unlock(&uplink_priv->unready_flows_lock);
1245b4a23329SRoi Dayan }
1246b4a23329SRoi Dayan 
1247b4a23329SRoi Dayan static void remove_unready_flow(struct mlx5e_tc_flow *flow)
1248b4a23329SRoi Dayan {
1249ad86755bSVlad Buslov 	struct mlx5_rep_uplink_priv *uplink_priv;
1250ad86755bSVlad Buslov 	struct mlx5e_rep_priv *rpriv;
1251ad86755bSVlad Buslov 	struct mlx5_eswitch *esw;
1252ad86755bSVlad Buslov 
1253ad86755bSVlad Buslov 	esw = flow->priv->mdev->priv.eswitch;
1254ad86755bSVlad Buslov 	rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
1255ad86755bSVlad Buslov 	uplink_priv = &rpriv->uplink_priv;
1256ad86755bSVlad Buslov 
1257ad86755bSVlad Buslov 	mutex_lock(&uplink_priv->unready_flows_lock);
1258ad86755bSVlad Buslov 	unready_flow_del(flow);
1259ad86755bSVlad Buslov 	mutex_unlock(&uplink_priv->unready_flows_lock);
1260b4a23329SRoi Dayan }
1261b4a23329SRoi Dayan 
126210742efcSVlad Buslov static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv);
126310742efcSVlad Buslov 
1264a508728aSVlad Buslov bool mlx5e_tc_is_vf_tunnel(struct net_device *out_dev, struct net_device *route_dev)
126510742efcSVlad Buslov {
126610742efcSVlad Buslov 	struct mlx5_core_dev *out_mdev, *route_mdev;
126710742efcSVlad Buslov 	struct mlx5e_priv *out_priv, *route_priv;
126810742efcSVlad Buslov 
126910742efcSVlad Buslov 	out_priv = netdev_priv(out_dev);
127010742efcSVlad Buslov 	out_mdev = out_priv->mdev;
127110742efcSVlad Buslov 	route_priv = netdev_priv(route_dev);
127210742efcSVlad Buslov 	route_mdev = route_priv->mdev;
127310742efcSVlad Buslov 
127410742efcSVlad Buslov 	if (out_mdev->coredev_type != MLX5_COREDEV_PF ||
127510742efcSVlad Buslov 	    route_mdev->coredev_type != MLX5_COREDEV_VF)
127610742efcSVlad Buslov 		return false;
127710742efcSVlad Buslov 
127810742efcSVlad Buslov 	return same_hw_devs(out_priv, route_priv);
127910742efcSVlad Buslov }
128010742efcSVlad Buslov 
1281a508728aSVlad Buslov int mlx5e_tc_query_route_vport(struct net_device *out_dev, struct net_device *route_dev, u16 *vport)
128210742efcSVlad Buslov {
128310742efcSVlad Buslov 	struct mlx5e_priv *out_priv, *route_priv;
128410742efcSVlad Buslov 	struct mlx5_core_dev *route_mdev;
128510742efcSVlad Buslov 	struct mlx5_eswitch *esw;
128610742efcSVlad Buslov 	u16 vhca_id;
128710742efcSVlad Buslov 	int err;
128810742efcSVlad Buslov 
128910742efcSVlad Buslov 	out_priv = netdev_priv(out_dev);
129010742efcSVlad Buslov 	esw = out_priv->mdev->priv.eswitch;
129110742efcSVlad Buslov 	route_priv = netdev_priv(route_dev);
129210742efcSVlad Buslov 	route_mdev = route_priv->mdev;
129310742efcSVlad Buslov 
129410742efcSVlad Buslov 	vhca_id = MLX5_CAP_GEN(route_mdev, vhca_id);
129510742efcSVlad Buslov 	err = mlx5_eswitch_vhca_id_to_vport(esw, vhca_id, vport);
129610742efcSVlad Buslov 	return err;
129710742efcSVlad Buslov }
129810742efcSVlad Buslov 
1299c7b9038dSVlad Buslov int mlx5e_tc_add_flow_mod_hdr(struct mlx5e_priv *priv,
1300c7b9038dSVlad Buslov 			      struct mlx5e_tc_flow_parse_attr *parse_attr,
1301c7b9038dSVlad Buslov 			      struct mlx5e_tc_flow *flow)
1302c7b9038dSVlad Buslov {
1303c7b9038dSVlad Buslov 	struct mlx5e_tc_mod_hdr_acts *mod_hdr_acts = &parse_attr->mod_hdr_acts;
1304c7b9038dSVlad Buslov 	struct mlx5_modify_hdr *mod_hdr;
1305c7b9038dSVlad Buslov 
1306c7b9038dSVlad Buslov 	mod_hdr = mlx5_modify_header_alloc(priv->mdev,
1307c7b9038dSVlad Buslov 					   get_flow_name_space(flow),
1308c7b9038dSVlad Buslov 					   mod_hdr_acts->num_actions,
1309c7b9038dSVlad Buslov 					   mod_hdr_acts->actions);
1310c7b9038dSVlad Buslov 	if (IS_ERR(mod_hdr))
1311c7b9038dSVlad Buslov 		return PTR_ERR(mod_hdr);
1312c7b9038dSVlad Buslov 
1313c7b9038dSVlad Buslov 	WARN_ON(flow->attr->modify_hdr);
1314c7b9038dSVlad Buslov 	flow->attr->modify_hdr = mod_hdr;
1315c7b9038dSVlad Buslov 
1316c7b9038dSVlad Buslov 	return 0;
1317c7b9038dSVlad Buslov }
1318c7b9038dSVlad Buslov 
1319c83954abSRabie Loulou static int
132074491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv,
1321e98bedf5SEli Britstein 		      struct mlx5e_tc_flow *flow,
1322e98bedf5SEli Britstein 		      struct netlink_ext_ack *extack)
1323adb4c123SOr Gerlitz {
1324adb4c123SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
1325c620b772SAriel Levkovich 	struct mlx5e_tc_flow_parse_attr *parse_attr;
1326c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr = flow->attr;
13278914add2SVlad Buslov 	bool vf_tun = false, encap_valid = true;
1328fe7738ebSDima Chumak 	struct net_device *encap_dev = NULL;
1329c620b772SAriel Levkovich 	struct mlx5_esw_flow_attr *esw_attr;
1330b8aee822SMark Bloch 	struct mlx5_fc *counter = NULL;
13313c37745eSOr Gerlitz 	struct mlx5e_rep_priv *rpriv;
13323c37745eSOr Gerlitz 	struct mlx5e_priv *out_priv;
133339ac237cSPaul Blakey 	u32 max_prio, max_chain;
13340ad060eeSRoi Dayan 	int err = 0;
1335f493f155SEli Britstein 	int out_index;
13368b32580dSOr Gerlitz 
133784179981SPaul Blakey 	/* We check chain range only for tc flows.
133884179981SPaul Blakey 	 * For ft flows, we checked attr->chain was originally 0 and set it to
133984179981SPaul Blakey 	 * FDB_FT_CHAIN which is outside tc range.
134084179981SPaul Blakey 	 * See mlx5e_rep_setup_ft_cb().
134184179981SPaul Blakey 	 */
1342ae430332SAriel Levkovich 	max_chain = mlx5_chains_get_chain_range(esw_chains(esw));
134384179981SPaul Blakey 	if (!mlx5e_is_ft_flow(flow) && attr->chain > max_chain) {
134461644c3dSRoi Dayan 		NL_SET_ERR_MSG_MOD(extack,
134561644c3dSRoi Dayan 				   "Requested chain is out of supported range");
13468914add2SVlad Buslov 		err = -EOPNOTSUPP;
13478914add2SVlad Buslov 		goto err_out;
1348bf07aa73SPaul Blakey 	}
1349bf07aa73SPaul Blakey 
1350ae430332SAriel Levkovich 	max_prio = mlx5_chains_get_prio_range(esw_chains(esw));
1351bf07aa73SPaul Blakey 	if (attr->prio > max_prio) {
135261644c3dSRoi Dayan 		NL_SET_ERR_MSG_MOD(extack,
135361644c3dSRoi Dayan 				   "Requested priority is out of supported range");
13548914add2SVlad Buslov 		err = -EOPNOTSUPP;
13558914add2SVlad Buslov 		goto err_out;
1356bf07aa73SPaul Blakey 	}
1357bf07aa73SPaul Blakey 
1358777bb800SVlad Buslov 	if (flow_flag_test(flow, TUN_RX)) {
1359777bb800SVlad Buslov 		err = mlx5e_attach_decap_route(priv, flow);
1360777bb800SVlad Buslov 		if (err)
13618914add2SVlad Buslov 			goto err_out;
1362777bb800SVlad Buslov 	}
1363777bb800SVlad Buslov 
136414e6b038SEli Cohen 	if (flow_flag_test(flow, L3_TO_L2_DECAP)) {
136514e6b038SEli Cohen 		err = mlx5e_attach_decap(priv, flow, extack);
136614e6b038SEli Cohen 		if (err)
13678914add2SVlad Buslov 			goto err_out;
136814e6b038SEli Cohen 	}
136914e6b038SEli Cohen 
1370c620b772SAriel Levkovich 	parse_attr = attr->parse_attr;
1371c620b772SAriel Levkovich 	esw_attr = attr->esw_attr;
1372c620b772SAriel Levkovich 
1373f493f155SEli Britstein 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) {
1374fe7738ebSDima Chumak 		struct net_device *out_dev;
13758c4dc42bSEli Britstein 		int mirred_ifindex;
13768c4dc42bSEli Britstein 
1377c620b772SAriel Levkovich 		if (!(esw_attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP))
1378f493f155SEli Britstein 			continue;
1379f493f155SEli Britstein 
13807040632dSTonghao Zhang 		mirred_ifindex = parse_attr->mirred_ifindex[out_index];
1381fe7738ebSDima Chumak 		out_dev = dev_get_by_index(dev_net(priv->netdev), mirred_ifindex);
1382fe7738ebSDima Chumak 		if (!out_dev) {
1383fe7738ebSDima Chumak 			NL_SET_ERR_MSG_MOD(extack, "Requested mirred device not found");
1384fe7738ebSDima Chumak 			err = -ENODEV;
1385fe7738ebSDima Chumak 			goto err_out;
1386fe7738ebSDima Chumak 		}
1387733d4f36SRoi Dayan 		err = mlx5e_attach_encap(priv, flow, out_dev, out_index,
13880ad060eeSRoi Dayan 					 extack, &encap_dev, &encap_valid);
1389fe7738ebSDima Chumak 		dev_put(out_dev);
13900ad060eeSRoi Dayan 		if (err)
13918914add2SVlad Buslov 			goto err_out;
13920ad060eeSRoi Dayan 
13938914add2SVlad Buslov 		if (esw_attr->dests[out_index].flags &
13948914add2SVlad Buslov 		    MLX5_ESW_DEST_CHAIN_WITH_SRC_PORT_CHANGE)
13958914add2SVlad Buslov 			vf_tun = true;
13963c37745eSOr Gerlitz 		out_priv = netdev_priv(encap_dev);
13973c37745eSOr Gerlitz 		rpriv = out_priv->ppriv;
1398c620b772SAriel Levkovich 		esw_attr->dests[out_index].rep = rpriv->rep;
1399c620b772SAriel Levkovich 		esw_attr->dests[out_index].mdev = out_priv->mdev;
14003c37745eSOr Gerlitz 	}
14013c37745eSOr Gerlitz 
14027d1a3d08SVlad Buslov 	if (vf_tun && esw_attr->out_count > 1) {
14037d1a3d08SVlad Buslov 		NL_SET_ERR_MSG_MOD(extack, "VF tunnel encap with mirroring is not supported");
14047d1a3d08SVlad Buslov 		err = -EOPNOTSUPP;
14057d1a3d08SVlad Buslov 		goto err_out;
14067d1a3d08SVlad Buslov 	}
14077d1a3d08SVlad Buslov 
14088b32580dSOr Gerlitz 	err = mlx5_eswitch_add_vlan_action(esw, attr);
1409c83954abSRabie Loulou 	if (err)
14108914add2SVlad Buslov 		goto err_out;
1411adb4c123SOr Gerlitz 
1412d5a3c2b6SRoi Dayan 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR &&
1413d5a3c2b6SRoi Dayan 	    !(attr->ct_attr.ct_action & TCA_CT_ACT_CLEAR)) {
14148914add2SVlad Buslov 		if (vf_tun) {
14158914add2SVlad Buslov 			err = mlx5e_tc_add_flow_mod_hdr(priv, parse_attr, flow);
14168914add2SVlad Buslov 			if (err)
14178914add2SVlad Buslov 				goto err_out;
14188914add2SVlad Buslov 		} else {
14191a9527bbSOr Gerlitz 			err = mlx5e_attach_mod_hdr(priv, flow, parse_attr);
1420c83954abSRabie Loulou 			if (err)
14218914add2SVlad Buslov 				goto err_out;
14228914add2SVlad Buslov 		}
1423d7e75a32SOr Gerlitz 	}
1424d7e75a32SOr Gerlitz 
1425b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
1426c620b772SAriel Levkovich 		counter = mlx5_fc_create(esw_attr->counter_dev, true);
14278914add2SVlad Buslov 		if (IS_ERR(counter)) {
14288914add2SVlad Buslov 			err = PTR_ERR(counter);
14298914add2SVlad Buslov 			goto err_out;
14308914add2SVlad Buslov 		}
1431b8aee822SMark Bloch 
1432b8aee822SMark Bloch 		attr->counter = counter;
1433b8aee822SMark Bloch 	}
1434b8aee822SMark Bloch 
14350ad060eeSRoi Dayan 	/* we get here if one of the following takes place:
14360ad060eeSRoi Dayan 	 * (1) there's no error
14370ad060eeSRoi Dayan 	 * (2) there's an encap action and we don't have valid neigh
14383c37745eSOr Gerlitz 	 */
1439bc1d75faSRoi Dayan 	if (!encap_valid)
1440178f69b4SEli Cohen 		flow->rule[0] = mlx5e_tc_offload_to_slow_path(esw, flow, &parse_attr->spec);
1441bc1d75faSRoi Dayan 	else
14426d2a3ed0SOr Gerlitz 		flow->rule[0] = mlx5e_tc_offload_fdb_rules(esw, flow, &parse_attr->spec, attr);
14435dbe906fSPaul Blakey 
14448914add2SVlad Buslov 	if (IS_ERR(flow->rule[0])) {
14458914add2SVlad Buslov 		err = PTR_ERR(flow->rule[0]);
14468914add2SVlad Buslov 		goto err_out;
14478914add2SVlad Buslov 	}
1448226f2ca3SVlad Buslov 	flow_flag_set(flow, OFFLOADED);
1449c83954abSRabie Loulou 
14505dbe906fSPaul Blakey 	return 0;
14518914add2SVlad Buslov 
14528914add2SVlad Buslov err_out:
14538914add2SVlad Buslov 	flow_flag_set(flow, FAILED);
14548914add2SVlad Buslov 	return err;
1455aa0cbbaeSOr Gerlitz }
1456d85cdccbSOr Gerlitz 
14579272e3dfSYevgeny Kliteynik static bool mlx5_flow_has_geneve_opt(struct mlx5e_tc_flow *flow)
14589272e3dfSYevgeny Kliteynik {
1459c620b772SAriel Levkovich 	struct mlx5_flow_spec *spec = &flow->attr->parse_attr->spec;
14609272e3dfSYevgeny Kliteynik 	void *headers_v = MLX5_ADDR_OF(fte_match_param,
14619272e3dfSYevgeny Kliteynik 				       spec->match_value,
14629272e3dfSYevgeny Kliteynik 				       misc_parameters_3);
14639272e3dfSYevgeny Kliteynik 	u32 geneve_tlv_opt_0_data = MLX5_GET(fte_match_set_misc3,
14649272e3dfSYevgeny Kliteynik 					     headers_v,
14659272e3dfSYevgeny Kliteynik 					     geneve_tlv_option_0_data);
14669272e3dfSYevgeny Kliteynik 
14679272e3dfSYevgeny Kliteynik 	return !!geneve_tlv_opt_0_data;
14689272e3dfSYevgeny Kliteynik }
14699272e3dfSYevgeny Kliteynik 
1470d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv,
1471d85cdccbSOr Gerlitz 				  struct mlx5e_tc_flow *flow)
1472d85cdccbSOr Gerlitz {
1473d85cdccbSOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
1474c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr = flow->attr;
1475777bb800SVlad Buslov 	struct mlx5_esw_flow_attr *esw_attr;
14768914add2SVlad Buslov 	bool vf_tun = false;
1477f493f155SEli Britstein 	int out_index;
1478d85cdccbSOr Gerlitz 
1479777bb800SVlad Buslov 	esw_attr = attr->esw_attr;
14800a7fcb78SPaul Blakey 	mlx5e_put_flow_tunnel_id(flow);
14810a7fcb78SPaul Blakey 
148212a240a4SJianbo Liu 	if (flow_flag_test(flow, NOT_READY))
1483b4a23329SRoi Dayan 		remove_unready_flow(flow);
1484ef06c9eeSRoi Dayan 
1485226f2ca3SVlad Buslov 	if (mlx5e_is_offloaded_flow(flow)) {
1486226f2ca3SVlad Buslov 		if (flow_flag_test(flow, SLOW))
1487178f69b4SEli Cohen 			mlx5e_tc_unoffload_from_slow_path(esw, flow);
14885dbe906fSPaul Blakey 		else
14895dbe906fSPaul Blakey 			mlx5e_tc_unoffload_fdb_rules(esw, flow, attr);
14905dbe906fSPaul Blakey 	}
1491d85cdccbSOr Gerlitz 
14929272e3dfSYevgeny Kliteynik 	if (mlx5_flow_has_geneve_opt(flow))
14939272e3dfSYevgeny Kliteynik 		mlx5_geneve_tlv_option_del(priv->mdev->geneve);
14949272e3dfSYevgeny Kliteynik 
1495513f8f7fSOr Gerlitz 	mlx5_eswitch_del_vlan_action(esw, attr);
1496d85cdccbSOr Gerlitz 
1497777bb800SVlad Buslov 	if (flow->decap_route)
1498777bb800SVlad Buslov 		mlx5e_detach_decap_route(priv, flow);
1499777bb800SVlad Buslov 
1500777bb800SVlad Buslov 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) {
15018914add2SVlad Buslov 		if (esw_attr->dests[out_index].flags &
15028914add2SVlad Buslov 		    MLX5_ESW_DEST_CHAIN_WITH_SRC_PORT_CHANGE)
15038914add2SVlad Buslov 			vf_tun = true;
1504777bb800SVlad Buslov 		if (esw_attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP) {
15058c4dc42bSEli Britstein 			mlx5e_detach_encap(priv, flow, out_index);
15062a4b6526SVlad Buslov 			kfree(attr->parse_attr->tun_info[out_index]);
15072a4b6526SVlad Buslov 		}
1508777bb800SVlad Buslov 	}
1509d7e75a32SOr Gerlitz 
1510aedd133dSAriel Levkovich 	mlx5_tc_ct_match_del(get_ct_priv(priv), &flow->attr->ct_attr);
15114c8594adSRoi Dayan 
1512c7b9038dSVlad Buslov 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) {
1513c7b9038dSVlad Buslov 		dealloc_mod_hdr_actions(&attr->parse_attr->mod_hdr_acts);
15148914add2SVlad Buslov 		if (vf_tun && attr->modify_hdr)
15158914add2SVlad Buslov 			mlx5_modify_header_dealloc(priv->mdev, attr->modify_hdr);
15168914add2SVlad Buslov 		else
15171a9527bbSOr Gerlitz 			mlx5e_detach_mod_hdr(priv, flow);
1518c7b9038dSVlad Buslov 	}
15198914add2SVlad Buslov 	kvfree(attr->parse_attr);
15208914add2SVlad Buslov 	kvfree(attr->esw_attr->rx_tun_attr);
1521b8aee822SMark Bloch 
1522b8aee822SMark Bloch 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT)
1523777bb800SVlad Buslov 		mlx5_fc_destroy(esw_attr->counter_dev, attr->counter);
152414e6b038SEli Cohen 
152514e6b038SEli Cohen 	if (flow_flag_test(flow, L3_TO_L2_DECAP))
152614e6b038SEli Cohen 		mlx5e_detach_decap(priv, flow);
1527c620b772SAriel Levkovich 
152841c2fd94SChris Mi 	kfree(flow->attr->esw_attr->sample);
1529c620b772SAriel Levkovich 	kfree(flow->attr);
1530d85cdccbSOr Gerlitz }
1531d85cdccbSOr Gerlitz 
15320d9f9647SVlad Buslov struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow)
1533b8aee822SMark Bloch {
1534c620b772SAriel Levkovich 	return flow->attr->counter;
1535b8aee822SMark Bloch }
1536b8aee822SMark Bloch 
15376a06c2f7SVlad Buslov /* Iterate over tmp_list of flows attached to flow_list head. */
1538021905f8SVlad Buslov void mlx5e_put_flow_list(struct mlx5e_priv *priv, struct list_head *flow_list)
15396a06c2f7SVlad Buslov {
15406a06c2f7SVlad Buslov 	struct mlx5e_tc_flow *flow, *tmp;
15416a06c2f7SVlad Buslov 
15426a06c2f7SVlad Buslov 	list_for_each_entry_safe(flow, tmp, flow_list, tmp_list)
15436a06c2f7SVlad Buslov 		mlx5e_flow_put(priv, flow);
15446a06c2f7SVlad Buslov }
15456a06c2f7SVlad Buslov 
154604de7ddaSRoi Dayan static void __mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
154704de7ddaSRoi Dayan {
154804de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = flow->priv->mdev->priv.eswitch;
154904de7ddaSRoi Dayan 
1550226f2ca3SVlad Buslov 	if (!flow_flag_test(flow, ESWITCH) ||
1551226f2ca3SVlad Buslov 	    !flow_flag_test(flow, DUP))
155204de7ddaSRoi Dayan 		return;
155304de7ddaSRoi Dayan 
155404de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
155504de7ddaSRoi Dayan 	list_del(&flow->peer);
155604de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
155704de7ddaSRoi Dayan 
1558226f2ca3SVlad Buslov 	flow_flag_clear(flow, DUP);
155904de7ddaSRoi Dayan 
1560eb252c3aSRoi Dayan 	if (refcount_dec_and_test(&flow->peer_flow->refcnt)) {
156104de7ddaSRoi Dayan 		mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow);
1562a23dae79SRoi Dayan 		kfree(flow->peer_flow);
1563eb252c3aSRoi Dayan 	}
1564eb252c3aSRoi Dayan 
156504de7ddaSRoi Dayan 	flow->peer_flow = NULL;
156604de7ddaSRoi Dayan }
156704de7ddaSRoi Dayan 
156804de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow)
156904de7ddaSRoi Dayan {
157004de7ddaSRoi Dayan 	struct mlx5_core_dev *dev = flow->priv->mdev;
157104de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = dev->priv.devcom;
157204de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
157304de7ddaSRoi Dayan 
157404de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
157504de7ddaSRoi Dayan 	if (!peer_esw)
157604de7ddaSRoi Dayan 		return;
157704de7ddaSRoi Dayan 
157804de7ddaSRoi Dayan 	__mlx5e_tc_del_fdb_peer_flow(flow);
157904de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
158004de7ddaSRoi Dayan }
158104de7ddaSRoi Dayan 
1582e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv,
1583961e8979SRoi Dayan 			      struct mlx5e_tc_flow *flow)
1584e8f887acSAmir Vadai {
1585226f2ca3SVlad Buslov 	if (mlx5e_is_eswitch_flow(flow)) {
158604de7ddaSRoi Dayan 		mlx5e_tc_del_fdb_peer_flow(flow);
1587d85cdccbSOr Gerlitz 		mlx5e_tc_del_fdb_flow(priv, flow);
158804de7ddaSRoi Dayan 	} else {
1589d85cdccbSOr Gerlitz 		mlx5e_tc_del_nic_flow(priv, flow);
1590e8f887acSAmir Vadai 	}
159104de7ddaSRoi Dayan }
1592e8f887acSAmir Vadai 
15930a7fcb78SPaul Blakey static int flow_has_tc_fwd_action(struct flow_cls_offload *f)
1594bbd00f7eSHadar Hen Zion {
1595f9e30088SPablo Neira Ayuso 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
15960a7fcb78SPaul Blakey 	struct flow_action *flow_action = &rule->action;
15970a7fcb78SPaul Blakey 	const struct flow_action_entry *act;
15980a7fcb78SPaul Blakey 	int i;
1599bbd00f7eSHadar Hen Zion 
16000a7fcb78SPaul Blakey 	flow_action_for_each(i, act, flow_action) {
16010a7fcb78SPaul Blakey 		switch (act->id) {
16020a7fcb78SPaul Blakey 		case FLOW_ACTION_GOTO:
16030a7fcb78SPaul Blakey 			return true;
16040a7fcb78SPaul Blakey 		default:
16050a7fcb78SPaul Blakey 			continue;
1606fe1587a7SDmytro Linkin 		}
16072e72eb43SOr Gerlitz 	}
1608bbd00f7eSHadar Hen Zion 
16090a7fcb78SPaul Blakey 	return false;
16100a7fcb78SPaul Blakey }
1611bcef735cSOr Gerlitz 
16120a7fcb78SPaul Blakey static int
16130a7fcb78SPaul Blakey enc_opts_is_dont_care_or_full_match(struct mlx5e_priv *priv,
16140a7fcb78SPaul Blakey 				    struct flow_dissector_key_enc_opts *opts,
16150a7fcb78SPaul Blakey 				    struct netlink_ext_ack *extack,
16160a7fcb78SPaul Blakey 				    bool *dont_care)
16170a7fcb78SPaul Blakey {
16180a7fcb78SPaul Blakey 	struct geneve_opt *opt;
16190a7fcb78SPaul Blakey 	int off = 0;
1620bcef735cSOr Gerlitz 
16210a7fcb78SPaul Blakey 	*dont_care = true;
1622bcef735cSOr Gerlitz 
16230a7fcb78SPaul Blakey 	while (opts->len > off) {
16240a7fcb78SPaul Blakey 		opt = (struct geneve_opt *)&opts->data[off];
1625e98bedf5SEli Britstein 
16260a7fcb78SPaul Blakey 		if (!(*dont_care) || opt->opt_class || opt->type ||
16270a7fcb78SPaul Blakey 		    memchr_inv(opt->opt_data, 0, opt->length * 4)) {
16280a7fcb78SPaul Blakey 			*dont_care = false;
16290a7fcb78SPaul Blakey 
1630c51323eeSSaeed Mahameed 			if (opt->opt_class != htons(U16_MAX) ||
1631d7a42ad0SRoi Dayan 			    opt->type != U8_MAX) {
16320a7fcb78SPaul Blakey 				NL_SET_ERR_MSG(extack,
16330a7fcb78SPaul Blakey 					       "Partial match of tunnel options in chain > 0 isn't supported");
16340a7fcb78SPaul Blakey 				netdev_warn(priv->netdev,
16350a7fcb78SPaul Blakey 					    "Partial match of tunnel options in chain > 0 isn't supported");
1636e98bedf5SEli Britstein 				return -EOPNOTSUPP;
1637e98bedf5SEli Britstein 			}
1638bcef735cSOr Gerlitz 		}
1639bcef735cSOr Gerlitz 
16400a7fcb78SPaul Blakey 		off += sizeof(struct geneve_opt) + opt->length * 4;
1641bbd00f7eSHadar Hen Zion 	}
1642bbd00f7eSHadar Hen Zion 
1643bbd00f7eSHadar Hen Zion 	return 0;
1644bbd00f7eSHadar Hen Zion }
1645bbd00f7eSHadar Hen Zion 
16460a7fcb78SPaul Blakey #define COPY_DISSECTOR(rule, diss_key, dst)\
16470a7fcb78SPaul Blakey ({ \
16480a7fcb78SPaul Blakey 	struct flow_rule *__rule = (rule);\
16490a7fcb78SPaul Blakey 	typeof(dst) __dst = dst;\
16500a7fcb78SPaul Blakey \
16510a7fcb78SPaul Blakey 	memcpy(__dst,\
16520a7fcb78SPaul Blakey 	       skb_flow_dissector_target(__rule->match.dissector,\
16530a7fcb78SPaul Blakey 					 diss_key,\
16540a7fcb78SPaul Blakey 					 __rule->match.key),\
16550a7fcb78SPaul Blakey 	       sizeof(*__dst));\
16560a7fcb78SPaul Blakey })
16570a7fcb78SPaul Blakey 
16580a7fcb78SPaul Blakey static int mlx5e_get_flow_tunnel_id(struct mlx5e_priv *priv,
16590a7fcb78SPaul Blakey 				    struct mlx5e_tc_flow *flow,
16600a7fcb78SPaul Blakey 				    struct flow_cls_offload *f,
16610a7fcb78SPaul Blakey 				    struct net_device *filter_dev)
16628377629eSEli Britstein {
16630a7fcb78SPaul Blakey 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
16640a7fcb78SPaul Blakey 	struct netlink_ext_ack *extack = f->common.extack;
16650a7fcb78SPaul Blakey 	struct mlx5e_tc_mod_hdr_acts *mod_hdr_acts;
16660a7fcb78SPaul Blakey 	struct flow_match_enc_opts enc_opts_match;
1667d7a42ad0SRoi Dayan 	struct tunnel_match_enc_opts tun_enc_opts;
16680a7fcb78SPaul Blakey 	struct mlx5_rep_uplink_priv *uplink_priv;
1669c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr = flow->attr;
16700a7fcb78SPaul Blakey 	struct mlx5e_rep_priv *uplink_rpriv;
16710a7fcb78SPaul Blakey 	struct tunnel_match_key tunnel_key;
16720a7fcb78SPaul Blakey 	bool enc_opts_is_dont_care = true;
16730a7fcb78SPaul Blakey 	u32 tun_id, enc_opts_id = 0;
16740a7fcb78SPaul Blakey 	struct mlx5_eswitch *esw;
16750a7fcb78SPaul Blakey 	u32 value, mask;
16760a7fcb78SPaul Blakey 	int err;
16770a7fcb78SPaul Blakey 
16780a7fcb78SPaul Blakey 	esw = priv->mdev->priv.eswitch;
16790a7fcb78SPaul Blakey 	uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
16800a7fcb78SPaul Blakey 	uplink_priv = &uplink_rpriv->uplink_priv;
16810a7fcb78SPaul Blakey 
16820a7fcb78SPaul Blakey 	memset(&tunnel_key, 0, sizeof(tunnel_key));
16830a7fcb78SPaul Blakey 	COPY_DISSECTOR(rule, FLOW_DISSECTOR_KEY_ENC_CONTROL,
16840a7fcb78SPaul Blakey 		       &tunnel_key.enc_control);
16850a7fcb78SPaul Blakey 	if (tunnel_key.enc_control.addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS)
16860a7fcb78SPaul Blakey 		COPY_DISSECTOR(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS,
16870a7fcb78SPaul Blakey 			       &tunnel_key.enc_ipv4);
16880a7fcb78SPaul Blakey 	else
16890a7fcb78SPaul Blakey 		COPY_DISSECTOR(rule, FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS,
16900a7fcb78SPaul Blakey 			       &tunnel_key.enc_ipv6);
16910a7fcb78SPaul Blakey 	COPY_DISSECTOR(rule, FLOW_DISSECTOR_KEY_ENC_IP, &tunnel_key.enc_ip);
16920a7fcb78SPaul Blakey 	COPY_DISSECTOR(rule, FLOW_DISSECTOR_KEY_ENC_PORTS,
16930a7fcb78SPaul Blakey 		       &tunnel_key.enc_tp);
16940a7fcb78SPaul Blakey 	COPY_DISSECTOR(rule, FLOW_DISSECTOR_KEY_ENC_KEYID,
16950a7fcb78SPaul Blakey 		       &tunnel_key.enc_key_id);
16960a7fcb78SPaul Blakey 	tunnel_key.filter_ifindex = filter_dev->ifindex;
16970a7fcb78SPaul Blakey 
16980a7fcb78SPaul Blakey 	err = mapping_add(uplink_priv->tunnel_mapping, &tunnel_key, &tun_id);
16990a7fcb78SPaul Blakey 	if (err)
17000a7fcb78SPaul Blakey 		return err;
17010a7fcb78SPaul Blakey 
17020a7fcb78SPaul Blakey 	flow_rule_match_enc_opts(rule, &enc_opts_match);
17030a7fcb78SPaul Blakey 	err = enc_opts_is_dont_care_or_full_match(priv,
17040a7fcb78SPaul Blakey 						  enc_opts_match.mask,
17050a7fcb78SPaul Blakey 						  extack,
17060a7fcb78SPaul Blakey 						  &enc_opts_is_dont_care);
17070a7fcb78SPaul Blakey 	if (err)
17080a7fcb78SPaul Blakey 		goto err_enc_opts;
17090a7fcb78SPaul Blakey 
17100a7fcb78SPaul Blakey 	if (!enc_opts_is_dont_care) {
1711d7a42ad0SRoi Dayan 		memset(&tun_enc_opts, 0, sizeof(tun_enc_opts));
1712d7a42ad0SRoi Dayan 		memcpy(&tun_enc_opts.key, enc_opts_match.key,
1713d7a42ad0SRoi Dayan 		       sizeof(*enc_opts_match.key));
1714d7a42ad0SRoi Dayan 		memcpy(&tun_enc_opts.mask, enc_opts_match.mask,
1715d7a42ad0SRoi Dayan 		       sizeof(*enc_opts_match.mask));
1716d7a42ad0SRoi Dayan 
17170a7fcb78SPaul Blakey 		err = mapping_add(uplink_priv->tunnel_enc_opts_mapping,
1718d7a42ad0SRoi Dayan 				  &tun_enc_opts, &enc_opts_id);
17190a7fcb78SPaul Blakey 		if (err)
17200a7fcb78SPaul Blakey 			goto err_enc_opts;
17210a7fcb78SPaul Blakey 	}
17220a7fcb78SPaul Blakey 
17230a7fcb78SPaul Blakey 	value = tun_id << ENC_OPTS_BITS | enc_opts_id;
17240a7fcb78SPaul Blakey 	mask = enc_opts_id ? TUNNEL_ID_MASK :
17250a7fcb78SPaul Blakey 			     (TUNNEL_ID_MASK & ~ENC_OPTS_BITS_MASK);
17260a7fcb78SPaul Blakey 
17270a7fcb78SPaul Blakey 	if (attr->chain) {
17280a7fcb78SPaul Blakey 		mlx5e_tc_match_to_reg_match(&attr->parse_attr->spec,
17290a7fcb78SPaul Blakey 					    TUNNEL_TO_REG, value, mask);
17300a7fcb78SPaul Blakey 	} else {
17310a7fcb78SPaul Blakey 		mod_hdr_acts = &attr->parse_attr->mod_hdr_acts;
17320a7fcb78SPaul Blakey 		err = mlx5e_tc_match_to_reg_set(priv->mdev,
1733aedd133dSAriel Levkovich 						mod_hdr_acts, MLX5_FLOW_NAMESPACE_FDB,
17340a7fcb78SPaul Blakey 						TUNNEL_TO_REG, value);
17350a7fcb78SPaul Blakey 		if (err)
17360a7fcb78SPaul Blakey 			goto err_set;
17370a7fcb78SPaul Blakey 
17380a7fcb78SPaul Blakey 		attr->action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
17390a7fcb78SPaul Blakey 	}
17400a7fcb78SPaul Blakey 
17410a7fcb78SPaul Blakey 	flow->tunnel_id = value;
17420a7fcb78SPaul Blakey 	return 0;
17430a7fcb78SPaul Blakey 
17440a7fcb78SPaul Blakey err_set:
17450a7fcb78SPaul Blakey 	if (enc_opts_id)
17460a7fcb78SPaul Blakey 		mapping_remove(uplink_priv->tunnel_enc_opts_mapping,
17470a7fcb78SPaul Blakey 			       enc_opts_id);
17480a7fcb78SPaul Blakey err_enc_opts:
17490a7fcb78SPaul Blakey 	mapping_remove(uplink_priv->tunnel_mapping, tun_id);
17500a7fcb78SPaul Blakey 	return err;
17510a7fcb78SPaul Blakey }
17520a7fcb78SPaul Blakey 
17530a7fcb78SPaul Blakey static void mlx5e_put_flow_tunnel_id(struct mlx5e_tc_flow *flow)
17540a7fcb78SPaul Blakey {
17550a7fcb78SPaul Blakey 	u32 enc_opts_id = flow->tunnel_id & ENC_OPTS_BITS_MASK;
17560a7fcb78SPaul Blakey 	u32 tun_id = flow->tunnel_id >> ENC_OPTS_BITS;
17570a7fcb78SPaul Blakey 	struct mlx5_rep_uplink_priv *uplink_priv;
17580a7fcb78SPaul Blakey 	struct mlx5e_rep_priv *uplink_rpriv;
17590a7fcb78SPaul Blakey 	struct mlx5_eswitch *esw;
17600a7fcb78SPaul Blakey 
17610a7fcb78SPaul Blakey 	esw = flow->priv->mdev->priv.eswitch;
17620a7fcb78SPaul Blakey 	uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
17630a7fcb78SPaul Blakey 	uplink_priv = &uplink_rpriv->uplink_priv;
17640a7fcb78SPaul Blakey 
17650a7fcb78SPaul Blakey 	if (tun_id)
17660a7fcb78SPaul Blakey 		mapping_remove(uplink_priv->tunnel_mapping, tun_id);
17670a7fcb78SPaul Blakey 	if (enc_opts_id)
17680a7fcb78SPaul Blakey 		mapping_remove(uplink_priv->tunnel_enc_opts_mapping,
17690a7fcb78SPaul Blakey 			       enc_opts_id);
17700a7fcb78SPaul Blakey }
17710a7fcb78SPaul Blakey 
17724c3844d9SPaul Blakey u32 mlx5e_tc_get_flow_tun_id(struct mlx5e_tc_flow *flow)
17734c3844d9SPaul Blakey {
17744c3844d9SPaul Blakey 	return flow->tunnel_id;
17754c3844d9SPaul Blakey }
17764c3844d9SPaul Blakey 
1777fca53304SEli Britstein void mlx5e_tc_set_ethertype(struct mlx5_core_dev *mdev,
1778fca53304SEli Britstein 			    struct flow_match_basic *match, bool outer,
1779fca53304SEli Britstein 			    void *headers_c, void *headers_v)
17804a5d5d73SEli Britstein {
1781fca53304SEli Britstein 	bool ip_version_cap;
1782fca53304SEli Britstein 
1783fca53304SEli Britstein 	ip_version_cap = outer ?
1784fca53304SEli Britstein 		MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
1785fca53304SEli Britstein 					  ft_field_support.outer_ip_version) :
1786fca53304SEli Britstein 		MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
1787fca53304SEli Britstein 					  ft_field_support.inner_ip_version);
1788fca53304SEli Britstein 
1789fca53304SEli Britstein 	if (ip_version_cap && match->mask->n_proto == htons(0xFFFF) &&
1790fca53304SEli Britstein 	    (match->key->n_proto == htons(ETH_P_IP) ||
1791fca53304SEli Britstein 	     match->key->n_proto == htons(ETH_P_IPV6))) {
1792fca53304SEli Britstein 		MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ip_version);
1793fca53304SEli Britstein 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_version,
1794fca53304SEli Britstein 			 match->key->n_proto == htons(ETH_P_IP) ? 4 : 6);
1795fca53304SEli Britstein 	} else {
17964a5d5d73SEli Britstein 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype,
17974a5d5d73SEli Britstein 			 ntohs(match->mask->n_proto));
17984a5d5d73SEli Britstein 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype,
17994a5d5d73SEli Britstein 			 ntohs(match->key->n_proto));
18004a5d5d73SEli Britstein 	}
1801fca53304SEli Britstein }
18024a5d5d73SEli Britstein 
18030d9f9647SVlad Buslov u8 mlx5e_tc_get_ip_version(struct mlx5_flow_spec *spec, bool outer)
1804a508728aSVlad Buslov {
1805a508728aSVlad Buslov 	void *headers_v;
1806a508728aSVlad Buslov 	u16 ethertype;
1807a508728aSVlad Buslov 	u8 ip_version;
1808a508728aSVlad Buslov 
1809a508728aSVlad Buslov 	if (outer)
1810a508728aSVlad Buslov 		headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers);
1811a508728aSVlad Buslov 	else
1812a508728aSVlad Buslov 		headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, inner_headers);
1813a508728aSVlad Buslov 
1814a508728aSVlad Buslov 	ip_version = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_version);
1815a508728aSVlad Buslov 	/* Return ip_version converted from ethertype anyway */
1816a508728aSVlad Buslov 	if (!ip_version) {
1817a508728aSVlad Buslov 		ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype);
1818a508728aSVlad Buslov 		if (ethertype == ETH_P_IP || ethertype == ETH_P_ARP)
1819a508728aSVlad Buslov 			ip_version = 4;
1820a508728aSVlad Buslov 		else if (ethertype == ETH_P_IPV6)
1821a508728aSVlad Buslov 			ip_version = 6;
1822a508728aSVlad Buslov 	}
1823a508728aSVlad Buslov 	return ip_version;
1824a508728aSVlad Buslov }
1825a508728aSVlad Buslov 
18260a7fcb78SPaul Blakey static int parse_tunnel_attr(struct mlx5e_priv *priv,
18270a7fcb78SPaul Blakey 			     struct mlx5e_tc_flow *flow,
18280a7fcb78SPaul Blakey 			     struct mlx5_flow_spec *spec,
18290a7fcb78SPaul Blakey 			     struct flow_cls_offload *f,
18300a7fcb78SPaul Blakey 			     struct net_device *filter_dev,
18310a7fcb78SPaul Blakey 			     u8 *match_level,
18320a7fcb78SPaul Blakey 			     bool *match_inner)
18330a7fcb78SPaul Blakey {
1834a508728aSVlad Buslov 	struct mlx5e_tc_tunnel *tunnel = mlx5e_get_tc_tun(filter_dev);
18350a7fcb78SPaul Blakey 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
18360a7fcb78SPaul Blakey 	struct netlink_ext_ack *extack = f->common.extack;
18370a7fcb78SPaul Blakey 	bool needs_mapping, sets_mapping;
18380a7fcb78SPaul Blakey 	int err;
18390a7fcb78SPaul Blakey 
18400a7fcb78SPaul Blakey 	if (!mlx5e_is_eswitch_flow(flow))
18410a7fcb78SPaul Blakey 		return -EOPNOTSUPP;
18420a7fcb78SPaul Blakey 
1843c620b772SAriel Levkovich 	needs_mapping = !!flow->attr->chain;
1844c620b772SAriel Levkovich 	sets_mapping = !flow->attr->chain && flow_has_tc_fwd_action(f);
18450a7fcb78SPaul Blakey 	*match_inner = !needs_mapping;
18460a7fcb78SPaul Blakey 
18470a7fcb78SPaul Blakey 	if ((needs_mapping || sets_mapping) &&
1848636bb968SPaul Blakey 	    !mlx5_eswitch_reg_c1_loopback_enabled(esw)) {
18490a7fcb78SPaul Blakey 		NL_SET_ERR_MSG(extack,
1850636bb968SPaul Blakey 			       "Chains on tunnel devices isn't supported without register loopback support");
18510a7fcb78SPaul Blakey 		netdev_warn(priv->netdev,
1852636bb968SPaul Blakey 			    "Chains on tunnel devices isn't supported without register loopback support");
18530a7fcb78SPaul Blakey 		return -EOPNOTSUPP;
18540a7fcb78SPaul Blakey 	}
18550a7fcb78SPaul Blakey 
1856c620b772SAriel Levkovich 	if (!flow->attr->chain) {
18570a7fcb78SPaul Blakey 		err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f,
18580a7fcb78SPaul Blakey 					 match_level);
18590a7fcb78SPaul Blakey 		if (err) {
18600a7fcb78SPaul Blakey 			NL_SET_ERR_MSG_MOD(extack,
18610a7fcb78SPaul Blakey 					   "Failed to parse tunnel attributes");
18620a7fcb78SPaul Blakey 			netdev_warn(priv->netdev,
18630a7fcb78SPaul Blakey 				    "Failed to parse tunnel attributes");
18640a7fcb78SPaul Blakey 			return err;
18650a7fcb78SPaul Blakey 		}
18660a7fcb78SPaul Blakey 
186714e6b038SEli Cohen 		/* With mpls over udp we decapsulate using packet reformat
186814e6b038SEli Cohen 		 * object
186914e6b038SEli Cohen 		 */
187014e6b038SEli Cohen 		if (!netif_is_bareudp(filter_dev))
1871c620b772SAriel Levkovich 			flow->attr->action |= MLX5_FLOW_CONTEXT_ACTION_DECAP;
1872a508728aSVlad Buslov 		err = mlx5e_tc_set_attr_rx_tun(flow, spec);
1873a508728aSVlad Buslov 		if (err)
1874a508728aSVlad Buslov 			return err;
1875a508728aSVlad Buslov 	} else if (tunnel && tunnel->tunnel_type == MLX5E_TC_TUNNEL_TYPE_VXLAN) {
1876a508728aSVlad Buslov 		struct mlx5_flow_spec *tmp_spec;
1877a508728aSVlad Buslov 
1878a508728aSVlad Buslov 		tmp_spec = kvzalloc(sizeof(*tmp_spec), GFP_KERNEL);
1879a508728aSVlad Buslov 		if (!tmp_spec) {
1880a508728aSVlad Buslov 			NL_SET_ERR_MSG_MOD(extack, "Failed to allocate memory for vxlan tmp spec");
1881a508728aSVlad Buslov 			netdev_warn(priv->netdev, "Failed to allocate memory for vxlan tmp spec");
1882a508728aSVlad Buslov 			return -ENOMEM;
1883a508728aSVlad Buslov 		}
1884a508728aSVlad Buslov 		memcpy(tmp_spec, spec, sizeof(*tmp_spec));
1885a508728aSVlad Buslov 
1886a508728aSVlad Buslov 		err = mlx5e_tc_tun_parse(filter_dev, priv, tmp_spec, f, match_level);
1887a508728aSVlad Buslov 		if (err) {
1888a508728aSVlad Buslov 			kvfree(tmp_spec);
1889a508728aSVlad Buslov 			NL_SET_ERR_MSG_MOD(extack, "Failed to parse tunnel attributes");
1890a508728aSVlad Buslov 			netdev_warn(priv->netdev, "Failed to parse tunnel attributes");
1891a508728aSVlad Buslov 			return err;
1892a508728aSVlad Buslov 		}
1893a508728aSVlad Buslov 		err = mlx5e_tc_set_attr_rx_tun(flow, tmp_spec);
1894a508728aSVlad Buslov 		kvfree(tmp_spec);
1895a508728aSVlad Buslov 		if (err)
1896a508728aSVlad Buslov 			return err;
18970a7fcb78SPaul Blakey 	}
18980a7fcb78SPaul Blakey 
18990a7fcb78SPaul Blakey 	if (!needs_mapping && !sets_mapping)
19000a7fcb78SPaul Blakey 		return 0;
19010a7fcb78SPaul Blakey 
19020a7fcb78SPaul Blakey 	return mlx5e_get_flow_tunnel_id(priv, flow, f, filter_dev);
19030a7fcb78SPaul Blakey }
19040a7fcb78SPaul Blakey 
19050a7fcb78SPaul Blakey static void *get_match_inner_headers_criteria(struct mlx5_flow_spec *spec)
19060a7fcb78SPaul Blakey {
19070a7fcb78SPaul Blakey 	return MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
19080a7fcb78SPaul Blakey 			    inner_headers);
19090a7fcb78SPaul Blakey }
19100a7fcb78SPaul Blakey 
19110a7fcb78SPaul Blakey static void *get_match_inner_headers_value(struct mlx5_flow_spec *spec)
19120a7fcb78SPaul Blakey {
19130a7fcb78SPaul Blakey 	return MLX5_ADDR_OF(fte_match_param, spec->match_value,
19140a7fcb78SPaul Blakey 			    inner_headers);
19150a7fcb78SPaul Blakey }
19160a7fcb78SPaul Blakey 
19170a7fcb78SPaul Blakey static void *get_match_outer_headers_criteria(struct mlx5_flow_spec *spec)
19180a7fcb78SPaul Blakey {
19190a7fcb78SPaul Blakey 	return MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
19200a7fcb78SPaul Blakey 			    outer_headers);
19210a7fcb78SPaul Blakey }
19220a7fcb78SPaul Blakey 
19230a7fcb78SPaul Blakey static void *get_match_outer_headers_value(struct mlx5_flow_spec *spec)
19240a7fcb78SPaul Blakey {
19250a7fcb78SPaul Blakey 	return MLX5_ADDR_OF(fte_match_param, spec->match_value,
19268377629eSEli Britstein 			    outer_headers);
19278377629eSEli Britstein }
19288377629eSEli Britstein 
19298377629eSEli Britstein static void *get_match_headers_value(u32 flags,
19308377629eSEli Britstein 				     struct mlx5_flow_spec *spec)
19318377629eSEli Britstein {
19328377629eSEli Britstein 	return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ?
19330a7fcb78SPaul Blakey 		get_match_inner_headers_value(spec) :
19340a7fcb78SPaul Blakey 		get_match_outer_headers_value(spec);
19350a7fcb78SPaul Blakey }
19360a7fcb78SPaul Blakey 
19370a7fcb78SPaul Blakey static void *get_match_headers_criteria(u32 flags,
19380a7fcb78SPaul Blakey 					struct mlx5_flow_spec *spec)
19390a7fcb78SPaul Blakey {
19400a7fcb78SPaul Blakey 	return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ?
19410a7fcb78SPaul Blakey 		get_match_inner_headers_criteria(spec) :
19420a7fcb78SPaul Blakey 		get_match_outer_headers_criteria(spec);
19438377629eSEli Britstein }
19448377629eSEli Britstein 
19456d65bc64Swenxu static int mlx5e_flower_parse_meta(struct net_device *filter_dev,
19466d65bc64Swenxu 				   struct flow_cls_offload *f)
19476d65bc64Swenxu {
19486d65bc64Swenxu 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
19496d65bc64Swenxu 	struct netlink_ext_ack *extack = f->common.extack;
19506d65bc64Swenxu 	struct net_device *ingress_dev;
19516d65bc64Swenxu 	struct flow_match_meta match;
19526d65bc64Swenxu 
19536d65bc64Swenxu 	if (!flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_META))
19546d65bc64Swenxu 		return 0;
19556d65bc64Swenxu 
19566d65bc64Swenxu 	flow_rule_match_meta(rule, &match);
1957e3e0f9b2Swenxu 	if (!match.mask->ingress_ifindex)
1958e3e0f9b2Swenxu 		return 0;
1959e3e0f9b2Swenxu 
19606d65bc64Swenxu 	if (match.mask->ingress_ifindex != 0xFFFFFFFF) {
19616d65bc64Swenxu 		NL_SET_ERR_MSG_MOD(extack, "Unsupported ingress ifindex mask");
1962a683012aSPablo Neira Ayuso 		return -EOPNOTSUPP;
19636d65bc64Swenxu 	}
19646d65bc64Swenxu 
19656d65bc64Swenxu 	ingress_dev = __dev_get_by_index(dev_net(filter_dev),
19666d65bc64Swenxu 					 match.key->ingress_ifindex);
19676d65bc64Swenxu 	if (!ingress_dev) {
19686d65bc64Swenxu 		NL_SET_ERR_MSG_MOD(extack,
19696d65bc64Swenxu 				   "Can't find the ingress port to match on");
1970a683012aSPablo Neira Ayuso 		return -ENOENT;
19716d65bc64Swenxu 	}
19726d65bc64Swenxu 
19736d65bc64Swenxu 	if (ingress_dev != filter_dev) {
19746d65bc64Swenxu 		NL_SET_ERR_MSG_MOD(extack,
19756d65bc64Swenxu 				   "Can't match on the ingress filter port");
1976a683012aSPablo Neira Ayuso 		return -EOPNOTSUPP;
19776d65bc64Swenxu 	}
19786d65bc64Swenxu 
19796d65bc64Swenxu 	return 0;
19806d65bc64Swenxu }
19816d65bc64Swenxu 
198272046a91SEli Cohen static bool skip_key_basic(struct net_device *filter_dev,
198372046a91SEli Cohen 			   struct flow_cls_offload *f)
198472046a91SEli Cohen {
198572046a91SEli Cohen 	/* When doing mpls over udp decap, the user needs to provide
198672046a91SEli Cohen 	 * MPLS_UC as the protocol in order to be able to match on mpls
198772046a91SEli Cohen 	 * label fields.  However, the actual ethertype is IP so we want to
198872046a91SEli Cohen 	 * avoid matching on this, otherwise we'll fail the match.
198972046a91SEli Cohen 	 */
199072046a91SEli Cohen 	if (netif_is_bareudp(filter_dev) && f->common.chain_index == 0)
199172046a91SEli Cohen 		return true;
199272046a91SEli Cohen 
199372046a91SEli Cohen 	return false;
199472046a91SEli Cohen }
199572046a91SEli Cohen 
1996de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv,
19970a7fcb78SPaul Blakey 			      struct mlx5e_tc_flow *flow,
1998de0af0bfSRoi Dayan 			      struct mlx5_flow_spec *spec,
1999f9e30088SPablo Neira Ayuso 			      struct flow_cls_offload *f,
200054c177caSOz Shlomo 			      struct net_device *filter_dev,
200193b3586eSHuy Nguyen 			      u8 *inner_match_level, u8 *outer_match_level)
2002e3a2b7edSAmir Vadai {
2003e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
2004c5bb1730SMaor Gottlieb 	void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
2005c5bb1730SMaor Gottlieb 				       outer_headers);
2006c5bb1730SMaor Gottlieb 	void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
2007c5bb1730SMaor Gottlieb 				       outer_headers);
2008699e96ddSJianbo Liu 	void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
2009699e96ddSJianbo Liu 				    misc_parameters);
2010699e96ddSJianbo Liu 	void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
2011699e96ddSJianbo Liu 				    misc_parameters);
2012a3222a2dSMaor Dickman 	void *misc_c_3 = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
2013a3222a2dSMaor Dickman 				    misc_parameters_3);
2014a3222a2dSMaor Dickman 	void *misc_v_3 = MLX5_ADDR_OF(fte_match_param, spec->match_value,
2015a3222a2dSMaor Dickman 				    misc_parameters_3);
2016f9e30088SPablo Neira Ayuso 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
20178f256622SPablo Neira Ayuso 	struct flow_dissector *dissector = rule->match.dissector;
2018e3a2b7edSAmir Vadai 	u16 addr_type = 0;
2019e3a2b7edSAmir Vadai 	u8 ip_proto = 0;
202093b3586eSHuy Nguyen 	u8 *match_level;
20216d65bc64Swenxu 	int err;
2022e3a2b7edSAmir Vadai 
202393b3586eSHuy Nguyen 	match_level = outer_match_level;
2024de0af0bfSRoi Dayan 
20258f256622SPablo Neira Ayuso 	if (dissector->used_keys &
20263d144578SVlad Buslov 	    ~(BIT(FLOW_DISSECTOR_KEY_META) |
20273d144578SVlad Buslov 	      BIT(FLOW_DISSECTOR_KEY_CONTROL) |
2028e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_BASIC) |
2029e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) |
2030095b6cfdSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_VLAN) |
2031699e96ddSJianbo Liu 	      BIT(FLOW_DISSECTOR_KEY_CVLAN) |
2032e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) |
2033e3a2b7edSAmir Vadai 	      BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) |
2034bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_PORTS) |
2035bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) |
2036bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) |
2037bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) |
2038bbd00f7eSHadar Hen Zion 	      BIT(FLOW_DISSECTOR_KEY_ENC_PORTS)	|
2039e77834ecSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) |
2040fd7da28bSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_TCP) |
2041bcef735cSOr Gerlitz 	      BIT(FLOW_DISSECTOR_KEY_IP)  |
20424c3844d9SPaul Blakey 	      BIT(FLOW_DISSECTOR_KEY_CT) |
20439272e3dfSYevgeny Kliteynik 	      BIT(FLOW_DISSECTOR_KEY_ENC_IP) |
204472046a91SEli Cohen 	      BIT(FLOW_DISSECTOR_KEY_ENC_OPTS) |
2045a3222a2dSMaor Dickman 	      BIT(FLOW_DISSECTOR_KEY_ICMP) |
204672046a91SEli Cohen 	      BIT(FLOW_DISSECTOR_KEY_MPLS))) {
2047e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack, "Unsupported key");
204848470a90SMaor Dickman 		netdev_dbg(priv->netdev, "Unsupported key used: 0x%x\n",
20498f256622SPablo Neira Ayuso 			   dissector->used_keys);
2050e3a2b7edSAmir Vadai 		return -EOPNOTSUPP;
2051e3a2b7edSAmir Vadai 	}
2052e3a2b7edSAmir Vadai 
2053075973c7SVlad Buslov 	if (mlx5e_get_tc_tun(filter_dev)) {
20540a7fcb78SPaul Blakey 		bool match_inner = false;
2055bbd00f7eSHadar Hen Zion 
20560a7fcb78SPaul Blakey 		err = parse_tunnel_attr(priv, flow, spec, f, filter_dev,
20570a7fcb78SPaul Blakey 					outer_match_level, &match_inner);
20580a7fcb78SPaul Blakey 		if (err)
20590a7fcb78SPaul Blakey 			return err;
20600a7fcb78SPaul Blakey 
20610a7fcb78SPaul Blakey 		if (match_inner) {
20620a7fcb78SPaul Blakey 			/* header pointers should point to the inner headers
20630a7fcb78SPaul Blakey 			 * if the packet was decapsulated already.
20640a7fcb78SPaul Blakey 			 * outer headers are set by parse_tunnel_attr.
2065bbd00f7eSHadar Hen Zion 			 */
206693b3586eSHuy Nguyen 			match_level = inner_match_level;
20670a7fcb78SPaul Blakey 			headers_c = get_match_inner_headers_criteria(spec);
20680a7fcb78SPaul Blakey 			headers_v = get_match_inner_headers_value(spec);
20690a7fcb78SPaul Blakey 		}
2070bbd00f7eSHadar Hen Zion 	}
2071bbd00f7eSHadar Hen Zion 
20726d65bc64Swenxu 	err = mlx5e_flower_parse_meta(filter_dev, f);
20736d65bc64Swenxu 	if (err)
20746d65bc64Swenxu 		return err;
20756d65bc64Swenxu 
207672046a91SEli Cohen 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC) &&
207772046a91SEli Cohen 	    !skip_key_basic(filter_dev, f)) {
20788f256622SPablo Neira Ayuso 		struct flow_match_basic match;
2079e3a2b7edSAmir Vadai 
20808f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
2081fca53304SEli Britstein 		mlx5e_tc_set_ethertype(priv->mdev, &match,
2082fca53304SEli Britstein 				       match_level == outer_match_level,
2083fca53304SEli Britstein 				       headers_c, headers_v);
20848f256622SPablo Neira Ayuso 
20858f256622SPablo Neira Ayuso 		if (match.mask->n_proto)
2086d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
2087e3a2b7edSAmir Vadai 	}
208835a605dbSEli Britstein 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN) ||
208935a605dbSEli Britstein 	    is_vlan_dev(filter_dev)) {
209035a605dbSEli Britstein 		struct flow_dissector_key_vlan filter_dev_mask;
209135a605dbSEli Britstein 		struct flow_dissector_key_vlan filter_dev_key;
20928f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
20938f256622SPablo Neira Ayuso 
209435a605dbSEli Britstein 		if (is_vlan_dev(filter_dev)) {
209535a605dbSEli Britstein 			match.key = &filter_dev_key;
209635a605dbSEli Britstein 			match.key->vlan_id = vlan_dev_vlan_id(filter_dev);
209735a605dbSEli Britstein 			match.key->vlan_tpid = vlan_dev_vlan_proto(filter_dev);
209835a605dbSEli Britstein 			match.key->vlan_priority = 0;
209935a605dbSEli Britstein 			match.mask = &filter_dev_mask;
210035a605dbSEli Britstein 			memset(match.mask, 0xff, sizeof(*match.mask));
210135a605dbSEli Britstein 			match.mask->vlan_priority = 0;
210235a605dbSEli Britstein 		} else {
21038f256622SPablo Neira Ayuso 			flow_rule_match_vlan(rule, &match);
210435a605dbSEli Britstein 		}
21058f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
21068f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
21078f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
21088f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
2109699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2110699e96ddSJianbo Liu 					 svlan_tag, 1);
2111699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2112699e96ddSJianbo Liu 					 svlan_tag, 1);
2113699e96ddSJianbo Liu 			} else {
2114699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2115699e96ddSJianbo Liu 					 cvlan_tag, 1);
2116699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2117699e96ddSJianbo Liu 					 cvlan_tag, 1);
2118699e96ddSJianbo Liu 			}
2119095b6cfdSOr Gerlitz 
21208f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid,
21218f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
21228f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid,
21238f256622SPablo Neira Ayuso 				 match.key->vlan_id);
2124358d79a4SOr Gerlitz 
21258f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio,
21268f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
21278f256622SPablo Neira Ayuso 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio,
21288f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
212954782900SOr Gerlitz 
2130d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
2131095b6cfdSOr Gerlitz 		}
2132d3a80bb5SOr Gerlitz 	} else if (*match_level != MLX5_MATCH_NONE) {
2133fc603294SMark Bloch 		/* cvlan_tag enabled in match criteria and
2134fc603294SMark Bloch 		 * disabled in match value means both S & C tags
2135fc603294SMark Bloch 		 * don't exist (untagged of both)
2136fc603294SMark Bloch 		 */
2137cee26487SJianbo Liu 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1);
2138d3a80bb5SOr Gerlitz 		*match_level = MLX5_MATCH_L2;
2139095b6cfdSOr Gerlitz 	}
2140095b6cfdSOr Gerlitz 
21418f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) {
21428f256622SPablo Neira Ayuso 		struct flow_match_vlan match;
21438f256622SPablo Neira Ayuso 
214412d5cbf8SJianbo Liu 		flow_rule_match_cvlan(rule, &match);
21458f256622SPablo Neira Ayuso 		if (match.mask->vlan_id ||
21468f256622SPablo Neira Ayuso 		    match.mask->vlan_priority ||
21478f256622SPablo Neira Ayuso 		    match.mask->vlan_tpid) {
21488f256622SPablo Neira Ayuso 			if (match.key->vlan_tpid == htons(ETH_P_8021AD)) {
2149699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
2150699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
2151699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
2152699e96ddSJianbo Liu 					 outer_second_svlan_tag, 1);
2153699e96ddSJianbo Liu 			} else {
2154699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_c,
2155699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
2156699e96ddSJianbo Liu 				MLX5_SET(fte_match_set_misc, misc_v,
2157699e96ddSJianbo Liu 					 outer_second_cvlan_tag, 1);
2158699e96ddSJianbo Liu 			}
2159699e96ddSJianbo Liu 
2160699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid,
21618f256622SPablo Neira Ayuso 				 match.mask->vlan_id);
2162699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid,
21638f256622SPablo Neira Ayuso 				 match.key->vlan_id);
2164699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio,
21658f256622SPablo Neira Ayuso 				 match.mask->vlan_priority);
2166699e96ddSJianbo Liu 			MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio,
21678f256622SPablo Neira Ayuso 				 match.key->vlan_priority);
2168699e96ddSJianbo Liu 
2169699e96ddSJianbo Liu 			*match_level = MLX5_MATCH_L2;
21700faddfe6SJianbo Liu 			spec->match_criteria_enable |= MLX5_MATCH_MISC_PARAMETERS;
2171699e96ddSJianbo Liu 		}
2172699e96ddSJianbo Liu 	}
2173699e96ddSJianbo Liu 
21748f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) {
21758f256622SPablo Neira Ayuso 		struct flow_match_eth_addrs match;
217654782900SOr Gerlitz 
21778f256622SPablo Neira Ayuso 		flow_rule_match_eth_addrs(rule, &match);
2178d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2179d3a80bb5SOr Gerlitz 					     dmac_47_16),
21808f256622SPablo Neira Ayuso 				match.mask->dst);
2181d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2182d3a80bb5SOr Gerlitz 					     dmac_47_16),
21838f256622SPablo Neira Ayuso 				match.key->dst);
2184d3a80bb5SOr Gerlitz 
2185d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2186d3a80bb5SOr Gerlitz 					     smac_47_16),
21878f256622SPablo Neira Ayuso 				match.mask->src);
2188d3a80bb5SOr Gerlitz 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2189d3a80bb5SOr Gerlitz 					     smac_47_16),
21908f256622SPablo Neira Ayuso 				match.key->src);
2191d3a80bb5SOr Gerlitz 
21928f256622SPablo Neira Ayuso 		if (!is_zero_ether_addr(match.mask->src) ||
21938f256622SPablo Neira Ayuso 		    !is_zero_ether_addr(match.mask->dst))
2194d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L2;
219554782900SOr Gerlitz 	}
219654782900SOr Gerlitz 
21978f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) {
21988f256622SPablo Neira Ayuso 		struct flow_match_control match;
219954782900SOr Gerlitz 
22008f256622SPablo Neira Ayuso 		flow_rule_match_control(rule, &match);
22018f256622SPablo Neira Ayuso 		addr_type = match.key->addr_type;
220254782900SOr Gerlitz 
220354782900SOr Gerlitz 		/* the HW doesn't support frag first/later */
22048f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_FIRST_FRAG)
220554782900SOr Gerlitz 			return -EOPNOTSUPP;
220654782900SOr Gerlitz 
22078f256622SPablo Neira Ayuso 		if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) {
220854782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1);
220954782900SOr Gerlitz 			MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag,
22108f256622SPablo Neira Ayuso 				 match.key->flags & FLOW_DIS_IS_FRAGMENT);
221154782900SOr Gerlitz 
221254782900SOr Gerlitz 			/* the HW doesn't need L3 inline to match on frag=no */
22138f256622SPablo Neira Ayuso 			if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT))
221483621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L2;
221554782900SOr Gerlitz 	/* ***  L2 attributes parsing up to here *** */
221654782900SOr Gerlitz 			else
221783621b7dSOr Gerlitz 				*match_level = MLX5_MATCH_L3;
221854782900SOr Gerlitz 		}
221954782900SOr Gerlitz 	}
222054782900SOr Gerlitz 
22218f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
22228f256622SPablo Neira Ayuso 		struct flow_match_basic match;
22238f256622SPablo Neira Ayuso 
22248f256622SPablo Neira Ayuso 		flow_rule_match_basic(rule, &match);
22258f256622SPablo Neira Ayuso 		ip_proto = match.key->ip_proto;
222654782900SOr Gerlitz 
222754782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
22288f256622SPablo Neira Ayuso 			 match.mask->ip_proto);
222954782900SOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
22308f256622SPablo Neira Ayuso 			 match.key->ip_proto);
223154782900SOr Gerlitz 
22328f256622SPablo Neira Ayuso 		if (match.mask->ip_proto)
2233d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
223454782900SOr Gerlitz 	}
223554782900SOr Gerlitz 
2236e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
22378f256622SPablo Neira Ayuso 		struct flow_match_ipv4_addrs match;
2238e3a2b7edSAmir Vadai 
22398f256622SPablo Neira Ayuso 		flow_rule_match_ipv4_addrs(rule, &match);
2240e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2241e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
22428f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
2243e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2244e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
22458f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
2246e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2247e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
22488f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
2249e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2250e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
22518f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
2252de0af0bfSRoi Dayan 
22538f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
2254d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
2255e3a2b7edSAmir Vadai 	}
2256e3a2b7edSAmir Vadai 
2257e3a2b7edSAmir Vadai 	if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
22588f256622SPablo Neira Ayuso 		struct flow_match_ipv6_addrs match;
2259e3a2b7edSAmir Vadai 
22608f256622SPablo Neira Ayuso 		flow_rule_match_ipv6_addrs(rule, &match);
2261e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2262e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
22638f256622SPablo Neira Ayuso 		       &match.mask->src, sizeof(match.mask->src));
2264e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2265e3a2b7edSAmir Vadai 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
22668f256622SPablo Neira Ayuso 		       &match.key->src, sizeof(match.key->src));
2267e3a2b7edSAmir Vadai 
2268e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2269e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
22708f256622SPablo Neira Ayuso 		       &match.mask->dst, sizeof(match.mask->dst));
2271e3a2b7edSAmir Vadai 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2272e3a2b7edSAmir Vadai 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
22738f256622SPablo Neira Ayuso 		       &match.key->dst, sizeof(match.key->dst));
2274de0af0bfSRoi Dayan 
22758f256622SPablo Neira Ayuso 		if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY ||
22768f256622SPablo Neira Ayuso 		    ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY)
2277d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
2278e3a2b7edSAmir Vadai 	}
2279e3a2b7edSAmir Vadai 
22808f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) {
22818f256622SPablo Neira Ayuso 		struct flow_match_ip match;
22821f97a526SOr Gerlitz 
22838f256622SPablo Neira Ayuso 		flow_rule_match_ip(rule, &match);
22848f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn,
22858f256622SPablo Neira Ayuso 			 match.mask->tos & 0x3);
22868f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn,
22878f256622SPablo Neira Ayuso 			 match.key->tos & 0x3);
22881f97a526SOr Gerlitz 
22898f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp,
22908f256622SPablo Neira Ayuso 			 match.mask->tos >> 2);
22918f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp,
22928f256622SPablo Neira Ayuso 			 match.key->tos  >> 2);
22931f97a526SOr Gerlitz 
22948f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit,
22958f256622SPablo Neira Ayuso 			 match.mask->ttl);
22968f256622SPablo Neira Ayuso 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit,
22978f256622SPablo Neira Ayuso 			 match.key->ttl);
22981f97a526SOr Gerlitz 
22998f256622SPablo Neira Ayuso 		if (match.mask->ttl &&
2300a8ade55fSOr Gerlitz 		    !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev,
2301e98bedf5SEli Britstein 						ft_field_support.outer_ipv4_ttl)) {
2302e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2303e98bedf5SEli Britstein 					   "Matching on TTL is not supported");
23041f97a526SOr Gerlitz 			return -EOPNOTSUPP;
2305e98bedf5SEli Britstein 		}
2306a8ade55fSOr Gerlitz 
23078f256622SPablo Neira Ayuso 		if (match.mask->tos || match.mask->ttl)
2308d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L3;
23091f97a526SOr Gerlitz 	}
23101f97a526SOr Gerlitz 
231154782900SOr Gerlitz 	/* ***  L3 attributes parsing up to here *** */
231254782900SOr Gerlitz 
23138f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) {
23148f256622SPablo Neira Ayuso 		struct flow_match_ports match;
23158f256622SPablo Neira Ayuso 
23168f256622SPablo Neira Ayuso 		flow_rule_match_ports(rule, &match);
2317e3a2b7edSAmir Vadai 		switch (ip_proto) {
2318e3a2b7edSAmir Vadai 		case IPPROTO_TCP:
2319e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
23208f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.mask->src));
2321e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
23228f256622SPablo Neira Ayuso 				 tcp_sport, ntohs(match.key->src));
2323e3a2b7edSAmir Vadai 
2324e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
23258f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.mask->dst));
2326e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
23278f256622SPablo Neira Ayuso 				 tcp_dport, ntohs(match.key->dst));
2328e3a2b7edSAmir Vadai 			break;
2329e3a2b7edSAmir Vadai 
2330e3a2b7edSAmir Vadai 		case IPPROTO_UDP:
2331e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
23328f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.mask->src));
2333e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
23348f256622SPablo Neira Ayuso 				 udp_sport, ntohs(match.key->src));
2335e3a2b7edSAmir Vadai 
2336e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
23378f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.mask->dst));
2338e3a2b7edSAmir Vadai 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
23398f256622SPablo Neira Ayuso 				 udp_dport, ntohs(match.key->dst));
2340e3a2b7edSAmir Vadai 			break;
2341e3a2b7edSAmir Vadai 		default:
2342e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2343e98bedf5SEli Britstein 					   "Only UDP and TCP transports are supported for L4 matching");
2344e3a2b7edSAmir Vadai 			netdev_err(priv->netdev,
2345e3a2b7edSAmir Vadai 				   "Only UDP and TCP transport are supported\n");
2346e3a2b7edSAmir Vadai 			return -EINVAL;
2347e3a2b7edSAmir Vadai 		}
2348de0af0bfSRoi Dayan 
23498f256622SPablo Neira Ayuso 		if (match.mask->src || match.mask->dst)
2350d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
2351e3a2b7edSAmir Vadai 	}
2352e3a2b7edSAmir Vadai 
23538f256622SPablo Neira Ayuso 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) {
23548f256622SPablo Neira Ayuso 		struct flow_match_tcp match;
2355e77834ecSOr Gerlitz 
23568f256622SPablo Neira Ayuso 		flow_rule_match_tcp(rule, &match);
2357e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags,
23588f256622SPablo Neira Ayuso 			 ntohs(match.mask->flags));
2359e77834ecSOr Gerlitz 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags,
23608f256622SPablo Neira Ayuso 			 ntohs(match.key->flags));
2361e77834ecSOr Gerlitz 
23628f256622SPablo Neira Ayuso 		if (match.mask->flags)
2363d708f902SOr Gerlitz 			*match_level = MLX5_MATCH_L4;
2364e77834ecSOr Gerlitz 	}
2365a3222a2dSMaor Dickman 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ICMP)) {
2366a3222a2dSMaor Dickman 		struct flow_match_icmp match;
2367e77834ecSOr Gerlitz 
2368a3222a2dSMaor Dickman 		flow_rule_match_icmp(rule, &match);
2369a3222a2dSMaor Dickman 		switch (ip_proto) {
2370a3222a2dSMaor Dickman 		case IPPROTO_ICMP:
2371a3222a2dSMaor Dickman 			if (!(MLX5_CAP_GEN(priv->mdev, flex_parser_protocols) &
2372a3222a2dSMaor Dickman 			      MLX5_FLEX_PROTO_ICMP))
2373a3222a2dSMaor Dickman 				return -EOPNOTSUPP;
2374a3222a2dSMaor Dickman 			MLX5_SET(fte_match_set_misc3, misc_c_3, icmp_type,
2375a3222a2dSMaor Dickman 				 match.mask->type);
2376a3222a2dSMaor Dickman 			MLX5_SET(fte_match_set_misc3, misc_v_3, icmp_type,
2377a3222a2dSMaor Dickman 				 match.key->type);
2378a3222a2dSMaor Dickman 			MLX5_SET(fte_match_set_misc3, misc_c_3, icmp_code,
2379a3222a2dSMaor Dickman 				 match.mask->code);
2380a3222a2dSMaor Dickman 			MLX5_SET(fte_match_set_misc3, misc_v_3, icmp_code,
2381a3222a2dSMaor Dickman 				 match.key->code);
2382a3222a2dSMaor Dickman 			break;
2383a3222a2dSMaor Dickman 		case IPPROTO_ICMPV6:
2384a3222a2dSMaor Dickman 			if (!(MLX5_CAP_GEN(priv->mdev, flex_parser_protocols) &
2385a3222a2dSMaor Dickman 			      MLX5_FLEX_PROTO_ICMPV6))
2386a3222a2dSMaor Dickman 				return -EOPNOTSUPP;
2387a3222a2dSMaor Dickman 			MLX5_SET(fte_match_set_misc3, misc_c_3, icmpv6_type,
2388a3222a2dSMaor Dickman 				 match.mask->type);
2389a3222a2dSMaor Dickman 			MLX5_SET(fte_match_set_misc3, misc_v_3, icmpv6_type,
2390a3222a2dSMaor Dickman 				 match.key->type);
2391a3222a2dSMaor Dickman 			MLX5_SET(fte_match_set_misc3, misc_c_3, icmpv6_code,
2392a3222a2dSMaor Dickman 				 match.mask->code);
2393a3222a2dSMaor Dickman 			MLX5_SET(fte_match_set_misc3, misc_v_3, icmpv6_code,
2394a3222a2dSMaor Dickman 				 match.key->code);
2395a3222a2dSMaor Dickman 			break;
2396a3222a2dSMaor Dickman 		default:
2397a3222a2dSMaor Dickman 			NL_SET_ERR_MSG_MOD(extack,
2398a3222a2dSMaor Dickman 					   "Code and type matching only with ICMP and ICMPv6");
2399a3222a2dSMaor Dickman 			netdev_err(priv->netdev,
2400a3222a2dSMaor Dickman 				   "Code and type matching only with ICMP and ICMPv6\n");
2401a3222a2dSMaor Dickman 			return -EINVAL;
2402a3222a2dSMaor Dickman 		}
2403a3222a2dSMaor Dickman 		if (match.mask->code || match.mask->type) {
2404a3222a2dSMaor Dickman 			*match_level = MLX5_MATCH_L4;
2405a3222a2dSMaor Dickman 			spec->match_criteria_enable |= MLX5_MATCH_MISC_PARAMETERS_3;
2406a3222a2dSMaor Dickman 		}
2407a3222a2dSMaor Dickman 	}
24087d6c86e3SAlaa Hleihel 	/* Currenlty supported only for MPLS over UDP */
24097d6c86e3SAlaa Hleihel 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_MPLS) &&
24107d6c86e3SAlaa Hleihel 	    !netif_is_bareudp(filter_dev)) {
24117d6c86e3SAlaa Hleihel 		NL_SET_ERR_MSG_MOD(extack,
24127d6c86e3SAlaa Hleihel 				   "Matching on MPLS is supported only for MPLS over UDP");
24137d6c86e3SAlaa Hleihel 		netdev_err(priv->netdev,
24147d6c86e3SAlaa Hleihel 			   "Matching on MPLS is supported only for MPLS over UDP\n");
24157d6c86e3SAlaa Hleihel 		return -EOPNOTSUPP;
24167d6c86e3SAlaa Hleihel 	}
24177d6c86e3SAlaa Hleihel 
2418e3a2b7edSAmir Vadai 	return 0;
2419e3a2b7edSAmir Vadai }
2420e3a2b7edSAmir Vadai 
2421de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv,
242265ba8fb7SOr Gerlitz 			    struct mlx5e_tc_flow *flow,
2423de0af0bfSRoi Dayan 			    struct mlx5_flow_spec *spec,
2424f9e30088SPablo Neira Ayuso 			    struct flow_cls_offload *f,
242554c177caSOz Shlomo 			    struct net_device *filter_dev)
2426de0af0bfSRoi Dayan {
242793b3586eSHuy Nguyen 	u8 inner_match_level, outer_match_level, non_tunnel_match_level;
2428e98bedf5SEli Britstein 	struct netlink_ext_ack *extack = f->common.extack;
2429de0af0bfSRoi Dayan 	struct mlx5_core_dev *dev = priv->mdev;
2430de0af0bfSRoi Dayan 	struct mlx5_eswitch *esw = dev->priv.eswitch;
24311d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
24321d447a39SSaeed Mahameed 	struct mlx5_eswitch_rep *rep;
2433226f2ca3SVlad Buslov 	bool is_eswitch_flow;
2434de0af0bfSRoi Dayan 	int err;
2435de0af0bfSRoi Dayan 
243693b3586eSHuy Nguyen 	inner_match_level = MLX5_MATCH_NONE;
243793b3586eSHuy Nguyen 	outer_match_level = MLX5_MATCH_NONE;
243893b3586eSHuy Nguyen 
24390a7fcb78SPaul Blakey 	err = __parse_cls_flower(priv, flow, spec, f, filter_dev,
24400a7fcb78SPaul Blakey 				 &inner_match_level, &outer_match_level);
244193b3586eSHuy Nguyen 	non_tunnel_match_level = (inner_match_level == MLX5_MATCH_NONE) ?
244293b3586eSHuy Nguyen 				 outer_match_level : inner_match_level;
2443de0af0bfSRoi Dayan 
2444226f2ca3SVlad Buslov 	is_eswitch_flow = mlx5e_is_eswitch_flow(flow);
2445226f2ca3SVlad Buslov 	if (!err && is_eswitch_flow) {
24461d447a39SSaeed Mahameed 		rep = rpriv->rep;
2447b05af6aaSBodong Wang 		if (rep->vport != MLX5_VPORT_UPLINK &&
24481d447a39SSaeed Mahameed 		    (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE &&
244993b3586eSHuy Nguyen 		    esw->offloads.inline_mode < non_tunnel_match_level)) {
2450e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2451e98bedf5SEli Britstein 					   "Flow is not offloaded due to min inline setting");
2452de0af0bfSRoi Dayan 			netdev_warn(priv->netdev,
2453de0af0bfSRoi Dayan 				    "Flow is not offloaded due to min inline setting, required %d actual %d\n",
245493b3586eSHuy Nguyen 				    non_tunnel_match_level, esw->offloads.inline_mode);
2455de0af0bfSRoi Dayan 			return -EOPNOTSUPP;
2456de0af0bfSRoi Dayan 		}
2457de0af0bfSRoi Dayan 	}
2458de0af0bfSRoi Dayan 
2459c620b772SAriel Levkovich 	flow->attr->inner_match_level = inner_match_level;
2460c620b772SAriel Levkovich 	flow->attr->outer_match_level = outer_match_level;
2461c620b772SAriel Levkovich 
246238aa51c1SOr Gerlitz 
2463de0af0bfSRoi Dayan 	return err;
2464de0af0bfSRoi Dayan }
2465de0af0bfSRoi Dayan 
2466d79b6df6SOr Gerlitz struct pedit_headers {
2467d79b6df6SOr Gerlitz 	struct ethhdr  eth;
24680eb69bb9SEli Britstein 	struct vlan_hdr vlan;
2469d79b6df6SOr Gerlitz 	struct iphdr   ip4;
2470d79b6df6SOr Gerlitz 	struct ipv6hdr ip6;
2471d79b6df6SOr Gerlitz 	struct tcphdr  tcp;
2472d79b6df6SOr Gerlitz 	struct udphdr  udp;
2473d79b6df6SOr Gerlitz };
2474d79b6df6SOr Gerlitz 
2475c500c86bSPablo Neira Ayuso struct pedit_headers_action {
2476c500c86bSPablo Neira Ayuso 	struct pedit_headers	vals;
2477c500c86bSPablo Neira Ayuso 	struct pedit_headers	masks;
2478c500c86bSPablo Neira Ayuso 	u32			pedits;
2479c500c86bSPablo Neira Ayuso };
2480c500c86bSPablo Neira Ayuso 
2481d79b6df6SOr Gerlitz static int pedit_header_offsets[] = {
248273867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth),
248373867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4),
248473867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6),
248573867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp),
248673867881SPablo Neira Ayuso 	[FLOW_ACT_MANGLE_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp),
2487d79b6df6SOr Gerlitz };
2488d79b6df6SOr Gerlitz 
2489d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype])
2490d79b6df6SOr Gerlitz 
2491d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset,
2492c500c86bSPablo Neira Ayuso 			 struct pedit_headers_action *hdrs)
2493d79b6df6SOr Gerlitz {
2494d79b6df6SOr Gerlitz 	u32 *curr_pmask, *curr_pval;
2495d79b6df6SOr Gerlitz 
2496c500c86bSPablo Neira Ayuso 	curr_pmask = (u32 *)(pedit_header(&hdrs->masks, hdr_type) + offset);
2497c500c86bSPablo Neira Ayuso 	curr_pval  = (u32 *)(pedit_header(&hdrs->vals, hdr_type) + offset);
2498d79b6df6SOr Gerlitz 
2499d79b6df6SOr Gerlitz 	if (*curr_pmask & mask)  /* disallow acting twice on the same location */
2500d79b6df6SOr Gerlitz 		goto out_err;
2501d79b6df6SOr Gerlitz 
2502d79b6df6SOr Gerlitz 	*curr_pmask |= mask;
2503d79b6df6SOr Gerlitz 	*curr_pval  |= (val & mask);
2504d79b6df6SOr Gerlitz 
2505d79b6df6SOr Gerlitz 	return 0;
2506d79b6df6SOr Gerlitz 
2507d79b6df6SOr Gerlitz out_err:
2508d79b6df6SOr Gerlitz 	return -EOPNOTSUPP;
2509d79b6df6SOr Gerlitz }
2510d79b6df6SOr Gerlitz 
2511d79b6df6SOr Gerlitz struct mlx5_fields {
2512d79b6df6SOr Gerlitz 	u8  field;
251388f30bbcSDmytro Linkin 	u8  field_bsize;
251488f30bbcSDmytro Linkin 	u32 field_mask;
2515d79b6df6SOr Gerlitz 	u32 offset;
251627c11b6bSEli Britstein 	u32 match_offset;
2517d79b6df6SOr Gerlitz };
2518d79b6df6SOr Gerlitz 
251988f30bbcSDmytro Linkin #define OFFLOAD(fw_field, field_bsize, field_mask, field, off, match_field) \
252088f30bbcSDmytro Linkin 		{MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, field_bsize, field_mask, \
252127c11b6bSEli Britstein 		 offsetof(struct pedit_headers, field) + (off), \
252227c11b6bSEli Britstein 		 MLX5_BYTE_OFF(fte_match_set_lyr_2_4, match_field)}
252327c11b6bSEli Britstein 
25242ef86872SEli Britstein /* masked values are the same and there are no rewrites that do not have a
25252ef86872SEli Britstein  * match.
25262ef86872SEli Britstein  */
25272ef86872SEli Britstein #define SAME_VAL_MASK(type, valp, maskp, matchvalp, matchmaskp) ({ \
25282ef86872SEli Britstein 	type matchmaskx = *(type *)(matchmaskp); \
25292ef86872SEli Britstein 	type matchvalx = *(type *)(matchvalp); \
25302ef86872SEli Britstein 	type maskx = *(type *)(maskp); \
25312ef86872SEli Britstein 	type valx = *(type *)(valp); \
25322ef86872SEli Britstein 	\
25332ef86872SEli Britstein 	(valx & maskx) == (matchvalx & matchmaskx) && !(maskx & (maskx ^ \
25342ef86872SEli Britstein 								 matchmaskx)); \
25352ef86872SEli Britstein })
25362ef86872SEli Britstein 
253727c11b6bSEli Britstein static bool cmp_val_mask(void *valp, void *maskp, void *matchvalp,
253888f30bbcSDmytro Linkin 			 void *matchmaskp, u8 bsize)
253927c11b6bSEli Britstein {
254027c11b6bSEli Britstein 	bool same = false;
254127c11b6bSEli Britstein 
254288f30bbcSDmytro Linkin 	switch (bsize) {
254388f30bbcSDmytro Linkin 	case 8:
25442ef86872SEli Britstein 		same = SAME_VAL_MASK(u8, valp, maskp, matchvalp, matchmaskp);
254527c11b6bSEli Britstein 		break;
254688f30bbcSDmytro Linkin 	case 16:
25472ef86872SEli Britstein 		same = SAME_VAL_MASK(u16, valp, maskp, matchvalp, matchmaskp);
254827c11b6bSEli Britstein 		break;
254988f30bbcSDmytro Linkin 	case 32:
25502ef86872SEli Britstein 		same = SAME_VAL_MASK(u32, valp, maskp, matchvalp, matchmaskp);
255127c11b6bSEli Britstein 		break;
255227c11b6bSEli Britstein 	}
255327c11b6bSEli Britstein 
255427c11b6bSEli Britstein 	return same;
255527c11b6bSEli Britstein }
2556a8e4f0c4SOr Gerlitz 
2557d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = {
255888f30bbcSDmytro Linkin 	OFFLOAD(DMAC_47_16, 32, U32_MAX, eth.h_dest[0], 0, dmac_47_16),
255988f30bbcSDmytro Linkin 	OFFLOAD(DMAC_15_0,  16, U16_MAX, eth.h_dest[4], 0, dmac_15_0),
256088f30bbcSDmytro Linkin 	OFFLOAD(SMAC_47_16, 32, U32_MAX, eth.h_source[0], 0, smac_47_16),
256188f30bbcSDmytro Linkin 	OFFLOAD(SMAC_15_0,  16, U16_MAX, eth.h_source[4], 0, smac_15_0),
256288f30bbcSDmytro Linkin 	OFFLOAD(ETHERTYPE,  16, U16_MAX, eth.h_proto, 0, ethertype),
256388f30bbcSDmytro Linkin 	OFFLOAD(FIRST_VID,  16, U16_MAX, vlan.h_vlan_TCI, 0, first_vid),
2564d79b6df6SOr Gerlitz 
2565ab9341b5SDmytro Linkin 	OFFLOAD(IP_DSCP, 8,    0xfc, ip4.tos,   0, ip_dscp),
256688f30bbcSDmytro Linkin 	OFFLOAD(IP_TTL,  8,  U8_MAX, ip4.ttl,   0, ttl_hoplimit),
256788f30bbcSDmytro Linkin 	OFFLOAD(SIPV4,  32, U32_MAX, ip4.saddr, 0, src_ipv4_src_ipv6.ipv4_layout.ipv4),
256888f30bbcSDmytro Linkin 	OFFLOAD(DIPV4,  32, U32_MAX, ip4.daddr, 0, dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
2569d79b6df6SOr Gerlitz 
257088f30bbcSDmytro Linkin 	OFFLOAD(SIPV6_127_96, 32, U32_MAX, ip6.saddr.s6_addr32[0], 0,
257127c11b6bSEli Britstein 		src_ipv4_src_ipv6.ipv6_layout.ipv6[0]),
257288f30bbcSDmytro Linkin 	OFFLOAD(SIPV6_95_64,  32, U32_MAX, ip6.saddr.s6_addr32[1], 0,
257327c11b6bSEli Britstein 		src_ipv4_src_ipv6.ipv6_layout.ipv6[4]),
257488f30bbcSDmytro Linkin 	OFFLOAD(SIPV6_63_32,  32, U32_MAX, ip6.saddr.s6_addr32[2], 0,
257527c11b6bSEli Britstein 		src_ipv4_src_ipv6.ipv6_layout.ipv6[8]),
257688f30bbcSDmytro Linkin 	OFFLOAD(SIPV6_31_0,   32, U32_MAX, ip6.saddr.s6_addr32[3], 0,
257727c11b6bSEli Britstein 		src_ipv4_src_ipv6.ipv6_layout.ipv6[12]),
257888f30bbcSDmytro Linkin 	OFFLOAD(DIPV6_127_96, 32, U32_MAX, ip6.daddr.s6_addr32[0], 0,
257927c11b6bSEli Britstein 		dst_ipv4_dst_ipv6.ipv6_layout.ipv6[0]),
258088f30bbcSDmytro Linkin 	OFFLOAD(DIPV6_95_64,  32, U32_MAX, ip6.daddr.s6_addr32[1], 0,
258127c11b6bSEli Britstein 		dst_ipv4_dst_ipv6.ipv6_layout.ipv6[4]),
258288f30bbcSDmytro Linkin 	OFFLOAD(DIPV6_63_32,  32, U32_MAX, ip6.daddr.s6_addr32[2], 0,
258327c11b6bSEli Britstein 		dst_ipv4_dst_ipv6.ipv6_layout.ipv6[8]),
258488f30bbcSDmytro Linkin 	OFFLOAD(DIPV6_31_0,   32, U32_MAX, ip6.daddr.s6_addr32[3], 0,
258527c11b6bSEli Britstein 		dst_ipv4_dst_ipv6.ipv6_layout.ipv6[12]),
258688f30bbcSDmytro Linkin 	OFFLOAD(IPV6_HOPLIMIT, 8,  U8_MAX, ip6.hop_limit, 0, ttl_hoplimit),
2587748cde9aSMaor Dickman 	OFFLOAD(IP_DSCP, 16,  0xc00f, ip6, 0, ip_dscp),
2588d79b6df6SOr Gerlitz 
258988f30bbcSDmytro Linkin 	OFFLOAD(TCP_SPORT, 16, U16_MAX, tcp.source,  0, tcp_sport),
259088f30bbcSDmytro Linkin 	OFFLOAD(TCP_DPORT, 16, U16_MAX, tcp.dest,    0, tcp_dport),
259188f30bbcSDmytro Linkin 	/* in linux iphdr tcp_flags is 8 bits long */
259288f30bbcSDmytro Linkin 	OFFLOAD(TCP_FLAGS,  8,  U8_MAX, tcp.ack_seq, 5, tcp_flags),
2593d79b6df6SOr Gerlitz 
259488f30bbcSDmytro Linkin 	OFFLOAD(UDP_SPORT, 16, U16_MAX, udp.source, 0, udp_sport),
259588f30bbcSDmytro Linkin 	OFFLOAD(UDP_DPORT, 16, U16_MAX, udp.dest,   0, udp_dport),
2596d79b6df6SOr Gerlitz };
2597d79b6df6SOr Gerlitz 
259882198d8bSMaor Dickman static unsigned long mask_to_le(unsigned long mask, int size)
259982198d8bSMaor Dickman {
260082198d8bSMaor Dickman 	__be32 mask_be32;
260182198d8bSMaor Dickman 	__be16 mask_be16;
260282198d8bSMaor Dickman 
260382198d8bSMaor Dickman 	if (size == 32) {
260482198d8bSMaor Dickman 		mask_be32 = (__force __be32)(mask);
260582198d8bSMaor Dickman 		mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32));
260682198d8bSMaor Dickman 	} else if (size == 16) {
260782198d8bSMaor Dickman 		mask_be32 = (__force __be32)(mask);
260882198d8bSMaor Dickman 		mask_be16 = *(__be16 *)&mask_be32;
260982198d8bSMaor Dickman 		mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16));
261082198d8bSMaor Dickman 	}
261182198d8bSMaor Dickman 
261282198d8bSMaor Dickman 	return mask;
261382198d8bSMaor Dickman }
26146ae4a6a5SPaul Blakey static int offload_pedit_fields(struct mlx5e_priv *priv,
26156ae4a6a5SPaul Blakey 				int namespace,
26166ae4a6a5SPaul Blakey 				struct pedit_headers_action *hdrs,
2617e98bedf5SEli Britstein 				struct mlx5e_tc_flow_parse_attr *parse_attr,
261827c11b6bSEli Britstein 				u32 *action_flags,
2619e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
2620d79b6df6SOr Gerlitz {
2621d79b6df6SOr Gerlitz 	struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals;
26226ae4a6a5SPaul Blakey 	int i, action_size, first, last, next_z;
262388f30bbcSDmytro Linkin 	void *headers_c, *headers_v, *action, *vals_p;
262488f30bbcSDmytro Linkin 	u32 *s_masks_p, *a_masks_p, s_mask, a_mask;
26256ae4a6a5SPaul Blakey 	struct mlx5e_tc_mod_hdr_acts *mod_acts;
2626d79b6df6SOr Gerlitz 	struct mlx5_fields *f;
262782198d8bSMaor Dickman 	unsigned long mask, field_mask;
26286ae4a6a5SPaul Blakey 	int err;
262988f30bbcSDmytro Linkin 	u8 cmd;
263088f30bbcSDmytro Linkin 
26316ae4a6a5SPaul Blakey 	mod_acts = &parse_attr->mod_hdr_acts;
263288f30bbcSDmytro Linkin 	headers_c = get_match_headers_criteria(*action_flags, &parse_attr->spec);
263388f30bbcSDmytro Linkin 	headers_v = get_match_headers_value(*action_flags, &parse_attr->spec);
2634d79b6df6SOr Gerlitz 
263573867881SPablo Neira Ayuso 	set_masks = &hdrs[0].masks;
263673867881SPablo Neira Ayuso 	add_masks = &hdrs[1].masks;
263773867881SPablo Neira Ayuso 	set_vals = &hdrs[0].vals;
263873867881SPablo Neira Ayuso 	add_vals = &hdrs[1].vals;
2639d79b6df6SOr Gerlitz 
2640d65dbedfSHuy Nguyen 	action_size = MLX5_UN_SZ_BYTES(set_add_copy_action_in_auto);
2641d79b6df6SOr Gerlitz 
2642d79b6df6SOr Gerlitz 	for (i = 0; i < ARRAY_SIZE(fields); i++) {
264327c11b6bSEli Britstein 		bool skip;
264427c11b6bSEli Britstein 
2645d79b6df6SOr Gerlitz 		f = &fields[i];
2646d79b6df6SOr Gerlitz 		/* avoid seeing bits set from previous iterations */
2647e3ca4e05SOr Gerlitz 		s_mask = 0;
2648e3ca4e05SOr Gerlitz 		a_mask = 0;
2649d79b6df6SOr Gerlitz 
2650d79b6df6SOr Gerlitz 		s_masks_p = (void *)set_masks + f->offset;
2651d79b6df6SOr Gerlitz 		a_masks_p = (void *)add_masks + f->offset;
2652d79b6df6SOr Gerlitz 
265388f30bbcSDmytro Linkin 		s_mask = *s_masks_p & f->field_mask;
265488f30bbcSDmytro Linkin 		a_mask = *a_masks_p & f->field_mask;
2655d79b6df6SOr Gerlitz 
2656d79b6df6SOr Gerlitz 		if (!s_mask && !a_mask) /* nothing to offload here */
2657d79b6df6SOr Gerlitz 			continue;
2658d79b6df6SOr Gerlitz 
2659d79b6df6SOr Gerlitz 		if (s_mask && a_mask) {
2660e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2661e98bedf5SEli Britstein 					   "can't set and add to the same HW field");
2662d79b6df6SOr Gerlitz 			printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field);
2663d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
2664d79b6df6SOr Gerlitz 		}
2665d79b6df6SOr Gerlitz 
266627c11b6bSEli Britstein 		skip = false;
2667d79b6df6SOr Gerlitz 		if (s_mask) {
266827c11b6bSEli Britstein 			void *match_mask = headers_c + f->match_offset;
266927c11b6bSEli Britstein 			void *match_val = headers_v + f->match_offset;
267027c11b6bSEli Britstein 
2671d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_SET;
2672d79b6df6SOr Gerlitz 			mask = s_mask;
2673d79b6df6SOr Gerlitz 			vals_p = (void *)set_vals + f->offset;
267427c11b6bSEli Britstein 			/* don't rewrite if we have a match on the same value */
267527c11b6bSEli Britstein 			if (cmp_val_mask(vals_p, s_masks_p, match_val,
267688f30bbcSDmytro Linkin 					 match_mask, f->field_bsize))
267727c11b6bSEli Britstein 				skip = true;
2678d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
267988f30bbcSDmytro Linkin 			*s_masks_p &= ~f->field_mask;
2680d79b6df6SOr Gerlitz 		} else {
2681d79b6df6SOr Gerlitz 			cmd  = MLX5_ACTION_TYPE_ADD;
2682d79b6df6SOr Gerlitz 			mask = a_mask;
2683d79b6df6SOr Gerlitz 			vals_p = (void *)add_vals + f->offset;
268427c11b6bSEli Britstein 			/* add 0 is no change */
268588f30bbcSDmytro Linkin 			if ((*(u32 *)vals_p & f->field_mask) == 0)
268627c11b6bSEli Britstein 				skip = true;
2687d79b6df6SOr Gerlitz 			/* clear to denote we consumed this field */
268888f30bbcSDmytro Linkin 			*a_masks_p &= ~f->field_mask;
2689d79b6df6SOr Gerlitz 		}
269027c11b6bSEli Britstein 		if (skip)
269127c11b6bSEli Britstein 			continue;
2692d79b6df6SOr Gerlitz 
269382198d8bSMaor Dickman 		mask = mask_to_le(mask, f->field_bsize);
26942b64bebaSOr Gerlitz 
269588f30bbcSDmytro Linkin 		first = find_first_bit(&mask, f->field_bsize);
269688f30bbcSDmytro Linkin 		next_z = find_next_zero_bit(&mask, f->field_bsize, first);
269788f30bbcSDmytro Linkin 		last  = find_last_bit(&mask, f->field_bsize);
26982b64bebaSOr Gerlitz 		if (first < next_z && next_z < last) {
2699e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2700e98bedf5SEli Britstein 					   "rewrite of few sub-fields isn't supported");
27012b64bebaSOr Gerlitz 			printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n",
2702d79b6df6SOr Gerlitz 			       mask);
2703d79b6df6SOr Gerlitz 			return -EOPNOTSUPP;
2704d79b6df6SOr Gerlitz 		}
2705d79b6df6SOr Gerlitz 
27066ae4a6a5SPaul Blakey 		err = alloc_mod_hdr_actions(priv->mdev, namespace, mod_acts);
27076ae4a6a5SPaul Blakey 		if (err) {
27086ae4a6a5SPaul Blakey 			NL_SET_ERR_MSG_MOD(extack,
27096ae4a6a5SPaul Blakey 					   "too many pedit actions, can't offload");
27106ae4a6a5SPaul Blakey 			mlx5_core_warn(priv->mdev,
27116ae4a6a5SPaul Blakey 				       "mlx5: parsed %d pedit actions, can't do more\n",
27126ae4a6a5SPaul Blakey 				       mod_acts->num_actions);
27136ae4a6a5SPaul Blakey 			return err;
27146ae4a6a5SPaul Blakey 		}
27156ae4a6a5SPaul Blakey 
27166ae4a6a5SPaul Blakey 		action = mod_acts->actions +
27176ae4a6a5SPaul Blakey 			 (mod_acts->num_actions * action_size);
2718d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, action_type, cmd);
2719d79b6df6SOr Gerlitz 		MLX5_SET(set_action_in, action, field, f->field);
2720d79b6df6SOr Gerlitz 
2721d79b6df6SOr Gerlitz 		if (cmd == MLX5_ACTION_TYPE_SET) {
272288f30bbcSDmytro Linkin 			int start;
272388f30bbcSDmytro Linkin 
272482198d8bSMaor Dickman 			field_mask = mask_to_le(f->field_mask, f->field_bsize);
272582198d8bSMaor Dickman 
272688f30bbcSDmytro Linkin 			/* if field is bit sized it can start not from first bit */
272782198d8bSMaor Dickman 			start = find_first_bit(&field_mask, f->field_bsize);
272888f30bbcSDmytro Linkin 
272988f30bbcSDmytro Linkin 			MLX5_SET(set_action_in, action, offset, first - start);
2730d79b6df6SOr Gerlitz 			/* length is num of bits to be written, zero means length of 32 */
27312b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, length, (last - first + 1));
2732d79b6df6SOr Gerlitz 		}
2733d79b6df6SOr Gerlitz 
273488f30bbcSDmytro Linkin 		if (f->field_bsize == 32)
27352b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first);
273688f30bbcSDmytro Linkin 		else if (f->field_bsize == 16)
27372b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first);
273888f30bbcSDmytro Linkin 		else if (f->field_bsize == 8)
27392b64bebaSOr Gerlitz 			MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first);
2740d79b6df6SOr Gerlitz 
27416ae4a6a5SPaul Blakey 		++mod_acts->num_actions;
2742d79b6df6SOr Gerlitz 	}
2743d79b6df6SOr Gerlitz 
2744d79b6df6SOr Gerlitz 	return 0;
2745d79b6df6SOr Gerlitz }
2746d79b6df6SOr Gerlitz 
27472cc1cb1dSTonghao Zhang static int mlx5e_flow_namespace_max_modify_action(struct mlx5_core_dev *mdev,
27482cc1cb1dSTonghao Zhang 						  int namespace)
27492cc1cb1dSTonghao Zhang {
27502cc1cb1dSTonghao Zhang 	if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */
27512cc1cb1dSTonghao Zhang 		return MLX5_CAP_ESW_FLOWTABLE_FDB(mdev, max_modify_header_actions);
27522cc1cb1dSTonghao Zhang 	else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */
27532cc1cb1dSTonghao Zhang 		return MLX5_CAP_FLOWTABLE_NIC_RX(mdev, max_modify_header_actions);
27542cc1cb1dSTonghao Zhang }
27552cc1cb1dSTonghao Zhang 
27566ae4a6a5SPaul Blakey int alloc_mod_hdr_actions(struct mlx5_core_dev *mdev,
2757c500c86bSPablo Neira Ayuso 			  int namespace,
27586ae4a6a5SPaul Blakey 			  struct mlx5e_tc_mod_hdr_acts *mod_hdr_acts)
2759d79b6df6SOr Gerlitz {
27606ae4a6a5SPaul Blakey 	int action_size, new_num_actions, max_hw_actions;
27616ae4a6a5SPaul Blakey 	size_t new_sz, old_sz;
27626ae4a6a5SPaul Blakey 	void *ret;
2763d79b6df6SOr Gerlitz 
27646ae4a6a5SPaul Blakey 	if (mod_hdr_acts->num_actions < mod_hdr_acts->max_actions)
27656ae4a6a5SPaul Blakey 		return 0;
27666ae4a6a5SPaul Blakey 
2767d65dbedfSHuy Nguyen 	action_size = MLX5_UN_SZ_BYTES(set_add_copy_action_in_auto);
2768d79b6df6SOr Gerlitz 
27696ae4a6a5SPaul Blakey 	max_hw_actions = mlx5e_flow_namespace_max_modify_action(mdev,
27706ae4a6a5SPaul Blakey 								namespace);
27716ae4a6a5SPaul Blakey 	new_num_actions = min(max_hw_actions,
27726ae4a6a5SPaul Blakey 			      mod_hdr_acts->actions ?
27736ae4a6a5SPaul Blakey 			      mod_hdr_acts->max_actions * 2 : 1);
27746ae4a6a5SPaul Blakey 	if (mod_hdr_acts->max_actions == new_num_actions)
27756ae4a6a5SPaul Blakey 		return -ENOSPC;
2776d79b6df6SOr Gerlitz 
27776ae4a6a5SPaul Blakey 	new_sz = action_size * new_num_actions;
27786ae4a6a5SPaul Blakey 	old_sz = mod_hdr_acts->max_actions * action_size;
27796ae4a6a5SPaul Blakey 	ret = krealloc(mod_hdr_acts->actions, new_sz, GFP_KERNEL);
27806ae4a6a5SPaul Blakey 	if (!ret)
2781d79b6df6SOr Gerlitz 		return -ENOMEM;
2782d79b6df6SOr Gerlitz 
27836ae4a6a5SPaul Blakey 	memset(ret + old_sz, 0, new_sz - old_sz);
27846ae4a6a5SPaul Blakey 	mod_hdr_acts->actions = ret;
27856ae4a6a5SPaul Blakey 	mod_hdr_acts->max_actions = new_num_actions;
27866ae4a6a5SPaul Blakey 
2787d79b6df6SOr Gerlitz 	return 0;
2788d79b6df6SOr Gerlitz }
2789d79b6df6SOr Gerlitz 
27906ae4a6a5SPaul Blakey void dealloc_mod_hdr_actions(struct mlx5e_tc_mod_hdr_acts *mod_hdr_acts)
27916ae4a6a5SPaul Blakey {
27926ae4a6a5SPaul Blakey 	kfree(mod_hdr_acts->actions);
27936ae4a6a5SPaul Blakey 	mod_hdr_acts->actions = NULL;
27946ae4a6a5SPaul Blakey 	mod_hdr_acts->num_actions = 0;
27956ae4a6a5SPaul Blakey 	mod_hdr_acts->max_actions = 0;
27966ae4a6a5SPaul Blakey }
27976ae4a6a5SPaul Blakey 
2798d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {};
2799d79b6df6SOr Gerlitz 
2800582234b4SEli Cohen static int
2801582234b4SEli Cohen parse_pedit_to_modify_hdr(struct mlx5e_priv *priv,
280273867881SPablo Neira Ayuso 			  const struct flow_action_entry *act, int namespace,
2803582234b4SEli Cohen 			  struct mlx5e_tc_flow_parse_attr *parse_attr,
2804c500c86bSPablo Neira Ayuso 			  struct pedit_headers_action *hdrs,
2805e98bedf5SEli Britstein 			  struct netlink_ext_ack *extack)
2806d79b6df6SOr Gerlitz {
280773867881SPablo Neira Ayuso 	u8 cmd = (act->id == FLOW_ACTION_MANGLE) ? 0 : 1;
280873867881SPablo Neira Ayuso 	int err = -EOPNOTSUPP;
2809d79b6df6SOr Gerlitz 	u32 mask, val, offset;
281073867881SPablo Neira Ayuso 	u8 htype;
2811d79b6df6SOr Gerlitz 
281273867881SPablo Neira Ayuso 	htype = act->mangle.htype;
2813d79b6df6SOr Gerlitz 	err = -EOPNOTSUPP; /* can't be all optimistic */
2814d79b6df6SOr Gerlitz 
281573867881SPablo Neira Ayuso 	if (htype == FLOW_ACT_MANGLE_UNSPEC) {
281673867881SPablo Neira Ayuso 		NL_SET_ERR_MSG_MOD(extack, "legacy pedit isn't offloaded");
2817d79b6df6SOr Gerlitz 		goto out_err;
2818d79b6df6SOr Gerlitz 	}
2819d79b6df6SOr Gerlitz 
28202cc1cb1dSTonghao Zhang 	if (!mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace)) {
28212cc1cb1dSTonghao Zhang 		NL_SET_ERR_MSG_MOD(extack,
28222cc1cb1dSTonghao Zhang 				   "The pedit offload action is not supported");
28232cc1cb1dSTonghao Zhang 		goto out_err;
28242cc1cb1dSTonghao Zhang 	}
28252cc1cb1dSTonghao Zhang 
282673867881SPablo Neira Ayuso 	mask = act->mangle.mask;
282773867881SPablo Neira Ayuso 	val = act->mangle.val;
282873867881SPablo Neira Ayuso 	offset = act->mangle.offset;
2829d79b6df6SOr Gerlitz 
2830c500c86bSPablo Neira Ayuso 	err = set_pedit_val(htype, ~mask, val, offset, &hdrs[cmd]);
2831d79b6df6SOr Gerlitz 	if (err)
2832d79b6df6SOr Gerlitz 		goto out_err;
2833c500c86bSPablo Neira Ayuso 
2834c500c86bSPablo Neira Ayuso 	hdrs[cmd].pedits++;
2835d79b6df6SOr Gerlitz 
2836c500c86bSPablo Neira Ayuso 	return 0;
2837c500c86bSPablo Neira Ayuso out_err:
2838c500c86bSPablo Neira Ayuso 	return err;
2839c500c86bSPablo Neira Ayuso }
2840c500c86bSPablo Neira Ayuso 
2841582234b4SEli Cohen static int
2842582234b4SEli Cohen parse_pedit_to_reformat(struct mlx5e_priv *priv,
2843582234b4SEli Cohen 			const struct flow_action_entry *act,
2844582234b4SEli Cohen 			struct mlx5e_tc_flow_parse_attr *parse_attr,
2845582234b4SEli Cohen 			struct netlink_ext_ack *extack)
2846582234b4SEli Cohen {
2847582234b4SEli Cohen 	u32 mask, val, offset;
2848582234b4SEli Cohen 	u32 *p;
2849582234b4SEli Cohen 
2850582234b4SEli Cohen 	if (act->id != FLOW_ACTION_MANGLE)
2851582234b4SEli Cohen 		return -EOPNOTSUPP;
2852582234b4SEli Cohen 
2853582234b4SEli Cohen 	if (act->mangle.htype != FLOW_ACT_MANGLE_HDR_TYPE_ETH) {
2854582234b4SEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "Only Ethernet modification is supported");
2855582234b4SEli Cohen 		return -EOPNOTSUPP;
2856582234b4SEli Cohen 	}
2857582234b4SEli Cohen 
2858582234b4SEli Cohen 	mask = ~act->mangle.mask;
2859582234b4SEli Cohen 	val = act->mangle.val;
2860582234b4SEli Cohen 	offset = act->mangle.offset;
2861582234b4SEli Cohen 	p = (u32 *)&parse_attr->eth;
2862582234b4SEli Cohen 	*(p + (offset >> 2)) |= (val & mask);
2863582234b4SEli Cohen 
2864582234b4SEli Cohen 	return 0;
2865582234b4SEli Cohen }
2866582234b4SEli Cohen 
2867582234b4SEli Cohen static int parse_tc_pedit_action(struct mlx5e_priv *priv,
2868582234b4SEli Cohen 				 const struct flow_action_entry *act, int namespace,
2869582234b4SEli Cohen 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2870582234b4SEli Cohen 				 struct pedit_headers_action *hdrs,
2871582234b4SEli Cohen 				 struct mlx5e_tc_flow *flow,
2872582234b4SEli Cohen 				 struct netlink_ext_ack *extack)
2873582234b4SEli Cohen {
2874582234b4SEli Cohen 	if (flow && flow_flag_test(flow, L3_TO_L2_DECAP))
2875582234b4SEli Cohen 		return parse_pedit_to_reformat(priv, act, parse_attr, extack);
2876582234b4SEli Cohen 
2877582234b4SEli Cohen 	return parse_pedit_to_modify_hdr(priv, act, namespace,
2878582234b4SEli Cohen 					 parse_attr, hdrs, extack);
2879582234b4SEli Cohen }
2880582234b4SEli Cohen 
2881c500c86bSPablo Neira Ayuso static int alloc_tc_pedit_action(struct mlx5e_priv *priv, int namespace,
2882c500c86bSPablo Neira Ayuso 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
2883c500c86bSPablo Neira Ayuso 				 struct pedit_headers_action *hdrs,
288427c11b6bSEli Britstein 				 u32 *action_flags,
2885c500c86bSPablo Neira Ayuso 				 struct netlink_ext_ack *extack)
2886c500c86bSPablo Neira Ayuso {
2887c500c86bSPablo Neira Ayuso 	struct pedit_headers *cmd_masks;
2888c500c86bSPablo Neira Ayuso 	int err;
2889c500c86bSPablo Neira Ayuso 	u8 cmd;
2890c500c86bSPablo Neira Ayuso 
28916ae4a6a5SPaul Blakey 	err = offload_pedit_fields(priv, namespace, hdrs, parse_attr,
28926ae4a6a5SPaul Blakey 				   action_flags, extack);
2893d79b6df6SOr Gerlitz 	if (err < 0)
2894d79b6df6SOr Gerlitz 		goto out_dealloc_parsed_actions;
2895d79b6df6SOr Gerlitz 
2896d79b6df6SOr Gerlitz 	for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) {
2897c500c86bSPablo Neira Ayuso 		cmd_masks = &hdrs[cmd].masks;
2898d79b6df6SOr Gerlitz 		if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) {
2899e98bedf5SEli Britstein 			NL_SET_ERR_MSG_MOD(extack,
2900e98bedf5SEli Britstein 					   "attempt to offload an unsupported field");
2901b3a433deSOr Gerlitz 			netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd);
2902d79b6df6SOr Gerlitz 			print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS,
2903d79b6df6SOr Gerlitz 				       16, 1, cmd_masks, sizeof(zero_masks), true);
2904d79b6df6SOr Gerlitz 			err = -EOPNOTSUPP;
2905d79b6df6SOr Gerlitz 			goto out_dealloc_parsed_actions;
2906d79b6df6SOr Gerlitz 		}
2907d79b6df6SOr Gerlitz 	}
2908d79b6df6SOr Gerlitz 
2909d79b6df6SOr Gerlitz 	return 0;
2910d79b6df6SOr Gerlitz 
2911d79b6df6SOr Gerlitz out_dealloc_parsed_actions:
29126ae4a6a5SPaul Blakey 	dealloc_mod_hdr_actions(&parse_attr->mod_hdr_acts);
2913d79b6df6SOr Gerlitz 	return err;
2914d79b6df6SOr Gerlitz }
2915d79b6df6SOr Gerlitz 
2916e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv,
2917e98bedf5SEli Britstein 				   u32 action,
2918e98bedf5SEli Britstein 				   u32 update_flags,
2919e98bedf5SEli Britstein 				   struct netlink_ext_ack *extack)
292026c02749SOr Gerlitz {
292126c02749SOr Gerlitz 	u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP |
292226c02749SOr Gerlitz 			 TCA_CSUM_UPDATE_FLAG_UDP;
292326c02749SOr Gerlitz 
292426c02749SOr Gerlitz 	/*  The HW recalcs checksums only if re-writing headers */
292526c02749SOr Gerlitz 	if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) {
2926e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2927e98bedf5SEli Britstein 				   "TC csum action is only offloaded with pedit");
292826c02749SOr Gerlitz 		netdev_warn(priv->netdev,
292926c02749SOr Gerlitz 			    "TC csum action is only offloaded with pedit\n");
293026c02749SOr Gerlitz 		return false;
293126c02749SOr Gerlitz 	}
293226c02749SOr Gerlitz 
293326c02749SOr Gerlitz 	if (update_flags & ~prot_flags) {
2934e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
2935e98bedf5SEli Britstein 				   "can't offload TC csum action for some header/s");
293626c02749SOr Gerlitz 		netdev_warn(priv->netdev,
293726c02749SOr Gerlitz 			    "can't offload TC csum action for some header/s - flags %#x\n",
293826c02749SOr Gerlitz 			    update_flags);
293926c02749SOr Gerlitz 		return false;
294026c02749SOr Gerlitz 	}
294126c02749SOr Gerlitz 
294226c02749SOr Gerlitz 	return true;
294326c02749SOr Gerlitz }
294426c02749SOr Gerlitz 
29458998576bSDmytro Linkin struct ip_ttl_word {
29468998576bSDmytro Linkin 	__u8	ttl;
29478998576bSDmytro Linkin 	__u8	protocol;
29488998576bSDmytro Linkin 	__sum16	check;
29498998576bSDmytro Linkin };
29508998576bSDmytro Linkin 
29518998576bSDmytro Linkin struct ipv6_hoplimit_word {
29528998576bSDmytro Linkin 	__be16	payload_len;
29538998576bSDmytro Linkin 	__u8	nexthdr;
29548998576bSDmytro Linkin 	__u8	hop_limit;
29558998576bSDmytro Linkin };
29568998576bSDmytro Linkin 
29574c3844d9SPaul Blakey static int is_action_keys_supported(const struct flow_action_entry *act,
29584c3844d9SPaul Blakey 				    bool ct_flow, bool *modify_ip_header,
29597e36feebSPaul Blakey 				    bool *modify_tuple,
29604c3844d9SPaul Blakey 				    struct netlink_ext_ack *extack)
29618998576bSDmytro Linkin {
29628998576bSDmytro Linkin 	u32 mask, offset;
29638998576bSDmytro Linkin 	u8 htype;
29648998576bSDmytro Linkin 
29658998576bSDmytro Linkin 	htype = act->mangle.htype;
29668998576bSDmytro Linkin 	offset = act->mangle.offset;
29678998576bSDmytro Linkin 	mask = ~act->mangle.mask;
29688998576bSDmytro Linkin 	/* For IPv4 & IPv6 header check 4 byte word,
29698998576bSDmytro Linkin 	 * to determine that modified fields
29708998576bSDmytro Linkin 	 * are NOT ttl & hop_limit only.
29718998576bSDmytro Linkin 	 */
29728998576bSDmytro Linkin 	if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP4) {
29738998576bSDmytro Linkin 		struct ip_ttl_word *ttl_word =
29748998576bSDmytro Linkin 			(struct ip_ttl_word *)&mask;
29758998576bSDmytro Linkin 
29768998576bSDmytro Linkin 		if (offset != offsetof(struct iphdr, ttl) ||
29778998576bSDmytro Linkin 		    ttl_word->protocol ||
29788998576bSDmytro Linkin 		    ttl_word->check) {
29794c3844d9SPaul Blakey 			*modify_ip_header = true;
29804c3844d9SPaul Blakey 		}
29814c3844d9SPaul Blakey 
29827e36feebSPaul Blakey 		if (offset >= offsetof(struct iphdr, saddr))
29837e36feebSPaul Blakey 			*modify_tuple = true;
29847e36feebSPaul Blakey 
29857e36feebSPaul Blakey 		if (ct_flow && *modify_tuple) {
29864c3844d9SPaul Blakey 			NL_SET_ERR_MSG_MOD(extack,
29874c3844d9SPaul Blakey 					   "can't offload re-write of ipv4 address with action ct");
29884c3844d9SPaul Blakey 			return -EOPNOTSUPP;
29898998576bSDmytro Linkin 		}
29908998576bSDmytro Linkin 	} else if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP6) {
29918998576bSDmytro Linkin 		struct ipv6_hoplimit_word *hoplimit_word =
29928998576bSDmytro Linkin 			(struct ipv6_hoplimit_word *)&mask;
29938998576bSDmytro Linkin 
29948998576bSDmytro Linkin 		if (offset != offsetof(struct ipv6hdr, payload_len) ||
29958998576bSDmytro Linkin 		    hoplimit_word->payload_len ||
29968998576bSDmytro Linkin 		    hoplimit_word->nexthdr) {
29974c3844d9SPaul Blakey 			*modify_ip_header = true;
29988998576bSDmytro Linkin 		}
29994c3844d9SPaul Blakey 
30007e36feebSPaul Blakey 		if (ct_flow && offset >= offsetof(struct ipv6hdr, saddr))
30017e36feebSPaul Blakey 			*modify_tuple = true;
30027e36feebSPaul Blakey 
30037e36feebSPaul Blakey 		if (ct_flow && *modify_tuple) {
30044c3844d9SPaul Blakey 			NL_SET_ERR_MSG_MOD(extack,
30054c3844d9SPaul Blakey 					   "can't offload re-write of ipv6 address with action ct");
30064c3844d9SPaul Blakey 			return -EOPNOTSUPP;
30078998576bSDmytro Linkin 		}
30087e36feebSPaul Blakey 	} else if (htype == FLOW_ACT_MANGLE_HDR_TYPE_TCP ||
30097e36feebSPaul Blakey 		   htype == FLOW_ACT_MANGLE_HDR_TYPE_UDP) {
30107e36feebSPaul Blakey 		*modify_tuple = true;
30117e36feebSPaul Blakey 		if (ct_flow) {
30124c3844d9SPaul Blakey 			NL_SET_ERR_MSG_MOD(extack,
30134c3844d9SPaul Blakey 					   "can't offload re-write of transport header ports with action ct");
30144c3844d9SPaul Blakey 			return -EOPNOTSUPP;
30154c3844d9SPaul Blakey 		}
30167e36feebSPaul Blakey 	}
30174c3844d9SPaul Blakey 
30184c3844d9SPaul Blakey 	return 0;
30198998576bSDmytro Linkin }
30208998576bSDmytro Linkin 
302196b5b458SDima Chumak static bool modify_tuple_supported(bool modify_tuple, bool ct_clear,
302296b5b458SDima Chumak 				   bool ct_flow, struct netlink_ext_ack *extack,
302396b5b458SDima Chumak 				   struct mlx5e_priv *priv,
302496b5b458SDima Chumak 				   struct mlx5_flow_spec *spec)
302596b5b458SDima Chumak {
302696b5b458SDima Chumak 	if (!modify_tuple || ct_clear)
302796b5b458SDima Chumak 		return true;
302896b5b458SDima Chumak 
302996b5b458SDima Chumak 	if (ct_flow) {
303096b5b458SDima Chumak 		NL_SET_ERR_MSG_MOD(extack,
303196b5b458SDima Chumak 				   "can't offload tuple modification with non-clear ct()");
303296b5b458SDima Chumak 		netdev_info(priv->netdev,
303396b5b458SDima Chumak 			    "can't offload tuple modification with non-clear ct()");
303496b5b458SDima Chumak 		return false;
303596b5b458SDima Chumak 	}
303696b5b458SDima Chumak 
303796b5b458SDima Chumak 	/* Add ct_state=-trk match so it will be offloaded for non ct flows
303896b5b458SDima Chumak 	 * (or after clear action), as otherwise, since the tuple is changed,
303996b5b458SDima Chumak 	 * we can't restore ct state
304096b5b458SDima Chumak 	 */
304196b5b458SDima Chumak 	if (mlx5_tc_ct_add_no_trk_match(spec)) {
304296b5b458SDima Chumak 		NL_SET_ERR_MSG_MOD(extack,
304396b5b458SDima Chumak 				   "can't offload tuple modification with ct matches and no ct(clear) action");
304496b5b458SDima Chumak 		netdev_info(priv->netdev,
304596b5b458SDima Chumak 			    "can't offload tuple modification with ct matches and no ct(clear) action");
304696b5b458SDima Chumak 		return false;
304796b5b458SDima Chumak 	}
304896b5b458SDima Chumak 
304996b5b458SDima Chumak 	return true;
305096b5b458SDima Chumak }
305196b5b458SDima Chumak 
30523d486ec4SOz Shlomo static bool modify_header_match_supported(struct mlx5e_priv *priv,
30533d486ec4SOz Shlomo 					  struct mlx5_flow_spec *spec,
305473867881SPablo Neira Ayuso 					  struct flow_action *flow_action,
30554c3844d9SPaul Blakey 					  u32 actions, bool ct_flow,
30567e36feebSPaul Blakey 					  bool ct_clear,
3057e98bedf5SEli Britstein 					  struct netlink_ext_ack *extack)
3058bdd66ac0SOr Gerlitz {
305973867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
30607e36feebSPaul Blakey 	bool modify_ip_header, modify_tuple;
3061fca53304SEli Britstein 	void *headers_c;
3062bdd66ac0SOr Gerlitz 	void *headers_v;
3063bdd66ac0SOr Gerlitz 	u16 ethertype;
30648998576bSDmytro Linkin 	u8 ip_proto;
30654c3844d9SPaul Blakey 	int i, err;
3066bdd66ac0SOr Gerlitz 
3067fca53304SEli Britstein 	headers_c = get_match_headers_criteria(actions, spec);
30688377629eSEli Britstein 	headers_v = get_match_headers_value(actions, spec);
3069bdd66ac0SOr Gerlitz 	ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype);
3070bdd66ac0SOr Gerlitz 
3071bdd66ac0SOr Gerlitz 	/* for non-IP we only re-write MACs, so we're okay */
3072fca53304SEli Britstein 	if (MLX5_GET(fte_match_set_lyr_2_4, headers_c, ip_version) == 0 &&
3073fca53304SEli Britstein 	    ethertype != ETH_P_IP && ethertype != ETH_P_IPV6)
3074bdd66ac0SOr Gerlitz 		goto out_ok;
3075bdd66ac0SOr Gerlitz 
3076bdd66ac0SOr Gerlitz 	modify_ip_header = false;
30777e36feebSPaul Blakey 	modify_tuple = false;
307873867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
307973867881SPablo Neira Ayuso 		if (act->id != FLOW_ACTION_MANGLE &&
308073867881SPablo Neira Ayuso 		    act->id != FLOW_ACTION_ADD)
3081bdd66ac0SOr Gerlitz 			continue;
3082bdd66ac0SOr Gerlitz 
30834c3844d9SPaul Blakey 		err = is_action_keys_supported(act, ct_flow,
30847e36feebSPaul Blakey 					       &modify_ip_header,
30857e36feebSPaul Blakey 					       &modify_tuple, extack);
30864c3844d9SPaul Blakey 		if (err)
30874c3844d9SPaul Blakey 			return err;
3088bdd66ac0SOr Gerlitz 	}
3089bdd66ac0SOr Gerlitz 
309096b5b458SDima Chumak 	if (!modify_tuple_supported(modify_tuple, ct_clear, ct_flow, extack,
309196b5b458SDima Chumak 				    priv, spec))
30927e36feebSPaul Blakey 		return false;
30937e36feebSPaul Blakey 
3094bdd66ac0SOr Gerlitz 	ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol);
30951ccef350SJianbo Liu 	if (modify_ip_header && ip_proto != IPPROTO_TCP &&
30961ccef350SJianbo Liu 	    ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) {
3097e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
3098e98bedf5SEli Britstein 				   "can't offload re-write of non TCP/UDP");
30993d486ec4SOz Shlomo 		netdev_info(priv->netdev, "can't offload re-write of ip proto %d\n",
31003d486ec4SOz Shlomo 			    ip_proto);
3101bdd66ac0SOr Gerlitz 		return false;
3102bdd66ac0SOr Gerlitz 	}
3103bdd66ac0SOr Gerlitz 
3104bdd66ac0SOr Gerlitz out_ok:
3105bdd66ac0SOr Gerlitz 	return true;
3106bdd66ac0SOr Gerlitz }
3107bdd66ac0SOr Gerlitz 
3108bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv,
310973867881SPablo Neira Ayuso 				    struct flow_action *flow_action,
3110bdd66ac0SOr Gerlitz 				    struct mlx5e_tc_flow_parse_attr *parse_attr,
3111e98bedf5SEli Britstein 				    struct mlx5e_tc_flow *flow,
3112e98bedf5SEli Britstein 				    struct netlink_ext_ack *extack)
3113bdd66ac0SOr Gerlitz {
3114a7c119bdSPaul Blakey 	bool ct_flow = false, ct_clear = false;
3115bdd66ac0SOr Gerlitz 	u32 actions;
3116bdd66ac0SOr Gerlitz 
3117c620b772SAriel Levkovich 	ct_clear = flow->attr->ct_attr.ct_action &
3118a7c119bdSPaul Blakey 		TCA_CT_ACT_CLEAR;
3119a7c119bdSPaul Blakey 	ct_flow = flow_flag_test(flow, CT) && !ct_clear;
3120c620b772SAriel Levkovich 	actions = flow->attr->action;
3121c620b772SAriel Levkovich 
3122c620b772SAriel Levkovich 	if (mlx5e_is_eswitch_flow(flow)) {
312369e2916eSPaul Blakey 		if (flow->attr->esw_attr->split_count && ct_flow &&
312469e2916eSPaul Blakey 		    !MLX5_CAP_GEN(flow->attr->esw_attr->in_mdev, reg_c_preserve)) {
31254c3844d9SPaul Blakey 			/* All registers used by ct are cleared when using
31264c3844d9SPaul Blakey 			 * split rules.
31274c3844d9SPaul Blakey 			 */
31284c3844d9SPaul Blakey 			NL_SET_ERR_MSG_MOD(extack,
31294c3844d9SPaul Blakey 					   "Can't offload mirroring with action ct");
313049397b80SDan Carpenter 			return false;
31314c3844d9SPaul Blakey 		}
31324c3844d9SPaul Blakey 	}
3133bdd66ac0SOr Gerlitz 
3134bdd66ac0SOr Gerlitz 	if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
31353d486ec4SOz Shlomo 		return modify_header_match_supported(priv, &parse_attr->spec,
3136a655fe9fSDavid S. Miller 						     flow_action, actions,
31377e36feebSPaul Blakey 						     ct_flow, ct_clear,
31387e36feebSPaul Blakey 						     extack);
3139bdd66ac0SOr Gerlitz 
3140bdd66ac0SOr Gerlitz 	return true;
3141bdd66ac0SOr Gerlitz }
3142bdd66ac0SOr Gerlitz 
314332134847SMaor Dickman static bool same_port_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv)
314432134847SMaor Dickman {
314532134847SMaor Dickman 	return priv->mdev == peer_priv->mdev;
314632134847SMaor Dickman }
314732134847SMaor Dickman 
31485c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv)
31495c65c564SOr Gerlitz {
31505c65c564SOr Gerlitz 	struct mlx5_core_dev *fmdev, *pmdev;
3151816f6706SOr Gerlitz 	u64 fsystem_guid, psystem_guid;
31525c65c564SOr Gerlitz 
31535c65c564SOr Gerlitz 	fmdev = priv->mdev;
31545c65c564SOr Gerlitz 	pmdev = peer_priv->mdev;
31555c65c564SOr Gerlitz 
315659c9d35eSAlaa Hleihel 	fsystem_guid = mlx5_query_nic_system_image_guid(fmdev);
315759c9d35eSAlaa Hleihel 	psystem_guid = mlx5_query_nic_system_image_guid(pmdev);
31585c65c564SOr Gerlitz 
3159816f6706SOr Gerlitz 	return (fsystem_guid == psystem_guid);
31605c65c564SOr Gerlitz }
31615c65c564SOr Gerlitz 
3162bb569657SAriel Levkovich static bool same_vf_reps(struct mlx5e_priv *priv,
3163bb569657SAriel Levkovich 			 struct net_device *out_dev)
3164bb569657SAriel Levkovich {
3165bb569657SAriel Levkovich 	return mlx5e_eswitch_vf_rep(priv->netdev) &&
3166bb569657SAriel Levkovich 	       priv->netdev == out_dev;
3167bb569657SAriel Levkovich }
3168bb569657SAriel Levkovich 
3169bdc837eeSEli Britstein static int add_vlan_rewrite_action(struct mlx5e_priv *priv, int namespace,
3170bdc837eeSEli Britstein 				   const struct flow_action_entry *act,
3171bdc837eeSEli Britstein 				   struct mlx5e_tc_flow_parse_attr *parse_attr,
3172bdc837eeSEli Britstein 				   struct pedit_headers_action *hdrs,
3173bdc837eeSEli Britstein 				   u32 *action, struct netlink_ext_ack *extack)
3174bdc837eeSEli Britstein {
3175bdc837eeSEli Britstein 	u16 mask16 = VLAN_VID_MASK;
3176bdc837eeSEli Britstein 	u16 val16 = act->vlan.vid & VLAN_VID_MASK;
3177bdc837eeSEli Britstein 	const struct flow_action_entry pedit_act = {
3178bdc837eeSEli Britstein 		.id = FLOW_ACTION_MANGLE,
3179bdc837eeSEli Britstein 		.mangle.htype = FLOW_ACT_MANGLE_HDR_TYPE_ETH,
3180bdc837eeSEli Britstein 		.mangle.offset = offsetof(struct vlan_ethhdr, h_vlan_TCI),
3181bdc837eeSEli Britstein 		.mangle.mask = ~(u32)be16_to_cpu(*(__be16 *)&mask16),
3182bdc837eeSEli Britstein 		.mangle.val = (u32)be16_to_cpu(*(__be16 *)&val16),
3183bdc837eeSEli Britstein 	};
31846fca9d1eSEli Britstein 	u8 match_prio_mask, match_prio_val;
3185bf2f3bcaSEli Britstein 	void *headers_c, *headers_v;
3186bdc837eeSEli Britstein 	int err;
3187bdc837eeSEli Britstein 
3188bf2f3bcaSEli Britstein 	headers_c = get_match_headers_criteria(*action, &parse_attr->spec);
3189bf2f3bcaSEli Britstein 	headers_v = get_match_headers_value(*action, &parse_attr->spec);
3190bf2f3bcaSEli Britstein 
3191bf2f3bcaSEli Britstein 	if (!(MLX5_GET(fte_match_set_lyr_2_4, headers_c, cvlan_tag) &&
3192bf2f3bcaSEli Britstein 	      MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag))) {
3193bf2f3bcaSEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
3194bf2f3bcaSEli Britstein 				   "VLAN rewrite action must have VLAN protocol match");
3195bf2f3bcaSEli Britstein 		return -EOPNOTSUPP;
3196bf2f3bcaSEli Britstein 	}
3197bf2f3bcaSEli Britstein 
31986fca9d1eSEli Britstein 	match_prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio);
31996fca9d1eSEli Britstein 	match_prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio);
32006fca9d1eSEli Britstein 	if (act->vlan.prio != (match_prio_val & match_prio_mask)) {
32016fca9d1eSEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
32026fca9d1eSEli Britstein 				   "Changing VLAN prio is not supported");
3203bdc837eeSEli Britstein 		return -EOPNOTSUPP;
3204bdc837eeSEli Britstein 	}
3205bdc837eeSEli Britstein 
3206582234b4SEli Cohen 	err = parse_tc_pedit_action(priv, &pedit_act, namespace, parse_attr, hdrs, NULL, extack);
3207bdc837eeSEli Britstein 	*action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
3208bdc837eeSEli Britstein 
3209bdc837eeSEli Britstein 	return err;
3210bdc837eeSEli Britstein }
3211bdc837eeSEli Britstein 
32120bac1194SEli Britstein static int
32130bac1194SEli Britstein add_vlan_prio_tag_rewrite_action(struct mlx5e_priv *priv,
32140bac1194SEli Britstein 				 struct mlx5e_tc_flow_parse_attr *parse_attr,
32150bac1194SEli Britstein 				 struct pedit_headers_action *hdrs,
32160bac1194SEli Britstein 				 u32 *action, struct netlink_ext_ack *extack)
32170bac1194SEli Britstein {
32180bac1194SEli Britstein 	const struct flow_action_entry prio_tag_act = {
32190bac1194SEli Britstein 		.vlan.vid = 0,
32200bac1194SEli Britstein 		.vlan.prio =
32210bac1194SEli Britstein 			MLX5_GET(fte_match_set_lyr_2_4,
32220bac1194SEli Britstein 				 get_match_headers_value(*action,
32230bac1194SEli Britstein 							 &parse_attr->spec),
32240bac1194SEli Britstein 				 first_prio) &
32250bac1194SEli Britstein 			MLX5_GET(fte_match_set_lyr_2_4,
32260bac1194SEli Britstein 				 get_match_headers_criteria(*action,
32270bac1194SEli Britstein 							    &parse_attr->spec),
32280bac1194SEli Britstein 				 first_prio),
32290bac1194SEli Britstein 	};
32300bac1194SEli Britstein 
32310bac1194SEli Britstein 	return add_vlan_rewrite_action(priv, MLX5_FLOW_NAMESPACE_FDB,
32320bac1194SEli Britstein 				       &prio_tag_act, parse_attr, hdrs, action,
32330bac1194SEli Britstein 				       extack);
32340bac1194SEli Britstein }
32350bac1194SEli Britstein 
3236c7569097SAriel Levkovich static int validate_goto_chain(struct mlx5e_priv *priv,
3237c7569097SAriel Levkovich 			       struct mlx5e_tc_flow *flow,
3238c7569097SAriel Levkovich 			       const struct flow_action_entry *act,
3239c7569097SAriel Levkovich 			       u32 actions,
3240c7569097SAriel Levkovich 			       struct netlink_ext_ack *extack)
3241c7569097SAriel Levkovich {
3242c7569097SAriel Levkovich 	bool is_esw = mlx5e_is_eswitch_flow(flow);
3243c7569097SAriel Levkovich 	struct mlx5_flow_attr *attr = flow->attr;
3244c7569097SAriel Levkovich 	bool ft_flow = mlx5e_is_ft_flow(flow);
3245c7569097SAriel Levkovich 	u32 dest_chain = act->chain_index;
3246c7569097SAriel Levkovich 	struct mlx5_fs_chains *chains;
3247c7569097SAriel Levkovich 	struct mlx5_eswitch *esw;
3248c7569097SAriel Levkovich 	u32 reformat_and_fwd;
3249c7569097SAriel Levkovich 	u32 max_chain;
3250c7569097SAriel Levkovich 
3251c7569097SAriel Levkovich 	esw = priv->mdev->priv.eswitch;
3252c7569097SAriel Levkovich 	chains = is_esw ? esw_chains(esw) : nic_chains(priv);
3253c7569097SAriel Levkovich 	max_chain = mlx5_chains_get_chain_range(chains);
3254c7569097SAriel Levkovich 	reformat_and_fwd = is_esw ?
3255c7569097SAriel Levkovich 			   MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, reformat_and_fwd_to_table) :
3256c7569097SAriel Levkovich 			   MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, reformat_and_fwd_to_table);
3257c7569097SAriel Levkovich 
3258c7569097SAriel Levkovich 	if (ft_flow) {
3259c7569097SAriel Levkovich 		NL_SET_ERR_MSG_MOD(extack, "Goto action is not supported");
3260c7569097SAriel Levkovich 		return -EOPNOTSUPP;
3261c7569097SAriel Levkovich 	}
3262c7569097SAriel Levkovich 
3263c7569097SAriel Levkovich 	if (!mlx5_chains_backwards_supported(chains) &&
3264c7569097SAriel Levkovich 	    dest_chain <= attr->chain) {
3265c7569097SAriel Levkovich 		NL_SET_ERR_MSG_MOD(extack,
3266c7569097SAriel Levkovich 				   "Goto lower numbered chain isn't supported");
3267c7569097SAriel Levkovich 		return -EOPNOTSUPP;
3268c7569097SAriel Levkovich 	}
3269c7569097SAriel Levkovich 
3270c7569097SAriel Levkovich 	if (dest_chain > max_chain) {
3271c7569097SAriel Levkovich 		NL_SET_ERR_MSG_MOD(extack,
3272c7569097SAriel Levkovich 				   "Requested destination chain is out of supported range");
3273c7569097SAriel Levkovich 		return -EOPNOTSUPP;
3274c7569097SAriel Levkovich 	}
3275c7569097SAriel Levkovich 
3276c7569097SAriel Levkovich 	if (actions & (MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT |
3277c7569097SAriel Levkovich 		       MLX5_FLOW_CONTEXT_ACTION_DECAP) &&
3278c7569097SAriel Levkovich 	    !reformat_and_fwd) {
3279c7569097SAriel Levkovich 		NL_SET_ERR_MSG_MOD(extack,
3280c7569097SAriel Levkovich 				   "Goto chain is not allowed if action has reformat or decap");
3281c7569097SAriel Levkovich 		return -EOPNOTSUPP;
3282c7569097SAriel Levkovich 	}
3283c7569097SAriel Levkovich 
3284c7569097SAriel Levkovich 	return 0;
3285c7569097SAriel Levkovich }
3286c7569097SAriel Levkovich 
328773867881SPablo Neira Ayuso static int parse_tc_nic_actions(struct mlx5e_priv *priv,
328873867881SPablo Neira Ayuso 				struct flow_action *flow_action,
3289aa0cbbaeSOr Gerlitz 				struct mlx5e_tc_flow_parse_attr *parse_attr,
3290e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
3291e98bedf5SEli Britstein 				struct netlink_ext_ack *extack)
3292e3a2b7edSAmir Vadai {
3293c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr = flow->attr;
329473867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
329573867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
3296c620b772SAriel Levkovich 	struct mlx5_nic_flow_attr *nic_attr;
32971cab1cd7SOr Gerlitz 	u32 action = 0;
3298244cd96aSCong Wang 	int err, i;
3299e3a2b7edSAmir Vadai 
330073867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
3301e3a2b7edSAmir Vadai 		return -EINVAL;
3302e3a2b7edSAmir Vadai 
330353eca1f3SJakub Kicinski 	if (!flow_action_hw_stats_check(flow_action, extack,
330453eca1f3SJakub Kicinski 					FLOW_ACTION_HW_STATS_DELAYED_BIT))
3305319a1d19SJiri Pirko 		return -EOPNOTSUPP;
3306319a1d19SJiri Pirko 
3307c620b772SAriel Levkovich 	nic_attr = attr->nic_attr;
3308c620b772SAriel Levkovich 
3309c620b772SAriel Levkovich 	nic_attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG;
3310e3a2b7edSAmir Vadai 
331173867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
331273867881SPablo Neira Ayuso 		switch (act->id) {
331315fc92ecSTonghao Zhang 		case FLOW_ACTION_ACCEPT:
331415fc92ecSTonghao Zhang 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
331515fc92ecSTonghao Zhang 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
331615fc92ecSTonghao Zhang 			break;
331773867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
33181cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP;
3319aad7e08dSAmir Vadai 			if (MLX5_CAP_FLOWTABLE(priv->mdev,
3320aad7e08dSAmir Vadai 					       flow_table_properties_nic_receive.flow_counter))
33211cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
332273867881SPablo Neira Ayuso 			break;
332373867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
332473867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
332573867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_KERNEL,
3326582234b4SEli Cohen 						    parse_attr, hdrs, NULL, extack);
33272f4fe4caSOr Gerlitz 			if (err)
33282f4fe4caSOr Gerlitz 				return err;
33292f4fe4caSOr Gerlitz 
3330c7569097SAriel Levkovich 			action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
333173867881SPablo Neira Ayuso 			break;
3332bdc837eeSEli Britstein 		case FLOW_ACTION_VLAN_MANGLE:
3333bdc837eeSEli Britstein 			err = add_vlan_rewrite_action(priv,
3334bdc837eeSEli Britstein 						      MLX5_FLOW_NAMESPACE_KERNEL,
3335bdc837eeSEli Britstein 						      act, parse_attr, hdrs,
3336bdc837eeSEli Britstein 						      &action, extack);
3337bdc837eeSEli Britstein 			if (err)
3338bdc837eeSEli Britstein 				return err;
3339bdc837eeSEli Britstein 
3340bdc837eeSEli Britstein 			break;
334173867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
33421cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
334373867881SPablo Neira Ayuso 						   act->csum_flags,
3344e98bedf5SEli Britstein 						   extack))
334573867881SPablo Neira Ayuso 				break;
334626c02749SOr Gerlitz 
334726c02749SOr Gerlitz 			return -EOPNOTSUPP;
334873867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT: {
334973867881SPablo Neira Ayuso 			struct net_device *peer_dev = act->dev;
33505c65c564SOr Gerlitz 
33515c65c564SOr Gerlitz 			if (priv->netdev->netdev_ops == peer_dev->netdev_ops &&
33525c65c564SOr Gerlitz 			    same_hw_devs(priv, netdev_priv(peer_dev))) {
335398b66cb1SEli Britstein 				parse_attr->mirred_ifindex[0] = peer_dev->ifindex;
3354226f2ca3SVlad Buslov 				flow_flag_set(flow, HAIRPIN);
33551cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
33565c65c564SOr Gerlitz 					  MLX5_FLOW_CONTEXT_ACTION_COUNT;
33575c65c564SOr Gerlitz 			} else {
3358e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
3359e98bedf5SEli Britstein 						   "device is not on same HW, can't offload");
33605c65c564SOr Gerlitz 				netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n",
33615c65c564SOr Gerlitz 					    peer_dev->name);
33625c65c564SOr Gerlitz 				return -EINVAL;
33635c65c564SOr Gerlitz 			}
33645c65c564SOr Gerlitz 			}
336573867881SPablo Neira Ayuso 			break;
336673867881SPablo Neira Ayuso 		case FLOW_ACTION_MARK: {
336773867881SPablo Neira Ayuso 			u32 mark = act->mark;
3368e3a2b7edSAmir Vadai 
3369e3a2b7edSAmir Vadai 			if (mark & ~MLX5E_TC_FLOW_ID_MASK) {
3370e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
3371e98bedf5SEli Britstein 						   "Bad flow mark - only 16 bit is supported");
3372e3a2b7edSAmir Vadai 				return -EINVAL;
3373e3a2b7edSAmir Vadai 			}
3374e3a2b7edSAmir Vadai 
3375c620b772SAriel Levkovich 			nic_attr->flow_tag = mark;
33761cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
3377e3a2b7edSAmir Vadai 			}
337873867881SPablo Neira Ayuso 			break;
3379c7569097SAriel Levkovich 		case FLOW_ACTION_GOTO:
3380c7569097SAriel Levkovich 			err = validate_goto_chain(priv, flow, act, action,
3381c7569097SAriel Levkovich 						  extack);
3382c7569097SAriel Levkovich 			if (err)
3383c7569097SAriel Levkovich 				return err;
3384c7569097SAriel Levkovich 
3385c7569097SAriel Levkovich 			action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
3386c7569097SAriel Levkovich 			attr->dest_chain = act->chain_index;
3387c7569097SAriel Levkovich 			break;
3388aedd133dSAriel Levkovich 		case FLOW_ACTION_CT:
3389aedd133dSAriel Levkovich 			err = mlx5_tc_ct_parse_action(get_ct_priv(priv), attr, act, extack);
3390aedd133dSAriel Levkovich 			if (err)
3391aedd133dSAriel Levkovich 				return err;
3392aedd133dSAriel Levkovich 
3393aedd133dSAriel Levkovich 			flow_flag_set(flow, CT);
3394aedd133dSAriel Levkovich 			break;
339573867881SPablo Neira Ayuso 		default:
33962cc1cb1dSTonghao Zhang 			NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported");
33972cc1cb1dSTonghao Zhang 			return -EOPNOTSUPP;
3398e3a2b7edSAmir Vadai 		}
339973867881SPablo Neira Ayuso 	}
3400e3a2b7edSAmir Vadai 
3401c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
3402c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
3403c500c86bSPablo Neira Ayuso 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL,
340427c11b6bSEli Britstein 					    parse_attr, hdrs, &action, extack);
3405c500c86bSPablo Neira Ayuso 		if (err)
3406c500c86bSPablo Neira Ayuso 			return err;
340727c11b6bSEli Britstein 		/* in case all pedit actions are skipped, remove the MOD_HDR
340827c11b6bSEli Britstein 		 * flag.
340927c11b6bSEli Britstein 		 */
34106ae4a6a5SPaul Blakey 		if (parse_attr->mod_hdr_acts.num_actions == 0) {
341127c11b6bSEli Britstein 			action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
34126ae4a6a5SPaul Blakey 			dealloc_mod_hdr_actions(&parse_attr->mod_hdr_acts);
3413e7739a60SEli Britstein 		}
3414c500c86bSPablo Neira Ayuso 	}
3415c500c86bSPablo Neira Ayuso 
34161cab1cd7SOr Gerlitz 	attr->action = action;
3417c7569097SAriel Levkovich 
3418c7569097SAriel Levkovich 	if (attr->dest_chain) {
3419c7569097SAriel Levkovich 		if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
3420c7569097SAriel Levkovich 			NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported");
3421c7569097SAriel Levkovich 			return -EOPNOTSUPP;
3422c7569097SAriel Levkovich 		}
3423c7569097SAriel Levkovich 		attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
3424c7569097SAriel Levkovich 	}
3425c7569097SAriel Levkovich 
3426c7569097SAriel Levkovich 	if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
3427c7569097SAriel Levkovich 		attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
3428c7569097SAriel Levkovich 
342973867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
3430bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
3431bdd66ac0SOr Gerlitz 
3432e3a2b7edSAmir Vadai 	return 0;
3433e3a2b7edSAmir Vadai }
3434e3a2b7edSAmir Vadai 
343532134847SMaor Dickman static bool is_merged_eswitch_vfs(struct mlx5e_priv *priv,
3436b1d90e6bSRabie Loulou 				  struct net_device *peer_netdev)
3437b1d90e6bSRabie Loulou {
3438b1d90e6bSRabie Loulou 	struct mlx5e_priv *peer_priv;
3439b1d90e6bSRabie Loulou 
3440b1d90e6bSRabie Loulou 	peer_priv = netdev_priv(peer_netdev);
3441b1d90e6bSRabie Loulou 
3442b1d90e6bSRabie Loulou 	return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) &&
344332134847SMaor Dickman 		mlx5e_eswitch_vf_rep(priv->netdev) &&
344432134847SMaor Dickman 		mlx5e_eswitch_vf_rep(peer_netdev) &&
344568931c7dSRoi Dayan 		same_hw_devs(priv, peer_priv));
3446b1d90e6bSRabie Loulou }
3447b1d90e6bSRabie Loulou 
34481482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv,
344973867881SPablo Neira Ayuso 				const struct flow_action_entry *act,
34501482bd3dSJianbo Liu 				struct mlx5_esw_flow_attr *attr,
34511482bd3dSJianbo Liu 				u32 *action)
34521482bd3dSJianbo Liu {
3453cc495188SJianbo Liu 	u8 vlan_idx = attr->total_vlan;
3454cc495188SJianbo Liu 
3455cc495188SJianbo Liu 	if (vlan_idx >= MLX5_FS_VLAN_DEPTH)
34561482bd3dSJianbo Liu 		return -EOPNOTSUPP;
3457cc495188SJianbo Liu 
345873867881SPablo Neira Ayuso 	switch (act->id) {
345973867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_POP:
3460cc495188SJianbo Liu 		if (vlan_idx) {
3461cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
3462cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
3463cc495188SJianbo Liu 				return -EOPNOTSUPP;
3464cc495188SJianbo Liu 
3465cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2;
3466cc495188SJianbo Liu 		} else {
3467cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
3468cc495188SJianbo Liu 		}
346973867881SPablo Neira Ayuso 		break;
347073867881SPablo Neira Ayuso 	case FLOW_ACTION_VLAN_PUSH:
347173867881SPablo Neira Ayuso 		attr->vlan_vid[vlan_idx] = act->vlan.vid;
347273867881SPablo Neira Ayuso 		attr->vlan_prio[vlan_idx] = act->vlan.prio;
347373867881SPablo Neira Ayuso 		attr->vlan_proto[vlan_idx] = act->vlan.proto;
3474cc495188SJianbo Liu 		if (!attr->vlan_proto[vlan_idx])
3475cc495188SJianbo Liu 			attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q);
3476cc495188SJianbo Liu 
3477cc495188SJianbo Liu 		if (vlan_idx) {
3478cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev,
3479cc495188SJianbo Liu 								 MLX5_FS_VLAN_DEPTH))
3480cc495188SJianbo Liu 				return -EOPNOTSUPP;
3481cc495188SJianbo Liu 
3482cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2;
3483cc495188SJianbo Liu 		} else {
3484cc495188SJianbo Liu 			if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) &&
348573867881SPablo Neira Ayuso 			    (act->vlan.proto != htons(ETH_P_8021Q) ||
348673867881SPablo Neira Ayuso 			     act->vlan.prio))
3487cc495188SJianbo Liu 				return -EOPNOTSUPP;
3488cc495188SJianbo Liu 
3489cc495188SJianbo Liu 			*action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH;
34901482bd3dSJianbo Liu 		}
349173867881SPablo Neira Ayuso 		break;
349273867881SPablo Neira Ayuso 	default:
3493bdc837eeSEli Britstein 		return -EINVAL;
34941482bd3dSJianbo Liu 	}
34951482bd3dSJianbo Liu 
3496cc495188SJianbo Liu 	attr->total_vlan = vlan_idx + 1;
3497cc495188SJianbo Liu 
34981482bd3dSJianbo Liu 	return 0;
34991482bd3dSJianbo Liu }
35001482bd3dSJianbo Liu 
3501d34eb2fcSOr Gerlitz static struct net_device *get_fdb_out_dev(struct net_device *uplink_dev,
3502d34eb2fcSOr Gerlitz 					  struct net_device *out_dev)
3503d34eb2fcSOr Gerlitz {
3504d34eb2fcSOr Gerlitz 	struct net_device *fdb_out_dev = out_dev;
3505d34eb2fcSOr Gerlitz 	struct net_device *uplink_upper;
3506d34eb2fcSOr Gerlitz 
3507d34eb2fcSOr Gerlitz 	rcu_read_lock();
3508d34eb2fcSOr Gerlitz 	uplink_upper = netdev_master_upper_dev_get_rcu(uplink_dev);
3509d34eb2fcSOr Gerlitz 	if (uplink_upper && netif_is_lag_master(uplink_upper) &&
3510d34eb2fcSOr Gerlitz 	    uplink_upper == out_dev) {
3511d34eb2fcSOr Gerlitz 		fdb_out_dev = uplink_dev;
3512d34eb2fcSOr Gerlitz 	} else if (netif_is_lag_master(out_dev)) {
3513d34eb2fcSOr Gerlitz 		fdb_out_dev = bond_option_active_slave_get_rcu(netdev_priv(out_dev));
3514d34eb2fcSOr Gerlitz 		if (fdb_out_dev &&
3515d34eb2fcSOr Gerlitz 		    (!mlx5e_eswitch_rep(fdb_out_dev) ||
3516d34eb2fcSOr Gerlitz 		     !netdev_port_same_parent_id(fdb_out_dev, uplink_dev)))
3517d34eb2fcSOr Gerlitz 			fdb_out_dev = NULL;
3518d34eb2fcSOr Gerlitz 	}
3519d34eb2fcSOr Gerlitz 	rcu_read_unlock();
3520d34eb2fcSOr Gerlitz 	return fdb_out_dev;
3521d34eb2fcSOr Gerlitz }
3522d34eb2fcSOr Gerlitz 
3523278748a9SEli Britstein static int add_vlan_push_action(struct mlx5e_priv *priv,
3524c620b772SAriel Levkovich 				struct mlx5_flow_attr *attr,
3525278748a9SEli Britstein 				struct net_device **out_dev,
3526278748a9SEli Britstein 				u32 *action)
3527278748a9SEli Britstein {
3528278748a9SEli Britstein 	struct net_device *vlan_dev = *out_dev;
3529278748a9SEli Britstein 	struct flow_action_entry vlan_act = {
3530278748a9SEli Britstein 		.id = FLOW_ACTION_VLAN_PUSH,
3531278748a9SEli Britstein 		.vlan.vid = vlan_dev_vlan_id(vlan_dev),
3532278748a9SEli Britstein 		.vlan.proto = vlan_dev_vlan_proto(vlan_dev),
3533278748a9SEli Britstein 		.vlan.prio = 0,
3534278748a9SEli Britstein 	};
3535278748a9SEli Britstein 	int err;
3536278748a9SEli Britstein 
3537c620b772SAriel Levkovich 	err = parse_tc_vlan_action(priv, &vlan_act, attr->esw_attr, action);
3538278748a9SEli Britstein 	if (err)
3539278748a9SEli Britstein 		return err;
3540278748a9SEli Britstein 
3541dca59f4aSDima Chumak 	rcu_read_lock();
3542dca59f4aSDima Chumak 	*out_dev = dev_get_by_index_rcu(dev_net(vlan_dev), dev_get_iflink(vlan_dev));
3543dca59f4aSDima Chumak 	rcu_read_unlock();
3544dca59f4aSDima Chumak 	if (!*out_dev)
3545dca59f4aSDima Chumak 		return -ENODEV;
3546dca59f4aSDima Chumak 
3547278748a9SEli Britstein 	if (is_vlan_dev(*out_dev))
3548278748a9SEli Britstein 		err = add_vlan_push_action(priv, attr, out_dev, action);
3549278748a9SEli Britstein 
3550278748a9SEli Britstein 	return err;
3551278748a9SEli Britstein }
3552278748a9SEli Britstein 
355335a605dbSEli Britstein static int add_vlan_pop_action(struct mlx5e_priv *priv,
3554c620b772SAriel Levkovich 			       struct mlx5_flow_attr *attr,
355535a605dbSEli Britstein 			       u32 *action)
355635a605dbSEli Britstein {
355735a605dbSEli Britstein 	struct flow_action_entry vlan_act = {
355835a605dbSEli Britstein 		.id = FLOW_ACTION_VLAN_POP,
355935a605dbSEli Britstein 	};
356070f478caSDmytro Linkin 	int nest_level, err = 0;
356135a605dbSEli Britstein 
356270f478caSDmytro Linkin 	nest_level = attr->parse_attr->filter_dev->lower_level -
356370f478caSDmytro Linkin 						priv->netdev->lower_level;
356435a605dbSEli Britstein 	while (nest_level--) {
3565c620b772SAriel Levkovich 		err = parse_tc_vlan_action(priv, &vlan_act, attr->esw_attr, action);
356635a605dbSEli Britstein 		if (err)
356735a605dbSEli Britstein 			return err;
356835a605dbSEli Britstein 	}
356935a605dbSEli Britstein 
357035a605dbSEli Britstein 	return err;
357135a605dbSEli Britstein }
357235a605dbSEli Britstein 
357332134847SMaor Dickman static bool same_hw_reps(struct mlx5e_priv *priv,
357432134847SMaor Dickman 			 struct net_device *peer_netdev)
357532134847SMaor Dickman {
357632134847SMaor Dickman 	struct mlx5e_priv *peer_priv;
357732134847SMaor Dickman 
357832134847SMaor Dickman 	peer_priv = netdev_priv(peer_netdev);
357932134847SMaor Dickman 
358032134847SMaor Dickman 	return mlx5e_eswitch_rep(priv->netdev) &&
358132134847SMaor Dickman 	       mlx5e_eswitch_rep(peer_netdev) &&
358232134847SMaor Dickman 	       same_hw_devs(priv, peer_priv);
358332134847SMaor Dickman }
358432134847SMaor Dickman 
358532134847SMaor Dickman static bool is_lag_dev(struct mlx5e_priv *priv,
358632134847SMaor Dickman 		       struct net_device *peer_netdev)
358732134847SMaor Dickman {
358832134847SMaor Dickman 	return ((mlx5_lag_is_sriov(priv->mdev) ||
358932134847SMaor Dickman 		 mlx5_lag_is_multipath(priv->mdev)) &&
359032134847SMaor Dickman 		 same_hw_reps(priv, peer_netdev));
359132134847SMaor Dickman }
359232134847SMaor Dickman 
3593f6dc1264SPaul Blakey bool mlx5e_is_valid_eswitch_fwd_dev(struct mlx5e_priv *priv,
3594f6dc1264SPaul Blakey 				    struct net_device *out_dev)
3595f6dc1264SPaul Blakey {
359632134847SMaor Dickman 	if (is_merged_eswitch_vfs(priv, out_dev))
359732134847SMaor Dickman 		return true;
359832134847SMaor Dickman 
359932134847SMaor Dickman 	if (is_lag_dev(priv, out_dev))
3600f6dc1264SPaul Blakey 		return true;
3601f6dc1264SPaul Blakey 
3602f6dc1264SPaul Blakey 	return mlx5e_eswitch_rep(out_dev) &&
360332134847SMaor Dickman 	       same_port_devs(priv, netdev_priv(out_dev));
3604f6dc1264SPaul Blakey }
3605f6dc1264SPaul Blakey 
3606554fe75cSDmytro Linkin static bool is_duplicated_output_device(struct net_device *dev,
3607554fe75cSDmytro Linkin 					struct net_device *out_dev,
3608554fe75cSDmytro Linkin 					int *ifindexes, int if_count,
3609554fe75cSDmytro Linkin 					struct netlink_ext_ack *extack)
3610554fe75cSDmytro Linkin {
3611554fe75cSDmytro Linkin 	int i;
3612554fe75cSDmytro Linkin 
3613554fe75cSDmytro Linkin 	for (i = 0; i < if_count; i++) {
3614554fe75cSDmytro Linkin 		if (ifindexes[i] == out_dev->ifindex) {
3615554fe75cSDmytro Linkin 			NL_SET_ERR_MSG_MOD(extack,
3616554fe75cSDmytro Linkin 					   "can't duplicate output to same device");
3617554fe75cSDmytro Linkin 			netdev_err(dev, "can't duplicate output to same device: %s\n",
3618554fe75cSDmytro Linkin 				   out_dev->name);
3619554fe75cSDmytro Linkin 			return true;
3620554fe75cSDmytro Linkin 		}
3621554fe75cSDmytro Linkin 	}
3622554fe75cSDmytro Linkin 
3623554fe75cSDmytro Linkin 	return false;
3624554fe75cSDmytro Linkin }
3625554fe75cSDmytro Linkin 
3626613f53feSEli Cohen static int verify_uplink_forwarding(struct mlx5e_priv *priv,
3627613f53feSEli Cohen 				    struct mlx5e_tc_flow *flow,
3628613f53feSEli Cohen 				    struct net_device *out_dev,
3629613f53feSEli Cohen 				    struct netlink_ext_ack *extack)
3630613f53feSEli Cohen {
3631c620b772SAriel Levkovich 	struct mlx5_esw_flow_attr *attr = flow->attr->esw_attr;
3632613f53feSEli Cohen 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
3633613f53feSEli Cohen 	struct mlx5e_rep_priv *rep_priv;
3634613f53feSEli Cohen 
3635613f53feSEli Cohen 	/* Forwarding non encapsulated traffic between
3636613f53feSEli Cohen 	 * uplink ports is allowed only if
3637613f53feSEli Cohen 	 * termination_table_raw_traffic cap is set.
3638613f53feSEli Cohen 	 *
3639c620b772SAriel Levkovich 	 * Input vport was stored attr->in_rep.
3640613f53feSEli Cohen 	 * In LAG case, *priv* is the private data of
3641613f53feSEli Cohen 	 * uplink which may be not the input vport.
3642613f53feSEli Cohen 	 */
3643613f53feSEli Cohen 	rep_priv = mlx5e_rep_to_rep_priv(attr->in_rep);
3644613f53feSEli Cohen 
3645613f53feSEli Cohen 	if (!(mlx5e_eswitch_uplink_rep(rep_priv->netdev) &&
3646613f53feSEli Cohen 	      mlx5e_eswitch_uplink_rep(out_dev)))
3647613f53feSEli Cohen 		return 0;
3648613f53feSEli Cohen 
3649613f53feSEli Cohen 	if (!MLX5_CAP_ESW_FLOWTABLE_FDB(esw->dev,
3650613f53feSEli Cohen 					termination_table_raw_traffic)) {
3651613f53feSEli Cohen 		NL_SET_ERR_MSG_MOD(extack,
3652613f53feSEli Cohen 				   "devices are both uplink, can't offload forwarding");
3653613f53feSEli Cohen 			pr_err("devices %s %s are both uplink, can't offload forwarding\n",
3654613f53feSEli Cohen 			       priv->netdev->name, out_dev->name);
3655613f53feSEli Cohen 			return -EOPNOTSUPP;
3656613f53feSEli Cohen 	} else if (out_dev != rep_priv->netdev) {
3657613f53feSEli Cohen 		NL_SET_ERR_MSG_MOD(extack,
3658613f53feSEli Cohen 				   "devices are not the same uplink, can't offload forwarding");
3659613f53feSEli Cohen 		pr_err("devices %s %s are both uplink but not the same, can't offload forwarding\n",
3660613f53feSEli Cohen 		       priv->netdev->name, out_dev->name);
3661613f53feSEli Cohen 		return -EOPNOTSUPP;
3662613f53feSEli Cohen 	}
3663613f53feSEli Cohen 	return 0;
3664613f53feSEli Cohen }
3665613f53feSEli Cohen 
366673867881SPablo Neira Ayuso static int parse_tc_fdb_actions(struct mlx5e_priv *priv,
366773867881SPablo Neira Ayuso 				struct flow_action *flow_action,
3668e98bedf5SEli Britstein 				struct mlx5e_tc_flow *flow,
366914e6b038SEli Cohen 				struct netlink_ext_ack *extack,
367014e6b038SEli Cohen 				struct net_device *filter_dev)
3671a54e20b4SHadar Hen Zion {
367273867881SPablo Neira Ayuso 	struct pedit_headers_action hdrs[2] = {};
3673bf07aa73SPaul Blakey 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
3674c620b772SAriel Levkovich 	struct mlx5e_tc_flow_parse_attr *parse_attr;
36751d447a39SSaeed Mahameed 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
367673867881SPablo Neira Ayuso 	const struct ip_tunnel_info *info = NULL;
3677c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr = flow->attr;
3678554fe75cSDmytro Linkin 	int ifindexes[MLX5_MAX_FLOW_FWD_VPORTS];
367984179981SPaul Blakey 	bool ft_flow = mlx5e_is_ft_flow(flow);
368073867881SPablo Neira Ayuso 	const struct flow_action_entry *act;
3681c620b772SAriel Levkovich 	struct mlx5_esw_flow_attr *esw_attr;
368241c2fd94SChris Mi 	struct mlx5_sample_attr sample = {};
36830a7fcb78SPaul Blakey 	bool encap = false, decap = false;
36840a7fcb78SPaul Blakey 	u32 action = attr->action;
3685554fe75cSDmytro Linkin 	int err, i, if_count = 0;
3686f828ca6aSEli Cohen 	bool mpls_push = false;
368703a9d11eSOr Gerlitz 
368873867881SPablo Neira Ayuso 	if (!flow_action_has_entries(flow_action))
368903a9d11eSOr Gerlitz 		return -EINVAL;
369003a9d11eSOr Gerlitz 
369153eca1f3SJakub Kicinski 	if (!flow_action_hw_stats_check(flow_action, extack,
369253eca1f3SJakub Kicinski 					FLOW_ACTION_HW_STATS_DELAYED_BIT))
3693319a1d19SJiri Pirko 		return -EOPNOTSUPP;
3694319a1d19SJiri Pirko 
3695c620b772SAriel Levkovich 	esw_attr = attr->esw_attr;
3696c620b772SAriel Levkovich 	parse_attr = attr->parse_attr;
3697c620b772SAriel Levkovich 
369873867881SPablo Neira Ayuso 	flow_action_for_each(i, act, flow_action) {
369973867881SPablo Neira Ayuso 		switch (act->id) {
370073867881SPablo Neira Ayuso 		case FLOW_ACTION_DROP:
37011cab1cd7SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_DROP |
370203a9d11eSOr Gerlitz 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
370373867881SPablo Neira Ayuso 			break;
3704f0288210SEli Cohen 		case FLOW_ACTION_TRAP:
3705f0288210SEli Cohen 			if (!flow_offload_has_one_action(flow_action)) {
3706f0288210SEli Cohen 				NL_SET_ERR_MSG_MOD(extack,
3707f0288210SEli Cohen 						   "action trap is supported as a sole action only");
3708f0288210SEli Cohen 				return -EOPNOTSUPP;
3709f0288210SEli Cohen 			}
3710f0288210SEli Cohen 			action |= (MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
3711f0288210SEli Cohen 				   MLX5_FLOW_CONTEXT_ACTION_COUNT);
3712f0288210SEli Cohen 			attr->flags |= MLX5_ESW_ATTR_FLAG_SLOW_PATH;
3713f0288210SEli Cohen 			break;
3714f828ca6aSEli Cohen 		case FLOW_ACTION_MPLS_PUSH:
3715f828ca6aSEli Cohen 			if (!MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev,
3716f828ca6aSEli Cohen 							reformat_l2_to_l3_tunnel) ||
3717f828ca6aSEli Cohen 			    act->mpls_push.proto != htons(ETH_P_MPLS_UC)) {
3718f828ca6aSEli Cohen 				NL_SET_ERR_MSG_MOD(extack,
3719f828ca6aSEli Cohen 						   "mpls push is supported only for mpls_uc protocol");
3720f828ca6aSEli Cohen 				return -EOPNOTSUPP;
3721f828ca6aSEli Cohen 			}
3722f828ca6aSEli Cohen 			mpls_push = true;
3723f828ca6aSEli Cohen 			break;
372414e6b038SEli Cohen 		case FLOW_ACTION_MPLS_POP:
372514e6b038SEli Cohen 			/* we only support mpls pop if it is the first action
372614e6b038SEli Cohen 			 * and the filter net device is bareudp. Subsequent
372714e6b038SEli Cohen 			 * actions can be pedit and the last can be mirred
372814e6b038SEli Cohen 			 * egress redirect.
372914e6b038SEli Cohen 			 */
373014e6b038SEli Cohen 			if (i) {
373114e6b038SEli Cohen 				NL_SET_ERR_MSG_MOD(extack,
373214e6b038SEli Cohen 						   "mpls pop supported only as first action");
373314e6b038SEli Cohen 				return -EOPNOTSUPP;
373414e6b038SEli Cohen 			}
373514e6b038SEli Cohen 			if (!netif_is_bareudp(filter_dev)) {
373614e6b038SEli Cohen 				NL_SET_ERR_MSG_MOD(extack,
373714e6b038SEli Cohen 						   "mpls pop supported only on bareudp devices");
373814e6b038SEli Cohen 				return -EOPNOTSUPP;
373914e6b038SEli Cohen 			}
374014e6b038SEli Cohen 
374114e6b038SEli Cohen 			parse_attr->eth.h_proto = act->mpls_pop.proto;
374214e6b038SEli Cohen 			action |= MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT;
374314e6b038SEli Cohen 			flow_flag_set(flow, L3_TO_L2_DECAP);
374414e6b038SEli Cohen 			break;
374573867881SPablo Neira Ayuso 		case FLOW_ACTION_MANGLE:
374673867881SPablo Neira Ayuso 		case FLOW_ACTION_ADD:
374773867881SPablo Neira Ayuso 			err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_FDB,
3748582234b4SEli Cohen 						    parse_attr, hdrs, flow, extack);
3749d7e75a32SOr Gerlitz 			if (err)
3750d7e75a32SOr Gerlitz 				return err;
3751d7e75a32SOr Gerlitz 
3752582234b4SEli Cohen 			if (!flow_flag_test(flow, L3_TO_L2_DECAP)) {
37531cab1cd7SOr Gerlitz 				action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
3754c620b772SAriel Levkovich 				esw_attr->split_count = esw_attr->out_count;
3755582234b4SEli Cohen 			}
375673867881SPablo Neira Ayuso 			break;
375773867881SPablo Neira Ayuso 		case FLOW_ACTION_CSUM:
37581cab1cd7SOr Gerlitz 			if (csum_offload_supported(priv, action,
375973867881SPablo Neira Ayuso 						   act->csum_flags, extack))
376073867881SPablo Neira Ayuso 				break;
376126c02749SOr Gerlitz 
376226c02749SOr Gerlitz 			return -EOPNOTSUPP;
376373867881SPablo Neira Ayuso 		case FLOW_ACTION_REDIRECT:
376473867881SPablo Neira Ayuso 		case FLOW_ACTION_MIRRED: {
376503a9d11eSOr Gerlitz 			struct mlx5e_priv *out_priv;
3766592d3651SChris Mi 			struct net_device *out_dev;
376703a9d11eSOr Gerlitz 
376873867881SPablo Neira Ayuso 			out_dev = act->dev;
3769ef381359SOz Shlomo 			if (!out_dev) {
3770ef381359SOz Shlomo 				/* out_dev is NULL when filters with
3771ef381359SOz Shlomo 				 * non-existing mirred device are replayed to
3772ef381359SOz Shlomo 				 * the driver.
3773ef381359SOz Shlomo 				 */
3774ef381359SOz Shlomo 				return -EINVAL;
3775ef381359SOz Shlomo 			}
377603a9d11eSOr Gerlitz 
3777f828ca6aSEli Cohen 			if (mpls_push && !netif_is_bareudp(out_dev)) {
3778f828ca6aSEli Cohen 				NL_SET_ERR_MSG_MOD(extack,
3779f828ca6aSEli Cohen 						   "mpls is supported only through a bareudp device");
3780f828ca6aSEli Cohen 				return -EOPNOTSUPP;
3781f828ca6aSEli Cohen 			}
3782f828ca6aSEli Cohen 
378384179981SPaul Blakey 			if (ft_flow && out_dev == priv->netdev) {
378484179981SPaul Blakey 				/* Ignore forward to self rules generated
378584179981SPaul Blakey 				 * by adding both mlx5 devs to the flow table
378684179981SPaul Blakey 				 * block on a normal nft offload setup.
378784179981SPaul Blakey 				 */
378884179981SPaul Blakey 				return -EOPNOTSUPP;
378984179981SPaul Blakey 			}
379084179981SPaul Blakey 
3791c620b772SAriel Levkovich 			if (esw_attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) {
3792e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
3793e98bedf5SEli Britstein 						   "can't support more output ports, can't offload forwarding");
37944ccd83f4SRoi Dayan 				netdev_warn(priv->netdev,
37954ccd83f4SRoi Dayan 					    "can't support more than %d output ports, can't offload forwarding\n",
3796c620b772SAriel Levkovich 					    esw_attr->out_count);
3797592d3651SChris Mi 				return -EOPNOTSUPP;
3798592d3651SChris Mi 			}
3799592d3651SChris Mi 
3800f493f155SEli Britstein 			action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
3801f493f155SEli Britstein 				  MLX5_FLOW_CONTEXT_ACTION_COUNT;
3802b6a4ac24SVlad Buslov 			if (encap) {
3803c620b772SAriel Levkovich 				parse_attr->mirred_ifindex[esw_attr->out_count] =
3804b6a4ac24SVlad Buslov 					out_dev->ifindex;
38050d9f9647SVlad Buslov 				parse_attr->tun_info[esw_attr->out_count] =
38060d9f9647SVlad Buslov 					mlx5e_dup_tun_info(info);
3807c620b772SAriel Levkovich 				if (!parse_attr->tun_info[esw_attr->out_count])
3808b6a4ac24SVlad Buslov 					return -ENOMEM;
3809b6a4ac24SVlad Buslov 				encap = false;
3810c620b772SAriel Levkovich 				esw_attr->dests[esw_attr->out_count].flags |=
3811b6a4ac24SVlad Buslov 					MLX5_ESW_DEST_ENCAP;
3812c620b772SAriel Levkovich 				esw_attr->out_count++;
3813b6a4ac24SVlad Buslov 				/* attr->dests[].rep is resolved when we
3814b6a4ac24SVlad Buslov 				 * handle encap
3815b6a4ac24SVlad Buslov 				 */
3816b6a4ac24SVlad Buslov 			} else if (netdev_port_same_parent_id(priv->netdev, out_dev)) {
38177ba58ba7SRabie Loulou 				struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
38187ba58ba7SRabie Loulou 				struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH);
38197ba58ba7SRabie Loulou 
3820554fe75cSDmytro Linkin 				if (is_duplicated_output_device(priv->netdev,
3821554fe75cSDmytro Linkin 								out_dev,
3822554fe75cSDmytro Linkin 								ifindexes,
3823554fe75cSDmytro Linkin 								if_count,
3824554fe75cSDmytro Linkin 								extack))
3825554fe75cSDmytro Linkin 					return -EOPNOTSUPP;
3826554fe75cSDmytro Linkin 
3827554fe75cSDmytro Linkin 				ifindexes[if_count] = out_dev->ifindex;
3828554fe75cSDmytro Linkin 				if_count++;
3829554fe75cSDmytro Linkin 
3830d34eb2fcSOr Gerlitz 				out_dev = get_fdb_out_dev(uplink_dev, out_dev);
3831d34eb2fcSOr Gerlitz 				if (!out_dev)
3832d34eb2fcSOr Gerlitz 					return -ENODEV;
38337ba58ba7SRabie Loulou 
3834278748a9SEli Britstein 				if (is_vlan_dev(out_dev)) {
3835278748a9SEli Britstein 					err = add_vlan_push_action(priv, attr,
3836278748a9SEli Britstein 								   &out_dev,
3837278748a9SEli Britstein 								   &action);
3838278748a9SEli Britstein 					if (err)
3839278748a9SEli Britstein 						return err;
3840278748a9SEli Britstein 				}
3841f6dc1264SPaul Blakey 
384235a605dbSEli Britstein 				if (is_vlan_dev(parse_attr->filter_dev)) {
384335a605dbSEli Britstein 					err = add_vlan_pop_action(priv, attr,
384435a605dbSEli Britstein 								  &action);
384535a605dbSEli Britstein 					if (err)
384635a605dbSEli Britstein 						return err;
384735a605dbSEli Britstein 				}
3848278748a9SEli Britstein 
3849613f53feSEli Cohen 				err = verify_uplink_forwarding(priv, flow, out_dev, extack);
3850613f53feSEli Cohen 				if (err)
3851613f53feSEli Cohen 					return err;
3852ffec9702STonghao Zhang 
3853f6dc1264SPaul Blakey 				if (!mlx5e_is_valid_eswitch_fwd_dev(priv, out_dev)) {
3854f6dc1264SPaul Blakey 					NL_SET_ERR_MSG_MOD(extack,
3855f6dc1264SPaul Blakey 							   "devices are not on same switch HW, can't offload forwarding");
3856a0646c88SEli Britstein 					return -EOPNOTSUPP;
3857f6dc1264SPaul Blakey 				}
3858a0646c88SEli Britstein 
3859bb569657SAriel Levkovich 				if (same_vf_reps(priv, out_dev)) {
3860bb569657SAriel Levkovich 					NL_SET_ERR_MSG_MOD(extack,
3861bb569657SAriel Levkovich 							   "can't forward from a VF to itself");
3862bb569657SAriel Levkovich 					return -EOPNOTSUPP;
3863bb569657SAriel Levkovich 				}
3864bb569657SAriel Levkovich 
386503a9d11eSOr Gerlitz 				out_priv = netdev_priv(out_dev);
38661d447a39SSaeed Mahameed 				rpriv = out_priv->ppriv;
3867c620b772SAriel Levkovich 				esw_attr->dests[esw_attr->out_count].rep = rpriv->rep;
3868c620b772SAriel Levkovich 				esw_attr->dests[esw_attr->out_count].mdev = out_priv->mdev;
3869c620b772SAriel Levkovich 				esw_attr->out_count++;
3870ef381359SOz Shlomo 			} else if (parse_attr->filter_dev != priv->netdev) {
3871ef381359SOz Shlomo 				/* All mlx5 devices are called to configure
3872ef381359SOz Shlomo 				 * high level device filters. Therefore, the
3873ef381359SOz Shlomo 				 * *attempt* to  install a filter on invalid
3874ef381359SOz Shlomo 				 * eswitch should not trigger an explicit error
3875ef381359SOz Shlomo 				 */
3876ef381359SOz Shlomo 				return -EINVAL;
3877a54e20b4SHadar Hen Zion 			} else {
3878e98bedf5SEli Britstein 				NL_SET_ERR_MSG_MOD(extack,
3879e98bedf5SEli Britstein 						   "devices are not on same switch HW, can't offload forwarding");
38804ccd83f4SRoi Dayan 				netdev_warn(priv->netdev,
38814ccd83f4SRoi Dayan 					    "devices %s %s not on same switch HW, can't offload forwarding\n",
38824ccd83f4SRoi Dayan 					    priv->netdev->name,
38834ccd83f4SRoi Dayan 					    out_dev->name);
3884a54e20b4SHadar Hen Zion 				return -EINVAL;
3885a54e20b4SHadar Hen Zion 			}
3886a54e20b4SHadar Hen Zion 			}
388773867881SPablo Neira Ayuso 			break;
388873867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_ENCAP:
388973867881SPablo Neira Ayuso 			info = act->tunnel;
3890a54e20b4SHadar Hen Zion 			if (info)
3891a54e20b4SHadar Hen Zion 				encap = true;
3892a54e20b4SHadar Hen Zion 			else
3893a54e20b4SHadar Hen Zion 				return -EOPNOTSUPP;
389403a9d11eSOr Gerlitz 
389573867881SPablo Neira Ayuso 			break;
389673867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_PUSH:
389773867881SPablo Neira Ayuso 		case FLOW_ACTION_VLAN_POP:
389876b496b1SEli Britstein 			if (act->id == FLOW_ACTION_VLAN_PUSH &&
389976b496b1SEli Britstein 			    (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP)) {
390076b496b1SEli Britstein 				/* Replace vlan pop+push with vlan modify */
390176b496b1SEli Britstein 				action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
390276b496b1SEli Britstein 				err = add_vlan_rewrite_action(priv,
390376b496b1SEli Britstein 							      MLX5_FLOW_NAMESPACE_FDB,
390476b496b1SEli Britstein 							      act, parse_attr, hdrs,
390576b496b1SEli Britstein 							      &action, extack);
390676b496b1SEli Britstein 			} else {
3907c620b772SAriel Levkovich 				err = parse_tc_vlan_action(priv, act, esw_attr, &action);
390876b496b1SEli Britstein 			}
39091482bd3dSJianbo Liu 			if (err)
39101482bd3dSJianbo Liu 				return err;
39111482bd3dSJianbo Liu 
3912c620b772SAriel Levkovich 			esw_attr->split_count = esw_attr->out_count;
391373867881SPablo Neira Ayuso 			break;
3914bdc837eeSEli Britstein 		case FLOW_ACTION_VLAN_MANGLE:
3915bdc837eeSEli Britstein 			err = add_vlan_rewrite_action(priv,
3916bdc837eeSEli Britstein 						      MLX5_FLOW_NAMESPACE_FDB,
3917bdc837eeSEli Britstein 						      act, parse_attr, hdrs,
3918bdc837eeSEli Britstein 						      &action, extack);
3919bdc837eeSEli Britstein 			if (err)
3920bdc837eeSEli Britstein 				return err;
3921bdc837eeSEli Britstein 
3922c620b772SAriel Levkovich 			esw_attr->split_count = esw_attr->out_count;
3923bdc837eeSEli Britstein 			break;
392473867881SPablo Neira Ayuso 		case FLOW_ACTION_TUNNEL_DECAP:
39250a7fcb78SPaul Blakey 			decap = true;
392673867881SPablo Neira Ayuso 			break;
39272fbbc30dSEli Cohen 		case FLOW_ACTION_GOTO:
3928c7569097SAriel Levkovich 			err = validate_goto_chain(priv, flow, act, action,
39292fbbc30dSEli Cohen 						  extack);
39302fbbc30dSEli Cohen 			if (err)
39312fbbc30dSEli Cohen 				return err;
3932bf07aa73SPaul Blakey 
3933e88afe75SOr Gerlitz 			action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
39342fbbc30dSEli Cohen 			attr->dest_chain = act->chain_index;
393573867881SPablo Neira Ayuso 			break;
39364c3844d9SPaul Blakey 		case FLOW_ACTION_CT:
393741c2fd94SChris Mi 			if (flow_flag_test(flow, SAMPLE)) {
393841c2fd94SChris Mi 				NL_SET_ERR_MSG_MOD(extack, "Sample action with connection tracking is not supported");
393941c2fd94SChris Mi 				return -EOPNOTSUPP;
394041c2fd94SChris Mi 			}
3941aedd133dSAriel Levkovich 			err = mlx5_tc_ct_parse_action(get_ct_priv(priv), attr, act, extack);
39424c3844d9SPaul Blakey 			if (err)
39434c3844d9SPaul Blakey 				return err;
39444c3844d9SPaul Blakey 
39454c3844d9SPaul Blakey 			flow_flag_set(flow, CT);
394669e2916eSPaul Blakey 			esw_attr->split_count = esw_attr->out_count;
39474c3844d9SPaul Blakey 			break;
394841c2fd94SChris Mi 		case FLOW_ACTION_SAMPLE:
394941c2fd94SChris Mi 			if (flow_flag_test(flow, CT)) {
395041c2fd94SChris Mi 				NL_SET_ERR_MSG_MOD(extack, "Sample action with connection tracking is not supported");
395141c2fd94SChris Mi 				return -EOPNOTSUPP;
395241c2fd94SChris Mi 			}
395341c2fd94SChris Mi 			sample.rate = act->sample.rate;
395441c2fd94SChris Mi 			sample.group_num = act->sample.psample_group->group_num;
395541c2fd94SChris Mi 			if (act->sample.truncate)
395641c2fd94SChris Mi 				sample.trunc_size = act->sample.trunc_size;
395741c2fd94SChris Mi 			flow_flag_set(flow, SAMPLE);
395841c2fd94SChris Mi 			break;
395973867881SPablo Neira Ayuso 		default:
39602cc1cb1dSTonghao Zhang 			NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported");
39612cc1cb1dSTonghao Zhang 			return -EOPNOTSUPP;
396203a9d11eSOr Gerlitz 		}
396373867881SPablo Neira Ayuso 	}
3964bdd66ac0SOr Gerlitz 
3965a508728aSVlad Buslov 	/* always set IP version for indirect table handling */
3966a508728aSVlad Buslov 	attr->ip_version = mlx5e_tc_get_ip_version(&parse_attr->spec, true);
3967a508728aSVlad Buslov 
39680bac1194SEli Britstein 	if (MLX5_CAP_GEN(esw->dev, prio_tag_required) &&
39690bac1194SEli Britstein 	    action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) {
39700bac1194SEli Britstein 		/* For prio tag mode, replace vlan pop with rewrite vlan prio
39710bac1194SEli Britstein 		 * tag rewrite.
39720bac1194SEli Britstein 		 */
39730bac1194SEli Britstein 		action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP;
39740bac1194SEli Britstein 		err = add_vlan_prio_tag_rewrite_action(priv, parse_attr, hdrs,
39750bac1194SEli Britstein 						       &action, extack);
39760bac1194SEli Britstein 		if (err)
39770bac1194SEli Britstein 			return err;
39780bac1194SEli Britstein 	}
39790bac1194SEli Britstein 
3980c500c86bSPablo Neira Ayuso 	if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits ||
3981c500c86bSPablo Neira Ayuso 	    hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) {
398284be899fSTonghao Zhang 		err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_FDB,
398327c11b6bSEli Britstein 					    parse_attr, hdrs, &action, extack);
3984c500c86bSPablo Neira Ayuso 		if (err)
3985c500c86bSPablo Neira Ayuso 			return err;
398627c11b6bSEli Britstein 		/* in case all pedit actions are skipped, remove the MOD_HDR
398727c11b6bSEli Britstein 		 * flag. we might have set split_count either by pedit or
398827c11b6bSEli Britstein 		 * pop/push. if there is no pop/push either, reset it too.
398927c11b6bSEli Britstein 		 */
39906ae4a6a5SPaul Blakey 		if (parse_attr->mod_hdr_acts.num_actions == 0) {
399127c11b6bSEli Britstein 			action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
39926ae4a6a5SPaul Blakey 			dealloc_mod_hdr_actions(&parse_attr->mod_hdr_acts);
399327c11b6bSEli Britstein 			if (!((action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) ||
399427c11b6bSEli Britstein 			      (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH)))
3995c620b772SAriel Levkovich 				esw_attr->split_count = 0;
399627c11b6bSEli Britstein 		}
3997c500c86bSPablo Neira Ayuso 	}
3998c500c86bSPablo Neira Ayuso 
39991cab1cd7SOr Gerlitz 	attr->action = action;
400073867881SPablo Neira Ayuso 	if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack))
4001bdd66ac0SOr Gerlitz 		return -EOPNOTSUPP;
4002bdd66ac0SOr Gerlitz 
4003e88afe75SOr Gerlitz 	if (attr->dest_chain) {
40040a7fcb78SPaul Blakey 		if (decap) {
40050a7fcb78SPaul Blakey 			/* It can be supported if we'll create a mapping for
40060a7fcb78SPaul Blakey 			 * the tunnel device only (without tunnel), and set
40070a7fcb78SPaul Blakey 			 * this tunnel id with this decap flow.
40080a7fcb78SPaul Blakey 			 *
40090a7fcb78SPaul Blakey 			 * On restore (miss), we'll just set this saved tunnel
40100a7fcb78SPaul Blakey 			 * device.
40110a7fcb78SPaul Blakey 			 */
40120a7fcb78SPaul Blakey 
40130a7fcb78SPaul Blakey 			NL_SET_ERR_MSG(extack,
40140a7fcb78SPaul Blakey 				       "Decap with goto isn't supported");
40150a7fcb78SPaul Blakey 			netdev_warn(priv->netdev,
40160a7fcb78SPaul Blakey 				    "Decap with goto isn't supported");
40170a7fcb78SPaul Blakey 			return -EOPNOTSUPP;
40180a7fcb78SPaul Blakey 		}
40190a7fcb78SPaul Blakey 
4020e88afe75SOr Gerlitz 		attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
4021e88afe75SOr Gerlitz 	}
4022e88afe75SOr Gerlitz 
4023ae2741e2SVlad Buslov 	if (!(attr->action &
4024ae2741e2SVlad Buslov 	      (MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | MLX5_FLOW_CONTEXT_ACTION_DROP))) {
402561644c3dSRoi Dayan 		NL_SET_ERR_MSG_MOD(extack,
402661644c3dSRoi Dayan 				   "Rule must have at least one forward/drop action");
4027ae2741e2SVlad Buslov 		return -EOPNOTSUPP;
4028ae2741e2SVlad Buslov 	}
4029ae2741e2SVlad Buslov 
4030c620b772SAriel Levkovich 	if (esw_attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) {
4031e98bedf5SEli Britstein 		NL_SET_ERR_MSG_MOD(extack,
4032e98bedf5SEli Britstein 				   "current firmware doesn't support split rule for port mirroring");
4033592d3651SChris Mi 		netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n");
4034592d3651SChris Mi 		return -EOPNOTSUPP;
4035592d3651SChris Mi 	}
4036592d3651SChris Mi 
403741c2fd94SChris Mi 	/* Allocate sample attribute only when there is a sample action and
403841c2fd94SChris Mi 	 * no errors after parsing.
403941c2fd94SChris Mi 	 */
404041c2fd94SChris Mi 	if (flow_flag_test(flow, SAMPLE)) {
404141c2fd94SChris Mi 		esw_attr->sample = kzalloc(sizeof(*esw_attr->sample), GFP_KERNEL);
404241c2fd94SChris Mi 		if (!esw_attr->sample)
404341c2fd94SChris Mi 			return -ENOMEM;
404441c2fd94SChris Mi 		*esw_attr->sample = sample;
404541c2fd94SChris Mi 	}
404641c2fd94SChris Mi 
404731c8eba5SOr Gerlitz 	return 0;
404803a9d11eSOr Gerlitz }
404903a9d11eSOr Gerlitz 
4050226f2ca3SVlad Buslov static void get_flags(int flags, unsigned long *flow_flags)
405160bd4af8SOr Gerlitz {
4052226f2ca3SVlad Buslov 	unsigned long __flow_flags = 0;
405360bd4af8SOr Gerlitz 
4054226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(INGRESS))
4055226f2ca3SVlad Buslov 		__flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_INGRESS);
4056226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(EGRESS))
4057226f2ca3SVlad Buslov 		__flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_EGRESS);
405860bd4af8SOr Gerlitz 
4059226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(ESW_OFFLOAD))
4060226f2ca3SVlad Buslov 		__flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_ESWITCH);
4061226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(NIC_OFFLOAD))
4062226f2ca3SVlad Buslov 		__flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_NIC);
406384179981SPaul Blakey 	if (flags & MLX5_TC_FLAG(FT_OFFLOAD))
406484179981SPaul Blakey 		__flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_FT);
4065d9ee0491SOr Gerlitz 
406660bd4af8SOr Gerlitz 	*flow_flags = __flow_flags;
406760bd4af8SOr Gerlitz }
406860bd4af8SOr Gerlitz 
406905866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = {
407005866c82SOr Gerlitz 	.head_offset = offsetof(struct mlx5e_tc_flow, node),
407105866c82SOr Gerlitz 	.key_offset = offsetof(struct mlx5e_tc_flow, cookie),
407205866c82SOr Gerlitz 	.key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie),
407305866c82SOr Gerlitz 	.automatic_shrinking = true,
407405866c82SOr Gerlitz };
407505866c82SOr Gerlitz 
4076226f2ca3SVlad Buslov static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv,
4077226f2ca3SVlad Buslov 				    unsigned long flags)
407805866c82SOr Gerlitz {
4079655dc3d2SOr Gerlitz 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
4080655dc3d2SOr Gerlitz 	struct mlx5e_rep_priv *uplink_rpriv;
4081655dc3d2SOr Gerlitz 
4082226f2ca3SVlad Buslov 	if (flags & MLX5_TC_FLAG(ESW_OFFLOAD)) {
4083655dc3d2SOr Gerlitz 		uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH);
4084ec1366c2SOz Shlomo 		return &uplink_rpriv->uplink_priv.tc_ht;
4085d9ee0491SOr Gerlitz 	} else /* NIC offload */
408605866c82SOr Gerlitz 		return &priv->fs.tc.ht;
408705866c82SOr Gerlitz }
408805866c82SOr Gerlitz 
408904de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow)
409004de7ddaSRoi Dayan {
4091c620b772SAriel Levkovich 	struct mlx5_esw_flow_attr *esw_attr = flow->attr->esw_attr;
4092c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr = flow->attr;
4093c620b772SAriel Levkovich 	bool is_rep_ingress = esw_attr->in_rep->vport != MLX5_VPORT_UPLINK &&
4094226f2ca3SVlad Buslov 		flow_flag_test(flow, INGRESS);
40951418ddd9SAviv Heller 	bool act_is_encap = !!(attr->action &
40961418ddd9SAviv Heller 			       MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT);
4097c620b772SAriel Levkovich 	bool esw_paired = mlx5_devcom_is_paired(esw_attr->in_mdev->priv.devcom,
40981418ddd9SAviv Heller 						MLX5_DEVCOM_ESW_OFFLOADS);
40991418ddd9SAviv Heller 
410010fbb1cdSRoi Dayan 	if (!esw_paired)
410110fbb1cdSRoi Dayan 		return false;
410210fbb1cdSRoi Dayan 
4103c620b772SAriel Levkovich 	if ((mlx5_lag_is_sriov(esw_attr->in_mdev) ||
4104c620b772SAriel Levkovich 	     mlx5_lag_is_multipath(esw_attr->in_mdev)) &&
410510fbb1cdSRoi Dayan 	    (is_rep_ingress || act_is_encap))
410610fbb1cdSRoi Dayan 		return true;
410710fbb1cdSRoi Dayan 
410810fbb1cdSRoi Dayan 	return false;
410904de7ddaSRoi Dayan }
411004de7ddaSRoi Dayan 
4111c620b772SAriel Levkovich struct mlx5_flow_attr *
4112c620b772SAriel Levkovich mlx5_alloc_flow_attr(enum mlx5_flow_namespace_type type)
4113c620b772SAriel Levkovich {
4114c620b772SAriel Levkovich 	u32 ex_attr_size = (type == MLX5_FLOW_NAMESPACE_FDB)  ?
4115c620b772SAriel Levkovich 				sizeof(struct mlx5_esw_flow_attr) :
4116c620b772SAriel Levkovich 				sizeof(struct mlx5_nic_flow_attr);
4117c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr;
4118c620b772SAriel Levkovich 
4119c620b772SAriel Levkovich 	return kzalloc(sizeof(*attr) + ex_attr_size, GFP_KERNEL);
4120c620b772SAriel Levkovich }
4121c620b772SAriel Levkovich 
4122a88780a9SRoi Dayan static int
4123a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size,
4124226f2ca3SVlad Buslov 		 struct flow_cls_offload *f, unsigned long flow_flags,
4125a88780a9SRoi Dayan 		 struct mlx5e_tc_flow_parse_attr **__parse_attr,
4126a88780a9SRoi Dayan 		 struct mlx5e_tc_flow **__flow)
4127e3a2b7edSAmir Vadai {
412817091853SOr Gerlitz 	struct mlx5e_tc_flow_parse_attr *parse_attr;
4129c620b772SAriel Levkovich 	struct mlx5_flow_attr *attr;
41303bc4b7bfSOr Gerlitz 	struct mlx5e_tc_flow *flow;
4131ff7ea04aSGustavo A. R. Silva 	int err = -ENOMEM;
4132ff7ea04aSGustavo A. R. Silva 	int out_index;
4133776b12b6SOr Gerlitz 
4134c620b772SAriel Levkovich 	flow = kzalloc(sizeof(*flow), GFP_KERNEL);
41351b9a07eeSLeon Romanovsky 	parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL);
4136ff7ea04aSGustavo A. R. Silva 	if (!parse_attr || !flow)
4137ff7ea04aSGustavo A. R. Silva 		goto err_free;
4138c620b772SAriel Levkovich 
4139c620b772SAriel Levkovich 	flow->flags = flow_flags;
4140c620b772SAriel Levkovich 	flow->cookie = f->cookie;
4141c620b772SAriel Levkovich 	flow->priv = priv;
4142c620b772SAriel Levkovich 
4143c620b772SAriel Levkovich 	attr = mlx5_alloc_flow_attr(get_flow_name_space(flow));
4144ff7ea04aSGustavo A. R. Silva 	if (!attr)
4145e3a2b7edSAmir Vadai 		goto err_free;
4146ff7ea04aSGustavo A. R. Silva 
4147c620b772SAriel Levkovich 	flow->attr = attr;
4148e3a2b7edSAmir Vadai 
41495a7e5bcbSVlad Buslov 	for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++)
41505a7e5bcbSVlad Buslov 		INIT_LIST_HEAD(&flow->encaps[out_index].list);
41515a7e5bcbSVlad Buslov 	INIT_LIST_HEAD(&flow->hairpin);
415214e6b038SEli Cohen 	INIT_LIST_HEAD(&flow->l3_to_l2_reformat);
41535a7e5bcbSVlad Buslov 	refcount_set(&flow->refcnt, 1);
415495435ad7SVlad Buslov 	init_completion(&flow->init_done);
4155e3a2b7edSAmir Vadai 
4156a88780a9SRoi Dayan 	*__flow = flow;
4157a88780a9SRoi Dayan 	*__parse_attr = parse_attr;
4158a88780a9SRoi Dayan 
4159a88780a9SRoi Dayan 	return 0;
4160a88780a9SRoi Dayan 
4161a88780a9SRoi Dayan err_free:
4162a88780a9SRoi Dayan 	kfree(flow);
4163a88780a9SRoi Dayan 	kvfree(parse_attr);
4164a88780a9SRoi Dayan 	return err;
4165adb4c123SOr Gerlitz }
4166adb4c123SOr Gerlitz 
4167988ab9c7STonghao Zhang static void
4168c7569097SAriel Levkovich mlx5e_flow_attr_init(struct mlx5_flow_attr *attr,
4169c7569097SAriel Levkovich 		     struct mlx5e_tc_flow_parse_attr *parse_attr,
4170c7569097SAriel Levkovich 		     struct flow_cls_offload *f)
4171c7569097SAriel Levkovich {
4172c7569097SAriel Levkovich 	attr->parse_attr = parse_attr;
4173c7569097SAriel Levkovich 	attr->chain = f->common.chain_index;
4174c7569097SAriel Levkovich 	attr->prio = f->common.prio;
4175c7569097SAriel Levkovich }
4176c7569097SAriel Levkovich 
4177c7569097SAriel Levkovich static void
4178c620b772SAriel Levkovich mlx5e_flow_esw_attr_init(struct mlx5_flow_attr *attr,
4179988ab9c7STonghao Zhang 			 struct mlx5e_priv *priv,
4180988ab9c7STonghao Zhang 			 struct mlx5e_tc_flow_parse_attr *parse_attr,
4181f9e30088SPablo Neira Ayuso 			 struct flow_cls_offload *f,
4182988ab9c7STonghao Zhang 			 struct mlx5_eswitch_rep *in_rep,
4183988ab9c7STonghao Zhang 			 struct mlx5_core_dev *in_mdev)
4184988ab9c7STonghao Zhang {
4185988ab9c7STonghao Zhang 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
4186c620b772SAriel Levkovich 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
4187988ab9c7STonghao Zhang 
4188c7569097SAriel Levkovich 	mlx5e_flow_attr_init(attr, parse_attr, f);
4189988ab9c7STonghao Zhang 
4190988ab9c7STonghao Zhang 	esw_attr->in_rep = in_rep;
4191988ab9c7STonghao Zhang 	esw_attr->in_mdev = in_mdev;
4192988ab9c7STonghao Zhang 
4193988ab9c7STonghao Zhang 	if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) ==
4194988ab9c7STonghao Zhang 	    MLX5_COUNTER_SOURCE_ESWITCH)
4195988ab9c7STonghao Zhang 		esw_attr->counter_dev = in_mdev;
4196988ab9c7STonghao Zhang 	else
4197988ab9c7STonghao Zhang 		esw_attr->counter_dev = priv->mdev;
4198988ab9c7STonghao Zhang }
4199988ab9c7STonghao Zhang 
420071129676SJason Gunthorpe static struct mlx5e_tc_flow *
420104de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
4202f9e30088SPablo Neira Ayuso 		     struct flow_cls_offload *f,
4203226f2ca3SVlad Buslov 		     unsigned long flow_flags,
4204d11afc26SOz Shlomo 		     struct net_device *filter_dev,
420504de7ddaSRoi Dayan 		     struct mlx5_eswitch_rep *in_rep,
420671129676SJason Gunthorpe 		     struct mlx5_core_dev *in_mdev)
4207a88780a9SRoi Dayan {
4208f9e30088SPablo Neira Ayuso 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
4209a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
4210a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
4211a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
4212a88780a9SRoi Dayan 	int attr_size, err;
4213a88780a9SRoi Dayan 
4214226f2ca3SVlad Buslov 	flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_ESWITCH);
4215a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_esw_flow_attr);
4216a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
4217a88780a9SRoi Dayan 			       &parse_attr, &flow);
4218a88780a9SRoi Dayan 	if (err)
4219a88780a9SRoi Dayan 		goto out;
4220988ab9c7STonghao Zhang 
4221d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
4222c620b772SAriel Levkovich 	mlx5e_flow_esw_attr_init(flow->attr,
4223988ab9c7STonghao Zhang 				 priv, parse_attr,
4224988ab9c7STonghao Zhang 				 f, in_rep, in_mdev);
4225988ab9c7STonghao Zhang 
422654c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
422754c177caSOz Shlomo 			       f, filter_dev);
4228d11afc26SOz Shlomo 	if (err)
4229d11afc26SOz Shlomo 		goto err_free;
4230a88780a9SRoi Dayan 
42317e36feebSPaul Blakey 	/* actions validation depends on parsing the ct matches first */
4232aedd133dSAriel Levkovich 	err = mlx5_tc_ct_match_add(get_ct_priv(priv), &parse_attr->spec, f,
4233c620b772SAriel Levkovich 				   &flow->attr->ct_attr, extack);
4234a88780a9SRoi Dayan 	if (err)
4235a88780a9SRoi Dayan 		goto err_free;
4236a88780a9SRoi Dayan 
42377e36feebSPaul Blakey 	err = parse_tc_fdb_actions(priv, &rule->action, flow, extack, filter_dev);
42384c3844d9SPaul Blakey 	if (err)
42394c3844d9SPaul Blakey 		goto err_free;
42404c3844d9SPaul Blakey 
42417040632dSTonghao Zhang 	err = mlx5e_tc_add_fdb_flow(priv, flow, extack);
424295435ad7SVlad Buslov 	complete_all(&flow->init_done);
4243ef06c9eeSRoi Dayan 	if (err) {
4244ef06c9eeSRoi Dayan 		if (!(err == -ENETUNREACH && mlx5_lag_is_multipath(in_mdev)))
4245aa0cbbaeSOr Gerlitz 			goto err_free;
42465c40348cSOr Gerlitz 
4247b4a23329SRoi Dayan 		add_unready_flow(flow);
4248ef06c9eeSRoi Dayan 	}
4249ef06c9eeSRoi Dayan 
425071129676SJason Gunthorpe 	return flow;
4251e3a2b7edSAmir Vadai 
4252e3a2b7edSAmir Vadai err_free:
42535a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
4254a88780a9SRoi Dayan out:
425571129676SJason Gunthorpe 	return ERR_PTR(err);
4256a88780a9SRoi Dayan }
4257a88780a9SRoi Dayan 
4258f9e30088SPablo Neira Ayuso static int mlx5e_tc_add_fdb_peer_flow(struct flow_cls_offload *f,
425995dc1902SRoi Dayan 				      struct mlx5e_tc_flow *flow,
4260226f2ca3SVlad Buslov 				      unsigned long flow_flags)
426104de7ddaSRoi Dayan {
426204de7ddaSRoi Dayan 	struct mlx5e_priv *priv = flow->priv, *peer_priv;
426304de7ddaSRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw;
4264c620b772SAriel Levkovich 	struct mlx5_esw_flow_attr *attr = flow->attr->esw_attr;
426504de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
426604de7ddaSRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
426704de7ddaSRoi Dayan 	struct mlx5e_rep_priv *peer_urpriv;
426804de7ddaSRoi Dayan 	struct mlx5e_tc_flow *peer_flow;
426904de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev;
427004de7ddaSRoi Dayan 	int err = 0;
427104de7ddaSRoi Dayan 
427204de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
427304de7ddaSRoi Dayan 	if (!peer_esw)
427404de7ddaSRoi Dayan 		return -ENODEV;
427504de7ddaSRoi Dayan 
427604de7ddaSRoi Dayan 	peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH);
427704de7ddaSRoi Dayan 	peer_priv = netdev_priv(peer_urpriv->netdev);
427804de7ddaSRoi Dayan 
427904de7ddaSRoi Dayan 	/* in_mdev is assigned of which the packet originated from.
428004de7ddaSRoi Dayan 	 * So packets redirected to uplink use the same mdev of the
428104de7ddaSRoi Dayan 	 * original flow and packets redirected from uplink use the
428204de7ddaSRoi Dayan 	 * peer mdev.
428304de7ddaSRoi Dayan 	 */
4284c620b772SAriel Levkovich 	if (attr->in_rep->vport == MLX5_VPORT_UPLINK)
428504de7ddaSRoi Dayan 		in_mdev = peer_priv->mdev;
428604de7ddaSRoi Dayan 	else
428704de7ddaSRoi Dayan 		in_mdev = priv->mdev;
428804de7ddaSRoi Dayan 
4289c620b772SAriel Levkovich 	parse_attr = flow->attr->parse_attr;
429095dc1902SRoi Dayan 	peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow_flags,
429104de7ddaSRoi Dayan 					 parse_attr->filter_dev,
4292c620b772SAriel Levkovich 					 attr->in_rep, in_mdev);
429371129676SJason Gunthorpe 	if (IS_ERR(peer_flow)) {
429471129676SJason Gunthorpe 		err = PTR_ERR(peer_flow);
429504de7ddaSRoi Dayan 		goto out;
429671129676SJason Gunthorpe 	}
429704de7ddaSRoi Dayan 
429804de7ddaSRoi Dayan 	flow->peer_flow = peer_flow;
4299226f2ca3SVlad Buslov 	flow_flag_set(flow, DUP);
430004de7ddaSRoi Dayan 	mutex_lock(&esw->offloads.peer_mutex);
430104de7ddaSRoi Dayan 	list_add_tail(&flow->peer, &esw->offloads.peer_flows);
430204de7ddaSRoi Dayan 	mutex_unlock(&esw->offloads.peer_mutex);
430304de7ddaSRoi Dayan 
430404de7ddaSRoi Dayan out:
430504de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
430604de7ddaSRoi Dayan 	return err;
430704de7ddaSRoi Dayan }
430804de7ddaSRoi Dayan 
430904de7ddaSRoi Dayan static int
431004de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv,
4311f9e30088SPablo Neira Ayuso 		   struct flow_cls_offload *f,
4312226f2ca3SVlad Buslov 		   unsigned long flow_flags,
431304de7ddaSRoi Dayan 		   struct net_device *filter_dev,
431404de7ddaSRoi Dayan 		   struct mlx5e_tc_flow **__flow)
431504de7ddaSRoi Dayan {
431604de7ddaSRoi Dayan 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
431704de7ddaSRoi Dayan 	struct mlx5_eswitch_rep *in_rep = rpriv->rep;
431804de7ddaSRoi Dayan 	struct mlx5_core_dev *in_mdev = priv->mdev;
431904de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow;
432004de7ddaSRoi Dayan 	int err;
432104de7ddaSRoi Dayan 
432271129676SJason Gunthorpe 	flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep,
432371129676SJason Gunthorpe 				    in_mdev);
432471129676SJason Gunthorpe 	if (IS_ERR(flow))
432571129676SJason Gunthorpe 		return PTR_ERR(flow);
432604de7ddaSRoi Dayan 
432704de7ddaSRoi Dayan 	if (is_peer_flow_needed(flow)) {
432895dc1902SRoi Dayan 		err = mlx5e_tc_add_fdb_peer_flow(f, flow, flow_flags);
432904de7ddaSRoi Dayan 		if (err) {
433004de7ddaSRoi Dayan 			mlx5e_tc_del_fdb_flow(priv, flow);
433104de7ddaSRoi Dayan 			goto out;
433204de7ddaSRoi Dayan 		}
433304de7ddaSRoi Dayan 	}
433404de7ddaSRoi Dayan 
433504de7ddaSRoi Dayan 	*__flow = flow;
433604de7ddaSRoi Dayan 
433704de7ddaSRoi Dayan 	return 0;
433804de7ddaSRoi Dayan 
433904de7ddaSRoi Dayan out:
434004de7ddaSRoi Dayan 	return err;
434104de7ddaSRoi Dayan }
434204de7ddaSRoi Dayan 
4343a88780a9SRoi Dayan static int
4344a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv,
4345f9e30088SPablo Neira Ayuso 		   struct flow_cls_offload *f,
4346226f2ca3SVlad Buslov 		   unsigned long flow_flags,
4347d11afc26SOz Shlomo 		   struct net_device *filter_dev,
4348a88780a9SRoi Dayan 		   struct mlx5e_tc_flow **__flow)
4349a88780a9SRoi Dayan {
4350f9e30088SPablo Neira Ayuso 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
4351a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
4352a88780a9SRoi Dayan 	struct mlx5e_tc_flow_parse_attr *parse_attr;
4353a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
4354a88780a9SRoi Dayan 	int attr_size, err;
4355a88780a9SRoi Dayan 
4356c7569097SAriel Levkovich 	if (!MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, ignore_flow_level)) {
4357bf07aa73SPaul Blakey 		if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common))
4358bf07aa73SPaul Blakey 			return -EOPNOTSUPP;
4359c7569097SAriel Levkovich 	} else if (!tc_can_offload_extack(priv->netdev, f->common.extack)) {
4360c7569097SAriel Levkovich 		return -EOPNOTSUPP;
4361c7569097SAriel Levkovich 	}
4362bf07aa73SPaul Blakey 
4363226f2ca3SVlad Buslov 	flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_NIC);
4364a88780a9SRoi Dayan 	attr_size  = sizeof(struct mlx5_nic_flow_attr);
4365a88780a9SRoi Dayan 	err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags,
4366a88780a9SRoi Dayan 			       &parse_attr, &flow);
4367a88780a9SRoi Dayan 	if (err)
4368a88780a9SRoi Dayan 		goto out;
4369a88780a9SRoi Dayan 
4370d11afc26SOz Shlomo 	parse_attr->filter_dev = filter_dev;
4371c7569097SAriel Levkovich 	mlx5e_flow_attr_init(flow->attr, parse_attr, f);
4372c7569097SAriel Levkovich 
437354c177caSOz Shlomo 	err = parse_cls_flower(flow->priv, flow, &parse_attr->spec,
437454c177caSOz Shlomo 			       f, filter_dev);
4375d11afc26SOz Shlomo 	if (err)
4376d11afc26SOz Shlomo 		goto err_free;
4377d11afc26SOz Shlomo 
4378aedd133dSAriel Levkovich 	err = mlx5_tc_ct_match_add(get_ct_priv(priv), &parse_attr->spec, f,
4379aedd133dSAriel Levkovich 				   &flow->attr->ct_attr, extack);
4380aedd133dSAriel Levkovich 	if (err)
4381aedd133dSAriel Levkovich 		goto err_free;
4382aedd133dSAriel Levkovich 
438373867881SPablo Neira Ayuso 	err = parse_tc_nic_actions(priv, &rule->action, parse_attr, flow, extack);
4384a88780a9SRoi Dayan 	if (err)
4385a88780a9SRoi Dayan 		goto err_free;
4386a88780a9SRoi Dayan 
4387a88780a9SRoi Dayan 	err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack);
4388a88780a9SRoi Dayan 	if (err)
4389a88780a9SRoi Dayan 		goto err_free;
4390a88780a9SRoi Dayan 
4391226f2ca3SVlad Buslov 	flow_flag_set(flow, OFFLOADED);
4392a88780a9SRoi Dayan 	*__flow = flow;
4393a88780a9SRoi Dayan 
4394a88780a9SRoi Dayan 	return 0;
4395a88780a9SRoi Dayan 
4396a88780a9SRoi Dayan err_free:
43978914add2SVlad Buslov 	flow_flag_set(flow, FAILED);
4398e68e28b4SMaor Dickman 	dealloc_mod_hdr_actions(&parse_attr->mod_hdr_acts);
43995a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
4400a88780a9SRoi Dayan out:
4401a88780a9SRoi Dayan 	return err;
4402a88780a9SRoi Dayan }
4403a88780a9SRoi Dayan 
4404a88780a9SRoi Dayan static int
4405a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv,
4406f9e30088SPablo Neira Ayuso 		  struct flow_cls_offload *f,
4407226f2ca3SVlad Buslov 		  unsigned long flags,
4408d11afc26SOz Shlomo 		  struct net_device *filter_dev,
4409a88780a9SRoi Dayan 		  struct mlx5e_tc_flow **flow)
4410a88780a9SRoi Dayan {
4411a88780a9SRoi Dayan 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
4412226f2ca3SVlad Buslov 	unsigned long flow_flags;
4413a88780a9SRoi Dayan 	int err;
4414a88780a9SRoi Dayan 
4415a88780a9SRoi Dayan 	get_flags(flags, &flow_flags);
4416a88780a9SRoi Dayan 
4417bf07aa73SPaul Blakey 	if (!tc_can_offload_extack(priv->netdev, f->common.extack))
4418bf07aa73SPaul Blakey 		return -EOPNOTSUPP;
4419bf07aa73SPaul Blakey 
4420f6455de0SBodong Wang 	if (esw && esw->mode == MLX5_ESWITCH_OFFLOADS)
4421d11afc26SOz Shlomo 		err = mlx5e_add_fdb_flow(priv, f, flow_flags,
4422d11afc26SOz Shlomo 					 filter_dev, flow);
4423a88780a9SRoi Dayan 	else
4424d11afc26SOz Shlomo 		err = mlx5e_add_nic_flow(priv, f, flow_flags,
4425d11afc26SOz Shlomo 					 filter_dev, flow);
4426a88780a9SRoi Dayan 
4427a88780a9SRoi Dayan 	return err;
4428a88780a9SRoi Dayan }
4429a88780a9SRoi Dayan 
4430553f9328SVu Pham static bool is_flow_rule_duplicate_allowed(struct net_device *dev,
4431553f9328SVu Pham 					   struct mlx5e_rep_priv *rpriv)
4432553f9328SVu Pham {
4433553f9328SVu Pham 	/* Offloaded flow rule is allowed to duplicate on non-uplink representor
44342fb15e72SVlad Buslov 	 * sharing tc block with other slaves of a lag device. Rpriv can be NULL if this
44352fb15e72SVlad Buslov 	 * function is called from NIC mode.
4436553f9328SVu Pham 	 */
44372fb15e72SVlad Buslov 	return netif_is_lag_port(dev) && rpriv && rpriv->rep->vport != MLX5_VPORT_UPLINK;
4438553f9328SVu Pham }
4439553f9328SVu Pham 
444071d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv,
4441226f2ca3SVlad Buslov 			   struct flow_cls_offload *f, unsigned long flags)
4442a88780a9SRoi Dayan {
4443a88780a9SRoi Dayan 	struct netlink_ext_ack *extack = f->common.extack;
4444d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
4445553f9328SVu Pham 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
4446a88780a9SRoi Dayan 	struct mlx5e_tc_flow *flow;
4447a88780a9SRoi Dayan 	int err = 0;
4448a88780a9SRoi Dayan 
44497dc84de9SRoi Dayan 	if (!mlx5_esw_hold(priv->mdev))
44507dc84de9SRoi Dayan 		return -EAGAIN;
44517dc84de9SRoi Dayan 
44527dc84de9SRoi Dayan 	mlx5_esw_get(priv->mdev);
44537dc84de9SRoi Dayan 
4454c5d326b2SVlad Buslov 	rcu_read_lock();
4455c5d326b2SVlad Buslov 	flow = rhashtable_lookup(tc_ht, &f->cookie, tc_ht_params);
4456a88780a9SRoi Dayan 	if (flow) {
4457553f9328SVu Pham 		/* Same flow rule offloaded to non-uplink representor sharing tc block,
4458553f9328SVu Pham 		 * just return 0.
4459553f9328SVu Pham 		 */
4460553f9328SVu Pham 		if (is_flow_rule_duplicate_allowed(dev, rpriv) && flow->orig_dev != dev)
4461c1aea9e1SVlad Buslov 			goto rcu_unlock;
4462553f9328SVu Pham 
4463a88780a9SRoi Dayan 		NL_SET_ERR_MSG_MOD(extack,
4464a88780a9SRoi Dayan 				   "flow cookie already exists, ignoring");
4465a88780a9SRoi Dayan 		netdev_warn_once(priv->netdev,
4466a88780a9SRoi Dayan 				 "flow cookie %lx already exists, ignoring\n",
4467a88780a9SRoi Dayan 				 f->cookie);
44680e1c1a2fSVlad Buslov 		err = -EEXIST;
4469c1aea9e1SVlad Buslov 		goto rcu_unlock;
4470a88780a9SRoi Dayan 	}
4471c1aea9e1SVlad Buslov rcu_unlock:
4472c1aea9e1SVlad Buslov 	rcu_read_unlock();
4473c1aea9e1SVlad Buslov 	if (flow)
4474c1aea9e1SVlad Buslov 		goto out;
4475a88780a9SRoi Dayan 
44767a978759SDmytro Linkin 	trace_mlx5e_configure_flower(f);
4477d11afc26SOz Shlomo 	err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow);
4478a88780a9SRoi Dayan 	if (err)
4479a88780a9SRoi Dayan 		goto out;
4480a88780a9SRoi Dayan 
4481553f9328SVu Pham 	/* Flow rule offloaded to non-uplink representor sharing tc block,
4482553f9328SVu Pham 	 * set the flow's owner dev.
4483553f9328SVu Pham 	 */
4484553f9328SVu Pham 	if (is_flow_rule_duplicate_allowed(dev, rpriv))
4485553f9328SVu Pham 		flow->orig_dev = dev;
4486553f9328SVu Pham 
4487c5d326b2SVlad Buslov 	err = rhashtable_lookup_insert_fast(tc_ht, &flow->node, tc_ht_params);
4488a88780a9SRoi Dayan 	if (err)
4489a88780a9SRoi Dayan 		goto err_free;
4490a88780a9SRoi Dayan 
44917dc84de9SRoi Dayan 	mlx5_esw_release(priv->mdev);
4492a88780a9SRoi Dayan 	return 0;
4493a88780a9SRoi Dayan 
4494a88780a9SRoi Dayan err_free:
44955a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
4496a88780a9SRoi Dayan out:
44977dc84de9SRoi Dayan 	mlx5_esw_put(priv->mdev);
44987dc84de9SRoi Dayan 	mlx5_esw_release(priv->mdev);
4499e3a2b7edSAmir Vadai 	return err;
4500e3a2b7edSAmir Vadai }
4501e3a2b7edSAmir Vadai 
45028f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags)
45038f8ae895SOr Gerlitz {
4504226f2ca3SVlad Buslov 	bool dir_ingress = !!(flags & MLX5_TC_FLAG(INGRESS));
4505226f2ca3SVlad Buslov 	bool dir_egress = !!(flags & MLX5_TC_FLAG(EGRESS));
45068f8ae895SOr Gerlitz 
4507226f2ca3SVlad Buslov 	return flow_flag_test(flow, INGRESS) == dir_ingress &&
4508226f2ca3SVlad Buslov 		flow_flag_test(flow, EGRESS) == dir_egress;
45098f8ae895SOr Gerlitz }
45108f8ae895SOr Gerlitz 
451171d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv,
4512226f2ca3SVlad Buslov 			struct flow_cls_offload *f, unsigned long flags)
4513e3a2b7edSAmir Vadai {
4514d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
4515e3a2b7edSAmir Vadai 	struct mlx5e_tc_flow *flow;
4516c5d326b2SVlad Buslov 	int err;
4517e3a2b7edSAmir Vadai 
4518c5d326b2SVlad Buslov 	rcu_read_lock();
4519ab818362STaehee Yoo 	flow = rhashtable_lookup(tc_ht, &f->cookie, tc_ht_params);
4520c5d326b2SVlad Buslov 	if (!flow || !same_flow_direction(flow, flags)) {
4521c5d326b2SVlad Buslov 		err = -EINVAL;
4522c5d326b2SVlad Buslov 		goto errout;
4523c5d326b2SVlad Buslov 	}
4524e3a2b7edSAmir Vadai 
4525c5d326b2SVlad Buslov 	/* Only delete the flow if it doesn't have MLX5E_TC_FLOW_DELETED flag
4526c5d326b2SVlad Buslov 	 * set.
4527c5d326b2SVlad Buslov 	 */
4528c5d326b2SVlad Buslov 	if (flow_flag_test_and_set(flow, DELETED)) {
4529c5d326b2SVlad Buslov 		err = -EINVAL;
4530c5d326b2SVlad Buslov 		goto errout;
4531c5d326b2SVlad Buslov 	}
453205866c82SOr Gerlitz 	rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params);
4533c5d326b2SVlad Buslov 	rcu_read_unlock();
4534e3a2b7edSAmir Vadai 
45357a978759SDmytro Linkin 	trace_mlx5e_delete_flower(f);
45365a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
4537e3a2b7edSAmir Vadai 
45387dc84de9SRoi Dayan 	mlx5_esw_put(priv->mdev);
4539e3a2b7edSAmir Vadai 	return 0;
4540c5d326b2SVlad Buslov 
4541c5d326b2SVlad Buslov errout:
4542c5d326b2SVlad Buslov 	rcu_read_unlock();
4543c5d326b2SVlad Buslov 	return err;
4544e3a2b7edSAmir Vadai }
4545e3a2b7edSAmir Vadai 
454671d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv,
4547226f2ca3SVlad Buslov 		       struct flow_cls_offload *f, unsigned long flags)
4548aad7e08dSAmir Vadai {
454904de7ddaSRoi Dayan 	struct mlx5_devcom *devcom = priv->mdev->priv.devcom;
4550d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
455104de7ddaSRoi Dayan 	struct mlx5_eswitch *peer_esw;
4552aad7e08dSAmir Vadai 	struct mlx5e_tc_flow *flow;
4553aad7e08dSAmir Vadai 	struct mlx5_fc *counter;
4554316d5f72SRoi Dayan 	u64 lastuse = 0;
4555316d5f72SRoi Dayan 	u64 packets = 0;
4556316d5f72SRoi Dayan 	u64 bytes = 0;
45575a7e5bcbSVlad Buslov 	int err = 0;
4558aad7e08dSAmir Vadai 
4559c5d326b2SVlad Buslov 	rcu_read_lock();
4560c5d326b2SVlad Buslov 	flow = mlx5e_flow_get(rhashtable_lookup(tc_ht, &f->cookie,
45615a7e5bcbSVlad Buslov 						tc_ht_params));
4562c5d326b2SVlad Buslov 	rcu_read_unlock();
45635a7e5bcbSVlad Buslov 	if (IS_ERR(flow))
45645a7e5bcbSVlad Buslov 		return PTR_ERR(flow);
45655a7e5bcbSVlad Buslov 
45665a7e5bcbSVlad Buslov 	if (!same_flow_direction(flow, flags)) {
45675a7e5bcbSVlad Buslov 		err = -EINVAL;
45685a7e5bcbSVlad Buslov 		goto errout;
45695a7e5bcbSVlad Buslov 	}
4570aad7e08dSAmir Vadai 
45714c3844d9SPaul Blakey 	if (mlx5e_is_offloaded_flow(flow) || flow_flag_test(flow, CT)) {
4572b8aee822SMark Bloch 		counter = mlx5e_tc_get_counter(flow);
4573aad7e08dSAmir Vadai 		if (!counter)
45745a7e5bcbSVlad Buslov 			goto errout;
4575aad7e08dSAmir Vadai 
4576aad7e08dSAmir Vadai 		mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse);
4577316d5f72SRoi Dayan 	}
4578aad7e08dSAmir Vadai 
4579316d5f72SRoi Dayan 	/* Under multipath it's possible for one rule to be currently
4580316d5f72SRoi Dayan 	 * un-offloaded while the other rule is offloaded.
4581316d5f72SRoi Dayan 	 */
458204de7ddaSRoi Dayan 	peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
458304de7ddaSRoi Dayan 	if (!peer_esw)
458404de7ddaSRoi Dayan 		goto out;
458504de7ddaSRoi Dayan 
4586226f2ca3SVlad Buslov 	if (flow_flag_test(flow, DUP) &&
4587226f2ca3SVlad Buslov 	    flow_flag_test(flow->peer_flow, OFFLOADED)) {
458804de7ddaSRoi Dayan 		u64 bytes2;
458904de7ddaSRoi Dayan 		u64 packets2;
459004de7ddaSRoi Dayan 		u64 lastuse2;
459104de7ddaSRoi Dayan 
459204de7ddaSRoi Dayan 		counter = mlx5e_tc_get_counter(flow->peer_flow);
4593316d5f72SRoi Dayan 		if (!counter)
4594316d5f72SRoi Dayan 			goto no_peer_counter;
459504de7ddaSRoi Dayan 		mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2);
459604de7ddaSRoi Dayan 
459704de7ddaSRoi Dayan 		bytes += bytes2;
459804de7ddaSRoi Dayan 		packets += packets2;
459904de7ddaSRoi Dayan 		lastuse = max_t(u64, lastuse, lastuse2);
460004de7ddaSRoi Dayan 	}
460104de7ddaSRoi Dayan 
4602316d5f72SRoi Dayan no_peer_counter:
460304de7ddaSRoi Dayan 	mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
460404de7ddaSRoi Dayan out:
46054b61d3e8SPo Liu 	flow_stats_update(&f->stats, bytes, packets, 0, lastuse,
460693a129ebSJiri Pirko 			  FLOW_ACTION_HW_STATS_DELAYED);
46077a978759SDmytro Linkin 	trace_mlx5e_stats_flower(f);
46085a7e5bcbSVlad Buslov errout:
46095a7e5bcbSVlad Buslov 	mlx5e_flow_put(priv, flow);
46105a7e5bcbSVlad Buslov 	return err;
4611aad7e08dSAmir Vadai }
4612aad7e08dSAmir Vadai 
46131fe3e316SParav Pandit static int apply_police_params(struct mlx5e_priv *priv, u64 rate,
4614fcb64c0fSEli Cohen 			       struct netlink_ext_ack *extack)
4615fcb64c0fSEli Cohen {
4616fcb64c0fSEli Cohen 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
4617fcb64c0fSEli Cohen 	struct mlx5_eswitch *esw;
46181fe3e316SParav Pandit 	u32 rate_mbps = 0;
4619fcb64c0fSEli Cohen 	u16 vport_num;
4620fcb64c0fSEli Cohen 	int err;
4621fcb64c0fSEli Cohen 
4622e401a184SEli Cohen 	vport_num = rpriv->rep->vport;
4623e401a184SEli Cohen 	if (vport_num >= MLX5_VPORT_ECPF) {
4624e401a184SEli Cohen 		NL_SET_ERR_MSG_MOD(extack,
4625e401a184SEli Cohen 				   "Ingress rate limit is supported only for Eswitch ports connected to VFs");
4626e401a184SEli Cohen 		return -EOPNOTSUPP;
4627e401a184SEli Cohen 	}
4628e401a184SEli Cohen 
4629fcb64c0fSEli Cohen 	esw = priv->mdev->priv.eswitch;
4630fcb64c0fSEli Cohen 	/* rate is given in bytes/sec.
4631fcb64c0fSEli Cohen 	 * First convert to bits/sec and then round to the nearest mbit/secs.
4632fcb64c0fSEli Cohen 	 * mbit means million bits.
4633fcb64c0fSEli Cohen 	 * Moreover, if rate is non zero we choose to configure to a minimum of
4634fcb64c0fSEli Cohen 	 * 1 mbit/sec.
4635fcb64c0fSEli Cohen 	 */
46361fe3e316SParav Pandit 	if (rate) {
46371fe3e316SParav Pandit 		rate = (rate * BITS_PER_BYTE) + 500000;
46388b90d897SParav Pandit 		do_div(rate, 1000000);
46398b90d897SParav Pandit 		rate_mbps = max_t(u32, rate, 1);
46401fe3e316SParav Pandit 	}
46411fe3e316SParav Pandit 
4642fcb64c0fSEli Cohen 	err = mlx5_esw_modify_vport_rate(esw, vport_num, rate_mbps);
4643fcb64c0fSEli Cohen 	if (err)
4644fcb64c0fSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "failed applying action to hardware");
4645fcb64c0fSEli Cohen 
4646fcb64c0fSEli Cohen 	return err;
4647fcb64c0fSEli Cohen }
4648fcb64c0fSEli Cohen 
4649fcb64c0fSEli Cohen static int scan_tc_matchall_fdb_actions(struct mlx5e_priv *priv,
4650fcb64c0fSEli Cohen 					struct flow_action *flow_action,
4651fcb64c0fSEli Cohen 					struct netlink_ext_ack *extack)
4652fcb64c0fSEli Cohen {
4653fcb64c0fSEli Cohen 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
4654fcb64c0fSEli Cohen 	const struct flow_action_entry *act;
4655fcb64c0fSEli Cohen 	int err;
4656fcb64c0fSEli Cohen 	int i;
4657fcb64c0fSEli Cohen 
4658fcb64c0fSEli Cohen 	if (!flow_action_has_entries(flow_action)) {
4659fcb64c0fSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "matchall called with no action");
4660fcb64c0fSEli Cohen 		return -EINVAL;
4661fcb64c0fSEli Cohen 	}
4662fcb64c0fSEli Cohen 
4663fcb64c0fSEli Cohen 	if (!flow_offload_has_one_action(flow_action)) {
4664fcb64c0fSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "matchall policing support only a single action");
4665fcb64c0fSEli Cohen 		return -EOPNOTSUPP;
4666fcb64c0fSEli Cohen 	}
4667fcb64c0fSEli Cohen 
466853eca1f3SJakub Kicinski 	if (!flow_action_basic_hw_stats_check(flow_action, extack))
4669319a1d19SJiri Pirko 		return -EOPNOTSUPP;
4670319a1d19SJiri Pirko 
4671fcb64c0fSEli Cohen 	flow_action_for_each(i, act, flow_action) {
4672fcb64c0fSEli Cohen 		switch (act->id) {
4673fcb64c0fSEli Cohen 		case FLOW_ACTION_POLICE:
46746a56e199SBaowen Zheng 			if (act->police.rate_pkt_ps) {
46756a56e199SBaowen Zheng 				NL_SET_ERR_MSG_MOD(extack, "QoS offload not support packets per second");
46766a56e199SBaowen Zheng 				return -EOPNOTSUPP;
46776a56e199SBaowen Zheng 			}
4678fcb64c0fSEli Cohen 			err = apply_police_params(priv, act->police.rate_bytes_ps, extack);
4679fcb64c0fSEli Cohen 			if (err)
4680fcb64c0fSEli Cohen 				return err;
4681fcb64c0fSEli Cohen 
4682fcb64c0fSEli Cohen 			rpriv->prev_vf_vport_stats = priv->stats.vf_vport;
4683fcb64c0fSEli Cohen 			break;
4684fcb64c0fSEli Cohen 		default:
4685fcb64c0fSEli Cohen 			NL_SET_ERR_MSG_MOD(extack, "mlx5 supports only police action for matchall");
4686fcb64c0fSEli Cohen 			return -EOPNOTSUPP;
4687fcb64c0fSEli Cohen 		}
4688fcb64c0fSEli Cohen 	}
4689fcb64c0fSEli Cohen 
4690fcb64c0fSEli Cohen 	return 0;
4691fcb64c0fSEli Cohen }
4692fcb64c0fSEli Cohen 
4693fcb64c0fSEli Cohen int mlx5e_tc_configure_matchall(struct mlx5e_priv *priv,
4694fcb64c0fSEli Cohen 				struct tc_cls_matchall_offload *ma)
4695fcb64c0fSEli Cohen {
4696b5f814ccSEli Cohen 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
4697fcb64c0fSEli Cohen 	struct netlink_ext_ack *extack = ma->common.extack;
4698fcb64c0fSEli Cohen 
4699b5f814ccSEli Cohen 	if (!mlx5_esw_qos_enabled(esw)) {
4700b5f814ccSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "QoS is not supported on this device");
4701b5f814ccSEli Cohen 		return -EOPNOTSUPP;
4702b5f814ccSEli Cohen 	}
4703b5f814ccSEli Cohen 
47047b83355fSEli Cohen 	if (ma->common.prio != 1) {
4705fcb64c0fSEli Cohen 		NL_SET_ERR_MSG_MOD(extack, "only priority 1 is supported");
4706fcb64c0fSEli Cohen 		return -EINVAL;
4707fcb64c0fSEli Cohen 	}
4708fcb64c0fSEli Cohen 
4709fcb64c0fSEli Cohen 	return scan_tc_matchall_fdb_actions(priv, &ma->rule->action, extack);
4710fcb64c0fSEli Cohen }
4711fcb64c0fSEli Cohen 
4712fcb64c0fSEli Cohen int mlx5e_tc_delete_matchall(struct mlx5e_priv *priv,
4713fcb64c0fSEli Cohen 			     struct tc_cls_matchall_offload *ma)
4714fcb64c0fSEli Cohen {
4715fcb64c0fSEli Cohen 	struct netlink_ext_ack *extack = ma->common.extack;
4716fcb64c0fSEli Cohen 
4717fcb64c0fSEli Cohen 	return apply_police_params(priv, 0, extack);
4718fcb64c0fSEli Cohen }
4719fcb64c0fSEli Cohen 
4720fcb64c0fSEli Cohen void mlx5e_tc_stats_matchall(struct mlx5e_priv *priv,
4721fcb64c0fSEli Cohen 			     struct tc_cls_matchall_offload *ma)
4722fcb64c0fSEli Cohen {
4723fcb64c0fSEli Cohen 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
4724fcb64c0fSEli Cohen 	struct rtnl_link_stats64 cur_stats;
4725fcb64c0fSEli Cohen 	u64 dbytes;
4726fcb64c0fSEli Cohen 	u64 dpkts;
4727fcb64c0fSEli Cohen 
4728fcb64c0fSEli Cohen 	cur_stats = priv->stats.vf_vport;
4729fcb64c0fSEli Cohen 	dpkts = cur_stats.rx_packets - rpriv->prev_vf_vport_stats.rx_packets;
4730fcb64c0fSEli Cohen 	dbytes = cur_stats.rx_bytes - rpriv->prev_vf_vport_stats.rx_bytes;
4731fcb64c0fSEli Cohen 	rpriv->prev_vf_vport_stats = cur_stats;
47324b61d3e8SPo Liu 	flow_stats_update(&ma->stats, dbytes, dpkts, 0, jiffies,
473393a129ebSJiri Pirko 			  FLOW_ACTION_HW_STATS_DELAYED);
4734fcb64c0fSEli Cohen }
4735fcb64c0fSEli Cohen 
47364d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv,
47374d8fcf21SAlaa Hleihel 					      struct mlx5e_priv *peer_priv)
47384d8fcf21SAlaa Hleihel {
47394d8fcf21SAlaa Hleihel 	struct mlx5_core_dev *peer_mdev = peer_priv->mdev;
4740db76ca24SVlad Buslov 	struct mlx5e_hairpin_entry *hpe, *tmp;
4741db76ca24SVlad Buslov 	LIST_HEAD(init_wait_list);
47424d8fcf21SAlaa Hleihel 	u16 peer_vhca_id;
47434d8fcf21SAlaa Hleihel 	int bkt;
47444d8fcf21SAlaa Hleihel 
47454d8fcf21SAlaa Hleihel 	if (!same_hw_devs(priv, peer_priv))
47464d8fcf21SAlaa Hleihel 		return;
47474d8fcf21SAlaa Hleihel 
47484d8fcf21SAlaa Hleihel 	peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id);
47494d8fcf21SAlaa Hleihel 
4750b32accdaSVlad Buslov 	mutex_lock(&priv->fs.tc.hairpin_tbl_lock);
4751db76ca24SVlad Buslov 	hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist)
4752db76ca24SVlad Buslov 		if (refcount_inc_not_zero(&hpe->refcnt))
4753db76ca24SVlad Buslov 			list_add(&hpe->dead_peer_wait_list, &init_wait_list);
4754b32accdaSVlad Buslov 	mutex_unlock(&priv->fs.tc.hairpin_tbl_lock);
4755db76ca24SVlad Buslov 
4756db76ca24SVlad Buslov 	list_for_each_entry_safe(hpe, tmp, &init_wait_list, dead_peer_wait_list) {
4757db76ca24SVlad Buslov 		wait_for_completion(&hpe->res_ready);
4758db76ca24SVlad Buslov 		if (!IS_ERR_OR_NULL(hpe->hp) && hpe->peer_vhca_id == peer_vhca_id)
4759db76ca24SVlad Buslov 			hpe->hp->pair->peer_gone = true;
4760db76ca24SVlad Buslov 
4761db76ca24SVlad Buslov 		mlx5e_hairpin_put(priv, hpe);
4762db76ca24SVlad Buslov 	}
47634d8fcf21SAlaa Hleihel }
47644d8fcf21SAlaa Hleihel 
47654d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this,
47664d8fcf21SAlaa Hleihel 				 unsigned long event, void *ptr)
47674d8fcf21SAlaa Hleihel {
47684d8fcf21SAlaa Hleihel 	struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
47694d8fcf21SAlaa Hleihel 	struct mlx5e_flow_steering *fs;
47704d8fcf21SAlaa Hleihel 	struct mlx5e_priv *peer_priv;
47714d8fcf21SAlaa Hleihel 	struct mlx5e_tc_table *tc;
47724d8fcf21SAlaa Hleihel 	struct mlx5e_priv *priv;
47734d8fcf21SAlaa Hleihel 
47744d8fcf21SAlaa Hleihel 	if (ndev->netdev_ops != &mlx5e_netdev_ops ||
47754d8fcf21SAlaa Hleihel 	    event != NETDEV_UNREGISTER ||
47764d8fcf21SAlaa Hleihel 	    ndev->reg_state == NETREG_REGISTERED)
47774d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
47784d8fcf21SAlaa Hleihel 
47794d8fcf21SAlaa Hleihel 	tc = container_of(this, struct mlx5e_tc_table, netdevice_nb);
47804d8fcf21SAlaa Hleihel 	fs = container_of(tc, struct mlx5e_flow_steering, tc);
47814d8fcf21SAlaa Hleihel 	priv = container_of(fs, struct mlx5e_priv, fs);
47824d8fcf21SAlaa Hleihel 	peer_priv = netdev_priv(ndev);
47834d8fcf21SAlaa Hleihel 	if (priv == peer_priv ||
47844d8fcf21SAlaa Hleihel 	    !(priv->netdev->features & NETIF_F_HW_TC))
47854d8fcf21SAlaa Hleihel 		return NOTIFY_DONE;
47864d8fcf21SAlaa Hleihel 
47874d8fcf21SAlaa Hleihel 	mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv);
47884d8fcf21SAlaa Hleihel 
47894d8fcf21SAlaa Hleihel 	return NOTIFY_DONE;
47904d8fcf21SAlaa Hleihel }
47914d8fcf21SAlaa Hleihel 
47926a064674SAriel Levkovich static int mlx5e_tc_nic_get_ft_size(struct mlx5_core_dev *dev)
47936a064674SAriel Levkovich {
47946a064674SAriel Levkovich 	int tc_grp_size, tc_tbl_size;
47956a064674SAriel Levkovich 	u32 max_flow_counter;
47966a064674SAriel Levkovich 
47976a064674SAriel Levkovich 	max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) |
47986a064674SAriel Levkovich 			    MLX5_CAP_GEN(dev, max_flow_counter_15_0);
47996a064674SAriel Levkovich 
48006a064674SAriel Levkovich 	tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE);
48016a064674SAriel Levkovich 
48026a064674SAriel Levkovich 	tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS,
48036a064674SAriel Levkovich 			    BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size)));
48046a064674SAriel Levkovich 
48056a064674SAriel Levkovich 	return tc_tbl_size;
48066a064674SAriel Levkovich }
48076a064674SAriel Levkovich 
4808655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv)
4809e8f887acSAmir Vadai {
4810acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
48116a064674SAriel Levkovich 	struct mlx5_core_dev *dev = priv->mdev;
4812c9355682SChris Mi 	struct mapping_ctx *chains_mapping;
48136a064674SAriel Levkovich 	struct mlx5_chains_attr attr = {};
48144d8fcf21SAlaa Hleihel 	int err;
4815e8f887acSAmir Vadai 
4816b2fdf3d0SPaul Blakey 	mlx5e_mod_hdr_tbl_init(&tc->mod_hdr);
4817b6fac0b4SVlad Buslov 	mutex_init(&tc->t_lock);
4818b32accdaSVlad Buslov 	mutex_init(&tc->hairpin_tbl_lock);
48195c65c564SOr Gerlitz 	hash_init(tc->hairpin_tbl);
482011c9c548SOr Gerlitz 
48214d8fcf21SAlaa Hleihel 	err = rhashtable_init(&tc->ht, &tc_ht_params);
48224d8fcf21SAlaa Hleihel 	if (err)
48234d8fcf21SAlaa Hleihel 		return err;
48244d8fcf21SAlaa Hleihel 
48259ba33339SRoi Dayan 	lockdep_set_class(&tc->ht.mutex, &tc_ht_lock_key);
48269ba33339SRoi Dayan 
4827c9355682SChris Mi 	chains_mapping = mapping_create(sizeof(struct mlx5_mapped_obj),
4828c9355682SChris Mi 					MLX5E_TC_TABLE_CHAIN_TAG_MASK, true);
4829c9355682SChris Mi 	if (IS_ERR(chains_mapping)) {
4830c9355682SChris Mi 		err = PTR_ERR(chains_mapping);
4831c9355682SChris Mi 		goto err_mapping;
4832c9355682SChris Mi 	}
4833c9355682SChris Mi 	tc->mapping = chains_mapping;
4834c9355682SChris Mi 
4835c9355682SChris Mi 	if (MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, ignore_flow_level))
4836c7569097SAriel Levkovich 		attr.flags = MLX5_CHAINS_AND_PRIOS_SUPPORTED |
4837c7569097SAriel Levkovich 			MLX5_CHAINS_IGNORE_FLOW_LEVEL_SUPPORTED;
48386a064674SAriel Levkovich 	attr.ns = MLX5_FLOW_NAMESPACE_KERNEL;
48396a064674SAriel Levkovich 	attr.max_ft_sz = mlx5e_tc_nic_get_ft_size(dev);
48406a064674SAriel Levkovich 	attr.max_grp_num = MLX5E_TC_TABLE_NUM_GROUPS;
48416783f0a2SVu Pham 	attr.default_ft = mlx5e_vlan_get_flowtable(priv->fs.vlan);
4842c9355682SChris Mi 	attr.mapping = chains_mapping;
48436a064674SAriel Levkovich 
48446a064674SAriel Levkovich 	tc->chains = mlx5_chains_create(dev, &attr);
48456a064674SAriel Levkovich 	if (IS_ERR(tc->chains)) {
48466a064674SAriel Levkovich 		err = PTR_ERR(tc->chains);
48476a064674SAriel Levkovich 		goto err_chains;
48486a064674SAriel Levkovich 	}
48496a064674SAriel Levkovich 
4850aedd133dSAriel Levkovich 	tc->ct = mlx5_tc_ct_init(priv, tc->chains, &priv->fs.tc.mod_hdr,
4851aedd133dSAriel Levkovich 				 MLX5_FLOW_NAMESPACE_KERNEL);
4852aedd133dSAriel Levkovich 
48534d8fcf21SAlaa Hleihel 	tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event;
4854d48834f9SJiri Pirko 	err = register_netdevice_notifier_dev_net(priv->netdev,
4855d48834f9SJiri Pirko 						  &tc->netdevice_nb,
4856d48834f9SJiri Pirko 						  &tc->netdevice_nn);
4857d48834f9SJiri Pirko 	if (err) {
48584d8fcf21SAlaa Hleihel 		tc->netdevice_nb.notifier_call = NULL;
48594d8fcf21SAlaa Hleihel 		mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n");
48606a064674SAriel Levkovich 		goto err_reg;
48614d8fcf21SAlaa Hleihel 	}
48624d8fcf21SAlaa Hleihel 
48636a064674SAriel Levkovich 	return 0;
48646a064674SAriel Levkovich 
48656a064674SAriel Levkovich err_reg:
4866aedd133dSAriel Levkovich 	mlx5_tc_ct_clean(tc->ct);
48676a064674SAriel Levkovich 	mlx5_chains_destroy(tc->chains);
48686a064674SAriel Levkovich err_chains:
4869c9355682SChris Mi 	mapping_destroy(chains_mapping);
4870c9355682SChris Mi err_mapping:
48716a064674SAriel Levkovich 	rhashtable_destroy(&tc->ht);
48724d8fcf21SAlaa Hleihel 	return err;
4873e8f887acSAmir Vadai }
4874e8f887acSAmir Vadai 
4875e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg)
4876e8f887acSAmir Vadai {
4877e8f887acSAmir Vadai 	struct mlx5e_tc_flow *flow = ptr;
4878655dc3d2SOr Gerlitz 	struct mlx5e_priv *priv = flow->priv;
4879e8f887acSAmir Vadai 
4880961e8979SRoi Dayan 	mlx5e_tc_del_flow(priv, flow);
4881e8f887acSAmir Vadai 	kfree(flow);
4882e8f887acSAmir Vadai }
4883e8f887acSAmir Vadai 
4884655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv)
4885e8f887acSAmir Vadai {
4886acff797cSMaor Gottlieb 	struct mlx5e_tc_table *tc = &priv->fs.tc;
4887e8f887acSAmir Vadai 
48884d8fcf21SAlaa Hleihel 	if (tc->netdevice_nb.notifier_call)
4889d48834f9SJiri Pirko 		unregister_netdevice_notifier_dev_net(priv->netdev,
4890d48834f9SJiri Pirko 						      &tc->netdevice_nb,
4891d48834f9SJiri Pirko 						      &tc->netdevice_nn);
48924d8fcf21SAlaa Hleihel 
4893b2fdf3d0SPaul Blakey 	mlx5e_mod_hdr_tbl_destroy(&tc->mod_hdr);
4894b32accdaSVlad Buslov 	mutex_destroy(&tc->hairpin_tbl_lock);
4895b32accdaSVlad Buslov 
48966a064674SAriel Levkovich 	rhashtable_free_and_destroy(&tc->ht, _mlx5e_tc_del_flow, NULL);
4897e8f887acSAmir Vadai 
4898acff797cSMaor Gottlieb 	if (!IS_ERR_OR_NULL(tc->t)) {
48996a064674SAriel Levkovich 		mlx5_chains_put_table(tc->chains, 0, 1, MLX5E_TC_FT_LEVEL);
4900acff797cSMaor Gottlieb 		tc->t = NULL;
4901e8f887acSAmir Vadai 	}
4902b6fac0b4SVlad Buslov 	mutex_destroy(&tc->t_lock);
49036a064674SAriel Levkovich 
4904aedd133dSAriel Levkovich 	mlx5_tc_ct_clean(tc->ct);
4905c9355682SChris Mi 	mapping_destroy(tc->mapping);
49066a064674SAriel Levkovich 	mlx5_chains_destroy(tc->chains);
4907e8f887acSAmir Vadai }
4908655dc3d2SOr Gerlitz 
4909655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht)
4910655dc3d2SOr Gerlitz {
4911d7a42ad0SRoi Dayan 	const size_t sz_enc_opts = sizeof(struct tunnel_match_enc_opts);
49120a7fcb78SPaul Blakey 	struct mlx5_rep_uplink_priv *uplink_priv;
4913aedd133dSAriel Levkovich 	struct mlx5e_rep_priv *rpriv;
49140a7fcb78SPaul Blakey 	struct mapping_ctx *mapping;
4915aedd133dSAriel Levkovich 	struct mlx5_eswitch *esw;
4916aedd133dSAriel Levkovich 	struct mlx5e_priv *priv;
4917aedd133dSAriel Levkovich 	int err = 0;
49180a7fcb78SPaul Blakey 
49190a7fcb78SPaul Blakey 	uplink_priv = container_of(tc_ht, struct mlx5_rep_uplink_priv, tc_ht);
4920aedd133dSAriel Levkovich 	rpriv = container_of(uplink_priv, struct mlx5e_rep_priv, uplink_priv);
4921aedd133dSAriel Levkovich 	priv = netdev_priv(rpriv->netdev);
4922aedd133dSAriel Levkovich 	esw = priv->mdev->priv.eswitch;
49230a7fcb78SPaul Blakey 
4924aedd133dSAriel Levkovich 	uplink_priv->ct_priv = mlx5_tc_ct_init(netdev_priv(priv->netdev),
4925aedd133dSAriel Levkovich 					       esw_chains(esw),
4926aedd133dSAriel Levkovich 					       &esw->offloads.mod_hdr,
4927aedd133dSAriel Levkovich 					       MLX5_FLOW_NAMESPACE_FDB);
49284c3844d9SPaul Blakey 
49292a9ab10aSChris Mi #if IS_ENABLED(CONFIG_MLX5_TC_SAMPLE)
49302a9ab10aSChris Mi 	uplink_priv->esw_psample = mlx5_esw_sample_init(netdev_priv(priv->netdev));
49312a9ab10aSChris Mi #endif
49322a9ab10aSChris Mi 
49330a7fcb78SPaul Blakey 	mapping = mapping_create(sizeof(struct tunnel_match_key),
49340a7fcb78SPaul Blakey 				 TUNNEL_INFO_BITS_MASK, true);
49350a7fcb78SPaul Blakey 	if (IS_ERR(mapping)) {
49360a7fcb78SPaul Blakey 		err = PTR_ERR(mapping);
49370a7fcb78SPaul Blakey 		goto err_tun_mapping;
49380a7fcb78SPaul Blakey 	}
49390a7fcb78SPaul Blakey 	uplink_priv->tunnel_mapping = mapping;
49400a7fcb78SPaul Blakey 
49418e404fefSVlad Buslov 	/* 0xFFF is reserved for stack devices slow path table mark */
49428e404fefSVlad Buslov 	mapping = mapping_create(sz_enc_opts, ENC_OPTS_BITS_MASK - 1, true);
49430a7fcb78SPaul Blakey 	if (IS_ERR(mapping)) {
49440a7fcb78SPaul Blakey 		err = PTR_ERR(mapping);
49450a7fcb78SPaul Blakey 		goto err_enc_opts_mapping;
49460a7fcb78SPaul Blakey 	}
49470a7fcb78SPaul Blakey 	uplink_priv->tunnel_enc_opts_mapping = mapping;
49480a7fcb78SPaul Blakey 
49490a7fcb78SPaul Blakey 	err = rhashtable_init(tc_ht, &tc_ht_params);
49500a7fcb78SPaul Blakey 	if (err)
49510a7fcb78SPaul Blakey 		goto err_ht_init;
49520a7fcb78SPaul Blakey 
49539ba33339SRoi Dayan 	lockdep_set_class(&tc_ht->mutex, &tc_ht_lock_key);
49549ba33339SRoi Dayan 
49558914add2SVlad Buslov 	uplink_priv->encap = mlx5e_tc_tun_init(priv);
49562b6c3c1eSWei Yongjun 	if (IS_ERR(uplink_priv->encap)) {
49572b6c3c1eSWei Yongjun 		err = PTR_ERR(uplink_priv->encap);
49588914add2SVlad Buslov 		goto err_register_fib_notifier;
49592b6c3c1eSWei Yongjun 	}
49608914add2SVlad Buslov 
49612b6c3c1eSWei Yongjun 	return 0;
49620a7fcb78SPaul Blakey 
49638914add2SVlad Buslov err_register_fib_notifier:
49648914add2SVlad Buslov 	rhashtable_destroy(tc_ht);
49650a7fcb78SPaul Blakey err_ht_init:
49660a7fcb78SPaul Blakey 	mapping_destroy(uplink_priv->tunnel_enc_opts_mapping);
49670a7fcb78SPaul Blakey err_enc_opts_mapping:
49680a7fcb78SPaul Blakey 	mapping_destroy(uplink_priv->tunnel_mapping);
49690a7fcb78SPaul Blakey err_tun_mapping:
49702a9ab10aSChris Mi #if IS_ENABLED(CONFIG_MLX5_TC_SAMPLE)
49712a9ab10aSChris Mi 	mlx5_esw_sample_cleanup(uplink_priv->esw_psample);
49722a9ab10aSChris Mi #endif
4973aedd133dSAriel Levkovich 	mlx5_tc_ct_clean(uplink_priv->ct_priv);
49740a7fcb78SPaul Blakey 	netdev_warn(priv->netdev,
49750a7fcb78SPaul Blakey 		    "Failed to initialize tc (eswitch), err: %d", err);
49760a7fcb78SPaul Blakey 	return err;
4977655dc3d2SOr Gerlitz }
4978655dc3d2SOr Gerlitz 
4979655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht)
4980655dc3d2SOr Gerlitz {
49810a7fcb78SPaul Blakey 	struct mlx5_rep_uplink_priv *uplink_priv;
49820a7fcb78SPaul Blakey 
49830a7fcb78SPaul Blakey 	uplink_priv = container_of(tc_ht, struct mlx5_rep_uplink_priv, tc_ht);
4984aedd133dSAriel Levkovich 
49858914add2SVlad Buslov 	rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL);
49868914add2SVlad Buslov 	mlx5e_tc_tun_cleanup(uplink_priv->encap);
49878914add2SVlad Buslov 
49880a7fcb78SPaul Blakey 	mapping_destroy(uplink_priv->tunnel_enc_opts_mapping);
49890a7fcb78SPaul Blakey 	mapping_destroy(uplink_priv->tunnel_mapping);
49904c3844d9SPaul Blakey 
49912a9ab10aSChris Mi #if IS_ENABLED(CONFIG_MLX5_TC_SAMPLE)
49922a9ab10aSChris Mi 	mlx5_esw_sample_cleanup(uplink_priv->esw_psample);
49932a9ab10aSChris Mi #endif
4994aedd133dSAriel Levkovich 	mlx5_tc_ct_clean(uplink_priv->ct_priv);
4995655dc3d2SOr Gerlitz }
499601252a27SOr Gerlitz 
4997226f2ca3SVlad Buslov int mlx5e_tc_num_filters(struct mlx5e_priv *priv, unsigned long flags)
499801252a27SOr Gerlitz {
4999d9ee0491SOr Gerlitz 	struct rhashtable *tc_ht = get_tc_ht(priv, flags);
500001252a27SOr Gerlitz 
500101252a27SOr Gerlitz 	return atomic_read(&tc_ht->nelems);
500201252a27SOr Gerlitz }
500304de7ddaSRoi Dayan 
500404de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw)
500504de7ddaSRoi Dayan {
500604de7ddaSRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
500704de7ddaSRoi Dayan 
500804de7ddaSRoi Dayan 	list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer)
500904de7ddaSRoi Dayan 		__mlx5e_tc_del_fdb_peer_flow(flow);
501004de7ddaSRoi Dayan }
5011b4a23329SRoi Dayan 
5012b4a23329SRoi Dayan void mlx5e_tc_reoffload_flows_work(struct work_struct *work)
5013b4a23329SRoi Dayan {
5014b4a23329SRoi Dayan 	struct mlx5_rep_uplink_priv *rpriv =
5015b4a23329SRoi Dayan 		container_of(work, struct mlx5_rep_uplink_priv,
5016b4a23329SRoi Dayan 			     reoffload_flows_work);
5017b4a23329SRoi Dayan 	struct mlx5e_tc_flow *flow, *tmp;
5018b4a23329SRoi Dayan 
5019ad86755bSVlad Buslov 	mutex_lock(&rpriv->unready_flows_lock);
5020b4a23329SRoi Dayan 	list_for_each_entry_safe(flow, tmp, &rpriv->unready_flows, unready) {
5021b4a23329SRoi Dayan 		if (!mlx5e_tc_add_fdb_flow(flow->priv, flow, NULL))
5022ad86755bSVlad Buslov 			unready_flow_del(flow);
5023b4a23329SRoi Dayan 	}
5024ad86755bSVlad Buslov 	mutex_unlock(&rpriv->unready_flows_lock);
5025b4a23329SRoi Dayan }
5026e2394a61SVlad Buslov 
5027e2394a61SVlad Buslov static int mlx5e_setup_tc_cls_flower(struct mlx5e_priv *priv,
5028e2394a61SVlad Buslov 				     struct flow_cls_offload *cls_flower,
5029e2394a61SVlad Buslov 				     unsigned long flags)
5030e2394a61SVlad Buslov {
5031e2394a61SVlad Buslov 	switch (cls_flower->command) {
5032e2394a61SVlad Buslov 	case FLOW_CLS_REPLACE:
5033e2394a61SVlad Buslov 		return mlx5e_configure_flower(priv->netdev, priv, cls_flower,
5034e2394a61SVlad Buslov 					      flags);
5035e2394a61SVlad Buslov 	case FLOW_CLS_DESTROY:
5036e2394a61SVlad Buslov 		return mlx5e_delete_flower(priv->netdev, priv, cls_flower,
5037e2394a61SVlad Buslov 					   flags);
5038e2394a61SVlad Buslov 	case FLOW_CLS_STATS:
5039e2394a61SVlad Buslov 		return mlx5e_stats_flower(priv->netdev, priv, cls_flower,
5040e2394a61SVlad Buslov 					  flags);
5041e2394a61SVlad Buslov 	default:
5042e2394a61SVlad Buslov 		return -EOPNOTSUPP;
5043e2394a61SVlad Buslov 	}
5044e2394a61SVlad Buslov }
5045e2394a61SVlad Buslov 
5046e2394a61SVlad Buslov int mlx5e_setup_tc_block_cb(enum tc_setup_type type, void *type_data,
5047e2394a61SVlad Buslov 			    void *cb_priv)
5048e2394a61SVlad Buslov {
5049ec9457a6SRoi Dayan 	unsigned long flags = MLX5_TC_FLAG(INGRESS);
5050e2394a61SVlad Buslov 	struct mlx5e_priv *priv = cb_priv;
5051e2394a61SVlad Buslov 
50522ff349c5SRoi Dayan 	if (!priv->netdev || !netif_device_present(priv->netdev))
50532ff349c5SRoi Dayan 		return -EOPNOTSUPP;
50542ff349c5SRoi Dayan 
5055ec9457a6SRoi Dayan 	if (mlx5e_is_uplink_rep(priv))
5056ec9457a6SRoi Dayan 		flags |= MLX5_TC_FLAG(ESW_OFFLOAD);
5057ec9457a6SRoi Dayan 	else
5058ec9457a6SRoi Dayan 		flags |= MLX5_TC_FLAG(NIC_OFFLOAD);
5059ec9457a6SRoi Dayan 
5060e2394a61SVlad Buslov 	switch (type) {
5061e2394a61SVlad Buslov 	case TC_SETUP_CLSFLOWER:
5062e2394a61SVlad Buslov 		return mlx5e_setup_tc_cls_flower(priv, type_data, flags);
5063e2394a61SVlad Buslov 	default:
5064e2394a61SVlad Buslov 		return -EOPNOTSUPP;
5065e2394a61SVlad Buslov 	}
5066e2394a61SVlad Buslov }
5067c7569097SAriel Levkovich 
5068c7569097SAriel Levkovich bool mlx5e_tc_update_skb(struct mlx5_cqe64 *cqe,
5069c7569097SAriel Levkovich 			 struct sk_buff *skb)
5070c7569097SAriel Levkovich {
5071c7569097SAriel Levkovich #if IS_ENABLED(CONFIG_NET_TC_SKB_EXT)
5072aedd133dSAriel Levkovich 	u32 chain = 0, chain_tag, reg_b, zone_restore_id;
5073c7569097SAriel Levkovich 	struct mlx5e_priv *priv = netdev_priv(skb->dev);
5074aedd133dSAriel Levkovich 	struct mlx5e_tc_table *tc = &priv->fs.tc;
5075a91d98a0SChris Mi 	struct mlx5_mapped_obj mapped_obj;
5076c7569097SAriel Levkovich 	struct tc_skb_ext *tc_skb_ext;
5077c7569097SAriel Levkovich 	int err;
5078c7569097SAriel Levkovich 
5079c7569097SAriel Levkovich 	reg_b = be32_to_cpu(cqe->ft_metadata);
5080c7569097SAriel Levkovich 
5081c7569097SAriel Levkovich 	chain_tag = reg_b & MLX5E_TC_TABLE_CHAIN_TAG_MASK;
5082c7569097SAriel Levkovich 
5083c9355682SChris Mi 	err = mapping_find(tc->mapping, chain_tag, &mapped_obj);
5084c7569097SAriel Levkovich 	if (err) {
5085c7569097SAriel Levkovich 		netdev_dbg(priv->netdev,
5086c7569097SAriel Levkovich 			   "Couldn't find chain for chain tag: %d, err: %d\n",
5087c7569097SAriel Levkovich 			   chain_tag, err);
5088c7569097SAriel Levkovich 		return false;
5089c7569097SAriel Levkovich 	}
5090c7569097SAriel Levkovich 
5091a91d98a0SChris Mi 	if (mapped_obj.type == MLX5_MAPPED_OBJ_CHAIN) {
5092a91d98a0SChris Mi 		chain = mapped_obj.chain;
5093*9453d45eSVlad Buslov 		tc_skb_ext = tc_skb_ext_alloc(skb);
5094c7569097SAriel Levkovich 		if (WARN_ON(!tc_skb_ext))
5095c7569097SAriel Levkovich 			return false;
5096c7569097SAriel Levkovich 
5097c7569097SAriel Levkovich 		tc_skb_ext->chain = chain;
5098aedd133dSAriel Levkovich 
5099aedd133dSAriel Levkovich 		zone_restore_id = (reg_b >> REG_MAPPING_SHIFT(NIC_ZONE_RESTORE_TO_REG)) &
510048d216e5SVlad Buslov 			ESW_ZONE_ID_MASK;
5101aedd133dSAriel Levkovich 
5102aedd133dSAriel Levkovich 		if (!mlx5e_tc_ct_restore_flow(tc->ct, skb,
5103aedd133dSAriel Levkovich 					      zone_restore_id))
5104aedd133dSAriel Levkovich 			return false;
5105a91d98a0SChris Mi 	} else {
5106a91d98a0SChris Mi 		netdev_dbg(priv->netdev, "Invalid mapped object type: %d\n", mapped_obj.type);
5107a91d98a0SChris Mi 		return false;
5108c7569097SAriel Levkovich 	}
5109c7569097SAriel Levkovich #endif /* CONFIG_NET_TC_SKB_EXT */
5110c7569097SAriel Levkovich 
5111c7569097SAriel Levkovich 	return true;
5112c7569097SAriel Levkovich }
5113