1 /*
2  * Copyright (c) 2016, Mellanox Technologies. All rights reserved.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * OpenIB.org BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *        copyright notice, this list of conditions and the following
16  *        disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *        copyright notice, this list of conditions and the following
20  *        disclaimer in the documentation and/or other materials
21  *        provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  */
32 
33 #include <linux/etherdevice.h>
34 #include <linux/idr.h>
35 #include <linux/mlx5/driver.h>
36 #include <linux/mlx5/mlx5_ifc.h>
37 #include <linux/mlx5/vport.h>
38 #include <linux/mlx5/fs.h>
39 #include "mlx5_core.h"
40 #include "eswitch.h"
41 #include "esw/indir_table.h"
42 #include "esw/acl/ofld.h"
43 #include "rdma.h"
44 #include "en.h"
45 #include "fs_core.h"
46 #include "lib/devcom.h"
47 #include "lib/eq.h"
48 #include "lib/fs_chains.h"
49 #include "en_tc.h"
50 #include "en/mapping.h"
51 
52 #define mlx5_esw_for_each_rep(esw, i, rep) \
53 	xa_for_each(&((esw)->offloads.vport_reps), i, rep)
54 
55 #define mlx5_esw_for_each_sf_rep(esw, i, rep) \
56 	xa_for_each_marked(&((esw)->offloads.vport_reps), i, rep, MLX5_ESW_VPT_SF)
57 
58 #define mlx5_esw_for_each_vf_rep(esw, index, rep)	\
59 	mlx5_esw_for_each_entry_marked(&((esw)->offloads.vport_reps), index, \
60 				       rep, (esw)->esw_funcs.num_vfs, MLX5_ESW_VPT_VF)
61 
62 /* There are two match-all miss flows, one for unicast dst mac and
63  * one for multicast.
64  */
65 #define MLX5_ESW_MISS_FLOWS (2)
66 #define UPLINK_REP_INDEX 0
67 
68 #define MLX5_ESW_VPORT_TBL_SIZE 128
69 #define MLX5_ESW_VPORT_TBL_NUM_GROUPS  4
70 
71 static const struct esw_vport_tbl_namespace mlx5_esw_vport_tbl_mirror_ns = {
72 	.max_fte = MLX5_ESW_VPORT_TBL_SIZE,
73 	.max_num_groups = MLX5_ESW_VPORT_TBL_NUM_GROUPS,
74 	.flags = 0,
75 };
76 
77 static struct mlx5_eswitch_rep *mlx5_eswitch_get_rep(struct mlx5_eswitch *esw,
78 						     u16 vport_num)
79 {
80 	return xa_load(&esw->offloads.vport_reps, vport_num);
81 }
82 
83 static void
84 mlx5_eswitch_set_rule_flow_source(struct mlx5_eswitch *esw,
85 				  struct mlx5_flow_spec *spec,
86 				  struct mlx5_esw_flow_attr *attr)
87 {
88 	if (MLX5_CAP_ESW_FLOWTABLE(esw->dev, flow_source) &&
89 	    attr && attr->in_rep)
90 		spec->flow_context.flow_source =
91 			attr->in_rep->vport == MLX5_VPORT_UPLINK ?
92 				MLX5_FLOW_CONTEXT_FLOW_SOURCE_UPLINK :
93 				MLX5_FLOW_CONTEXT_FLOW_SOURCE_LOCAL_VPORT;
94 }
95 
96 /* Actually only the upper 16 bits of reg c0 need to be cleared, but the lower 16 bits
97  * are not needed as well in the following process. So clear them all for simplicity.
98  */
99 void
100 mlx5_eswitch_clear_rule_source_port(struct mlx5_eswitch *esw, struct mlx5_flow_spec *spec)
101 {
102 	if (mlx5_eswitch_vport_match_metadata_enabled(esw)) {
103 		void *misc2;
104 
105 		misc2 = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters_2);
106 		MLX5_SET(fte_match_set_misc2, misc2, metadata_reg_c_0, 0);
107 
108 		misc2 = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters_2);
109 		MLX5_SET(fte_match_set_misc2, misc2, metadata_reg_c_0, 0);
110 
111 		if (!memchr_inv(misc2, 0, MLX5_ST_SZ_BYTES(fte_match_set_misc2)))
112 			spec->match_criteria_enable &= ~MLX5_MATCH_MISC_PARAMETERS_2;
113 	}
114 }
115 
116 static void
117 mlx5_eswitch_set_rule_source_port(struct mlx5_eswitch *esw,
118 				  struct mlx5_flow_spec *spec,
119 				  struct mlx5_flow_attr *attr,
120 				  struct mlx5_eswitch *src_esw,
121 				  u16 vport)
122 {
123 	void *misc2;
124 	void *misc;
125 
126 	/* Use metadata matching because vport is not represented by single
127 	 * VHCA in dual-port RoCE mode, and matching on source vport may fail.
128 	 */
129 	if (mlx5_eswitch_vport_match_metadata_enabled(esw)) {
130 		if (mlx5_esw_indir_table_decap_vport(attr))
131 			vport = mlx5_esw_indir_table_decap_vport(attr);
132 		misc2 = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters_2);
133 		MLX5_SET(fte_match_set_misc2, misc2, metadata_reg_c_0,
134 			 mlx5_eswitch_get_vport_metadata_for_match(src_esw,
135 								   vport));
136 
137 		misc2 = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters_2);
138 		MLX5_SET(fte_match_set_misc2, misc2, metadata_reg_c_0,
139 			 mlx5_eswitch_get_vport_metadata_mask());
140 
141 		spec->match_criteria_enable |= MLX5_MATCH_MISC_PARAMETERS_2;
142 	} else {
143 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters);
144 		MLX5_SET(fte_match_set_misc, misc, source_port, vport);
145 
146 		if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
147 			MLX5_SET(fte_match_set_misc, misc,
148 				 source_eswitch_owner_vhca_id,
149 				 MLX5_CAP_GEN(src_esw->dev, vhca_id));
150 
151 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters);
152 		MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
153 		if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
154 			MLX5_SET_TO_ONES(fte_match_set_misc, misc,
155 					 source_eswitch_owner_vhca_id);
156 
157 		spec->match_criteria_enable |= MLX5_MATCH_MISC_PARAMETERS;
158 	}
159 }
160 
161 static int
162 esw_setup_decap_indir(struct mlx5_eswitch *esw,
163 		      struct mlx5_flow_attr *attr,
164 		      struct mlx5_flow_spec *spec)
165 {
166 	struct mlx5_flow_table *ft;
167 
168 	if (!(attr->flags & MLX5_ESW_ATTR_FLAG_SRC_REWRITE))
169 		return -EOPNOTSUPP;
170 
171 	ft = mlx5_esw_indir_table_get(esw, attr, spec,
172 				      mlx5_esw_indir_table_decap_vport(attr), true);
173 	return PTR_ERR_OR_ZERO(ft);
174 }
175 
176 static void
177 esw_cleanup_decap_indir(struct mlx5_eswitch *esw,
178 			struct mlx5_flow_attr *attr)
179 {
180 	if (mlx5_esw_indir_table_decap_vport(attr))
181 		mlx5_esw_indir_table_put(esw, attr,
182 					 mlx5_esw_indir_table_decap_vport(attr),
183 					 true);
184 }
185 
186 static int
187 esw_setup_sampler_dest(struct mlx5_flow_destination *dest,
188 		       struct mlx5_flow_act *flow_act,
189 		       struct mlx5_esw_flow_attr *esw_attr,
190 		       int i)
191 {
192 	flow_act->flags |= FLOW_ACT_IGNORE_FLOW_LEVEL;
193 	dest[i].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_SAMPLER;
194 	dest[i].sampler_id = esw_attr->sample->sampler_id;
195 
196 	return 0;
197 }
198 
199 static int
200 esw_setup_ft_dest(struct mlx5_flow_destination *dest,
201 		  struct mlx5_flow_act *flow_act,
202 		  struct mlx5_eswitch *esw,
203 		  struct mlx5_flow_attr *attr,
204 		  struct mlx5_flow_spec *spec,
205 		  int i)
206 {
207 	flow_act->flags |= FLOW_ACT_IGNORE_FLOW_LEVEL;
208 	dest[i].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
209 	dest[i].ft = attr->dest_ft;
210 
211 	if (mlx5_esw_indir_table_decap_vport(attr))
212 		return esw_setup_decap_indir(esw, attr, spec);
213 	return 0;
214 }
215 
216 static void
217 esw_setup_slow_path_dest(struct mlx5_flow_destination *dest,
218 			 struct mlx5_flow_act *flow_act,
219 			 struct mlx5_fs_chains *chains,
220 			 int i)
221 {
222 	if (mlx5_chains_ignore_flow_level_supported(chains))
223 		flow_act->flags |= FLOW_ACT_IGNORE_FLOW_LEVEL;
224 	dest[i].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
225 	dest[i].ft = mlx5_chains_get_tc_end_ft(chains);
226 }
227 
228 static int
229 esw_setup_chain_dest(struct mlx5_flow_destination *dest,
230 		     struct mlx5_flow_act *flow_act,
231 		     struct mlx5_fs_chains *chains,
232 		     u32 chain, u32 prio, u32 level,
233 		     int i)
234 {
235 	struct mlx5_flow_table *ft;
236 
237 	flow_act->flags |= FLOW_ACT_IGNORE_FLOW_LEVEL;
238 	ft = mlx5_chains_get_table(chains, chain, prio, level);
239 	if (IS_ERR(ft))
240 		return PTR_ERR(ft);
241 
242 	dest[i].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
243 	dest[i].ft = ft;
244 	return  0;
245 }
246 
247 static void esw_put_dest_tables_loop(struct mlx5_eswitch *esw, struct mlx5_flow_attr *attr,
248 				     int from, int to)
249 {
250 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
251 	struct mlx5_fs_chains *chains = esw_chains(esw);
252 	int i;
253 
254 	for (i = from; i < to; i++)
255 		if (esw_attr->dests[i].flags & MLX5_ESW_DEST_CHAIN_WITH_SRC_PORT_CHANGE)
256 			mlx5_chains_put_table(chains, 0, 1, 0);
257 		else if (mlx5_esw_indir_table_needed(esw, attr, esw_attr->dests[i].rep->vport,
258 						     esw_attr->dests[i].mdev))
259 			mlx5_esw_indir_table_put(esw, attr, esw_attr->dests[i].rep->vport,
260 						 false);
261 }
262 
263 static bool
264 esw_is_chain_src_port_rewrite(struct mlx5_eswitch *esw, struct mlx5_esw_flow_attr *esw_attr)
265 {
266 	int i;
267 
268 	for (i = esw_attr->split_count; i < esw_attr->out_count; i++)
269 		if (esw_attr->dests[i].flags & MLX5_ESW_DEST_CHAIN_WITH_SRC_PORT_CHANGE)
270 			return true;
271 	return false;
272 }
273 
274 static int
275 esw_setup_chain_src_port_rewrite(struct mlx5_flow_destination *dest,
276 				 struct mlx5_flow_act *flow_act,
277 				 struct mlx5_eswitch *esw,
278 				 struct mlx5_fs_chains *chains,
279 				 struct mlx5_flow_attr *attr,
280 				 int *i)
281 {
282 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
283 	int j, err;
284 
285 	if (!(attr->flags & MLX5_ESW_ATTR_FLAG_SRC_REWRITE))
286 		return -EOPNOTSUPP;
287 
288 	for (j = esw_attr->split_count; j < esw_attr->out_count; j++, (*i)++) {
289 		err = esw_setup_chain_dest(dest, flow_act, chains, attr->dest_chain, 1, 0, *i);
290 		if (err)
291 			goto err_setup_chain;
292 		flow_act->action |= MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT;
293 		flow_act->pkt_reformat = esw_attr->dests[j].pkt_reformat;
294 	}
295 	return 0;
296 
297 err_setup_chain:
298 	esw_put_dest_tables_loop(esw, attr, esw_attr->split_count, j);
299 	return err;
300 }
301 
302 static void esw_cleanup_chain_src_port_rewrite(struct mlx5_eswitch *esw,
303 					       struct mlx5_flow_attr *attr)
304 {
305 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
306 
307 	esw_put_dest_tables_loop(esw, attr, esw_attr->split_count, esw_attr->out_count);
308 }
309 
310 static bool
311 esw_is_indir_table(struct mlx5_eswitch *esw, struct mlx5_flow_attr *attr)
312 {
313 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
314 	int i;
315 
316 	for (i = esw_attr->split_count; i < esw_attr->out_count; i++)
317 		if (mlx5_esw_indir_table_needed(esw, attr, esw_attr->dests[i].rep->vport,
318 						esw_attr->dests[i].mdev))
319 			return true;
320 	return false;
321 }
322 
323 static int
324 esw_setup_indir_table(struct mlx5_flow_destination *dest,
325 		      struct mlx5_flow_act *flow_act,
326 		      struct mlx5_eswitch *esw,
327 		      struct mlx5_flow_attr *attr,
328 		      struct mlx5_flow_spec *spec,
329 		      bool ignore_flow_lvl,
330 		      int *i)
331 {
332 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
333 	int j, err;
334 
335 	if (!(attr->flags & MLX5_ESW_ATTR_FLAG_SRC_REWRITE))
336 		return -EOPNOTSUPP;
337 
338 	for (j = esw_attr->split_count; j < esw_attr->out_count; j++, (*i)++) {
339 		if (ignore_flow_lvl)
340 			flow_act->flags |= FLOW_ACT_IGNORE_FLOW_LEVEL;
341 		dest[*i].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
342 
343 		dest[*i].ft = mlx5_esw_indir_table_get(esw, attr, spec,
344 						       esw_attr->dests[j].rep->vport, false);
345 		if (IS_ERR(dest[*i].ft)) {
346 			err = PTR_ERR(dest[*i].ft);
347 			goto err_indir_tbl_get;
348 		}
349 	}
350 
351 	if (mlx5_esw_indir_table_decap_vport(attr)) {
352 		err = esw_setup_decap_indir(esw, attr, spec);
353 		if (err)
354 			goto err_indir_tbl_get;
355 	}
356 
357 	return 0;
358 
359 err_indir_tbl_get:
360 	esw_put_dest_tables_loop(esw, attr, esw_attr->split_count, j);
361 	return err;
362 }
363 
364 static void esw_cleanup_indir_table(struct mlx5_eswitch *esw, struct mlx5_flow_attr *attr)
365 {
366 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
367 
368 	esw_put_dest_tables_loop(esw, attr, esw_attr->split_count, esw_attr->out_count);
369 	esw_cleanup_decap_indir(esw, attr);
370 }
371 
372 static void
373 esw_cleanup_chain_dest(struct mlx5_fs_chains *chains, u32 chain, u32 prio, u32 level)
374 {
375 	mlx5_chains_put_table(chains, chain, prio, level);
376 }
377 
378 static void
379 esw_setup_vport_dest(struct mlx5_flow_destination *dest, struct mlx5_flow_act *flow_act,
380 		     struct mlx5_eswitch *esw, struct mlx5_esw_flow_attr *esw_attr,
381 		     int attr_idx, int dest_idx, bool pkt_reformat)
382 {
383 	dest[dest_idx].type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
384 	dest[dest_idx].vport.num = esw_attr->dests[attr_idx].rep->vport;
385 	dest[dest_idx].vport.vhca_id =
386 		MLX5_CAP_GEN(esw_attr->dests[attr_idx].mdev, vhca_id);
387 	if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
388 		dest[dest_idx].vport.flags |= MLX5_FLOW_DEST_VPORT_VHCA_ID;
389 	if (esw_attr->dests[attr_idx].flags & MLX5_ESW_DEST_ENCAP) {
390 		if (pkt_reformat) {
391 			flow_act->action |= MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT;
392 			flow_act->pkt_reformat = esw_attr->dests[attr_idx].pkt_reformat;
393 		}
394 		dest[dest_idx].vport.flags |= MLX5_FLOW_DEST_VPORT_REFORMAT_ID;
395 		dest[dest_idx].vport.pkt_reformat = esw_attr->dests[attr_idx].pkt_reformat;
396 	}
397 }
398 
399 static int
400 esw_setup_vport_dests(struct mlx5_flow_destination *dest, struct mlx5_flow_act *flow_act,
401 		      struct mlx5_eswitch *esw, struct mlx5_esw_flow_attr *esw_attr,
402 		      int i)
403 {
404 	int j;
405 
406 	for (j = esw_attr->split_count; j < esw_attr->out_count; j++, i++)
407 		esw_setup_vport_dest(dest, flow_act, esw, esw_attr, j, i, true);
408 	return i;
409 }
410 
411 static bool
412 esw_src_port_rewrite_supported(struct mlx5_eswitch *esw)
413 {
414 	return MLX5_CAP_GEN(esw->dev, reg_c_preserve) &&
415 	       mlx5_eswitch_vport_match_metadata_enabled(esw) &&
416 	       MLX5_CAP_ESW_FLOWTABLE_FDB(esw->dev, ignore_flow_level);
417 }
418 
419 static int
420 esw_setup_dests(struct mlx5_flow_destination *dest,
421 		struct mlx5_flow_act *flow_act,
422 		struct mlx5_eswitch *esw,
423 		struct mlx5_flow_attr *attr,
424 		struct mlx5_flow_spec *spec,
425 		int *i)
426 {
427 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
428 	struct mlx5_fs_chains *chains = esw_chains(esw);
429 	int err = 0;
430 
431 	if (!mlx5_eswitch_termtbl_required(esw, attr, flow_act, spec) &&
432 	    esw_src_port_rewrite_supported(esw))
433 		attr->flags |= MLX5_ESW_ATTR_FLAG_SRC_REWRITE;
434 
435 	if (attr->flags & MLX5_ESW_ATTR_FLAG_SAMPLE) {
436 		esw_setup_sampler_dest(dest, flow_act, esw_attr, *i);
437 		(*i)++;
438 	} else if (attr->dest_ft) {
439 		esw_setup_ft_dest(dest, flow_act, esw, attr, spec, *i);
440 		(*i)++;
441 	} else if (attr->flags & MLX5_ESW_ATTR_FLAG_SLOW_PATH) {
442 		esw_setup_slow_path_dest(dest, flow_act, chains, *i);
443 		(*i)++;
444 	} else if (attr->dest_chain) {
445 		err = esw_setup_chain_dest(dest, flow_act, chains, attr->dest_chain,
446 					   1, 0, *i);
447 		(*i)++;
448 	} else if (esw_is_indir_table(esw, attr)) {
449 		err = esw_setup_indir_table(dest, flow_act, esw, attr, spec, true, i);
450 	} else if (esw_is_chain_src_port_rewrite(esw, esw_attr)) {
451 		err = esw_setup_chain_src_port_rewrite(dest, flow_act, esw, chains, attr, i);
452 	} else {
453 		*i = esw_setup_vport_dests(dest, flow_act, esw, esw_attr, *i);
454 	}
455 
456 	return err;
457 }
458 
459 static void
460 esw_cleanup_dests(struct mlx5_eswitch *esw,
461 		  struct mlx5_flow_attr *attr)
462 {
463 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
464 	struct mlx5_fs_chains *chains = esw_chains(esw);
465 
466 	if (attr->dest_ft) {
467 		esw_cleanup_decap_indir(esw, attr);
468 	} else if (!(attr->flags & MLX5_ESW_ATTR_FLAG_SLOW_PATH)) {
469 		if (attr->dest_chain)
470 			esw_cleanup_chain_dest(chains, attr->dest_chain, 1, 0);
471 		else if (esw_is_indir_table(esw, attr))
472 			esw_cleanup_indir_table(esw, attr);
473 		else if (esw_is_chain_src_port_rewrite(esw, esw_attr))
474 			esw_cleanup_chain_src_port_rewrite(esw, attr);
475 	}
476 }
477 
478 struct mlx5_flow_handle *
479 mlx5_eswitch_add_offloaded_rule(struct mlx5_eswitch *esw,
480 				struct mlx5_flow_spec *spec,
481 				struct mlx5_flow_attr *attr)
482 {
483 	struct mlx5_flow_destination dest[MLX5_MAX_FLOW_FWD_VPORTS + 1] = {};
484 	struct mlx5_flow_act flow_act = { .flags = FLOW_ACT_NO_APPEND, };
485 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
486 	struct mlx5_fs_chains *chains = esw_chains(esw);
487 	bool split = !!(esw_attr->split_count);
488 	struct mlx5_vport_tbl_attr fwd_attr;
489 	struct mlx5_flow_handle *rule;
490 	struct mlx5_flow_table *fdb;
491 	int i = 0;
492 
493 	if (esw->mode != MLX5_ESWITCH_OFFLOADS)
494 		return ERR_PTR(-EOPNOTSUPP);
495 
496 	flow_act.action = attr->action;
497 	/* if per flow vlan pop/push is emulated, don't set that into the firmware */
498 	if (!mlx5_eswitch_vlan_actions_supported(esw->dev, 1))
499 		flow_act.action &= ~(MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH |
500 				     MLX5_FLOW_CONTEXT_ACTION_VLAN_POP);
501 	else if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH) {
502 		flow_act.vlan[0].ethtype = ntohs(esw_attr->vlan_proto[0]);
503 		flow_act.vlan[0].vid = esw_attr->vlan_vid[0];
504 		flow_act.vlan[0].prio = esw_attr->vlan_prio[0];
505 		if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2) {
506 			flow_act.vlan[1].ethtype = ntohs(esw_attr->vlan_proto[1]);
507 			flow_act.vlan[1].vid = esw_attr->vlan_vid[1];
508 			flow_act.vlan[1].prio = esw_attr->vlan_prio[1];
509 		}
510 	}
511 
512 	mlx5_eswitch_set_rule_flow_source(esw, spec, esw_attr);
513 
514 	if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
515 		int err;
516 
517 		err = esw_setup_dests(dest, &flow_act, esw, attr, spec, &i);
518 		if (err) {
519 			rule = ERR_PTR(err);
520 			goto err_create_goto_table;
521 		}
522 	}
523 
524 	if (esw_attr->decap_pkt_reformat)
525 		flow_act.pkt_reformat = esw_attr->decap_pkt_reformat;
526 
527 	if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
528 		dest[i].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
529 		dest[i].counter_id = mlx5_fc_id(attr->counter);
530 		i++;
531 	}
532 
533 	if (attr->outer_match_level != MLX5_MATCH_NONE)
534 		spec->match_criteria_enable |= MLX5_MATCH_OUTER_HEADERS;
535 	if (attr->inner_match_level != MLX5_MATCH_NONE)
536 		spec->match_criteria_enable |= MLX5_MATCH_INNER_HEADERS;
537 
538 	if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
539 		flow_act.modify_hdr = attr->modify_hdr;
540 
541 	/* esw_attr->sample is allocated only when there is a sample action */
542 	if (esw_attr->sample && esw_attr->sample->sample_default_tbl) {
543 		fdb = esw_attr->sample->sample_default_tbl;
544 	} else if (split) {
545 		fwd_attr.chain = attr->chain;
546 		fwd_attr.prio = attr->prio;
547 		fwd_attr.vport = esw_attr->in_rep->vport;
548 		fwd_attr.vport_ns = &mlx5_esw_vport_tbl_mirror_ns;
549 
550 		fdb = mlx5_esw_vporttbl_get(esw, &fwd_attr);
551 	} else {
552 		if (attr->chain || attr->prio)
553 			fdb = mlx5_chains_get_table(chains, attr->chain,
554 						    attr->prio, 0);
555 		else
556 			fdb = attr->ft;
557 
558 		if (!(attr->flags & MLX5_ESW_ATTR_FLAG_NO_IN_PORT))
559 			mlx5_eswitch_set_rule_source_port(esw, spec, attr,
560 							  esw_attr->in_mdev->priv.eswitch,
561 							  esw_attr->in_rep->vport);
562 	}
563 	if (IS_ERR(fdb)) {
564 		rule = ERR_CAST(fdb);
565 		goto err_esw_get;
566 	}
567 
568 	if (mlx5_eswitch_termtbl_required(esw, attr, &flow_act, spec))
569 		rule = mlx5_eswitch_add_termtbl_rule(esw, fdb, spec, esw_attr,
570 						     &flow_act, dest, i);
571 	else
572 		rule = mlx5_add_flow_rules(fdb, spec, &flow_act, dest, i);
573 	if (IS_ERR(rule))
574 		goto err_add_rule;
575 	else
576 		atomic64_inc(&esw->offloads.num_flows);
577 
578 	return rule;
579 
580 err_add_rule:
581 	if (split)
582 		mlx5_esw_vporttbl_put(esw, &fwd_attr);
583 	else if (attr->chain || attr->prio)
584 		mlx5_chains_put_table(chains, attr->chain, attr->prio, 0);
585 err_esw_get:
586 	esw_cleanup_dests(esw, attr);
587 err_create_goto_table:
588 	return rule;
589 }
590 
591 struct mlx5_flow_handle *
592 mlx5_eswitch_add_fwd_rule(struct mlx5_eswitch *esw,
593 			  struct mlx5_flow_spec *spec,
594 			  struct mlx5_flow_attr *attr)
595 {
596 	struct mlx5_flow_destination dest[MLX5_MAX_FLOW_FWD_VPORTS + 1] = {};
597 	struct mlx5_flow_act flow_act = { .flags = FLOW_ACT_NO_APPEND, };
598 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
599 	struct mlx5_fs_chains *chains = esw_chains(esw);
600 	struct mlx5_vport_tbl_attr fwd_attr;
601 	struct mlx5_flow_table *fast_fdb;
602 	struct mlx5_flow_table *fwd_fdb;
603 	struct mlx5_flow_handle *rule;
604 	int i, err = 0;
605 
606 	fast_fdb = mlx5_chains_get_table(chains, attr->chain, attr->prio, 0);
607 	if (IS_ERR(fast_fdb)) {
608 		rule = ERR_CAST(fast_fdb);
609 		goto err_get_fast;
610 	}
611 
612 	fwd_attr.chain = attr->chain;
613 	fwd_attr.prio = attr->prio;
614 	fwd_attr.vport = esw_attr->in_rep->vport;
615 	fwd_attr.vport_ns = &mlx5_esw_vport_tbl_mirror_ns;
616 	fwd_fdb = mlx5_esw_vporttbl_get(esw, &fwd_attr);
617 	if (IS_ERR(fwd_fdb)) {
618 		rule = ERR_CAST(fwd_fdb);
619 		goto err_get_fwd;
620 	}
621 
622 	flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
623 	for (i = 0; i < esw_attr->split_count; i++) {
624 		if (esw_is_indir_table(esw, attr))
625 			err = esw_setup_indir_table(dest, &flow_act, esw, attr, spec, false, &i);
626 		else if (esw_is_chain_src_port_rewrite(esw, esw_attr))
627 			err = esw_setup_chain_src_port_rewrite(dest, &flow_act, esw, chains, attr,
628 							       &i);
629 		else
630 			esw_setup_vport_dest(dest, &flow_act, esw, esw_attr, i, i, false);
631 
632 		if (err) {
633 			rule = ERR_PTR(err);
634 			goto err_chain_src_rewrite;
635 		}
636 	}
637 	dest[i].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
638 	dest[i].ft = fwd_fdb;
639 	i++;
640 
641 	mlx5_eswitch_set_rule_source_port(esw, spec, attr,
642 					  esw_attr->in_mdev->priv.eswitch,
643 					  esw_attr->in_rep->vport);
644 
645 	if (attr->outer_match_level != MLX5_MATCH_NONE)
646 		spec->match_criteria_enable |= MLX5_MATCH_OUTER_HEADERS;
647 
648 	flow_act.flags |= FLOW_ACT_IGNORE_FLOW_LEVEL;
649 	rule = mlx5_add_flow_rules(fast_fdb, spec, &flow_act, dest, i);
650 
651 	if (IS_ERR(rule)) {
652 		i = esw_attr->split_count;
653 		goto err_chain_src_rewrite;
654 	}
655 
656 	atomic64_inc(&esw->offloads.num_flows);
657 
658 	return rule;
659 err_chain_src_rewrite:
660 	esw_put_dest_tables_loop(esw, attr, 0, i);
661 	mlx5_esw_vporttbl_put(esw, &fwd_attr);
662 err_get_fwd:
663 	mlx5_chains_put_table(chains, attr->chain, attr->prio, 0);
664 err_get_fast:
665 	return rule;
666 }
667 
668 static void
669 __mlx5_eswitch_del_rule(struct mlx5_eswitch *esw,
670 			struct mlx5_flow_handle *rule,
671 			struct mlx5_flow_attr *attr,
672 			bool fwd_rule)
673 {
674 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
675 	struct mlx5_fs_chains *chains = esw_chains(esw);
676 	bool split = (esw_attr->split_count > 0);
677 	struct mlx5_vport_tbl_attr fwd_attr;
678 	int i;
679 
680 	mlx5_del_flow_rules(rule);
681 
682 	if (!(attr->flags & MLX5_ESW_ATTR_FLAG_SLOW_PATH)) {
683 		/* unref the term table */
684 		for (i = 0; i < MLX5_MAX_FLOW_FWD_VPORTS; i++) {
685 			if (esw_attr->dests[i].termtbl)
686 				mlx5_eswitch_termtbl_put(esw, esw_attr->dests[i].termtbl);
687 		}
688 	}
689 
690 	atomic64_dec(&esw->offloads.num_flows);
691 
692 	if (fwd_rule || split) {
693 		fwd_attr.chain = attr->chain;
694 		fwd_attr.prio = attr->prio;
695 		fwd_attr.vport = esw_attr->in_rep->vport;
696 		fwd_attr.vport_ns = &mlx5_esw_vport_tbl_mirror_ns;
697 	}
698 
699 	if (fwd_rule)  {
700 		mlx5_esw_vporttbl_put(esw, &fwd_attr);
701 		mlx5_chains_put_table(chains, attr->chain, attr->prio, 0);
702 		esw_put_dest_tables_loop(esw, attr, 0, esw_attr->split_count);
703 	} else {
704 		if (split)
705 			mlx5_esw_vporttbl_put(esw, &fwd_attr);
706 		else if (attr->chain || attr->prio)
707 			mlx5_chains_put_table(chains, attr->chain, attr->prio, 0);
708 		esw_cleanup_dests(esw, attr);
709 	}
710 }
711 
712 void
713 mlx5_eswitch_del_offloaded_rule(struct mlx5_eswitch *esw,
714 				struct mlx5_flow_handle *rule,
715 				struct mlx5_flow_attr *attr)
716 {
717 	__mlx5_eswitch_del_rule(esw, rule, attr, false);
718 }
719 
720 void
721 mlx5_eswitch_del_fwd_rule(struct mlx5_eswitch *esw,
722 			  struct mlx5_flow_handle *rule,
723 			  struct mlx5_flow_attr *attr)
724 {
725 	__mlx5_eswitch_del_rule(esw, rule, attr, true);
726 }
727 
728 static int esw_set_global_vlan_pop(struct mlx5_eswitch *esw, u8 val)
729 {
730 	struct mlx5_eswitch_rep *rep;
731 	unsigned long i;
732 	int err = 0;
733 
734 	esw_debug(esw->dev, "%s applying global %s policy\n", __func__, val ? "pop" : "none");
735 	mlx5_esw_for_each_host_func_vport(esw, i, rep, esw->esw_funcs.num_vfs) {
736 		if (atomic_read(&rep->rep_data[REP_ETH].state) != REP_LOADED)
737 			continue;
738 
739 		err = __mlx5_eswitch_set_vport_vlan(esw, rep->vport, 0, 0, val);
740 		if (err)
741 			goto out;
742 	}
743 
744 out:
745 	return err;
746 }
747 
748 static struct mlx5_eswitch_rep *
749 esw_vlan_action_get_vport(struct mlx5_esw_flow_attr *attr, bool push, bool pop)
750 {
751 	struct mlx5_eswitch_rep *in_rep, *out_rep, *vport = NULL;
752 
753 	in_rep  = attr->in_rep;
754 	out_rep = attr->dests[0].rep;
755 
756 	if (push)
757 		vport = in_rep;
758 	else if (pop)
759 		vport = out_rep;
760 	else
761 		vport = in_rep;
762 
763 	return vport;
764 }
765 
766 static int esw_add_vlan_action_check(struct mlx5_esw_flow_attr *attr,
767 				     bool push, bool pop, bool fwd)
768 {
769 	struct mlx5_eswitch_rep *in_rep, *out_rep;
770 
771 	if ((push || pop) && !fwd)
772 		goto out_notsupp;
773 
774 	in_rep  = attr->in_rep;
775 	out_rep = attr->dests[0].rep;
776 
777 	if (push && in_rep->vport == MLX5_VPORT_UPLINK)
778 		goto out_notsupp;
779 
780 	if (pop && out_rep->vport == MLX5_VPORT_UPLINK)
781 		goto out_notsupp;
782 
783 	/* vport has vlan push configured, can't offload VF --> wire rules w.o it */
784 	if (!push && !pop && fwd)
785 		if (in_rep->vlan && out_rep->vport == MLX5_VPORT_UPLINK)
786 			goto out_notsupp;
787 
788 	/* protects against (1) setting rules with different vlans to push and
789 	 * (2) setting rules w.o vlans (attr->vlan = 0) && w. vlans to push (!= 0)
790 	 */
791 	if (push && in_rep->vlan_refcount && (in_rep->vlan != attr->vlan_vid[0]))
792 		goto out_notsupp;
793 
794 	return 0;
795 
796 out_notsupp:
797 	return -EOPNOTSUPP;
798 }
799 
800 int mlx5_eswitch_add_vlan_action(struct mlx5_eswitch *esw,
801 				 struct mlx5_flow_attr *attr)
802 {
803 	struct offloads_fdb *offloads = &esw->fdb_table.offloads;
804 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
805 	struct mlx5_eswitch_rep *vport = NULL;
806 	bool push, pop, fwd;
807 	int err = 0;
808 
809 	/* nop if we're on the vlan push/pop non emulation mode */
810 	if (mlx5_eswitch_vlan_actions_supported(esw->dev, 1))
811 		return 0;
812 
813 	push = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH);
814 	pop  = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP);
815 	fwd  = !!((attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) &&
816 		   !attr->dest_chain);
817 
818 	mutex_lock(&esw->state_lock);
819 
820 	err = esw_add_vlan_action_check(esw_attr, push, pop, fwd);
821 	if (err)
822 		goto unlock;
823 
824 	attr->flags &= ~MLX5_ESW_ATTR_FLAG_VLAN_HANDLED;
825 
826 	vport = esw_vlan_action_get_vport(esw_attr, push, pop);
827 
828 	if (!push && !pop && fwd) {
829 		/* tracks VF --> wire rules without vlan push action */
830 		if (esw_attr->dests[0].rep->vport == MLX5_VPORT_UPLINK) {
831 			vport->vlan_refcount++;
832 			attr->flags |= MLX5_ESW_ATTR_FLAG_VLAN_HANDLED;
833 		}
834 
835 		goto unlock;
836 	}
837 
838 	if (!push && !pop)
839 		goto unlock;
840 
841 	if (!(offloads->vlan_push_pop_refcount)) {
842 		/* it's the 1st vlan rule, apply global vlan pop policy */
843 		err = esw_set_global_vlan_pop(esw, SET_VLAN_STRIP);
844 		if (err)
845 			goto out;
846 	}
847 	offloads->vlan_push_pop_refcount++;
848 
849 	if (push) {
850 		if (vport->vlan_refcount)
851 			goto skip_set_push;
852 
853 		err = __mlx5_eswitch_set_vport_vlan(esw, vport->vport, esw_attr->vlan_vid[0],
854 						    0, SET_VLAN_INSERT | SET_VLAN_STRIP);
855 		if (err)
856 			goto out;
857 		vport->vlan = esw_attr->vlan_vid[0];
858 skip_set_push:
859 		vport->vlan_refcount++;
860 	}
861 out:
862 	if (!err)
863 		attr->flags |= MLX5_ESW_ATTR_FLAG_VLAN_HANDLED;
864 unlock:
865 	mutex_unlock(&esw->state_lock);
866 	return err;
867 }
868 
869 int mlx5_eswitch_del_vlan_action(struct mlx5_eswitch *esw,
870 				 struct mlx5_flow_attr *attr)
871 {
872 	struct offloads_fdb *offloads = &esw->fdb_table.offloads;
873 	struct mlx5_esw_flow_attr *esw_attr = attr->esw_attr;
874 	struct mlx5_eswitch_rep *vport = NULL;
875 	bool push, pop, fwd;
876 	int err = 0;
877 
878 	/* nop if we're on the vlan push/pop non emulation mode */
879 	if (mlx5_eswitch_vlan_actions_supported(esw->dev, 1))
880 		return 0;
881 
882 	if (!(attr->flags & MLX5_ESW_ATTR_FLAG_VLAN_HANDLED))
883 		return 0;
884 
885 	push = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH);
886 	pop  = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP);
887 	fwd  = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST);
888 
889 	mutex_lock(&esw->state_lock);
890 
891 	vport = esw_vlan_action_get_vport(esw_attr, push, pop);
892 
893 	if (!push && !pop && fwd) {
894 		/* tracks VF --> wire rules without vlan push action */
895 		if (esw_attr->dests[0].rep->vport == MLX5_VPORT_UPLINK)
896 			vport->vlan_refcount--;
897 
898 		goto out;
899 	}
900 
901 	if (push) {
902 		vport->vlan_refcount--;
903 		if (vport->vlan_refcount)
904 			goto skip_unset_push;
905 
906 		vport->vlan = 0;
907 		err = __mlx5_eswitch_set_vport_vlan(esw, vport->vport,
908 						    0, 0, SET_VLAN_STRIP);
909 		if (err)
910 			goto out;
911 	}
912 
913 skip_unset_push:
914 	offloads->vlan_push_pop_refcount--;
915 	if (offloads->vlan_push_pop_refcount)
916 		goto out;
917 
918 	/* no more vlan rules, stop global vlan pop policy */
919 	err = esw_set_global_vlan_pop(esw, 0);
920 
921 out:
922 	mutex_unlock(&esw->state_lock);
923 	return err;
924 }
925 
926 struct mlx5_flow_handle *
927 mlx5_eswitch_add_send_to_vport_rule(struct mlx5_eswitch *on_esw,
928 				    struct mlx5_eswitch_rep *rep,
929 				    u32 sqn)
930 {
931 	struct mlx5_flow_act flow_act = {0};
932 	struct mlx5_flow_destination dest = {};
933 	struct mlx5_flow_handle *flow_rule;
934 	struct mlx5_flow_spec *spec;
935 	void *misc;
936 
937 	spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
938 	if (!spec) {
939 		flow_rule = ERR_PTR(-ENOMEM);
940 		goto out;
941 	}
942 
943 	misc = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters);
944 	MLX5_SET(fte_match_set_misc, misc, source_sqn, sqn);
945 	/* source vport is the esw manager */
946 	MLX5_SET(fte_match_set_misc, misc, source_port, rep->esw->manager_vport);
947 	if (MLX5_CAP_ESW(on_esw->dev, merged_eswitch))
948 		MLX5_SET(fte_match_set_misc, misc, source_eswitch_owner_vhca_id,
949 			 MLX5_CAP_GEN(rep->esw->dev, vhca_id));
950 
951 	misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters);
952 	MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_sqn);
953 	MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
954 	if (MLX5_CAP_ESW(on_esw->dev, merged_eswitch))
955 		MLX5_SET_TO_ONES(fte_match_set_misc, misc,
956 				 source_eswitch_owner_vhca_id);
957 
958 	spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS;
959 	dest.type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
960 	dest.vport.num = rep->vport;
961 	dest.vport.vhca_id = MLX5_CAP_GEN(rep->esw->dev, vhca_id);
962 	dest.vport.flags |= MLX5_FLOW_DEST_VPORT_VHCA_ID;
963 	flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
964 
965 	flow_rule = mlx5_add_flow_rules(on_esw->fdb_table.offloads.slow_fdb,
966 					spec, &flow_act, &dest, 1);
967 	if (IS_ERR(flow_rule))
968 		esw_warn(on_esw->dev, "FDB: Failed to add send to vport rule err %ld\n",
969 			 PTR_ERR(flow_rule));
970 out:
971 	kvfree(spec);
972 	return flow_rule;
973 }
974 EXPORT_SYMBOL(mlx5_eswitch_add_send_to_vport_rule);
975 
976 void mlx5_eswitch_del_send_to_vport_rule(struct mlx5_flow_handle *rule)
977 {
978 	mlx5_del_flow_rules(rule);
979 }
980 
981 static void mlx5_eswitch_del_send_to_vport_meta_rules(struct mlx5_eswitch *esw)
982 {
983 	struct mlx5_flow_handle **flows = esw->fdb_table.offloads.send_to_vport_meta_rules;
984 	int i = 0, num_vfs = esw->esw_funcs.num_vfs;
985 
986 	if (!num_vfs || !flows)
987 		return;
988 
989 	for (i = 0; i < num_vfs; i++)
990 		mlx5_del_flow_rules(flows[i]);
991 
992 	kvfree(flows);
993 }
994 
995 static int
996 mlx5_eswitch_add_send_to_vport_meta_rules(struct mlx5_eswitch *esw)
997 {
998 	struct mlx5_flow_destination dest = {};
999 	struct mlx5_flow_act flow_act = {0};
1000 	int num_vfs, rule_idx = 0, err = 0;
1001 	struct mlx5_flow_handle *flow_rule;
1002 	struct mlx5_flow_handle **flows;
1003 	struct mlx5_flow_spec *spec;
1004 	struct mlx5_vport *vport;
1005 	unsigned long i;
1006 	u16 vport_num;
1007 
1008 	num_vfs = esw->esw_funcs.num_vfs;
1009 	flows = kvzalloc(num_vfs * sizeof(*flows), GFP_KERNEL);
1010 	if (!flows)
1011 		return -ENOMEM;
1012 
1013 	spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1014 	if (!spec) {
1015 		err = -ENOMEM;
1016 		goto alloc_err;
1017 	}
1018 
1019 	MLX5_SET(fte_match_param, spec->match_criteria,
1020 		 misc_parameters_2.metadata_reg_c_0, mlx5_eswitch_get_vport_metadata_mask());
1021 	MLX5_SET(fte_match_param, spec->match_criteria,
1022 		 misc_parameters_2.metadata_reg_c_1, ESW_TUN_MASK);
1023 	MLX5_SET(fte_match_param, spec->match_value, misc_parameters_2.metadata_reg_c_1,
1024 		 ESW_TUN_SLOW_TABLE_GOTO_VPORT_MARK);
1025 
1026 	spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS_2;
1027 	dest.type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
1028 	flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
1029 
1030 	mlx5_esw_for_each_vf_vport(esw, i, vport, num_vfs) {
1031 		vport_num = vport->vport;
1032 		MLX5_SET(fte_match_param, spec->match_value, misc_parameters_2.metadata_reg_c_0,
1033 			 mlx5_eswitch_get_vport_metadata_for_match(esw, vport_num));
1034 		dest.vport.num = vport_num;
1035 
1036 		flow_rule = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb,
1037 						spec, &flow_act, &dest, 1);
1038 		if (IS_ERR(flow_rule)) {
1039 			err = PTR_ERR(flow_rule);
1040 			esw_warn(esw->dev, "FDB: Failed to add send to vport meta rule idx %d, err %ld\n",
1041 				 rule_idx, PTR_ERR(flow_rule));
1042 			goto rule_err;
1043 		}
1044 		flows[rule_idx++] = flow_rule;
1045 	}
1046 
1047 	esw->fdb_table.offloads.send_to_vport_meta_rules = flows;
1048 	kvfree(spec);
1049 	return 0;
1050 
1051 rule_err:
1052 	while (--rule_idx >= 0)
1053 		mlx5_del_flow_rules(flows[rule_idx]);
1054 	kvfree(spec);
1055 alloc_err:
1056 	kvfree(flows);
1057 	return err;
1058 }
1059 
1060 static bool mlx5_eswitch_reg_c1_loopback_supported(struct mlx5_eswitch *esw)
1061 {
1062 	return MLX5_CAP_ESW_FLOWTABLE(esw->dev, fdb_to_vport_reg_c_id) &
1063 	       MLX5_FDB_TO_VPORT_REG_C_1;
1064 }
1065 
1066 static int esw_set_passing_vport_metadata(struct mlx5_eswitch *esw, bool enable)
1067 {
1068 	u32 out[MLX5_ST_SZ_DW(query_esw_vport_context_out)] = {};
1069 	u32 min[MLX5_ST_SZ_DW(modify_esw_vport_context_in)] = {};
1070 	u32 in[MLX5_ST_SZ_DW(query_esw_vport_context_in)] = {};
1071 	u8 curr, wanted;
1072 	int err;
1073 
1074 	if (!mlx5_eswitch_reg_c1_loopback_supported(esw) &&
1075 	    !mlx5_eswitch_vport_match_metadata_enabled(esw))
1076 		return 0;
1077 
1078 	MLX5_SET(query_esw_vport_context_in, in, opcode,
1079 		 MLX5_CMD_OP_QUERY_ESW_VPORT_CONTEXT);
1080 	err = mlx5_cmd_exec_inout(esw->dev, query_esw_vport_context, in, out);
1081 	if (err)
1082 		return err;
1083 
1084 	curr = MLX5_GET(query_esw_vport_context_out, out,
1085 			esw_vport_context.fdb_to_vport_reg_c_id);
1086 	wanted = MLX5_FDB_TO_VPORT_REG_C_0;
1087 	if (mlx5_eswitch_reg_c1_loopback_supported(esw))
1088 		wanted |= MLX5_FDB_TO_VPORT_REG_C_1;
1089 
1090 	if (enable)
1091 		curr |= wanted;
1092 	else
1093 		curr &= ~wanted;
1094 
1095 	MLX5_SET(modify_esw_vport_context_in, min,
1096 		 esw_vport_context.fdb_to_vport_reg_c_id, curr);
1097 	MLX5_SET(modify_esw_vport_context_in, min,
1098 		 field_select.fdb_to_vport_reg_c_id, 1);
1099 
1100 	err = mlx5_eswitch_modify_esw_vport_context(esw->dev, 0, false, min);
1101 	if (!err) {
1102 		if (enable && (curr & MLX5_FDB_TO_VPORT_REG_C_1))
1103 			esw->flags |= MLX5_ESWITCH_REG_C1_LOOPBACK_ENABLED;
1104 		else
1105 			esw->flags &= ~MLX5_ESWITCH_REG_C1_LOOPBACK_ENABLED;
1106 	}
1107 
1108 	return err;
1109 }
1110 
1111 static void peer_miss_rules_setup(struct mlx5_eswitch *esw,
1112 				  struct mlx5_core_dev *peer_dev,
1113 				  struct mlx5_flow_spec *spec,
1114 				  struct mlx5_flow_destination *dest)
1115 {
1116 	void *misc;
1117 
1118 	if (mlx5_eswitch_vport_match_metadata_enabled(esw)) {
1119 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1120 				    misc_parameters_2);
1121 		MLX5_SET(fte_match_set_misc2, misc, metadata_reg_c_0,
1122 			 mlx5_eswitch_get_vport_metadata_mask());
1123 
1124 		spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS_2;
1125 	} else {
1126 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1127 				    misc_parameters);
1128 
1129 		MLX5_SET(fte_match_set_misc, misc, source_eswitch_owner_vhca_id,
1130 			 MLX5_CAP_GEN(peer_dev, vhca_id));
1131 
1132 		spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS;
1133 
1134 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1135 				    misc_parameters);
1136 		MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
1137 		MLX5_SET_TO_ONES(fte_match_set_misc, misc,
1138 				 source_eswitch_owner_vhca_id);
1139 	}
1140 
1141 	dest->type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
1142 	dest->vport.num = peer_dev->priv.eswitch->manager_vport;
1143 	dest->vport.vhca_id = MLX5_CAP_GEN(peer_dev, vhca_id);
1144 	dest->vport.flags |= MLX5_FLOW_DEST_VPORT_VHCA_ID;
1145 }
1146 
1147 static void esw_set_peer_miss_rule_source_port(struct mlx5_eswitch *esw,
1148 					       struct mlx5_eswitch *peer_esw,
1149 					       struct mlx5_flow_spec *spec,
1150 					       u16 vport)
1151 {
1152 	void *misc;
1153 
1154 	if (mlx5_eswitch_vport_match_metadata_enabled(esw)) {
1155 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1156 				    misc_parameters_2);
1157 		MLX5_SET(fte_match_set_misc2, misc, metadata_reg_c_0,
1158 			 mlx5_eswitch_get_vport_metadata_for_match(peer_esw,
1159 								   vport));
1160 	} else {
1161 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1162 				    misc_parameters);
1163 		MLX5_SET(fte_match_set_misc, misc, source_port, vport);
1164 	}
1165 }
1166 
1167 static int esw_add_fdb_peer_miss_rules(struct mlx5_eswitch *esw,
1168 				       struct mlx5_core_dev *peer_dev)
1169 {
1170 	struct mlx5_flow_destination dest = {};
1171 	struct mlx5_flow_act flow_act = {0};
1172 	struct mlx5_flow_handle **flows;
1173 	/* total vports is the same for both e-switches */
1174 	int nvports = esw->total_vports;
1175 	struct mlx5_flow_handle *flow;
1176 	struct mlx5_flow_spec *spec;
1177 	struct mlx5_vport *vport;
1178 	unsigned long i;
1179 	void *misc;
1180 	int err;
1181 
1182 	spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1183 	if (!spec)
1184 		return -ENOMEM;
1185 
1186 	peer_miss_rules_setup(esw, peer_dev, spec, &dest);
1187 
1188 	flows = kvzalloc(nvports * sizeof(*flows), GFP_KERNEL);
1189 	if (!flows) {
1190 		err = -ENOMEM;
1191 		goto alloc_flows_err;
1192 	}
1193 
1194 	flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
1195 	misc = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1196 			    misc_parameters);
1197 
1198 	if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1199 		vport = mlx5_eswitch_get_vport(esw, MLX5_VPORT_PF);
1200 		esw_set_peer_miss_rule_source_port(esw, peer_dev->priv.eswitch,
1201 						   spec, MLX5_VPORT_PF);
1202 
1203 		flow = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb,
1204 					   spec, &flow_act, &dest, 1);
1205 		if (IS_ERR(flow)) {
1206 			err = PTR_ERR(flow);
1207 			goto add_pf_flow_err;
1208 		}
1209 		flows[vport->index] = flow;
1210 	}
1211 
1212 	if (mlx5_ecpf_vport_exists(esw->dev)) {
1213 		vport = mlx5_eswitch_get_vport(esw, MLX5_VPORT_ECPF);
1214 		MLX5_SET(fte_match_set_misc, misc, source_port, MLX5_VPORT_ECPF);
1215 		flow = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb,
1216 					   spec, &flow_act, &dest, 1);
1217 		if (IS_ERR(flow)) {
1218 			err = PTR_ERR(flow);
1219 			goto add_ecpf_flow_err;
1220 		}
1221 		flows[vport->index] = flow;
1222 	}
1223 
1224 	mlx5_esw_for_each_vf_vport(esw, i, vport, mlx5_core_max_vfs(esw->dev)) {
1225 		esw_set_peer_miss_rule_source_port(esw,
1226 						   peer_dev->priv.eswitch,
1227 						   spec, vport->vport);
1228 
1229 		flow = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb,
1230 					   spec, &flow_act, &dest, 1);
1231 		if (IS_ERR(flow)) {
1232 			err = PTR_ERR(flow);
1233 			goto add_vf_flow_err;
1234 		}
1235 		flows[vport->index] = flow;
1236 	}
1237 
1238 	esw->fdb_table.offloads.peer_miss_rules = flows;
1239 
1240 	kvfree(spec);
1241 	return 0;
1242 
1243 add_vf_flow_err:
1244 	mlx5_esw_for_each_vf_vport(esw, i, vport, mlx5_core_max_vfs(esw->dev)) {
1245 		if (!flows[vport->index])
1246 			continue;
1247 		mlx5_del_flow_rules(flows[vport->index]);
1248 	}
1249 	if (mlx5_ecpf_vport_exists(esw->dev)) {
1250 		vport = mlx5_eswitch_get_vport(esw, MLX5_VPORT_ECPF);
1251 		mlx5_del_flow_rules(flows[vport->index]);
1252 	}
1253 add_ecpf_flow_err:
1254 	if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1255 		vport = mlx5_eswitch_get_vport(esw, MLX5_VPORT_PF);
1256 		mlx5_del_flow_rules(flows[vport->index]);
1257 	}
1258 add_pf_flow_err:
1259 	esw_warn(esw->dev, "FDB: Failed to add peer miss flow rule err %d\n", err);
1260 	kvfree(flows);
1261 alloc_flows_err:
1262 	kvfree(spec);
1263 	return err;
1264 }
1265 
1266 static void esw_del_fdb_peer_miss_rules(struct mlx5_eswitch *esw)
1267 {
1268 	struct mlx5_flow_handle **flows;
1269 	struct mlx5_vport *vport;
1270 	unsigned long i;
1271 
1272 	flows = esw->fdb_table.offloads.peer_miss_rules;
1273 
1274 	mlx5_esw_for_each_vf_vport(esw, i, vport, mlx5_core_max_vfs(esw->dev))
1275 		mlx5_del_flow_rules(flows[vport->index]);
1276 
1277 	if (mlx5_ecpf_vport_exists(esw->dev)) {
1278 		vport = mlx5_eswitch_get_vport(esw, MLX5_VPORT_ECPF);
1279 		mlx5_del_flow_rules(flows[vport->index]);
1280 	}
1281 
1282 	if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1283 		vport = mlx5_eswitch_get_vport(esw, MLX5_VPORT_PF);
1284 		mlx5_del_flow_rules(flows[vport->index]);
1285 	}
1286 	kvfree(flows);
1287 }
1288 
1289 static int esw_add_fdb_miss_rule(struct mlx5_eswitch *esw)
1290 {
1291 	struct mlx5_flow_act flow_act = {0};
1292 	struct mlx5_flow_destination dest = {};
1293 	struct mlx5_flow_handle *flow_rule = NULL;
1294 	struct mlx5_flow_spec *spec;
1295 	void *headers_c;
1296 	void *headers_v;
1297 	int err = 0;
1298 	u8 *dmac_c;
1299 	u8 *dmac_v;
1300 
1301 	spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1302 	if (!spec) {
1303 		err = -ENOMEM;
1304 		goto out;
1305 	}
1306 
1307 	spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
1308 	headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1309 				 outer_headers);
1310 	dmac_c = MLX5_ADDR_OF(fte_match_param, headers_c,
1311 			      outer_headers.dmac_47_16);
1312 	dmac_c[0] = 0x01;
1313 
1314 	dest.type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
1315 	dest.vport.num = esw->manager_vport;
1316 	flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
1317 
1318 	flow_rule = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb,
1319 					spec, &flow_act, &dest, 1);
1320 	if (IS_ERR(flow_rule)) {
1321 		err = PTR_ERR(flow_rule);
1322 		esw_warn(esw->dev,  "FDB: Failed to add unicast miss flow rule err %d\n", err);
1323 		goto out;
1324 	}
1325 
1326 	esw->fdb_table.offloads.miss_rule_uni = flow_rule;
1327 
1328 	headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1329 				 outer_headers);
1330 	dmac_v = MLX5_ADDR_OF(fte_match_param, headers_v,
1331 			      outer_headers.dmac_47_16);
1332 	dmac_v[0] = 0x01;
1333 	flow_rule = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb,
1334 					spec, &flow_act, &dest, 1);
1335 	if (IS_ERR(flow_rule)) {
1336 		err = PTR_ERR(flow_rule);
1337 		esw_warn(esw->dev, "FDB: Failed to add multicast miss flow rule err %d\n", err);
1338 		mlx5_del_flow_rules(esw->fdb_table.offloads.miss_rule_uni);
1339 		goto out;
1340 	}
1341 
1342 	esw->fdb_table.offloads.miss_rule_multi = flow_rule;
1343 
1344 out:
1345 	kvfree(spec);
1346 	return err;
1347 }
1348 
1349 struct mlx5_flow_handle *
1350 esw_add_restore_rule(struct mlx5_eswitch *esw, u32 tag)
1351 {
1352 	struct mlx5_flow_act flow_act = { .flags = FLOW_ACT_NO_APPEND, };
1353 	struct mlx5_flow_table *ft = esw->offloads.ft_offloads_restore;
1354 	struct mlx5_flow_context *flow_context;
1355 	struct mlx5_flow_handle *flow_rule;
1356 	struct mlx5_flow_destination dest;
1357 	struct mlx5_flow_spec *spec;
1358 	void *misc;
1359 
1360 	if (!mlx5_eswitch_reg_c1_loopback_supported(esw))
1361 		return ERR_PTR(-EOPNOTSUPP);
1362 
1363 	spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1364 	if (!spec)
1365 		return ERR_PTR(-ENOMEM);
1366 
1367 	misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1368 			    misc_parameters_2);
1369 	MLX5_SET(fte_match_set_misc2, misc, metadata_reg_c_0,
1370 		 ESW_REG_C0_USER_DATA_METADATA_MASK);
1371 	misc = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1372 			    misc_parameters_2);
1373 	MLX5_SET(fte_match_set_misc2, misc, metadata_reg_c_0, tag);
1374 	spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS_2;
1375 	flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST |
1376 			  MLX5_FLOW_CONTEXT_ACTION_MOD_HDR;
1377 	flow_act.modify_hdr = esw->offloads.restore_copy_hdr_id;
1378 
1379 	flow_context = &spec->flow_context;
1380 	flow_context->flags |= FLOW_CONTEXT_HAS_TAG;
1381 	flow_context->flow_tag = tag;
1382 	dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
1383 	dest.ft = esw->offloads.ft_offloads;
1384 
1385 	flow_rule = mlx5_add_flow_rules(ft, spec, &flow_act, &dest, 1);
1386 	kvfree(spec);
1387 
1388 	if (IS_ERR(flow_rule))
1389 		esw_warn(esw->dev,
1390 			 "Failed to create restore rule for tag: %d, err(%d)\n",
1391 			 tag, (int)PTR_ERR(flow_rule));
1392 
1393 	return flow_rule;
1394 }
1395 
1396 #define MAX_PF_SQ 256
1397 #define MAX_SQ_NVPORTS 32
1398 
1399 static void esw_set_flow_group_source_port(struct mlx5_eswitch *esw,
1400 					   u32 *flow_group_in)
1401 {
1402 	void *match_criteria = MLX5_ADDR_OF(create_flow_group_in,
1403 					    flow_group_in,
1404 					    match_criteria);
1405 
1406 	if (mlx5_eswitch_vport_match_metadata_enabled(esw)) {
1407 		MLX5_SET(create_flow_group_in, flow_group_in,
1408 			 match_criteria_enable,
1409 			 MLX5_MATCH_MISC_PARAMETERS_2);
1410 
1411 		MLX5_SET(fte_match_param, match_criteria,
1412 			 misc_parameters_2.metadata_reg_c_0,
1413 			 mlx5_eswitch_get_vport_metadata_mask());
1414 	} else {
1415 		MLX5_SET(create_flow_group_in, flow_group_in,
1416 			 match_criteria_enable,
1417 			 MLX5_MATCH_MISC_PARAMETERS);
1418 
1419 		MLX5_SET_TO_ONES(fte_match_param, match_criteria,
1420 				 misc_parameters.source_port);
1421 	}
1422 }
1423 
1424 #if IS_ENABLED(CONFIG_MLX5_CLS_ACT)
1425 static void esw_vport_tbl_put(struct mlx5_eswitch *esw)
1426 {
1427 	struct mlx5_vport_tbl_attr attr;
1428 	struct mlx5_vport *vport;
1429 	unsigned long i;
1430 
1431 	attr.chain = 0;
1432 	attr.prio = 1;
1433 	mlx5_esw_for_each_vport(esw, i, vport) {
1434 		attr.vport = vport->vport;
1435 		attr.vport_ns = &mlx5_esw_vport_tbl_mirror_ns;
1436 		mlx5_esw_vporttbl_put(esw, &attr);
1437 	}
1438 }
1439 
1440 static int esw_vport_tbl_get(struct mlx5_eswitch *esw)
1441 {
1442 	struct mlx5_vport_tbl_attr attr;
1443 	struct mlx5_flow_table *fdb;
1444 	struct mlx5_vport *vport;
1445 	unsigned long i;
1446 
1447 	attr.chain = 0;
1448 	attr.prio = 1;
1449 	mlx5_esw_for_each_vport(esw, i, vport) {
1450 		attr.vport = vport->vport;
1451 		attr.vport_ns = &mlx5_esw_vport_tbl_mirror_ns;
1452 		fdb = mlx5_esw_vporttbl_get(esw, &attr);
1453 		if (IS_ERR(fdb))
1454 			goto out;
1455 	}
1456 	return 0;
1457 
1458 out:
1459 	esw_vport_tbl_put(esw);
1460 	return PTR_ERR(fdb);
1461 }
1462 
1463 #define fdb_modify_header_fwd_to_table_supported(esw) \
1464 	(MLX5_CAP_ESW_FLOWTABLE((esw)->dev, fdb_modify_header_fwd_to_table))
1465 static void esw_init_chains_offload_flags(struct mlx5_eswitch *esw, u32 *flags)
1466 {
1467 	struct mlx5_core_dev *dev = esw->dev;
1468 
1469 	if (MLX5_CAP_ESW_FLOWTABLE_FDB(dev, ignore_flow_level))
1470 		*flags |= MLX5_CHAINS_IGNORE_FLOW_LEVEL_SUPPORTED;
1471 
1472 	if (!MLX5_CAP_ESW_FLOWTABLE(dev, multi_fdb_encap) &&
1473 	    esw->offloads.encap != DEVLINK_ESWITCH_ENCAP_MODE_NONE) {
1474 		*flags &= ~MLX5_CHAINS_AND_PRIOS_SUPPORTED;
1475 		esw_warn(dev, "Tc chains and priorities offload aren't supported, update firmware if needed\n");
1476 	} else if (!mlx5_eswitch_reg_c1_loopback_enabled(esw)) {
1477 		*flags &= ~MLX5_CHAINS_AND_PRIOS_SUPPORTED;
1478 		esw_warn(dev, "Tc chains and priorities offload aren't supported\n");
1479 	} else if (!fdb_modify_header_fwd_to_table_supported(esw)) {
1480 		/* Disabled when ttl workaround is needed, e.g
1481 		 * when ESWITCH_IPV4_TTL_MODIFY_ENABLE = true in mlxconfig
1482 		 */
1483 		esw_warn(dev,
1484 			 "Tc chains and priorities offload aren't supported, check firmware version, or mlxconfig settings\n");
1485 		*flags &= ~MLX5_CHAINS_AND_PRIOS_SUPPORTED;
1486 	} else {
1487 		*flags |= MLX5_CHAINS_AND_PRIOS_SUPPORTED;
1488 		esw_info(dev, "Supported tc chains and prios offload\n");
1489 	}
1490 
1491 	if (esw->offloads.encap != DEVLINK_ESWITCH_ENCAP_MODE_NONE)
1492 		*flags |= MLX5_CHAINS_FT_TUNNEL_SUPPORTED;
1493 }
1494 
1495 static int
1496 esw_chains_create(struct mlx5_eswitch *esw, struct mlx5_flow_table *miss_fdb)
1497 {
1498 	struct mlx5_core_dev *dev = esw->dev;
1499 	struct mlx5_flow_table *nf_ft, *ft;
1500 	struct mlx5_chains_attr attr = {};
1501 	struct mlx5_fs_chains *chains;
1502 	u32 fdb_max;
1503 	int err;
1504 
1505 	fdb_max = 1 << MLX5_CAP_ESW_FLOWTABLE_FDB(dev, log_max_ft_size);
1506 
1507 	esw_init_chains_offload_flags(esw, &attr.flags);
1508 	attr.ns = MLX5_FLOW_NAMESPACE_FDB;
1509 	attr.max_ft_sz = fdb_max;
1510 	attr.max_grp_num = esw->params.large_group_num;
1511 	attr.default_ft = miss_fdb;
1512 	attr.mapping = esw->offloads.reg_c0_obj_pool;
1513 
1514 	chains = mlx5_chains_create(dev, &attr);
1515 	if (IS_ERR(chains)) {
1516 		err = PTR_ERR(chains);
1517 		esw_warn(dev, "Failed to create fdb chains err(%d)\n", err);
1518 		return err;
1519 	}
1520 
1521 	esw->fdb_table.offloads.esw_chains_priv = chains;
1522 
1523 	/* Create tc_end_ft which is the always created ft chain */
1524 	nf_ft = mlx5_chains_get_table(chains, mlx5_chains_get_nf_ft_chain(chains),
1525 				      1, 0);
1526 	if (IS_ERR(nf_ft)) {
1527 		err = PTR_ERR(nf_ft);
1528 		goto nf_ft_err;
1529 	}
1530 
1531 	/* Always open the root for fast path */
1532 	ft = mlx5_chains_get_table(chains, 0, 1, 0);
1533 	if (IS_ERR(ft)) {
1534 		err = PTR_ERR(ft);
1535 		goto level_0_err;
1536 	}
1537 
1538 	/* Open level 1 for split fdb rules now if prios isn't supported  */
1539 	if (!mlx5_chains_prios_supported(chains)) {
1540 		err = esw_vport_tbl_get(esw);
1541 		if (err)
1542 			goto level_1_err;
1543 	}
1544 
1545 	mlx5_chains_set_end_ft(chains, nf_ft);
1546 
1547 	return 0;
1548 
1549 level_1_err:
1550 	mlx5_chains_put_table(chains, 0, 1, 0);
1551 level_0_err:
1552 	mlx5_chains_put_table(chains, mlx5_chains_get_nf_ft_chain(chains), 1, 0);
1553 nf_ft_err:
1554 	mlx5_chains_destroy(chains);
1555 	esw->fdb_table.offloads.esw_chains_priv = NULL;
1556 
1557 	return err;
1558 }
1559 
1560 static void
1561 esw_chains_destroy(struct mlx5_eswitch *esw, struct mlx5_fs_chains *chains)
1562 {
1563 	if (!mlx5_chains_prios_supported(chains))
1564 		esw_vport_tbl_put(esw);
1565 	mlx5_chains_put_table(chains, 0, 1, 0);
1566 	mlx5_chains_put_table(chains, mlx5_chains_get_nf_ft_chain(chains), 1, 0);
1567 	mlx5_chains_destroy(chains);
1568 }
1569 
1570 #else /* CONFIG_MLX5_CLS_ACT */
1571 
1572 static int
1573 esw_chains_create(struct mlx5_eswitch *esw, struct mlx5_flow_table *miss_fdb)
1574 { return 0; }
1575 
1576 static void
1577 esw_chains_destroy(struct mlx5_eswitch *esw, struct mlx5_fs_chains *chains)
1578 {}
1579 
1580 #endif
1581 
1582 static int esw_create_offloads_fdb_tables(struct mlx5_eswitch *esw)
1583 {
1584 	int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1585 	struct mlx5_flow_table_attr ft_attr = {};
1586 	int num_vfs, table_size, ix, err = 0;
1587 	struct mlx5_core_dev *dev = esw->dev;
1588 	struct mlx5_flow_namespace *root_ns;
1589 	struct mlx5_flow_table *fdb = NULL;
1590 	u32 flags = 0, *flow_group_in;
1591 	struct mlx5_flow_group *g;
1592 	void *match_criteria;
1593 	u8 *dmac;
1594 
1595 	esw_debug(esw->dev, "Create offloads FDB Tables\n");
1596 
1597 	flow_group_in = kvzalloc(inlen, GFP_KERNEL);
1598 	if (!flow_group_in)
1599 		return -ENOMEM;
1600 
1601 	root_ns = mlx5_get_flow_namespace(dev, MLX5_FLOW_NAMESPACE_FDB);
1602 	if (!root_ns) {
1603 		esw_warn(dev, "Failed to get FDB flow namespace\n");
1604 		err = -EOPNOTSUPP;
1605 		goto ns_err;
1606 	}
1607 	esw->fdb_table.offloads.ns = root_ns;
1608 	err = mlx5_flow_namespace_set_mode(root_ns,
1609 					   esw->dev->priv.steering->mode);
1610 	if (err) {
1611 		esw_warn(dev, "Failed to set FDB namespace steering mode\n");
1612 		goto ns_err;
1613 	}
1614 
1615 	table_size = esw->total_vports * MAX_SQ_NVPORTS + MAX_PF_SQ +
1616 		MLX5_ESW_MISS_FLOWS + esw->total_vports + esw->esw_funcs.num_vfs;
1617 
1618 	/* create the slow path fdb with encap set, so further table instances
1619 	 * can be created at run time while VFs are probed if the FW allows that.
1620 	 */
1621 	if (esw->offloads.encap != DEVLINK_ESWITCH_ENCAP_MODE_NONE)
1622 		flags |= (MLX5_FLOW_TABLE_TUNNEL_EN_REFORMAT |
1623 			  MLX5_FLOW_TABLE_TUNNEL_EN_DECAP);
1624 
1625 	ft_attr.flags = flags;
1626 	ft_attr.max_fte = table_size;
1627 	ft_attr.prio = FDB_SLOW_PATH;
1628 
1629 	fdb = mlx5_create_flow_table(root_ns, &ft_attr);
1630 	if (IS_ERR(fdb)) {
1631 		err = PTR_ERR(fdb);
1632 		esw_warn(dev, "Failed to create slow path FDB Table err %d\n", err);
1633 		goto slow_fdb_err;
1634 	}
1635 	esw->fdb_table.offloads.slow_fdb = fdb;
1636 
1637 	/* Create empty TC-miss managed table. This allows plugging in following
1638 	 * priorities without directly exposing their level 0 table to
1639 	 * eswitch_offloads and passing it as miss_fdb to following call to
1640 	 * esw_chains_create().
1641 	 */
1642 	memset(&ft_attr, 0, sizeof(ft_attr));
1643 	ft_attr.prio = FDB_TC_MISS;
1644 	esw->fdb_table.offloads.tc_miss_table = mlx5_create_flow_table(root_ns, &ft_attr);
1645 	if (IS_ERR(esw->fdb_table.offloads.tc_miss_table)) {
1646 		err = PTR_ERR(esw->fdb_table.offloads.tc_miss_table);
1647 		esw_warn(dev, "Failed to create TC miss FDB Table err %d\n", err);
1648 		goto tc_miss_table_err;
1649 	}
1650 
1651 	err = esw_chains_create(esw, esw->fdb_table.offloads.tc_miss_table);
1652 	if (err) {
1653 		esw_warn(dev, "Failed to open fdb chains err(%d)\n", err);
1654 		goto fdb_chains_err;
1655 	}
1656 
1657 	/* create send-to-vport group */
1658 	MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
1659 		 MLX5_MATCH_MISC_PARAMETERS);
1660 
1661 	match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
1662 
1663 	MLX5_SET_TO_ONES(fte_match_param, match_criteria, misc_parameters.source_sqn);
1664 	MLX5_SET_TO_ONES(fte_match_param, match_criteria, misc_parameters.source_port);
1665 	if (MLX5_CAP_ESW(esw->dev, merged_eswitch)) {
1666 		MLX5_SET_TO_ONES(fte_match_param, match_criteria,
1667 				 misc_parameters.source_eswitch_owner_vhca_id);
1668 		MLX5_SET(create_flow_group_in, flow_group_in,
1669 			 source_eswitch_owner_vhca_id_valid, 1);
1670 	}
1671 
1672 	ix = esw->total_vports * MAX_SQ_NVPORTS + MAX_PF_SQ;
1673 	MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
1674 	MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, ix - 1);
1675 
1676 	g = mlx5_create_flow_group(fdb, flow_group_in);
1677 	if (IS_ERR(g)) {
1678 		err = PTR_ERR(g);
1679 		esw_warn(dev, "Failed to create send-to-vport flow group err(%d)\n", err);
1680 		goto send_vport_err;
1681 	}
1682 	esw->fdb_table.offloads.send_to_vport_grp = g;
1683 
1684 	if (esw_src_port_rewrite_supported(esw)) {
1685 		/* meta send to vport */
1686 		memset(flow_group_in, 0, inlen);
1687 		MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
1688 			 MLX5_MATCH_MISC_PARAMETERS_2);
1689 
1690 		match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
1691 
1692 		MLX5_SET(fte_match_param, match_criteria,
1693 			 misc_parameters_2.metadata_reg_c_0,
1694 			 mlx5_eswitch_get_vport_metadata_mask());
1695 		MLX5_SET(fte_match_param, match_criteria,
1696 			 misc_parameters_2.metadata_reg_c_1, ESW_TUN_MASK);
1697 
1698 		num_vfs = esw->esw_funcs.num_vfs;
1699 		if (num_vfs) {
1700 			MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, ix);
1701 			MLX5_SET(create_flow_group_in, flow_group_in,
1702 				 end_flow_index, ix + num_vfs - 1);
1703 			ix += num_vfs;
1704 
1705 			g = mlx5_create_flow_group(fdb, flow_group_in);
1706 			if (IS_ERR(g)) {
1707 				err = PTR_ERR(g);
1708 				esw_warn(dev, "Failed to create send-to-vport meta flow group err(%d)\n",
1709 					 err);
1710 				goto send_vport_meta_err;
1711 			}
1712 			esw->fdb_table.offloads.send_to_vport_meta_grp = g;
1713 
1714 			err = mlx5_eswitch_add_send_to_vport_meta_rules(esw);
1715 			if (err)
1716 				goto meta_rule_err;
1717 		}
1718 	}
1719 
1720 	if (MLX5_CAP_ESW(esw->dev, merged_eswitch)) {
1721 		/* create peer esw miss group */
1722 		memset(flow_group_in, 0, inlen);
1723 
1724 		esw_set_flow_group_source_port(esw, flow_group_in);
1725 
1726 		if (!mlx5_eswitch_vport_match_metadata_enabled(esw)) {
1727 			match_criteria = MLX5_ADDR_OF(create_flow_group_in,
1728 						      flow_group_in,
1729 						      match_criteria);
1730 
1731 			MLX5_SET_TO_ONES(fte_match_param, match_criteria,
1732 					 misc_parameters.source_eswitch_owner_vhca_id);
1733 
1734 			MLX5_SET(create_flow_group_in, flow_group_in,
1735 				 source_eswitch_owner_vhca_id_valid, 1);
1736 		}
1737 
1738 		MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, ix);
1739 		MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index,
1740 			 ix + esw->total_vports - 1);
1741 		ix += esw->total_vports;
1742 
1743 		g = mlx5_create_flow_group(fdb, flow_group_in);
1744 		if (IS_ERR(g)) {
1745 			err = PTR_ERR(g);
1746 			esw_warn(dev, "Failed to create peer miss flow group err(%d)\n", err);
1747 			goto peer_miss_err;
1748 		}
1749 		esw->fdb_table.offloads.peer_miss_grp = g;
1750 	}
1751 
1752 	/* create miss group */
1753 	memset(flow_group_in, 0, inlen);
1754 	MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
1755 		 MLX5_MATCH_OUTER_HEADERS);
1756 	match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in,
1757 				      match_criteria);
1758 	dmac = MLX5_ADDR_OF(fte_match_param, match_criteria,
1759 			    outer_headers.dmac_47_16);
1760 	dmac[0] = 0x01;
1761 
1762 	MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, ix);
1763 	MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index,
1764 		 ix + MLX5_ESW_MISS_FLOWS);
1765 
1766 	g = mlx5_create_flow_group(fdb, flow_group_in);
1767 	if (IS_ERR(g)) {
1768 		err = PTR_ERR(g);
1769 		esw_warn(dev, "Failed to create miss flow group err(%d)\n", err);
1770 		goto miss_err;
1771 	}
1772 	esw->fdb_table.offloads.miss_grp = g;
1773 
1774 	err = esw_add_fdb_miss_rule(esw);
1775 	if (err)
1776 		goto miss_rule_err;
1777 
1778 	kvfree(flow_group_in);
1779 	return 0;
1780 
1781 miss_rule_err:
1782 	mlx5_destroy_flow_group(esw->fdb_table.offloads.miss_grp);
1783 miss_err:
1784 	if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
1785 		mlx5_destroy_flow_group(esw->fdb_table.offloads.peer_miss_grp);
1786 peer_miss_err:
1787 	mlx5_eswitch_del_send_to_vport_meta_rules(esw);
1788 meta_rule_err:
1789 	if (esw->fdb_table.offloads.send_to_vport_meta_grp)
1790 		mlx5_destroy_flow_group(esw->fdb_table.offloads.send_to_vport_meta_grp);
1791 send_vport_meta_err:
1792 	mlx5_destroy_flow_group(esw->fdb_table.offloads.send_to_vport_grp);
1793 send_vport_err:
1794 	esw_chains_destroy(esw, esw_chains(esw));
1795 fdb_chains_err:
1796 	mlx5_destroy_flow_table(esw->fdb_table.offloads.tc_miss_table);
1797 tc_miss_table_err:
1798 	mlx5_destroy_flow_table(esw->fdb_table.offloads.slow_fdb);
1799 slow_fdb_err:
1800 	/* Holds true only as long as DMFS is the default */
1801 	mlx5_flow_namespace_set_mode(root_ns, MLX5_FLOW_STEERING_MODE_DMFS);
1802 ns_err:
1803 	kvfree(flow_group_in);
1804 	return err;
1805 }
1806 
1807 static void esw_destroy_offloads_fdb_tables(struct mlx5_eswitch *esw)
1808 {
1809 	if (!esw->fdb_table.offloads.slow_fdb)
1810 		return;
1811 
1812 	esw_debug(esw->dev, "Destroy offloads FDB Tables\n");
1813 	mlx5_del_flow_rules(esw->fdb_table.offloads.miss_rule_multi);
1814 	mlx5_del_flow_rules(esw->fdb_table.offloads.miss_rule_uni);
1815 	mlx5_eswitch_del_send_to_vport_meta_rules(esw);
1816 	mlx5_destroy_flow_group(esw->fdb_table.offloads.send_to_vport_grp);
1817 	if (esw->fdb_table.offloads.send_to_vport_meta_grp)
1818 		mlx5_destroy_flow_group(esw->fdb_table.offloads.send_to_vport_meta_grp);
1819 	if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
1820 		mlx5_destroy_flow_group(esw->fdb_table.offloads.peer_miss_grp);
1821 	mlx5_destroy_flow_group(esw->fdb_table.offloads.miss_grp);
1822 
1823 	esw_chains_destroy(esw, esw_chains(esw));
1824 
1825 	mlx5_destroy_flow_table(esw->fdb_table.offloads.tc_miss_table);
1826 	mlx5_destroy_flow_table(esw->fdb_table.offloads.slow_fdb);
1827 	/* Holds true only as long as DMFS is the default */
1828 	mlx5_flow_namespace_set_mode(esw->fdb_table.offloads.ns,
1829 				     MLX5_FLOW_STEERING_MODE_DMFS);
1830 	atomic64_set(&esw->user_count, 0);
1831 }
1832 
1833 static int esw_create_offloads_table(struct mlx5_eswitch *esw)
1834 {
1835 	struct mlx5_flow_table_attr ft_attr = {};
1836 	struct mlx5_core_dev *dev = esw->dev;
1837 	struct mlx5_flow_table *ft_offloads;
1838 	struct mlx5_flow_namespace *ns;
1839 	int err = 0;
1840 
1841 	ns = mlx5_get_flow_namespace(dev, MLX5_FLOW_NAMESPACE_OFFLOADS);
1842 	if (!ns) {
1843 		esw_warn(esw->dev, "Failed to get offloads flow namespace\n");
1844 		return -EOPNOTSUPP;
1845 	}
1846 
1847 	ft_attr.max_fte = esw->total_vports + MLX5_ESW_MISS_FLOWS;
1848 	ft_attr.prio = 1;
1849 
1850 	ft_offloads = mlx5_create_flow_table(ns, &ft_attr);
1851 	if (IS_ERR(ft_offloads)) {
1852 		err = PTR_ERR(ft_offloads);
1853 		esw_warn(esw->dev, "Failed to create offloads table, err %d\n", err);
1854 		return err;
1855 	}
1856 
1857 	esw->offloads.ft_offloads = ft_offloads;
1858 	return 0;
1859 }
1860 
1861 static void esw_destroy_offloads_table(struct mlx5_eswitch *esw)
1862 {
1863 	struct mlx5_esw_offload *offloads = &esw->offloads;
1864 
1865 	mlx5_destroy_flow_table(offloads->ft_offloads);
1866 }
1867 
1868 static int esw_create_vport_rx_group(struct mlx5_eswitch *esw)
1869 {
1870 	int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1871 	struct mlx5_flow_group *g;
1872 	u32 *flow_group_in;
1873 	int nvports;
1874 	int err = 0;
1875 
1876 	nvports = esw->total_vports + MLX5_ESW_MISS_FLOWS;
1877 	flow_group_in = kvzalloc(inlen, GFP_KERNEL);
1878 	if (!flow_group_in)
1879 		return -ENOMEM;
1880 
1881 	/* create vport rx group */
1882 	esw_set_flow_group_source_port(esw, flow_group_in);
1883 
1884 	MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
1885 	MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, nvports - 1);
1886 
1887 	g = mlx5_create_flow_group(esw->offloads.ft_offloads, flow_group_in);
1888 
1889 	if (IS_ERR(g)) {
1890 		err = PTR_ERR(g);
1891 		mlx5_core_warn(esw->dev, "Failed to create vport rx group err %d\n", err);
1892 		goto out;
1893 	}
1894 
1895 	esw->offloads.vport_rx_group = g;
1896 out:
1897 	kvfree(flow_group_in);
1898 	return err;
1899 }
1900 
1901 static void esw_destroy_vport_rx_group(struct mlx5_eswitch *esw)
1902 {
1903 	mlx5_destroy_flow_group(esw->offloads.vport_rx_group);
1904 }
1905 
1906 struct mlx5_flow_handle *
1907 mlx5_eswitch_create_vport_rx_rule(struct mlx5_eswitch *esw, u16 vport,
1908 				  struct mlx5_flow_destination *dest)
1909 {
1910 	struct mlx5_flow_act flow_act = {0};
1911 	struct mlx5_flow_handle *flow_rule;
1912 	struct mlx5_flow_spec *spec;
1913 	void *misc;
1914 
1915 	spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1916 	if (!spec) {
1917 		flow_rule = ERR_PTR(-ENOMEM);
1918 		goto out;
1919 	}
1920 
1921 	if (mlx5_eswitch_vport_match_metadata_enabled(esw)) {
1922 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters_2);
1923 		MLX5_SET(fte_match_set_misc2, misc, metadata_reg_c_0,
1924 			 mlx5_eswitch_get_vport_metadata_for_match(esw, vport));
1925 
1926 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters_2);
1927 		MLX5_SET(fte_match_set_misc2, misc, metadata_reg_c_0,
1928 			 mlx5_eswitch_get_vport_metadata_mask());
1929 
1930 		spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS_2;
1931 	} else {
1932 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters);
1933 		MLX5_SET(fte_match_set_misc, misc, source_port, vport);
1934 
1935 		misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters);
1936 		MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
1937 
1938 		spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS;
1939 	}
1940 
1941 	flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
1942 	flow_rule = mlx5_add_flow_rules(esw->offloads.ft_offloads, spec,
1943 					&flow_act, dest, 1);
1944 	if (IS_ERR(flow_rule)) {
1945 		esw_warn(esw->dev, "fs offloads: Failed to add vport rx rule err %ld\n", PTR_ERR(flow_rule));
1946 		goto out;
1947 	}
1948 
1949 out:
1950 	kvfree(spec);
1951 	return flow_rule;
1952 }
1953 
1954 static int mlx5_eswitch_inline_mode_get(struct mlx5_eswitch *esw, u8 *mode)
1955 {
1956 	u8 prev_mlx5_mode, mlx5_mode = MLX5_INLINE_MODE_L2;
1957 	struct mlx5_core_dev *dev = esw->dev;
1958 	struct mlx5_vport *vport;
1959 	unsigned long i;
1960 
1961 	if (!MLX5_CAP_GEN(dev, vport_group_manager))
1962 		return -EOPNOTSUPP;
1963 
1964 	if (esw->mode == MLX5_ESWITCH_NONE)
1965 		return -EOPNOTSUPP;
1966 
1967 	switch (MLX5_CAP_ETH(dev, wqe_inline_mode)) {
1968 	case MLX5_CAP_INLINE_MODE_NOT_REQUIRED:
1969 		mlx5_mode = MLX5_INLINE_MODE_NONE;
1970 		goto out;
1971 	case MLX5_CAP_INLINE_MODE_L2:
1972 		mlx5_mode = MLX5_INLINE_MODE_L2;
1973 		goto out;
1974 	case MLX5_CAP_INLINE_MODE_VPORT_CONTEXT:
1975 		goto query_vports;
1976 	}
1977 
1978 query_vports:
1979 	mlx5_query_nic_vport_min_inline(dev, esw->first_host_vport, &prev_mlx5_mode);
1980 	mlx5_esw_for_each_host_func_vport(esw, i, vport, esw->esw_funcs.num_vfs) {
1981 		mlx5_query_nic_vport_min_inline(dev, vport->vport, &mlx5_mode);
1982 		if (prev_mlx5_mode != mlx5_mode)
1983 			return -EINVAL;
1984 		prev_mlx5_mode = mlx5_mode;
1985 	}
1986 
1987 out:
1988 	*mode = mlx5_mode;
1989 	return 0;
1990 }
1991 
1992 static void esw_destroy_restore_table(struct mlx5_eswitch *esw)
1993 {
1994 	struct mlx5_esw_offload *offloads = &esw->offloads;
1995 
1996 	if (!mlx5_eswitch_reg_c1_loopback_supported(esw))
1997 		return;
1998 
1999 	mlx5_modify_header_dealloc(esw->dev, offloads->restore_copy_hdr_id);
2000 	mlx5_destroy_flow_group(offloads->restore_group);
2001 	mlx5_destroy_flow_table(offloads->ft_offloads_restore);
2002 }
2003 
2004 static int esw_create_restore_table(struct mlx5_eswitch *esw)
2005 {
2006 	u8 modact[MLX5_UN_SZ_BYTES(set_add_copy_action_in_auto)] = {};
2007 	int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
2008 	struct mlx5_flow_table_attr ft_attr = {};
2009 	struct mlx5_core_dev *dev = esw->dev;
2010 	struct mlx5_flow_namespace *ns;
2011 	struct mlx5_modify_hdr *mod_hdr;
2012 	void *match_criteria, *misc;
2013 	struct mlx5_flow_table *ft;
2014 	struct mlx5_flow_group *g;
2015 	u32 *flow_group_in;
2016 	int err = 0;
2017 
2018 	if (!mlx5_eswitch_reg_c1_loopback_supported(esw))
2019 		return 0;
2020 
2021 	ns = mlx5_get_flow_namespace(dev, MLX5_FLOW_NAMESPACE_OFFLOADS);
2022 	if (!ns) {
2023 		esw_warn(esw->dev, "Failed to get offloads flow namespace\n");
2024 		return -EOPNOTSUPP;
2025 	}
2026 
2027 	flow_group_in = kvzalloc(inlen, GFP_KERNEL);
2028 	if (!flow_group_in) {
2029 		err = -ENOMEM;
2030 		goto out_free;
2031 	}
2032 
2033 	ft_attr.max_fte = 1 << ESW_REG_C0_USER_DATA_METADATA_BITS;
2034 	ft = mlx5_create_flow_table(ns, &ft_attr);
2035 	if (IS_ERR(ft)) {
2036 		err = PTR_ERR(ft);
2037 		esw_warn(esw->dev, "Failed to create restore table, err %d\n",
2038 			 err);
2039 		goto out_free;
2040 	}
2041 
2042 	match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in,
2043 				      match_criteria);
2044 	misc = MLX5_ADDR_OF(fte_match_param, match_criteria,
2045 			    misc_parameters_2);
2046 
2047 	MLX5_SET(fte_match_set_misc2, misc, metadata_reg_c_0,
2048 		 ESW_REG_C0_USER_DATA_METADATA_MASK);
2049 	MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
2050 	MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index,
2051 		 ft_attr.max_fte - 1);
2052 	MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
2053 		 MLX5_MATCH_MISC_PARAMETERS_2);
2054 	g = mlx5_create_flow_group(ft, flow_group_in);
2055 	if (IS_ERR(g)) {
2056 		err = PTR_ERR(g);
2057 		esw_warn(dev, "Failed to create restore flow group, err: %d\n",
2058 			 err);
2059 		goto err_group;
2060 	}
2061 
2062 	MLX5_SET(copy_action_in, modact, action_type, MLX5_ACTION_TYPE_COPY);
2063 	MLX5_SET(copy_action_in, modact, src_field,
2064 		 MLX5_ACTION_IN_FIELD_METADATA_REG_C_1);
2065 	MLX5_SET(copy_action_in, modact, dst_field,
2066 		 MLX5_ACTION_IN_FIELD_METADATA_REG_B);
2067 	mod_hdr = mlx5_modify_header_alloc(esw->dev,
2068 					   MLX5_FLOW_NAMESPACE_KERNEL, 1,
2069 					   modact);
2070 	if (IS_ERR(mod_hdr)) {
2071 		err = PTR_ERR(mod_hdr);
2072 		esw_warn(dev, "Failed to create restore mod header, err: %d\n",
2073 			 err);
2074 		goto err_mod_hdr;
2075 	}
2076 
2077 	esw->offloads.ft_offloads_restore = ft;
2078 	esw->offloads.restore_group = g;
2079 	esw->offloads.restore_copy_hdr_id = mod_hdr;
2080 
2081 	kvfree(flow_group_in);
2082 
2083 	return 0;
2084 
2085 err_mod_hdr:
2086 	mlx5_destroy_flow_group(g);
2087 err_group:
2088 	mlx5_destroy_flow_table(ft);
2089 out_free:
2090 	kvfree(flow_group_in);
2091 
2092 	return err;
2093 }
2094 
2095 static int esw_offloads_start(struct mlx5_eswitch *esw,
2096 			      struct netlink_ext_ack *extack)
2097 {
2098 	int err, err1;
2099 
2100 	mlx5_eswitch_disable_locked(esw, false);
2101 	err = mlx5_eswitch_enable_locked(esw, MLX5_ESWITCH_OFFLOADS,
2102 					 esw->dev->priv.sriov.num_vfs);
2103 	if (err) {
2104 		NL_SET_ERR_MSG_MOD(extack,
2105 				   "Failed setting eswitch to offloads");
2106 		err1 = mlx5_eswitch_enable_locked(esw, MLX5_ESWITCH_LEGACY,
2107 						  MLX5_ESWITCH_IGNORE_NUM_VFS);
2108 		if (err1) {
2109 			NL_SET_ERR_MSG_MOD(extack,
2110 					   "Failed setting eswitch back to legacy");
2111 		}
2112 	}
2113 	if (esw->offloads.inline_mode == MLX5_INLINE_MODE_NONE) {
2114 		if (mlx5_eswitch_inline_mode_get(esw,
2115 						 &esw->offloads.inline_mode)) {
2116 			esw->offloads.inline_mode = MLX5_INLINE_MODE_L2;
2117 			NL_SET_ERR_MSG_MOD(extack,
2118 					   "Inline mode is different between vports");
2119 		}
2120 	}
2121 	return err;
2122 }
2123 
2124 static void mlx5_esw_offloads_rep_mark_set(struct mlx5_eswitch *esw,
2125 					   struct mlx5_eswitch_rep *rep,
2126 					   xa_mark_t mark)
2127 {
2128 	bool mark_set;
2129 
2130 	/* Copy the mark from vport to its rep */
2131 	mark_set = xa_get_mark(&esw->vports, rep->vport, mark);
2132 	if (mark_set)
2133 		xa_set_mark(&esw->offloads.vport_reps, rep->vport, mark);
2134 }
2135 
2136 static int mlx5_esw_offloads_rep_init(struct mlx5_eswitch *esw, const struct mlx5_vport *vport)
2137 {
2138 	struct mlx5_eswitch_rep *rep;
2139 	int rep_type;
2140 	int err;
2141 
2142 	rep = kzalloc(sizeof(*rep), GFP_KERNEL);
2143 	if (!rep)
2144 		return -ENOMEM;
2145 
2146 	rep->vport = vport->vport;
2147 	rep->vport_index = vport->index;
2148 	for (rep_type = 0; rep_type < NUM_REP_TYPES; rep_type++)
2149 		atomic_set(&rep->rep_data[rep_type].state, REP_UNREGISTERED);
2150 
2151 	err = xa_insert(&esw->offloads.vport_reps, rep->vport, rep, GFP_KERNEL);
2152 	if (err)
2153 		goto insert_err;
2154 
2155 	mlx5_esw_offloads_rep_mark_set(esw, rep, MLX5_ESW_VPT_HOST_FN);
2156 	mlx5_esw_offloads_rep_mark_set(esw, rep, MLX5_ESW_VPT_VF);
2157 	mlx5_esw_offloads_rep_mark_set(esw, rep, MLX5_ESW_VPT_SF);
2158 	return 0;
2159 
2160 insert_err:
2161 	kfree(rep);
2162 	return err;
2163 }
2164 
2165 static void mlx5_esw_offloads_rep_cleanup(struct mlx5_eswitch *esw,
2166 					  struct mlx5_eswitch_rep *rep)
2167 {
2168 	xa_erase(&esw->offloads.vport_reps, rep->vport);
2169 	kfree(rep);
2170 }
2171 
2172 void esw_offloads_cleanup_reps(struct mlx5_eswitch *esw)
2173 {
2174 	struct mlx5_eswitch_rep *rep;
2175 	unsigned long i;
2176 
2177 	mlx5_esw_for_each_rep(esw, i, rep)
2178 		mlx5_esw_offloads_rep_cleanup(esw, rep);
2179 	xa_destroy(&esw->offloads.vport_reps);
2180 }
2181 
2182 int esw_offloads_init_reps(struct mlx5_eswitch *esw)
2183 {
2184 	struct mlx5_vport *vport;
2185 	unsigned long i;
2186 	int err;
2187 
2188 	xa_init(&esw->offloads.vport_reps);
2189 
2190 	mlx5_esw_for_each_vport(esw, i, vport) {
2191 		err = mlx5_esw_offloads_rep_init(esw, vport);
2192 		if (err)
2193 			goto err;
2194 	}
2195 	return 0;
2196 
2197 err:
2198 	esw_offloads_cleanup_reps(esw);
2199 	return err;
2200 }
2201 
2202 static void __esw_offloads_unload_rep(struct mlx5_eswitch *esw,
2203 				      struct mlx5_eswitch_rep *rep, u8 rep_type)
2204 {
2205 	if (atomic_cmpxchg(&rep->rep_data[rep_type].state,
2206 			   REP_LOADED, REP_REGISTERED) == REP_LOADED)
2207 		esw->offloads.rep_ops[rep_type]->unload(rep);
2208 }
2209 
2210 static void __unload_reps_sf_vport(struct mlx5_eswitch *esw, u8 rep_type)
2211 {
2212 	struct mlx5_eswitch_rep *rep;
2213 	unsigned long i;
2214 
2215 	mlx5_esw_for_each_sf_rep(esw, i, rep)
2216 		__esw_offloads_unload_rep(esw, rep, rep_type);
2217 }
2218 
2219 static void __unload_reps_all_vport(struct mlx5_eswitch *esw, u8 rep_type)
2220 {
2221 	struct mlx5_eswitch_rep *rep;
2222 	unsigned long i;
2223 
2224 	__unload_reps_sf_vport(esw, rep_type);
2225 
2226 	mlx5_esw_for_each_vf_rep(esw, i, rep)
2227 		__esw_offloads_unload_rep(esw, rep, rep_type);
2228 
2229 	if (mlx5_ecpf_vport_exists(esw->dev)) {
2230 		rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_ECPF);
2231 		__esw_offloads_unload_rep(esw, rep, rep_type);
2232 	}
2233 
2234 	if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
2235 		rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_PF);
2236 		__esw_offloads_unload_rep(esw, rep, rep_type);
2237 	}
2238 
2239 	rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_UPLINK);
2240 	__esw_offloads_unload_rep(esw, rep, rep_type);
2241 }
2242 
2243 int mlx5_esw_offloads_rep_load(struct mlx5_eswitch *esw, u16 vport_num)
2244 {
2245 	struct mlx5_eswitch_rep *rep;
2246 	int rep_type;
2247 	int err;
2248 
2249 	rep = mlx5_eswitch_get_rep(esw, vport_num);
2250 	for (rep_type = 0; rep_type < NUM_REP_TYPES; rep_type++)
2251 		if (atomic_cmpxchg(&rep->rep_data[rep_type].state,
2252 				   REP_REGISTERED, REP_LOADED) == REP_REGISTERED) {
2253 			err = esw->offloads.rep_ops[rep_type]->load(esw->dev, rep);
2254 			if (err)
2255 				goto err_reps;
2256 		}
2257 
2258 	return 0;
2259 
2260 err_reps:
2261 	atomic_set(&rep->rep_data[rep_type].state, REP_REGISTERED);
2262 	for (--rep_type; rep_type >= 0; rep_type--)
2263 		__esw_offloads_unload_rep(esw, rep, rep_type);
2264 	return err;
2265 }
2266 
2267 void mlx5_esw_offloads_rep_unload(struct mlx5_eswitch *esw, u16 vport_num)
2268 {
2269 	struct mlx5_eswitch_rep *rep;
2270 	int rep_type;
2271 
2272 	rep = mlx5_eswitch_get_rep(esw, vport_num);
2273 	for (rep_type = NUM_REP_TYPES - 1; rep_type >= 0; rep_type--)
2274 		__esw_offloads_unload_rep(esw, rep, rep_type);
2275 }
2276 
2277 int esw_offloads_load_rep(struct mlx5_eswitch *esw, u16 vport_num)
2278 {
2279 	int err;
2280 
2281 	if (esw->mode != MLX5_ESWITCH_OFFLOADS)
2282 		return 0;
2283 
2284 	if (vport_num != MLX5_VPORT_UPLINK) {
2285 		err = mlx5_esw_offloads_devlink_port_register(esw, vport_num);
2286 		if (err)
2287 			return err;
2288 	}
2289 
2290 	err = mlx5_esw_offloads_rep_load(esw, vport_num);
2291 	if (err)
2292 		goto load_err;
2293 	return err;
2294 
2295 load_err:
2296 	if (vport_num != MLX5_VPORT_UPLINK)
2297 		mlx5_esw_offloads_devlink_port_unregister(esw, vport_num);
2298 	return err;
2299 }
2300 
2301 void esw_offloads_unload_rep(struct mlx5_eswitch *esw, u16 vport_num)
2302 {
2303 	if (esw->mode != MLX5_ESWITCH_OFFLOADS)
2304 		return;
2305 
2306 	mlx5_esw_offloads_rep_unload(esw, vport_num);
2307 
2308 	if (vport_num != MLX5_VPORT_UPLINK)
2309 		mlx5_esw_offloads_devlink_port_unregister(esw, vport_num);
2310 }
2311 
2312 #define ESW_OFFLOADS_DEVCOM_PAIR	(0)
2313 #define ESW_OFFLOADS_DEVCOM_UNPAIR	(1)
2314 
2315 static int mlx5_esw_offloads_pair(struct mlx5_eswitch *esw,
2316 				  struct mlx5_eswitch *peer_esw)
2317 {
2318 
2319 	return esw_add_fdb_peer_miss_rules(esw, peer_esw->dev);
2320 }
2321 
2322 static void mlx5_esw_offloads_unpair(struct mlx5_eswitch *esw)
2323 {
2324 #if IS_ENABLED(CONFIG_MLX5_CLS_ACT)
2325 	mlx5e_tc_clean_fdb_peer_flows(esw);
2326 #endif
2327 	esw_del_fdb_peer_miss_rules(esw);
2328 }
2329 
2330 static int mlx5_esw_offloads_set_ns_peer(struct mlx5_eswitch *esw,
2331 					 struct mlx5_eswitch *peer_esw,
2332 					 bool pair)
2333 {
2334 	struct mlx5_flow_root_namespace *peer_ns;
2335 	struct mlx5_flow_root_namespace *ns;
2336 	int err;
2337 
2338 	peer_ns = peer_esw->dev->priv.steering->fdb_root_ns;
2339 	ns = esw->dev->priv.steering->fdb_root_ns;
2340 
2341 	if (pair) {
2342 		err = mlx5_flow_namespace_set_peer(ns, peer_ns);
2343 		if (err)
2344 			return err;
2345 
2346 		err = mlx5_flow_namespace_set_peer(peer_ns, ns);
2347 		if (err) {
2348 			mlx5_flow_namespace_set_peer(ns, NULL);
2349 			return err;
2350 		}
2351 	} else {
2352 		mlx5_flow_namespace_set_peer(ns, NULL);
2353 		mlx5_flow_namespace_set_peer(peer_ns, NULL);
2354 	}
2355 
2356 	return 0;
2357 }
2358 
2359 static int mlx5_esw_offloads_devcom_event(int event,
2360 					  void *my_data,
2361 					  void *event_data)
2362 {
2363 	struct mlx5_eswitch *esw = my_data;
2364 	struct mlx5_devcom *devcom = esw->dev->priv.devcom;
2365 	struct mlx5_eswitch *peer_esw = event_data;
2366 	int err;
2367 
2368 	switch (event) {
2369 	case ESW_OFFLOADS_DEVCOM_PAIR:
2370 		if (mlx5_eswitch_vport_match_metadata_enabled(esw) !=
2371 		    mlx5_eswitch_vport_match_metadata_enabled(peer_esw))
2372 			break;
2373 
2374 		err = mlx5_esw_offloads_set_ns_peer(esw, peer_esw, true);
2375 		if (err)
2376 			goto err_out;
2377 		err = mlx5_esw_offloads_pair(esw, peer_esw);
2378 		if (err)
2379 			goto err_peer;
2380 
2381 		err = mlx5_esw_offloads_pair(peer_esw, esw);
2382 		if (err)
2383 			goto err_pair;
2384 
2385 		mlx5_devcom_set_paired(devcom, MLX5_DEVCOM_ESW_OFFLOADS, true);
2386 		break;
2387 
2388 	case ESW_OFFLOADS_DEVCOM_UNPAIR:
2389 		if (!mlx5_devcom_is_paired(devcom, MLX5_DEVCOM_ESW_OFFLOADS))
2390 			break;
2391 
2392 		mlx5_devcom_set_paired(devcom, MLX5_DEVCOM_ESW_OFFLOADS, false);
2393 		mlx5_esw_offloads_unpair(peer_esw);
2394 		mlx5_esw_offloads_unpair(esw);
2395 		mlx5_esw_offloads_set_ns_peer(esw, peer_esw, false);
2396 		break;
2397 	}
2398 
2399 	return 0;
2400 
2401 err_pair:
2402 	mlx5_esw_offloads_unpair(esw);
2403 err_peer:
2404 	mlx5_esw_offloads_set_ns_peer(esw, peer_esw, false);
2405 err_out:
2406 	mlx5_core_err(esw->dev, "esw offloads devcom event failure, event %u err %d",
2407 		      event, err);
2408 	return err;
2409 }
2410 
2411 static void esw_offloads_devcom_init(struct mlx5_eswitch *esw)
2412 {
2413 	struct mlx5_devcom *devcom = esw->dev->priv.devcom;
2414 
2415 	INIT_LIST_HEAD(&esw->offloads.peer_flows);
2416 	mutex_init(&esw->offloads.peer_mutex);
2417 
2418 	if (!MLX5_CAP_ESW(esw->dev, merged_eswitch))
2419 		return;
2420 
2421 	mlx5_devcom_register_component(devcom,
2422 				       MLX5_DEVCOM_ESW_OFFLOADS,
2423 				       mlx5_esw_offloads_devcom_event,
2424 				       esw);
2425 
2426 	mlx5_devcom_send_event(devcom,
2427 			       MLX5_DEVCOM_ESW_OFFLOADS,
2428 			       ESW_OFFLOADS_DEVCOM_PAIR, esw);
2429 }
2430 
2431 static void esw_offloads_devcom_cleanup(struct mlx5_eswitch *esw)
2432 {
2433 	struct mlx5_devcom *devcom = esw->dev->priv.devcom;
2434 
2435 	if (!MLX5_CAP_ESW(esw->dev, merged_eswitch))
2436 		return;
2437 
2438 	mlx5_devcom_send_event(devcom, MLX5_DEVCOM_ESW_OFFLOADS,
2439 			       ESW_OFFLOADS_DEVCOM_UNPAIR, esw);
2440 
2441 	mlx5_devcom_unregister_component(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
2442 }
2443 
2444 bool mlx5_esw_vport_match_metadata_supported(const struct mlx5_eswitch *esw)
2445 {
2446 	if (!MLX5_CAP_ESW(esw->dev, esw_uplink_ingress_acl))
2447 		return false;
2448 
2449 	if (!(MLX5_CAP_ESW_FLOWTABLE(esw->dev, fdb_to_vport_reg_c_id) &
2450 	      MLX5_FDB_TO_VPORT_REG_C_0))
2451 		return false;
2452 
2453 	if (!MLX5_CAP_ESW_FLOWTABLE(esw->dev, flow_source))
2454 		return false;
2455 
2456 	if (mlx5_core_is_ecpf_esw_manager(esw->dev) ||
2457 	    mlx5_ecpf_vport_exists(esw->dev))
2458 		return false;
2459 
2460 	return true;
2461 }
2462 
2463 u32 mlx5_esw_match_metadata_alloc(struct mlx5_eswitch *esw)
2464 {
2465 	u32 vport_end_ida = (1 << ESW_VPORT_BITS) - 1;
2466 	u32 max_pf_num = (1 << ESW_PFNUM_BITS) - 1;
2467 	u32 pf_num;
2468 	int id;
2469 
2470 	/* Only 4 bits of pf_num */
2471 	pf_num = PCI_FUNC(esw->dev->pdev->devfn);
2472 	if (pf_num > max_pf_num)
2473 		return 0;
2474 
2475 	/* Metadata is 4 bits of PFNUM and 12 bits of unique id */
2476 	/* Use only non-zero vport_id (1-4095) for all PF's */
2477 	id = ida_alloc_range(&esw->offloads.vport_metadata_ida, 1, vport_end_ida, GFP_KERNEL);
2478 	if (id < 0)
2479 		return 0;
2480 	id = (pf_num << ESW_VPORT_BITS) | id;
2481 	return id;
2482 }
2483 
2484 void mlx5_esw_match_metadata_free(struct mlx5_eswitch *esw, u32 metadata)
2485 {
2486 	u32 vport_bit_mask = (1 << ESW_VPORT_BITS) - 1;
2487 
2488 	/* Metadata contains only 12 bits of actual ida id */
2489 	ida_free(&esw->offloads.vport_metadata_ida, metadata & vport_bit_mask);
2490 }
2491 
2492 static int esw_offloads_vport_metadata_setup(struct mlx5_eswitch *esw,
2493 					     struct mlx5_vport *vport)
2494 {
2495 	vport->default_metadata = mlx5_esw_match_metadata_alloc(esw);
2496 	vport->metadata = vport->default_metadata;
2497 	return vport->metadata ? 0 : -ENOSPC;
2498 }
2499 
2500 static void esw_offloads_vport_metadata_cleanup(struct mlx5_eswitch *esw,
2501 						struct mlx5_vport *vport)
2502 {
2503 	if (!vport->default_metadata)
2504 		return;
2505 
2506 	WARN_ON(vport->metadata != vport->default_metadata);
2507 	mlx5_esw_match_metadata_free(esw, vport->default_metadata);
2508 }
2509 
2510 static void esw_offloads_metadata_uninit(struct mlx5_eswitch *esw)
2511 {
2512 	struct mlx5_vport *vport;
2513 	unsigned long i;
2514 
2515 	if (!mlx5_eswitch_vport_match_metadata_enabled(esw))
2516 		return;
2517 
2518 	mlx5_esw_for_each_vport(esw, i, vport)
2519 		esw_offloads_vport_metadata_cleanup(esw, vport);
2520 }
2521 
2522 static int esw_offloads_metadata_init(struct mlx5_eswitch *esw)
2523 {
2524 	struct mlx5_vport *vport;
2525 	unsigned long i;
2526 	int err;
2527 
2528 	if (!mlx5_eswitch_vport_match_metadata_enabled(esw))
2529 		return 0;
2530 
2531 	mlx5_esw_for_each_vport(esw, i, vport) {
2532 		err = esw_offloads_vport_metadata_setup(esw, vport);
2533 		if (err)
2534 			goto metadata_err;
2535 	}
2536 
2537 	return 0;
2538 
2539 metadata_err:
2540 	esw_offloads_metadata_uninit(esw);
2541 	return err;
2542 }
2543 
2544 int mlx5_esw_offloads_vport_metadata_set(struct mlx5_eswitch *esw, bool enable)
2545 {
2546 	int err = 0;
2547 
2548 	down_write(&esw->mode_lock);
2549 	if (esw->mode != MLX5_ESWITCH_NONE) {
2550 		err = -EBUSY;
2551 		goto done;
2552 	}
2553 	if (!mlx5_esw_vport_match_metadata_supported(esw)) {
2554 		err = -EOPNOTSUPP;
2555 		goto done;
2556 	}
2557 	if (enable)
2558 		esw->flags |= MLX5_ESWITCH_VPORT_MATCH_METADATA;
2559 	else
2560 		esw->flags &= ~MLX5_ESWITCH_VPORT_MATCH_METADATA;
2561 done:
2562 	up_write(&esw->mode_lock);
2563 	return err;
2564 }
2565 
2566 int
2567 esw_vport_create_offloads_acl_tables(struct mlx5_eswitch *esw,
2568 				     struct mlx5_vport *vport)
2569 {
2570 	int err;
2571 
2572 	err = esw_acl_ingress_ofld_setup(esw, vport);
2573 	if (err)
2574 		return err;
2575 
2576 	err = esw_acl_egress_ofld_setup(esw, vport);
2577 	if (err)
2578 		goto egress_err;
2579 
2580 	return 0;
2581 
2582 egress_err:
2583 	esw_acl_ingress_ofld_cleanup(esw, vport);
2584 	return err;
2585 }
2586 
2587 void
2588 esw_vport_destroy_offloads_acl_tables(struct mlx5_eswitch *esw,
2589 				      struct mlx5_vport *vport)
2590 {
2591 	esw_acl_egress_ofld_cleanup(vport);
2592 	esw_acl_ingress_ofld_cleanup(esw, vport);
2593 }
2594 
2595 static int esw_create_uplink_offloads_acl_tables(struct mlx5_eswitch *esw)
2596 {
2597 	struct mlx5_vport *vport;
2598 
2599 	vport = mlx5_eswitch_get_vport(esw, MLX5_VPORT_UPLINK);
2600 	if (IS_ERR(vport))
2601 		return PTR_ERR(vport);
2602 
2603 	return esw_vport_create_offloads_acl_tables(esw, vport);
2604 }
2605 
2606 static void esw_destroy_uplink_offloads_acl_tables(struct mlx5_eswitch *esw)
2607 {
2608 	struct mlx5_vport *vport;
2609 
2610 	vport = mlx5_eswitch_get_vport(esw, MLX5_VPORT_UPLINK);
2611 	if (IS_ERR(vport))
2612 		return;
2613 
2614 	esw_vport_destroy_offloads_acl_tables(esw, vport);
2615 }
2616 
2617 static int esw_offloads_steering_init(struct mlx5_eswitch *esw)
2618 {
2619 	struct mlx5_esw_indir_table *indir;
2620 	int err;
2621 
2622 	memset(&esw->fdb_table.offloads, 0, sizeof(struct offloads_fdb));
2623 	mutex_init(&esw->fdb_table.offloads.vports.lock);
2624 	hash_init(esw->fdb_table.offloads.vports.table);
2625 	atomic64_set(&esw->user_count, 0);
2626 
2627 	indir = mlx5_esw_indir_table_init();
2628 	if (IS_ERR(indir)) {
2629 		err = PTR_ERR(indir);
2630 		goto create_indir_err;
2631 	}
2632 	esw->fdb_table.offloads.indir = indir;
2633 
2634 	err = esw_create_uplink_offloads_acl_tables(esw);
2635 	if (err)
2636 		goto create_acl_err;
2637 
2638 	err = esw_create_offloads_table(esw);
2639 	if (err)
2640 		goto create_offloads_err;
2641 
2642 	err = esw_create_restore_table(esw);
2643 	if (err)
2644 		goto create_restore_err;
2645 
2646 	err = esw_create_offloads_fdb_tables(esw);
2647 	if (err)
2648 		goto create_fdb_err;
2649 
2650 	err = esw_create_vport_rx_group(esw);
2651 	if (err)
2652 		goto create_fg_err;
2653 
2654 	return 0;
2655 
2656 create_fg_err:
2657 	esw_destroy_offloads_fdb_tables(esw);
2658 create_fdb_err:
2659 	esw_destroy_restore_table(esw);
2660 create_restore_err:
2661 	esw_destroy_offloads_table(esw);
2662 create_offloads_err:
2663 	esw_destroy_uplink_offloads_acl_tables(esw);
2664 create_acl_err:
2665 	mlx5_esw_indir_table_destroy(esw->fdb_table.offloads.indir);
2666 create_indir_err:
2667 	mutex_destroy(&esw->fdb_table.offloads.vports.lock);
2668 	return err;
2669 }
2670 
2671 static void esw_offloads_steering_cleanup(struct mlx5_eswitch *esw)
2672 {
2673 	esw_destroy_vport_rx_group(esw);
2674 	esw_destroy_offloads_fdb_tables(esw);
2675 	esw_destroy_restore_table(esw);
2676 	esw_destroy_offloads_table(esw);
2677 	esw_destroy_uplink_offloads_acl_tables(esw);
2678 	mlx5_esw_indir_table_destroy(esw->fdb_table.offloads.indir);
2679 	mutex_destroy(&esw->fdb_table.offloads.vports.lock);
2680 }
2681 
2682 static void
2683 esw_vfs_changed_event_handler(struct mlx5_eswitch *esw, const u32 *out)
2684 {
2685 	bool host_pf_disabled;
2686 	u16 new_num_vfs;
2687 
2688 	new_num_vfs = MLX5_GET(query_esw_functions_out, out,
2689 			       host_params_context.host_num_of_vfs);
2690 	host_pf_disabled = MLX5_GET(query_esw_functions_out, out,
2691 				    host_params_context.host_pf_disabled);
2692 
2693 	if (new_num_vfs == esw->esw_funcs.num_vfs || host_pf_disabled)
2694 		return;
2695 
2696 	/* Number of VFs can only change from "0 to x" or "x to 0". */
2697 	if (esw->esw_funcs.num_vfs > 0) {
2698 		mlx5_eswitch_unload_vf_vports(esw, esw->esw_funcs.num_vfs);
2699 	} else {
2700 		int err;
2701 
2702 		err = mlx5_eswitch_load_vf_vports(esw, new_num_vfs,
2703 						  MLX5_VPORT_UC_ADDR_CHANGE);
2704 		if (err)
2705 			return;
2706 	}
2707 	esw->esw_funcs.num_vfs = new_num_vfs;
2708 }
2709 
2710 static void esw_functions_changed_event_handler(struct work_struct *work)
2711 {
2712 	struct mlx5_host_work *host_work;
2713 	struct mlx5_eswitch *esw;
2714 	const u32 *out;
2715 
2716 	host_work = container_of(work, struct mlx5_host_work, work);
2717 	esw = host_work->esw;
2718 
2719 	out = mlx5_esw_query_functions(esw->dev);
2720 	if (IS_ERR(out))
2721 		goto out;
2722 
2723 	esw_vfs_changed_event_handler(esw, out);
2724 	kvfree(out);
2725 out:
2726 	kfree(host_work);
2727 }
2728 
2729 int mlx5_esw_funcs_changed_handler(struct notifier_block *nb, unsigned long type, void *data)
2730 {
2731 	struct mlx5_esw_functions *esw_funcs;
2732 	struct mlx5_host_work *host_work;
2733 	struct mlx5_eswitch *esw;
2734 
2735 	host_work = kzalloc(sizeof(*host_work), GFP_ATOMIC);
2736 	if (!host_work)
2737 		return NOTIFY_DONE;
2738 
2739 	esw_funcs = mlx5_nb_cof(nb, struct mlx5_esw_functions, nb);
2740 	esw = container_of(esw_funcs, struct mlx5_eswitch, esw_funcs);
2741 
2742 	host_work->esw = esw;
2743 
2744 	INIT_WORK(&host_work->work, esw_functions_changed_event_handler);
2745 	queue_work(esw->work_queue, &host_work->work);
2746 
2747 	return NOTIFY_OK;
2748 }
2749 
2750 static int mlx5_esw_host_number_init(struct mlx5_eswitch *esw)
2751 {
2752 	const u32 *query_host_out;
2753 
2754 	if (!mlx5_core_is_ecpf_esw_manager(esw->dev))
2755 		return 0;
2756 
2757 	query_host_out = mlx5_esw_query_functions(esw->dev);
2758 	if (IS_ERR(query_host_out))
2759 		return PTR_ERR(query_host_out);
2760 
2761 	/* Mark non local controller with non zero controller number. */
2762 	esw->offloads.host_number = MLX5_GET(query_esw_functions_out, query_host_out,
2763 					     host_params_context.host_number);
2764 	kvfree(query_host_out);
2765 	return 0;
2766 }
2767 
2768 bool mlx5_esw_offloads_controller_valid(const struct mlx5_eswitch *esw, u32 controller)
2769 {
2770 	/* Local controller is always valid */
2771 	if (controller == 0)
2772 		return true;
2773 
2774 	if (!mlx5_core_is_ecpf_esw_manager(esw->dev))
2775 		return false;
2776 
2777 	/* External host number starts with zero in device */
2778 	return (controller == esw->offloads.host_number + 1);
2779 }
2780 
2781 int esw_offloads_enable(struct mlx5_eswitch *esw)
2782 {
2783 	struct mapping_ctx *reg_c0_obj_pool;
2784 	struct mlx5_vport *vport;
2785 	unsigned long i;
2786 	int err;
2787 
2788 	if (MLX5_CAP_ESW_FLOWTABLE_FDB(esw->dev, reformat) &&
2789 	    MLX5_CAP_ESW_FLOWTABLE_FDB(esw->dev, decap))
2790 		esw->offloads.encap = DEVLINK_ESWITCH_ENCAP_MODE_BASIC;
2791 	else
2792 		esw->offloads.encap = DEVLINK_ESWITCH_ENCAP_MODE_NONE;
2793 
2794 	mutex_init(&esw->offloads.termtbl_mutex);
2795 	mlx5_rdma_enable_roce(esw->dev);
2796 
2797 	err = mlx5_esw_host_number_init(esw);
2798 	if (err)
2799 		goto err_metadata;
2800 
2801 	err = esw_offloads_metadata_init(esw);
2802 	if (err)
2803 		goto err_metadata;
2804 
2805 	err = esw_set_passing_vport_metadata(esw, true);
2806 	if (err)
2807 		goto err_vport_metadata;
2808 
2809 	reg_c0_obj_pool = mapping_create(sizeof(struct mlx5_mapped_obj),
2810 					 ESW_REG_C0_USER_DATA_METADATA_MASK,
2811 					 true);
2812 	if (IS_ERR(reg_c0_obj_pool)) {
2813 		err = PTR_ERR(reg_c0_obj_pool);
2814 		goto err_pool;
2815 	}
2816 	esw->offloads.reg_c0_obj_pool = reg_c0_obj_pool;
2817 
2818 	err = esw_offloads_steering_init(esw);
2819 	if (err)
2820 		goto err_steering_init;
2821 
2822 	/* Representor will control the vport link state */
2823 	mlx5_esw_for_each_vf_vport(esw, i, vport, esw->esw_funcs.num_vfs)
2824 		vport->info.link_state = MLX5_VPORT_ADMIN_STATE_DOWN;
2825 
2826 	/* Uplink vport rep must load first. */
2827 	err = esw_offloads_load_rep(esw, MLX5_VPORT_UPLINK);
2828 	if (err)
2829 		goto err_uplink;
2830 
2831 	err = mlx5_eswitch_enable_pf_vf_vports(esw, MLX5_VPORT_UC_ADDR_CHANGE);
2832 	if (err)
2833 		goto err_vports;
2834 
2835 	esw_offloads_devcom_init(esw);
2836 
2837 	return 0;
2838 
2839 err_vports:
2840 	esw_offloads_unload_rep(esw, MLX5_VPORT_UPLINK);
2841 err_uplink:
2842 	esw_offloads_steering_cleanup(esw);
2843 err_steering_init:
2844 	mapping_destroy(reg_c0_obj_pool);
2845 err_pool:
2846 	esw_set_passing_vport_metadata(esw, false);
2847 err_vport_metadata:
2848 	esw_offloads_metadata_uninit(esw);
2849 err_metadata:
2850 	mlx5_rdma_disable_roce(esw->dev);
2851 	mutex_destroy(&esw->offloads.termtbl_mutex);
2852 	return err;
2853 }
2854 
2855 static int esw_offloads_stop(struct mlx5_eswitch *esw,
2856 			     struct netlink_ext_ack *extack)
2857 {
2858 	int err, err1;
2859 
2860 	mlx5_eswitch_disable_locked(esw, false);
2861 	err = mlx5_eswitch_enable_locked(esw, MLX5_ESWITCH_LEGACY,
2862 					 MLX5_ESWITCH_IGNORE_NUM_VFS);
2863 	if (err) {
2864 		NL_SET_ERR_MSG_MOD(extack, "Failed setting eswitch to legacy");
2865 		err1 = mlx5_eswitch_enable_locked(esw, MLX5_ESWITCH_OFFLOADS,
2866 						  MLX5_ESWITCH_IGNORE_NUM_VFS);
2867 		if (err1) {
2868 			NL_SET_ERR_MSG_MOD(extack,
2869 					   "Failed setting eswitch back to offloads");
2870 		}
2871 	}
2872 
2873 	return err;
2874 }
2875 
2876 void esw_offloads_disable(struct mlx5_eswitch *esw)
2877 {
2878 	esw_offloads_devcom_cleanup(esw);
2879 	mlx5_eswitch_disable_pf_vf_vports(esw);
2880 	esw_offloads_unload_rep(esw, MLX5_VPORT_UPLINK);
2881 	esw_set_passing_vport_metadata(esw, false);
2882 	esw_offloads_steering_cleanup(esw);
2883 	mapping_destroy(esw->offloads.reg_c0_obj_pool);
2884 	esw_offloads_metadata_uninit(esw);
2885 	mlx5_rdma_disable_roce(esw->dev);
2886 	mutex_destroy(&esw->offloads.termtbl_mutex);
2887 	esw->offloads.encap = DEVLINK_ESWITCH_ENCAP_MODE_NONE;
2888 }
2889 
2890 static int esw_mode_from_devlink(u16 mode, u16 *mlx5_mode)
2891 {
2892 	switch (mode) {
2893 	case DEVLINK_ESWITCH_MODE_LEGACY:
2894 		*mlx5_mode = MLX5_ESWITCH_LEGACY;
2895 		break;
2896 	case DEVLINK_ESWITCH_MODE_SWITCHDEV:
2897 		*mlx5_mode = MLX5_ESWITCH_OFFLOADS;
2898 		break;
2899 	default:
2900 		return -EINVAL;
2901 	}
2902 
2903 	return 0;
2904 }
2905 
2906 static int esw_mode_to_devlink(u16 mlx5_mode, u16 *mode)
2907 {
2908 	switch (mlx5_mode) {
2909 	case MLX5_ESWITCH_LEGACY:
2910 		*mode = DEVLINK_ESWITCH_MODE_LEGACY;
2911 		break;
2912 	case MLX5_ESWITCH_OFFLOADS:
2913 		*mode = DEVLINK_ESWITCH_MODE_SWITCHDEV;
2914 		break;
2915 	default:
2916 		return -EINVAL;
2917 	}
2918 
2919 	return 0;
2920 }
2921 
2922 static int esw_inline_mode_from_devlink(u8 mode, u8 *mlx5_mode)
2923 {
2924 	switch (mode) {
2925 	case DEVLINK_ESWITCH_INLINE_MODE_NONE:
2926 		*mlx5_mode = MLX5_INLINE_MODE_NONE;
2927 		break;
2928 	case DEVLINK_ESWITCH_INLINE_MODE_LINK:
2929 		*mlx5_mode = MLX5_INLINE_MODE_L2;
2930 		break;
2931 	case DEVLINK_ESWITCH_INLINE_MODE_NETWORK:
2932 		*mlx5_mode = MLX5_INLINE_MODE_IP;
2933 		break;
2934 	case DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT:
2935 		*mlx5_mode = MLX5_INLINE_MODE_TCP_UDP;
2936 		break;
2937 	default:
2938 		return -EINVAL;
2939 	}
2940 
2941 	return 0;
2942 }
2943 
2944 static int esw_inline_mode_to_devlink(u8 mlx5_mode, u8 *mode)
2945 {
2946 	switch (mlx5_mode) {
2947 	case MLX5_INLINE_MODE_NONE:
2948 		*mode = DEVLINK_ESWITCH_INLINE_MODE_NONE;
2949 		break;
2950 	case MLX5_INLINE_MODE_L2:
2951 		*mode = DEVLINK_ESWITCH_INLINE_MODE_LINK;
2952 		break;
2953 	case MLX5_INLINE_MODE_IP:
2954 		*mode = DEVLINK_ESWITCH_INLINE_MODE_NETWORK;
2955 		break;
2956 	case MLX5_INLINE_MODE_TCP_UDP:
2957 		*mode = DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT;
2958 		break;
2959 	default:
2960 		return -EINVAL;
2961 	}
2962 
2963 	return 0;
2964 }
2965 
2966 static int eswitch_devlink_esw_mode_check(const struct mlx5_eswitch *esw)
2967 {
2968 	/* devlink commands in NONE eswitch mode are currently supported only
2969 	 * on ECPF.
2970 	 */
2971 	return (esw->mode == MLX5_ESWITCH_NONE &&
2972 		!mlx5_core_is_ecpf_esw_manager(esw->dev)) ? -EOPNOTSUPP : 0;
2973 }
2974 
2975 int mlx5_devlink_eswitch_mode_set(struct devlink *devlink, u16 mode,
2976 				  struct netlink_ext_ack *extack)
2977 {
2978 	u16 cur_mlx5_mode, mlx5_mode = 0;
2979 	struct mlx5_eswitch *esw;
2980 	int err = 0;
2981 
2982 	esw = mlx5_devlink_eswitch_get(devlink);
2983 	if (IS_ERR(esw))
2984 		return PTR_ERR(esw);
2985 
2986 	if (esw_mode_from_devlink(mode, &mlx5_mode))
2987 		return -EINVAL;
2988 
2989 	err = mlx5_esw_try_lock(esw);
2990 	if (err < 0) {
2991 		NL_SET_ERR_MSG_MOD(extack, "Can't change mode, E-Switch is busy");
2992 		return err;
2993 	}
2994 	cur_mlx5_mode = err;
2995 	err = 0;
2996 
2997 	if (cur_mlx5_mode == mlx5_mode)
2998 		goto unlock;
2999 
3000 	if (mode == DEVLINK_ESWITCH_MODE_SWITCHDEV)
3001 		err = esw_offloads_start(esw, extack);
3002 	else if (mode == DEVLINK_ESWITCH_MODE_LEGACY)
3003 		err = esw_offloads_stop(esw, extack);
3004 	else
3005 		err = -EINVAL;
3006 
3007 unlock:
3008 	mlx5_esw_unlock(esw);
3009 	return err;
3010 }
3011 
3012 int mlx5_devlink_eswitch_mode_get(struct devlink *devlink, u16 *mode)
3013 {
3014 	struct mlx5_eswitch *esw;
3015 	int err;
3016 
3017 	esw = mlx5_devlink_eswitch_get(devlink);
3018 	if (IS_ERR(esw))
3019 		return PTR_ERR(esw);
3020 
3021 	down_write(&esw->mode_lock);
3022 	err = eswitch_devlink_esw_mode_check(esw);
3023 	if (err)
3024 		goto unlock;
3025 
3026 	err = esw_mode_to_devlink(esw->mode, mode);
3027 unlock:
3028 	up_write(&esw->mode_lock);
3029 	return err;
3030 }
3031 
3032 static int mlx5_esw_vports_inline_set(struct mlx5_eswitch *esw, u8 mlx5_mode,
3033 				      struct netlink_ext_ack *extack)
3034 {
3035 	struct mlx5_core_dev *dev = esw->dev;
3036 	struct mlx5_vport *vport;
3037 	u16 err_vport_num = 0;
3038 	unsigned long i;
3039 	int err = 0;
3040 
3041 	mlx5_esw_for_each_host_func_vport(esw, i, vport, esw->esw_funcs.num_vfs) {
3042 		err = mlx5_modify_nic_vport_min_inline(dev, vport->vport, mlx5_mode);
3043 		if (err) {
3044 			err_vport_num = vport->vport;
3045 			NL_SET_ERR_MSG_MOD(extack,
3046 					   "Failed to set min inline on vport");
3047 			goto revert_inline_mode;
3048 		}
3049 	}
3050 	return 0;
3051 
3052 revert_inline_mode:
3053 	mlx5_esw_for_each_host_func_vport(esw, i, vport, esw->esw_funcs.num_vfs) {
3054 		if (vport->vport == err_vport_num)
3055 			break;
3056 		mlx5_modify_nic_vport_min_inline(dev,
3057 						 vport->vport,
3058 						 esw->offloads.inline_mode);
3059 	}
3060 	return err;
3061 }
3062 
3063 int mlx5_devlink_eswitch_inline_mode_set(struct devlink *devlink, u8 mode,
3064 					 struct netlink_ext_ack *extack)
3065 {
3066 	struct mlx5_core_dev *dev = devlink_priv(devlink);
3067 	struct mlx5_eswitch *esw;
3068 	u8 mlx5_mode;
3069 	int err;
3070 
3071 	esw = mlx5_devlink_eswitch_get(devlink);
3072 	if (IS_ERR(esw))
3073 		return PTR_ERR(esw);
3074 
3075 	down_write(&esw->mode_lock);
3076 	err = eswitch_devlink_esw_mode_check(esw);
3077 	if (err)
3078 		goto out;
3079 
3080 	switch (MLX5_CAP_ETH(dev, wqe_inline_mode)) {
3081 	case MLX5_CAP_INLINE_MODE_NOT_REQUIRED:
3082 		if (mode == DEVLINK_ESWITCH_INLINE_MODE_NONE)
3083 			goto out;
3084 		fallthrough;
3085 	case MLX5_CAP_INLINE_MODE_L2:
3086 		NL_SET_ERR_MSG_MOD(extack, "Inline mode can't be set");
3087 		err = -EOPNOTSUPP;
3088 		goto out;
3089 	case MLX5_CAP_INLINE_MODE_VPORT_CONTEXT:
3090 		break;
3091 	}
3092 
3093 	if (atomic64_read(&esw->offloads.num_flows) > 0) {
3094 		NL_SET_ERR_MSG_MOD(extack,
3095 				   "Can't set inline mode when flows are configured");
3096 		err = -EOPNOTSUPP;
3097 		goto out;
3098 	}
3099 
3100 	err = esw_inline_mode_from_devlink(mode, &mlx5_mode);
3101 	if (err)
3102 		goto out;
3103 
3104 	err = mlx5_esw_vports_inline_set(esw, mlx5_mode, extack);
3105 	if (err)
3106 		goto out;
3107 
3108 	esw->offloads.inline_mode = mlx5_mode;
3109 	up_write(&esw->mode_lock);
3110 	return 0;
3111 
3112 out:
3113 	up_write(&esw->mode_lock);
3114 	return err;
3115 }
3116 
3117 int mlx5_devlink_eswitch_inline_mode_get(struct devlink *devlink, u8 *mode)
3118 {
3119 	struct mlx5_eswitch *esw;
3120 	int err;
3121 
3122 	esw = mlx5_devlink_eswitch_get(devlink);
3123 	if (IS_ERR(esw))
3124 		return PTR_ERR(esw);
3125 
3126 	down_write(&esw->mode_lock);
3127 	err = eswitch_devlink_esw_mode_check(esw);
3128 	if (err)
3129 		goto unlock;
3130 
3131 	err = esw_inline_mode_to_devlink(esw->offloads.inline_mode, mode);
3132 unlock:
3133 	up_write(&esw->mode_lock);
3134 	return err;
3135 }
3136 
3137 int mlx5_devlink_eswitch_encap_mode_set(struct devlink *devlink,
3138 					enum devlink_eswitch_encap_mode encap,
3139 					struct netlink_ext_ack *extack)
3140 {
3141 	struct mlx5_core_dev *dev = devlink_priv(devlink);
3142 	struct mlx5_eswitch *esw;
3143 	int err;
3144 
3145 	esw = mlx5_devlink_eswitch_get(devlink);
3146 	if (IS_ERR(esw))
3147 		return PTR_ERR(esw);
3148 
3149 	down_write(&esw->mode_lock);
3150 	err = eswitch_devlink_esw_mode_check(esw);
3151 	if (err)
3152 		goto unlock;
3153 
3154 	if (encap != DEVLINK_ESWITCH_ENCAP_MODE_NONE &&
3155 	    (!MLX5_CAP_ESW_FLOWTABLE_FDB(dev, reformat) ||
3156 	     !MLX5_CAP_ESW_FLOWTABLE_FDB(dev, decap))) {
3157 		err = -EOPNOTSUPP;
3158 		goto unlock;
3159 	}
3160 
3161 	if (encap && encap != DEVLINK_ESWITCH_ENCAP_MODE_BASIC) {
3162 		err = -EOPNOTSUPP;
3163 		goto unlock;
3164 	}
3165 
3166 	if (esw->mode == MLX5_ESWITCH_LEGACY) {
3167 		esw->offloads.encap = encap;
3168 		goto unlock;
3169 	}
3170 
3171 	if (esw->offloads.encap == encap)
3172 		goto unlock;
3173 
3174 	if (atomic64_read(&esw->offloads.num_flows) > 0) {
3175 		NL_SET_ERR_MSG_MOD(extack,
3176 				   "Can't set encapsulation when flows are configured");
3177 		err = -EOPNOTSUPP;
3178 		goto unlock;
3179 	}
3180 
3181 	esw_destroy_offloads_fdb_tables(esw);
3182 
3183 	esw->offloads.encap = encap;
3184 
3185 	err = esw_create_offloads_fdb_tables(esw);
3186 
3187 	if (err) {
3188 		NL_SET_ERR_MSG_MOD(extack,
3189 				   "Failed re-creating fast FDB table");
3190 		esw->offloads.encap = !encap;
3191 		(void)esw_create_offloads_fdb_tables(esw);
3192 	}
3193 
3194 unlock:
3195 	up_write(&esw->mode_lock);
3196 	return err;
3197 }
3198 
3199 int mlx5_devlink_eswitch_encap_mode_get(struct devlink *devlink,
3200 					enum devlink_eswitch_encap_mode *encap)
3201 {
3202 	struct mlx5_eswitch *esw;
3203 	int err;
3204 
3205 	esw = mlx5_devlink_eswitch_get(devlink);
3206 	if (IS_ERR(esw))
3207 		return PTR_ERR(esw);
3208 
3209 
3210 	down_write(&esw->mode_lock);
3211 	err = eswitch_devlink_esw_mode_check(esw);
3212 	if (err)
3213 		goto unlock;
3214 
3215 	*encap = esw->offloads.encap;
3216 unlock:
3217 	up_write(&esw->mode_lock);
3218 	return 0;
3219 }
3220 
3221 static bool
3222 mlx5_eswitch_vport_has_rep(const struct mlx5_eswitch *esw, u16 vport_num)
3223 {
3224 	/* Currently, only ECPF based device has representor for host PF. */
3225 	if (vport_num == MLX5_VPORT_PF &&
3226 	    !mlx5_core_is_ecpf_esw_manager(esw->dev))
3227 		return false;
3228 
3229 	if (vport_num == MLX5_VPORT_ECPF &&
3230 	    !mlx5_ecpf_vport_exists(esw->dev))
3231 		return false;
3232 
3233 	return true;
3234 }
3235 
3236 void mlx5_eswitch_register_vport_reps(struct mlx5_eswitch *esw,
3237 				      const struct mlx5_eswitch_rep_ops *ops,
3238 				      u8 rep_type)
3239 {
3240 	struct mlx5_eswitch_rep_data *rep_data;
3241 	struct mlx5_eswitch_rep *rep;
3242 	unsigned long i;
3243 
3244 	esw->offloads.rep_ops[rep_type] = ops;
3245 	mlx5_esw_for_each_rep(esw, i, rep) {
3246 		if (likely(mlx5_eswitch_vport_has_rep(esw, rep->vport))) {
3247 			rep->esw = esw;
3248 			rep_data = &rep->rep_data[rep_type];
3249 			atomic_set(&rep_data->state, REP_REGISTERED);
3250 		}
3251 	}
3252 }
3253 EXPORT_SYMBOL(mlx5_eswitch_register_vport_reps);
3254 
3255 void mlx5_eswitch_unregister_vport_reps(struct mlx5_eswitch *esw, u8 rep_type)
3256 {
3257 	struct mlx5_eswitch_rep *rep;
3258 	unsigned long i;
3259 
3260 	if (esw->mode == MLX5_ESWITCH_OFFLOADS)
3261 		__unload_reps_all_vport(esw, rep_type);
3262 
3263 	mlx5_esw_for_each_rep(esw, i, rep)
3264 		atomic_set(&rep->rep_data[rep_type].state, REP_UNREGISTERED);
3265 }
3266 EXPORT_SYMBOL(mlx5_eswitch_unregister_vport_reps);
3267 
3268 void *mlx5_eswitch_get_uplink_priv(struct mlx5_eswitch *esw, u8 rep_type)
3269 {
3270 	struct mlx5_eswitch_rep *rep;
3271 
3272 	rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_UPLINK);
3273 	return rep->rep_data[rep_type].priv;
3274 }
3275 
3276 void *mlx5_eswitch_get_proto_dev(struct mlx5_eswitch *esw,
3277 				 u16 vport,
3278 				 u8 rep_type)
3279 {
3280 	struct mlx5_eswitch_rep *rep;
3281 
3282 	rep = mlx5_eswitch_get_rep(esw, vport);
3283 
3284 	if (atomic_read(&rep->rep_data[rep_type].state) == REP_LOADED &&
3285 	    esw->offloads.rep_ops[rep_type]->get_proto_dev)
3286 		return esw->offloads.rep_ops[rep_type]->get_proto_dev(rep);
3287 	return NULL;
3288 }
3289 EXPORT_SYMBOL(mlx5_eswitch_get_proto_dev);
3290 
3291 void *mlx5_eswitch_uplink_get_proto_dev(struct mlx5_eswitch *esw, u8 rep_type)
3292 {
3293 	return mlx5_eswitch_get_proto_dev(esw, MLX5_VPORT_UPLINK, rep_type);
3294 }
3295 EXPORT_SYMBOL(mlx5_eswitch_uplink_get_proto_dev);
3296 
3297 struct mlx5_eswitch_rep *mlx5_eswitch_vport_rep(struct mlx5_eswitch *esw,
3298 						u16 vport)
3299 {
3300 	return mlx5_eswitch_get_rep(esw, vport);
3301 }
3302 EXPORT_SYMBOL(mlx5_eswitch_vport_rep);
3303 
3304 bool mlx5_eswitch_reg_c1_loopback_enabled(const struct mlx5_eswitch *esw)
3305 {
3306 	return !!(esw->flags & MLX5_ESWITCH_REG_C1_LOOPBACK_ENABLED);
3307 }
3308 EXPORT_SYMBOL(mlx5_eswitch_reg_c1_loopback_enabled);
3309 
3310 bool mlx5_eswitch_vport_match_metadata_enabled(const struct mlx5_eswitch *esw)
3311 {
3312 	return !!(esw->flags & MLX5_ESWITCH_VPORT_MATCH_METADATA);
3313 }
3314 EXPORT_SYMBOL(mlx5_eswitch_vport_match_metadata_enabled);
3315 
3316 u32 mlx5_eswitch_get_vport_metadata_for_match(struct mlx5_eswitch *esw,
3317 					      u16 vport_num)
3318 {
3319 	struct mlx5_vport *vport = mlx5_eswitch_get_vport(esw, vport_num);
3320 
3321 	if (WARN_ON_ONCE(IS_ERR(vport)))
3322 		return 0;
3323 
3324 	return vport->metadata << (32 - ESW_SOURCE_PORT_METADATA_BITS);
3325 }
3326 EXPORT_SYMBOL(mlx5_eswitch_get_vport_metadata_for_match);
3327 
3328 int mlx5_esw_offloads_sf_vport_enable(struct mlx5_eswitch *esw, struct devlink_port *dl_port,
3329 				      u16 vport_num, u32 controller, u32 sfnum)
3330 {
3331 	int err;
3332 
3333 	err = mlx5_esw_vport_enable(esw, vport_num, MLX5_VPORT_UC_ADDR_CHANGE);
3334 	if (err)
3335 		return err;
3336 
3337 	err = mlx5_esw_devlink_sf_port_register(esw, dl_port, vport_num, controller, sfnum);
3338 	if (err)
3339 		goto devlink_err;
3340 
3341 	err = mlx5_esw_offloads_rep_load(esw, vport_num);
3342 	if (err)
3343 		goto rep_err;
3344 	return 0;
3345 
3346 rep_err:
3347 	mlx5_esw_devlink_sf_port_unregister(esw, vport_num);
3348 devlink_err:
3349 	mlx5_esw_vport_disable(esw, vport_num);
3350 	return err;
3351 }
3352 
3353 void mlx5_esw_offloads_sf_vport_disable(struct mlx5_eswitch *esw, u16 vport_num)
3354 {
3355 	mlx5_esw_offloads_rep_unload(esw, vport_num);
3356 	mlx5_esw_devlink_sf_port_unregister(esw, vport_num);
3357 	mlx5_esw_vport_disable(esw, vport_num);
3358 }
3359 
3360 static int mlx5_esw_query_vport_vhca_id(struct mlx5_eswitch *esw, u16 vport_num, u16 *vhca_id)
3361 {
3362 	int query_out_sz = MLX5_ST_SZ_BYTES(query_hca_cap_out);
3363 	void *query_ctx;
3364 	void *hca_caps;
3365 	int err;
3366 
3367 	*vhca_id = 0;
3368 	if (mlx5_esw_is_manager_vport(esw, vport_num) ||
3369 	    !MLX5_CAP_GEN(esw->dev, vhca_resource_manager))
3370 		return -EPERM;
3371 
3372 	query_ctx = kzalloc(query_out_sz, GFP_KERNEL);
3373 	if (!query_ctx)
3374 		return -ENOMEM;
3375 
3376 	err = mlx5_vport_get_other_func_cap(esw->dev, vport_num, query_ctx);
3377 	if (err)
3378 		goto out_free;
3379 
3380 	hca_caps = MLX5_ADDR_OF(query_hca_cap_out, query_ctx, capability);
3381 	*vhca_id = MLX5_GET(cmd_hca_cap, hca_caps, vhca_id);
3382 
3383 out_free:
3384 	kfree(query_ctx);
3385 	return err;
3386 }
3387 
3388 int mlx5_esw_vport_vhca_id_set(struct mlx5_eswitch *esw, u16 vport_num)
3389 {
3390 	u16 *old_entry, *vhca_map_entry, vhca_id;
3391 	int err;
3392 
3393 	err = mlx5_esw_query_vport_vhca_id(esw, vport_num, &vhca_id);
3394 	if (err) {
3395 		esw_warn(esw->dev, "Getting vhca_id for vport failed (vport=%u,err=%d)\n",
3396 			 vport_num, err);
3397 		return err;
3398 	}
3399 
3400 	vhca_map_entry = kmalloc(sizeof(*vhca_map_entry), GFP_KERNEL);
3401 	if (!vhca_map_entry)
3402 		return -ENOMEM;
3403 
3404 	*vhca_map_entry = vport_num;
3405 	old_entry = xa_store(&esw->offloads.vhca_map, vhca_id, vhca_map_entry, GFP_KERNEL);
3406 	if (xa_is_err(old_entry)) {
3407 		kfree(vhca_map_entry);
3408 		return xa_err(old_entry);
3409 	}
3410 	kfree(old_entry);
3411 	return 0;
3412 }
3413 
3414 void mlx5_esw_vport_vhca_id_clear(struct mlx5_eswitch *esw, u16 vport_num)
3415 {
3416 	u16 *vhca_map_entry, vhca_id;
3417 	int err;
3418 
3419 	err = mlx5_esw_query_vport_vhca_id(esw, vport_num, &vhca_id);
3420 	if (err)
3421 		esw_warn(esw->dev, "Getting vhca_id for vport failed (vport=%hu,err=%d)\n",
3422 			 vport_num, err);
3423 
3424 	vhca_map_entry = xa_erase(&esw->offloads.vhca_map, vhca_id);
3425 	kfree(vhca_map_entry);
3426 }
3427 
3428 int mlx5_eswitch_vhca_id_to_vport(struct mlx5_eswitch *esw, u16 vhca_id, u16 *vport_num)
3429 {
3430 	u16 *res = xa_load(&esw->offloads.vhca_map, vhca_id);
3431 
3432 	if (!res)
3433 		return -ENOENT;
3434 
3435 	*vport_num = *res;
3436 	return 0;
3437 }
3438 
3439 u32 mlx5_eswitch_get_vport_metadata_for_set(struct mlx5_eswitch *esw,
3440 					    u16 vport_num)
3441 {
3442 	struct mlx5_vport *vport = mlx5_eswitch_get_vport(esw, vport_num);
3443 
3444 	if (WARN_ON_ONCE(IS_ERR(vport)))
3445 		return 0;
3446 
3447 	return vport->metadata;
3448 }
3449 EXPORT_SYMBOL(mlx5_eswitch_get_vport_metadata_for_set);
3450