Merge branch 'linus' into core/urgent, to merge in dependent changes
[linux-2.6-microblaze.git] / drivers / net / ethernet / mellanox / mlx5 / core / eswitch_offloads.c
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/mlx5/driver.h>
35 #include <linux/mlx5/mlx5_ifc.h>
36 #include <linux/mlx5/vport.h>
37 #include <linux/mlx5/fs.h>
38 #include "mlx5_core.h"
39 #include "eswitch.h"
40 #include "en.h"
41 #include "fs_core.h"
42 #include "lib/devcom.h"
43 #include "ecpf.h"
44 #include "lib/eq.h"
45
46 enum {
47         FDB_FAST_PATH = 0,
48         FDB_SLOW_PATH
49 };
50
51 /* There are two match-all miss flows, one for unicast dst mac and
52  * one for multicast.
53  */
54 #define MLX5_ESW_MISS_FLOWS (2)
55
56 #define fdb_prio_table(esw, chain, prio, level) \
57         (esw)->fdb_table.offloads.fdb_prio[(chain)][(prio)][(level)]
58
59 #define UPLINK_REP_INDEX 0
60
61 /* The rep getter/iterator are only valid after esw->total_vports
62  * and vport->vport are initialized in mlx5_eswitch_init.
63  */
64 #define mlx5_esw_for_all_reps(esw, i, rep)                      \
65         for ((i) = MLX5_VPORT_PF;                               \
66              (rep) = &(esw)->offloads.vport_reps[i],            \
67              (i) < (esw)->total_vports; (i)++)
68
69 #define mlx5_esw_for_each_vf_rep(esw, i, rep, nvfs)             \
70         for ((i) = MLX5_VPORT_FIRST_VF;                         \
71              (rep) = &(esw)->offloads.vport_reps[i],            \
72              (i) <= (nvfs); (i)++)
73
74 #define mlx5_esw_for_each_vf_rep_reverse(esw, i, rep, nvfs)     \
75         for ((i) = (nvfs);                                      \
76              (rep) = &(esw)->offloads.vport_reps[i],            \
77              (i) >= MLX5_VPORT_FIRST_VF; (i)--)
78
79 #define mlx5_esw_for_each_vf_vport(esw, vport, nvfs)            \
80         for ((vport) = MLX5_VPORT_FIRST_VF;                     \
81              (vport) <= (nvfs); (vport)++)
82
83 #define mlx5_esw_for_each_vf_vport_reverse(esw, vport, nvfs)    \
84         for ((vport) = (nvfs);                                  \
85              (vport) >= MLX5_VPORT_FIRST_VF; (vport)--)
86
87 static struct mlx5_eswitch_rep *mlx5_eswitch_get_rep(struct mlx5_eswitch *esw,
88                                                      u16 vport_num)
89 {
90         u16 idx = mlx5_eswitch_vport_num_to_index(esw, vport_num);
91
92         WARN_ON(idx > esw->total_vports - 1);
93         return &esw->offloads.vport_reps[idx];
94 }
95
96 static struct mlx5_flow_table *
97 esw_get_prio_table(struct mlx5_eswitch *esw, u32 chain, u16 prio, int level);
98 static void
99 esw_put_prio_table(struct mlx5_eswitch *esw, u32 chain, u16 prio, int level);
100
101 bool mlx5_eswitch_prios_supported(struct mlx5_eswitch *esw)
102 {
103         return (!!(esw->fdb_table.flags & ESW_FDB_CHAINS_AND_PRIOS_SUPPORTED));
104 }
105
106 u32 mlx5_eswitch_get_chain_range(struct mlx5_eswitch *esw)
107 {
108         if (esw->fdb_table.flags & ESW_FDB_CHAINS_AND_PRIOS_SUPPORTED)
109                 return FDB_MAX_CHAIN;
110
111         return 0;
112 }
113
114 u16 mlx5_eswitch_get_prio_range(struct mlx5_eswitch *esw)
115 {
116         if (esw->fdb_table.flags & ESW_FDB_CHAINS_AND_PRIOS_SUPPORTED)
117                 return FDB_MAX_PRIO;
118
119         return 1;
120 }
121
122 struct mlx5_flow_handle *
123 mlx5_eswitch_add_offloaded_rule(struct mlx5_eswitch *esw,
124                                 struct mlx5_flow_spec *spec,
125                                 struct mlx5_esw_flow_attr *attr)
126 {
127         struct mlx5_flow_destination dest[MLX5_MAX_FLOW_FWD_VPORTS + 1] = {};
128         struct mlx5_flow_act flow_act = { .flags = FLOW_ACT_NO_APPEND, };
129         bool split = !!(attr->split_count);
130         struct mlx5_flow_handle *rule;
131         struct mlx5_flow_table *fdb;
132         int j, i = 0;
133         void *misc;
134
135         if (esw->mode != SRIOV_OFFLOADS)
136                 return ERR_PTR(-EOPNOTSUPP);
137
138         flow_act.action = attr->action;
139         /* if per flow vlan pop/push is emulated, don't set that into the firmware */
140         if (!mlx5_eswitch_vlan_actions_supported(esw->dev, 1))
141                 flow_act.action &= ~(MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH |
142                                      MLX5_FLOW_CONTEXT_ACTION_VLAN_POP);
143         else if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH) {
144                 flow_act.vlan[0].ethtype = ntohs(attr->vlan_proto[0]);
145                 flow_act.vlan[0].vid = attr->vlan_vid[0];
146                 flow_act.vlan[0].prio = attr->vlan_prio[0];
147                 if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2) {
148                         flow_act.vlan[1].ethtype = ntohs(attr->vlan_proto[1]);
149                         flow_act.vlan[1].vid = attr->vlan_vid[1];
150                         flow_act.vlan[1].prio = attr->vlan_prio[1];
151                 }
152         }
153
154         if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) {
155                 if (attr->dest_chain) {
156                         struct mlx5_flow_table *ft;
157
158                         ft = esw_get_prio_table(esw, attr->dest_chain, 1, 0);
159                         if (IS_ERR(ft)) {
160                                 rule = ERR_CAST(ft);
161                                 goto err_create_goto_table;
162                         }
163
164                         dest[i].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
165                         dest[i].ft = ft;
166                         i++;
167                 } else {
168                         for (j = attr->split_count; j < attr->out_count; j++) {
169                                 dest[i].type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
170                                 dest[i].vport.num = attr->dests[j].rep->vport;
171                                 dest[i].vport.vhca_id =
172                                         MLX5_CAP_GEN(attr->dests[j].mdev, vhca_id);
173                                 if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
174                                         dest[i].vport.flags |=
175                                                 MLX5_FLOW_DEST_VPORT_VHCA_ID;
176                                 if (attr->dests[j].flags & MLX5_ESW_DEST_ENCAP) {
177                                         flow_act.action |= MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT;
178                                         flow_act.reformat_id = attr->dests[j].encap_id;
179                                         dest[i].vport.flags |= MLX5_FLOW_DEST_VPORT_REFORMAT_ID;
180                                         dest[i].vport.reformat_id =
181                                                 attr->dests[j].encap_id;
182                                 }
183                                 i++;
184                         }
185                 }
186         }
187         if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_COUNT) {
188                 dest[i].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
189                 dest[i].counter_id = mlx5_fc_id(attr->counter);
190                 i++;
191         }
192
193         misc = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters);
194         MLX5_SET(fte_match_set_misc, misc, source_port, attr->in_rep->vport);
195
196         if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
197                 MLX5_SET(fte_match_set_misc, misc,
198                          source_eswitch_owner_vhca_id,
199                          MLX5_CAP_GEN(attr->in_mdev, vhca_id));
200
201         misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters);
202         MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
203         if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
204                 MLX5_SET_TO_ONES(fte_match_set_misc, misc,
205                                  source_eswitch_owner_vhca_id);
206
207         spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS;
208         if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_DECAP) {
209                 if (attr->tunnel_match_level != MLX5_MATCH_NONE)
210                         spec->match_criteria_enable |= MLX5_MATCH_OUTER_HEADERS;
211                 if (attr->match_level != MLX5_MATCH_NONE)
212                         spec->match_criteria_enable |= MLX5_MATCH_INNER_HEADERS;
213         } else if (attr->match_level != MLX5_MATCH_NONE) {
214                 spec->match_criteria_enable |= MLX5_MATCH_OUTER_HEADERS;
215         }
216
217         if (flow_act.action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)
218                 flow_act.modify_id = attr->mod_hdr_id;
219
220         fdb = esw_get_prio_table(esw, attr->chain, attr->prio, !!split);
221         if (IS_ERR(fdb)) {
222                 rule = ERR_CAST(fdb);
223                 goto err_esw_get;
224         }
225
226         rule = mlx5_add_flow_rules(fdb, spec, &flow_act, dest, i);
227         if (IS_ERR(rule))
228                 goto err_add_rule;
229         else
230                 esw->offloads.num_flows++;
231
232         return rule;
233
234 err_add_rule:
235         esw_put_prio_table(esw, attr->chain, attr->prio, !!split);
236 err_esw_get:
237         if (attr->dest_chain)
238                 esw_put_prio_table(esw, attr->dest_chain, 1, 0);
239 err_create_goto_table:
240         return rule;
241 }
242
243 struct mlx5_flow_handle *
244 mlx5_eswitch_add_fwd_rule(struct mlx5_eswitch *esw,
245                           struct mlx5_flow_spec *spec,
246                           struct mlx5_esw_flow_attr *attr)
247 {
248         struct mlx5_flow_destination dest[MLX5_MAX_FLOW_FWD_VPORTS + 1] = {};
249         struct mlx5_flow_act flow_act = { .flags = FLOW_ACT_NO_APPEND, };
250         struct mlx5_flow_table *fast_fdb;
251         struct mlx5_flow_table *fwd_fdb;
252         struct mlx5_flow_handle *rule;
253         void *misc;
254         int i;
255
256         fast_fdb = esw_get_prio_table(esw, attr->chain, attr->prio, 0);
257         if (IS_ERR(fast_fdb)) {
258                 rule = ERR_CAST(fast_fdb);
259                 goto err_get_fast;
260         }
261
262         fwd_fdb = esw_get_prio_table(esw, attr->chain, attr->prio, 1);
263         if (IS_ERR(fwd_fdb)) {
264                 rule = ERR_CAST(fwd_fdb);
265                 goto err_get_fwd;
266         }
267
268         flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
269         for (i = 0; i < attr->split_count; i++) {
270                 dest[i].type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
271                 dest[i].vport.num = attr->dests[i].rep->vport;
272                 dest[i].vport.vhca_id =
273                         MLX5_CAP_GEN(attr->dests[i].mdev, vhca_id);
274                 if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
275                         dest[i].vport.flags |= MLX5_FLOW_DEST_VPORT_VHCA_ID;
276                 if (attr->dests[i].flags & MLX5_ESW_DEST_ENCAP) {
277                         dest[i].vport.flags |= MLX5_FLOW_DEST_VPORT_REFORMAT_ID;
278                         dest[i].vport.reformat_id = attr->dests[i].encap_id;
279                 }
280         }
281         dest[i].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
282         dest[i].ft = fwd_fdb,
283         i++;
284
285         misc = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters);
286         MLX5_SET(fte_match_set_misc, misc, source_port, attr->in_rep->vport);
287
288         if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
289                 MLX5_SET(fte_match_set_misc, misc,
290                          source_eswitch_owner_vhca_id,
291                          MLX5_CAP_GEN(attr->in_mdev, vhca_id));
292
293         misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters);
294         MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
295         if (MLX5_CAP_ESW(esw->dev, merged_eswitch))
296                 MLX5_SET_TO_ONES(fte_match_set_misc, misc,
297                                  source_eswitch_owner_vhca_id);
298
299         if (attr->match_level == MLX5_MATCH_NONE)
300                 spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS;
301         else
302                 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS |
303                                               MLX5_MATCH_MISC_PARAMETERS;
304
305         rule = mlx5_add_flow_rules(fast_fdb, spec, &flow_act, dest, i);
306
307         if (IS_ERR(rule))
308                 goto add_err;
309
310         esw->offloads.num_flows++;
311
312         return rule;
313 add_err:
314         esw_put_prio_table(esw, attr->chain, attr->prio, 1);
315 err_get_fwd:
316         esw_put_prio_table(esw, attr->chain, attr->prio, 0);
317 err_get_fast:
318         return rule;
319 }
320
321 static void
322 __mlx5_eswitch_del_rule(struct mlx5_eswitch *esw,
323                         struct mlx5_flow_handle *rule,
324                         struct mlx5_esw_flow_attr *attr,
325                         bool fwd_rule)
326 {
327         bool split = (attr->split_count > 0);
328
329         mlx5_del_flow_rules(rule);
330         esw->offloads.num_flows--;
331
332         if (fwd_rule)  {
333                 esw_put_prio_table(esw, attr->chain, attr->prio, 1);
334                 esw_put_prio_table(esw, attr->chain, attr->prio, 0);
335         } else {
336                 esw_put_prio_table(esw, attr->chain, attr->prio, !!split);
337                 if (attr->dest_chain)
338                         esw_put_prio_table(esw, attr->dest_chain, 1, 0);
339         }
340 }
341
342 void
343 mlx5_eswitch_del_offloaded_rule(struct mlx5_eswitch *esw,
344                                 struct mlx5_flow_handle *rule,
345                                 struct mlx5_esw_flow_attr *attr)
346 {
347         __mlx5_eswitch_del_rule(esw, rule, attr, false);
348 }
349
350 void
351 mlx5_eswitch_del_fwd_rule(struct mlx5_eswitch *esw,
352                           struct mlx5_flow_handle *rule,
353                           struct mlx5_esw_flow_attr *attr)
354 {
355         __mlx5_eswitch_del_rule(esw, rule, attr, true);
356 }
357
358 static int esw_set_global_vlan_pop(struct mlx5_eswitch *esw, u8 val)
359 {
360         struct mlx5_eswitch_rep *rep;
361         int vf_vport, err = 0;
362
363         esw_debug(esw->dev, "%s applying global %s policy\n", __func__, val ? "pop" : "none");
364         for (vf_vport = 1; vf_vport < esw->enabled_vports; vf_vport++) {
365                 rep = &esw->offloads.vport_reps[vf_vport];
366                 if (rep->rep_if[REP_ETH].state != REP_LOADED)
367                         continue;
368
369                 err = __mlx5_eswitch_set_vport_vlan(esw, rep->vport, 0, 0, val);
370                 if (err)
371                         goto out;
372         }
373
374 out:
375         return err;
376 }
377
378 static struct mlx5_eswitch_rep *
379 esw_vlan_action_get_vport(struct mlx5_esw_flow_attr *attr, bool push, bool pop)
380 {
381         struct mlx5_eswitch_rep *in_rep, *out_rep, *vport = NULL;
382
383         in_rep  = attr->in_rep;
384         out_rep = attr->dests[0].rep;
385
386         if (push)
387                 vport = in_rep;
388         else if (pop)
389                 vport = out_rep;
390         else
391                 vport = in_rep;
392
393         return vport;
394 }
395
396 static int esw_add_vlan_action_check(struct mlx5_esw_flow_attr *attr,
397                                      bool push, bool pop, bool fwd)
398 {
399         struct mlx5_eswitch_rep *in_rep, *out_rep;
400
401         if ((push || pop) && !fwd)
402                 goto out_notsupp;
403
404         in_rep  = attr->in_rep;
405         out_rep = attr->dests[0].rep;
406
407         if (push && in_rep->vport == MLX5_VPORT_UPLINK)
408                 goto out_notsupp;
409
410         if (pop && out_rep->vport == MLX5_VPORT_UPLINK)
411                 goto out_notsupp;
412
413         /* vport has vlan push configured, can't offload VF --> wire rules w.o it */
414         if (!push && !pop && fwd)
415                 if (in_rep->vlan && out_rep->vport == MLX5_VPORT_UPLINK)
416                         goto out_notsupp;
417
418         /* protects against (1) setting rules with different vlans to push and
419          * (2) setting rules w.o vlans (attr->vlan = 0) && w. vlans to push (!= 0)
420          */
421         if (push && in_rep->vlan_refcount && (in_rep->vlan != attr->vlan_vid[0]))
422                 goto out_notsupp;
423
424         return 0;
425
426 out_notsupp:
427         return -EOPNOTSUPP;
428 }
429
430 int mlx5_eswitch_add_vlan_action(struct mlx5_eswitch *esw,
431                                  struct mlx5_esw_flow_attr *attr)
432 {
433         struct offloads_fdb *offloads = &esw->fdb_table.offloads;
434         struct mlx5_eswitch_rep *vport = NULL;
435         bool push, pop, fwd;
436         int err = 0;
437
438         /* nop if we're on the vlan push/pop non emulation mode */
439         if (mlx5_eswitch_vlan_actions_supported(esw->dev, 1))
440                 return 0;
441
442         push = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH);
443         pop  = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP);
444         fwd  = !!((attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) &&
445                    !attr->dest_chain);
446
447         err = esw_add_vlan_action_check(attr, push, pop, fwd);
448         if (err)
449                 return err;
450
451         attr->vlan_handled = false;
452
453         vport = esw_vlan_action_get_vport(attr, push, pop);
454
455         if (!push && !pop && fwd) {
456                 /* tracks VF --> wire rules without vlan push action */
457                 if (attr->dests[0].rep->vport == MLX5_VPORT_UPLINK) {
458                         vport->vlan_refcount++;
459                         attr->vlan_handled = true;
460                 }
461
462                 return 0;
463         }
464
465         if (!push && !pop)
466                 return 0;
467
468         if (!(offloads->vlan_push_pop_refcount)) {
469                 /* it's the 1st vlan rule, apply global vlan pop policy */
470                 err = esw_set_global_vlan_pop(esw, SET_VLAN_STRIP);
471                 if (err)
472                         goto out;
473         }
474         offloads->vlan_push_pop_refcount++;
475
476         if (push) {
477                 if (vport->vlan_refcount)
478                         goto skip_set_push;
479
480                 err = __mlx5_eswitch_set_vport_vlan(esw, vport->vport, attr->vlan_vid[0], 0,
481                                                     SET_VLAN_INSERT | SET_VLAN_STRIP);
482                 if (err)
483                         goto out;
484                 vport->vlan = attr->vlan_vid[0];
485 skip_set_push:
486                 vport->vlan_refcount++;
487         }
488 out:
489         if (!err)
490                 attr->vlan_handled = true;
491         return err;
492 }
493
494 int mlx5_eswitch_del_vlan_action(struct mlx5_eswitch *esw,
495                                  struct mlx5_esw_flow_attr *attr)
496 {
497         struct offloads_fdb *offloads = &esw->fdb_table.offloads;
498         struct mlx5_eswitch_rep *vport = NULL;
499         bool push, pop, fwd;
500         int err = 0;
501
502         /* nop if we're on the vlan push/pop non emulation mode */
503         if (mlx5_eswitch_vlan_actions_supported(esw->dev, 1))
504                 return 0;
505
506         if (!attr->vlan_handled)
507                 return 0;
508
509         push = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH);
510         pop  = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP);
511         fwd  = !!(attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST);
512
513         vport = esw_vlan_action_get_vport(attr, push, pop);
514
515         if (!push && !pop && fwd) {
516                 /* tracks VF --> wire rules without vlan push action */
517                 if (attr->dests[0].rep->vport == MLX5_VPORT_UPLINK)
518                         vport->vlan_refcount--;
519
520                 return 0;
521         }
522
523         if (push) {
524                 vport->vlan_refcount--;
525                 if (vport->vlan_refcount)
526                         goto skip_unset_push;
527
528                 vport->vlan = 0;
529                 err = __mlx5_eswitch_set_vport_vlan(esw, vport->vport,
530                                                     0, 0, SET_VLAN_STRIP);
531                 if (err)
532                         goto out;
533         }
534
535 skip_unset_push:
536         offloads->vlan_push_pop_refcount--;
537         if (offloads->vlan_push_pop_refcount)
538                 return 0;
539
540         /* no more vlan rules, stop global vlan pop policy */
541         err = esw_set_global_vlan_pop(esw, 0);
542
543 out:
544         return err;
545 }
546
547 struct mlx5_flow_handle *
548 mlx5_eswitch_add_send_to_vport_rule(struct mlx5_eswitch *esw, int vport, u32 sqn)
549 {
550         struct mlx5_flow_act flow_act = {0};
551         struct mlx5_flow_destination dest = {};
552         struct mlx5_flow_handle *flow_rule;
553         struct mlx5_flow_spec *spec;
554         void *misc;
555
556         spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
557         if (!spec) {
558                 flow_rule = ERR_PTR(-ENOMEM);
559                 goto out;
560         }
561
562         misc = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters);
563         MLX5_SET(fte_match_set_misc, misc, source_sqn, sqn);
564         /* source vport is the esw manager */
565         MLX5_SET(fte_match_set_misc, misc, source_port, esw->manager_vport);
566
567         misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters);
568         MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_sqn);
569         MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
570
571         spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS;
572         dest.type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
573         dest.vport.num = vport;
574         flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
575
576         flow_rule = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb, spec,
577                                         &flow_act, &dest, 1);
578         if (IS_ERR(flow_rule))
579                 esw_warn(esw->dev, "FDB: Failed to add send to vport rule err %ld\n", PTR_ERR(flow_rule));
580 out:
581         kvfree(spec);
582         return flow_rule;
583 }
584 EXPORT_SYMBOL(mlx5_eswitch_add_send_to_vport_rule);
585
586 void mlx5_eswitch_del_send_to_vport_rule(struct mlx5_flow_handle *rule)
587 {
588         mlx5_del_flow_rules(rule);
589 }
590
591 static void peer_miss_rules_setup(struct mlx5_core_dev *peer_dev,
592                                   struct mlx5_flow_spec *spec,
593                                   struct mlx5_flow_destination *dest)
594 {
595         void *misc = MLX5_ADDR_OF(fte_match_param, spec->match_value,
596                                   misc_parameters);
597
598         MLX5_SET(fte_match_set_misc, misc, source_eswitch_owner_vhca_id,
599                  MLX5_CAP_GEN(peer_dev, vhca_id));
600
601         spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS;
602
603         misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
604                             misc_parameters);
605         MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
606         MLX5_SET_TO_ONES(fte_match_set_misc, misc,
607                          source_eswitch_owner_vhca_id);
608
609         dest->type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
610         dest->vport.num = peer_dev->priv.eswitch->manager_vport;
611         dest->vport.vhca_id = MLX5_CAP_GEN(peer_dev, vhca_id);
612         dest->vport.flags |= MLX5_FLOW_DEST_VPORT_VHCA_ID;
613 }
614
615 static int esw_add_fdb_peer_miss_rules(struct mlx5_eswitch *esw,
616                                        struct mlx5_core_dev *peer_dev)
617 {
618         struct mlx5_flow_destination dest = {};
619         struct mlx5_flow_act flow_act = {0};
620         struct mlx5_flow_handle **flows;
621         struct mlx5_flow_handle *flow;
622         struct mlx5_flow_spec *spec;
623         /* total vports is the same for both e-switches */
624         int nvports = esw->total_vports;
625         void *misc;
626         int err, i;
627
628         spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
629         if (!spec)
630                 return -ENOMEM;
631
632         peer_miss_rules_setup(peer_dev, spec, &dest);
633
634         flows = kvzalloc(nvports * sizeof(*flows), GFP_KERNEL);
635         if (!flows) {
636                 err = -ENOMEM;
637                 goto alloc_flows_err;
638         }
639
640         flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
641         misc = MLX5_ADDR_OF(fte_match_param, spec->match_value,
642                             misc_parameters);
643
644         if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
645                 MLX5_SET(fte_match_set_misc, misc, source_port, MLX5_VPORT_PF);
646                 flow = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb,
647                                            spec, &flow_act, &dest, 1);
648                 if (IS_ERR(flow)) {
649                         err = PTR_ERR(flow);
650                         goto add_pf_flow_err;
651                 }
652                 flows[MLX5_VPORT_PF] = flow;
653         }
654
655         if (mlx5_ecpf_vport_exists(esw->dev)) {
656                 MLX5_SET(fte_match_set_misc, misc, source_port, MLX5_VPORT_ECPF);
657                 flow = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb,
658                                            spec, &flow_act, &dest, 1);
659                 if (IS_ERR(flow)) {
660                         err = PTR_ERR(flow);
661                         goto add_ecpf_flow_err;
662                 }
663                 flows[mlx5_eswitch_ecpf_idx(esw)] = flow;
664         }
665
666         mlx5_esw_for_each_vf_vport(esw, i, mlx5_core_max_vfs(esw->dev)) {
667                 MLX5_SET(fte_match_set_misc, misc, source_port, i);
668                 flow = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb,
669                                            spec, &flow_act, &dest, 1);
670                 if (IS_ERR(flow)) {
671                         err = PTR_ERR(flow);
672                         goto add_vf_flow_err;
673                 }
674                 flows[i] = flow;
675         }
676
677         esw->fdb_table.offloads.peer_miss_rules = flows;
678
679         kvfree(spec);
680         return 0;
681
682 add_vf_flow_err:
683         nvports = --i;
684         mlx5_esw_for_each_vf_vport_reverse(esw, i, nvports)
685                 mlx5_del_flow_rules(flows[i]);
686
687         if (mlx5_ecpf_vport_exists(esw->dev))
688                 mlx5_del_flow_rules(flows[mlx5_eswitch_ecpf_idx(esw)]);
689 add_ecpf_flow_err:
690         if (mlx5_core_is_ecpf_esw_manager(esw->dev))
691                 mlx5_del_flow_rules(flows[MLX5_VPORT_PF]);
692 add_pf_flow_err:
693         esw_warn(esw->dev, "FDB: Failed to add peer miss flow rule err %d\n", err);
694         kvfree(flows);
695 alloc_flows_err:
696         kvfree(spec);
697         return err;
698 }
699
700 static void esw_del_fdb_peer_miss_rules(struct mlx5_eswitch *esw)
701 {
702         struct mlx5_flow_handle **flows;
703         int i;
704
705         flows = esw->fdb_table.offloads.peer_miss_rules;
706
707         mlx5_esw_for_each_vf_vport_reverse(esw, i, mlx5_core_max_vfs(esw->dev))
708                 mlx5_del_flow_rules(flows[i]);
709
710         if (mlx5_ecpf_vport_exists(esw->dev))
711                 mlx5_del_flow_rules(flows[mlx5_eswitch_ecpf_idx(esw)]);
712
713         if (mlx5_core_is_ecpf_esw_manager(esw->dev))
714                 mlx5_del_flow_rules(flows[MLX5_VPORT_PF]);
715
716         kvfree(flows);
717 }
718
719 static int esw_add_fdb_miss_rule(struct mlx5_eswitch *esw)
720 {
721         struct mlx5_flow_act flow_act = {0};
722         struct mlx5_flow_destination dest = {};
723         struct mlx5_flow_handle *flow_rule = NULL;
724         struct mlx5_flow_spec *spec;
725         void *headers_c;
726         void *headers_v;
727         int err = 0;
728         u8 *dmac_c;
729         u8 *dmac_v;
730
731         spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
732         if (!spec) {
733                 err = -ENOMEM;
734                 goto out;
735         }
736
737         spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
738         headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
739                                  outer_headers);
740         dmac_c = MLX5_ADDR_OF(fte_match_param, headers_c,
741                               outer_headers.dmac_47_16);
742         dmac_c[0] = 0x01;
743
744         dest.type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
745         dest.vport.num = esw->manager_vport;
746         flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
747
748         flow_rule = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb, spec,
749                                         &flow_act, &dest, 1);
750         if (IS_ERR(flow_rule)) {
751                 err = PTR_ERR(flow_rule);
752                 esw_warn(esw->dev,  "FDB: Failed to add unicast miss flow rule err %d\n", err);
753                 goto out;
754         }
755
756         esw->fdb_table.offloads.miss_rule_uni = flow_rule;
757
758         headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
759                                  outer_headers);
760         dmac_v = MLX5_ADDR_OF(fte_match_param, headers_v,
761                               outer_headers.dmac_47_16);
762         dmac_v[0] = 0x01;
763         flow_rule = mlx5_add_flow_rules(esw->fdb_table.offloads.slow_fdb, spec,
764                                         &flow_act, &dest, 1);
765         if (IS_ERR(flow_rule)) {
766                 err = PTR_ERR(flow_rule);
767                 esw_warn(esw->dev, "FDB: Failed to add multicast miss flow rule err %d\n", err);
768                 mlx5_del_flow_rules(esw->fdb_table.offloads.miss_rule_uni);
769                 goto out;
770         }
771
772         esw->fdb_table.offloads.miss_rule_multi = flow_rule;
773
774 out:
775         kvfree(spec);
776         return err;
777 }
778
779 #define ESW_OFFLOADS_NUM_GROUPS  4
780
781 /* Firmware currently has 4 pool of 4 sizes that it supports (ESW_POOLS),
782  * and a virtual memory region of 16M (ESW_SIZE), this region is duplicated
783  * for each flow table pool. We can allocate up to 16M of each pool,
784  * and we keep track of how much we used via put/get_sz_to_pool.
785  * Firmware doesn't report any of this for now.
786  * ESW_POOL is expected to be sorted from large to small
787  */
788 #define ESW_SIZE (16 * 1024 * 1024)
789 const unsigned int ESW_POOLS[4] = { 4 * 1024 * 1024, 1 * 1024 * 1024,
790                                     64 * 1024, 4 * 1024 };
791
792 static int
793 get_sz_from_pool(struct mlx5_eswitch *esw)
794 {
795         int sz = 0, i;
796
797         for (i = 0; i < ARRAY_SIZE(ESW_POOLS); i++) {
798                 if (esw->fdb_table.offloads.fdb_left[i]) {
799                         --esw->fdb_table.offloads.fdb_left[i];
800                         sz = ESW_POOLS[i];
801                         break;
802                 }
803         }
804
805         return sz;
806 }
807
808 static void
809 put_sz_to_pool(struct mlx5_eswitch *esw, int sz)
810 {
811         int i;
812
813         for (i = 0; i < ARRAY_SIZE(ESW_POOLS); i++) {
814                 if (sz >= ESW_POOLS[i]) {
815                         ++esw->fdb_table.offloads.fdb_left[i];
816                         break;
817                 }
818         }
819 }
820
821 static struct mlx5_flow_table *
822 create_next_size_table(struct mlx5_eswitch *esw,
823                        struct mlx5_flow_namespace *ns,
824                        u16 table_prio,
825                        int level,
826                        u32 flags)
827 {
828         struct mlx5_flow_table *fdb;
829         int sz;
830
831         sz = get_sz_from_pool(esw);
832         if (!sz)
833                 return ERR_PTR(-ENOSPC);
834
835         fdb = mlx5_create_auto_grouped_flow_table(ns,
836                                                   table_prio,
837                                                   sz,
838                                                   ESW_OFFLOADS_NUM_GROUPS,
839                                                   level,
840                                                   flags);
841         if (IS_ERR(fdb)) {
842                 esw_warn(esw->dev, "Failed to create FDB Table err %d (table prio: %d, level: %d, size: %d)\n",
843                          (int)PTR_ERR(fdb), table_prio, level, sz);
844                 put_sz_to_pool(esw, sz);
845         }
846
847         return fdb;
848 }
849
850 static struct mlx5_flow_table *
851 esw_get_prio_table(struct mlx5_eswitch *esw, u32 chain, u16 prio, int level)
852 {
853         struct mlx5_core_dev *dev = esw->dev;
854         struct mlx5_flow_table *fdb = NULL;
855         struct mlx5_flow_namespace *ns;
856         int table_prio, l = 0;
857         u32 flags = 0;
858
859         if (chain == FDB_SLOW_PATH_CHAIN)
860                 return esw->fdb_table.offloads.slow_fdb;
861
862         mutex_lock(&esw->fdb_table.offloads.fdb_prio_lock);
863
864         fdb = fdb_prio_table(esw, chain, prio, level).fdb;
865         if (fdb) {
866                 /* take ref on earlier levels as well */
867                 while (level >= 0)
868                         fdb_prio_table(esw, chain, prio, level--).num_rules++;
869                 mutex_unlock(&esw->fdb_table.offloads.fdb_prio_lock);
870                 return fdb;
871         }
872
873         ns = mlx5_get_fdb_sub_ns(dev, chain);
874         if (!ns) {
875                 esw_warn(dev, "Failed to get FDB sub namespace\n");
876                 mutex_unlock(&esw->fdb_table.offloads.fdb_prio_lock);
877                 return ERR_PTR(-EOPNOTSUPP);
878         }
879
880         if (esw->offloads.encap != DEVLINK_ESWITCH_ENCAP_MODE_NONE)
881                 flags |= (MLX5_FLOW_TABLE_TUNNEL_EN_REFORMAT |
882                           MLX5_FLOW_TABLE_TUNNEL_EN_DECAP);
883
884         table_prio = (chain * FDB_MAX_PRIO) + prio - 1;
885
886         /* create earlier levels for correct fs_core lookup when
887          * connecting tables
888          */
889         for (l = 0; l <= level; l++) {
890                 if (fdb_prio_table(esw, chain, prio, l).fdb) {
891                         fdb_prio_table(esw, chain, prio, l).num_rules++;
892                         continue;
893                 }
894
895                 fdb = create_next_size_table(esw, ns, table_prio, l, flags);
896                 if (IS_ERR(fdb)) {
897                         l--;
898                         goto err_create_fdb;
899                 }
900
901                 fdb_prio_table(esw, chain, prio, l).fdb = fdb;
902                 fdb_prio_table(esw, chain, prio, l).num_rules = 1;
903         }
904
905         mutex_unlock(&esw->fdb_table.offloads.fdb_prio_lock);
906         return fdb;
907
908 err_create_fdb:
909         mutex_unlock(&esw->fdb_table.offloads.fdb_prio_lock);
910         if (l >= 0)
911                 esw_put_prio_table(esw, chain, prio, l);
912
913         return fdb;
914 }
915
916 static void
917 esw_put_prio_table(struct mlx5_eswitch *esw, u32 chain, u16 prio, int level)
918 {
919         int l;
920
921         if (chain == FDB_SLOW_PATH_CHAIN)
922                 return;
923
924         mutex_lock(&esw->fdb_table.offloads.fdb_prio_lock);
925
926         for (l = level; l >= 0; l--) {
927                 if (--(fdb_prio_table(esw, chain, prio, l).num_rules) > 0)
928                         continue;
929
930                 put_sz_to_pool(esw, fdb_prio_table(esw, chain, prio, l).fdb->max_fte);
931                 mlx5_destroy_flow_table(fdb_prio_table(esw, chain, prio, l).fdb);
932                 fdb_prio_table(esw, chain, prio, l).fdb = NULL;
933         }
934
935         mutex_unlock(&esw->fdb_table.offloads.fdb_prio_lock);
936 }
937
938 static void esw_destroy_offloads_fast_fdb_tables(struct mlx5_eswitch *esw)
939 {
940         /* If lazy creation isn't supported, deref the fast path tables */
941         if (!(esw->fdb_table.flags & ESW_FDB_CHAINS_AND_PRIOS_SUPPORTED)) {
942                 esw_put_prio_table(esw, 0, 1, 1);
943                 esw_put_prio_table(esw, 0, 1, 0);
944         }
945 }
946
947 #define MAX_PF_SQ 256
948 #define MAX_SQ_NVPORTS 32
949
950 static int esw_create_offloads_fdb_tables(struct mlx5_eswitch *esw, int nvports)
951 {
952         int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
953         struct mlx5_flow_table_attr ft_attr = {};
954         struct mlx5_core_dev *dev = esw->dev;
955         u32 *flow_group_in, max_flow_counter;
956         struct mlx5_flow_namespace *root_ns;
957         struct mlx5_flow_table *fdb = NULL;
958         int table_size, ix, err = 0, i;
959         struct mlx5_flow_group *g;
960         u32 flags = 0, fdb_max;
961         void *match_criteria;
962         u8 *dmac;
963
964         esw_debug(esw->dev, "Create offloads FDB Tables\n");
965         flow_group_in = kvzalloc(inlen, GFP_KERNEL);
966         if (!flow_group_in)
967                 return -ENOMEM;
968
969         root_ns = mlx5_get_flow_namespace(dev, MLX5_FLOW_NAMESPACE_FDB);
970         if (!root_ns) {
971                 esw_warn(dev, "Failed to get FDB flow namespace\n");
972                 err = -EOPNOTSUPP;
973                 goto ns_err;
974         }
975
976         max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) |
977                             MLX5_CAP_GEN(dev, max_flow_counter_15_0);
978         fdb_max = 1 << MLX5_CAP_ESW_FLOWTABLE_FDB(dev, log_max_ft_size);
979
980         esw_debug(dev, "Create offloads FDB table, min (max esw size(2^%d), max counters(%d), groups(%d), max flow table size(2^%d))\n",
981                   MLX5_CAP_ESW_FLOWTABLE_FDB(dev, log_max_ft_size),
982                   max_flow_counter, ESW_OFFLOADS_NUM_GROUPS,
983                   fdb_max);
984
985         for (i = 0; i < ARRAY_SIZE(ESW_POOLS); i++)
986                 esw->fdb_table.offloads.fdb_left[i] =
987                         ESW_POOLS[i] <= fdb_max ? ESW_SIZE / ESW_POOLS[i] : 0;
988
989         table_size = nvports * MAX_SQ_NVPORTS + MAX_PF_SQ +
990                 MLX5_ESW_MISS_FLOWS + esw->total_vports;
991
992         /* create the slow path fdb with encap set, so further table instances
993          * can be created at run time while VFs are probed if the FW allows that.
994          */
995         if (esw->offloads.encap != DEVLINK_ESWITCH_ENCAP_MODE_NONE)
996                 flags |= (MLX5_FLOW_TABLE_TUNNEL_EN_REFORMAT |
997                           MLX5_FLOW_TABLE_TUNNEL_EN_DECAP);
998
999         ft_attr.flags = flags;
1000         ft_attr.max_fte = table_size;
1001         ft_attr.prio = FDB_SLOW_PATH;
1002
1003         fdb = mlx5_create_flow_table(root_ns, &ft_attr);
1004         if (IS_ERR(fdb)) {
1005                 err = PTR_ERR(fdb);
1006                 esw_warn(dev, "Failed to create slow path FDB Table err %d\n", err);
1007                 goto slow_fdb_err;
1008         }
1009         esw->fdb_table.offloads.slow_fdb = fdb;
1010
1011         /* If lazy creation isn't supported, open the fast path tables now */
1012         if (!MLX5_CAP_ESW_FLOWTABLE(esw->dev, multi_fdb_encap) &&
1013             esw->offloads.encap != DEVLINK_ESWITCH_ENCAP_MODE_NONE) {
1014                 esw->fdb_table.flags &= ~ESW_FDB_CHAINS_AND_PRIOS_SUPPORTED;
1015                 esw_warn(dev, "Lazy creation of flow tables isn't supported, ignoring priorities\n");
1016                 esw_get_prio_table(esw, 0, 1, 0);
1017                 esw_get_prio_table(esw, 0, 1, 1);
1018         } else {
1019                 esw_debug(dev, "Lazy creation of flow tables supported, deferring table opening\n");
1020                 esw->fdb_table.flags |= ESW_FDB_CHAINS_AND_PRIOS_SUPPORTED;
1021         }
1022
1023         /* create send-to-vport group */
1024         memset(flow_group_in, 0, inlen);
1025         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
1026                  MLX5_MATCH_MISC_PARAMETERS);
1027
1028         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
1029
1030         MLX5_SET_TO_ONES(fte_match_param, match_criteria, misc_parameters.source_sqn);
1031         MLX5_SET_TO_ONES(fte_match_param, match_criteria, misc_parameters.source_port);
1032
1033         ix = nvports * MAX_SQ_NVPORTS + MAX_PF_SQ;
1034         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
1035         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, ix - 1);
1036
1037         g = mlx5_create_flow_group(fdb, flow_group_in);
1038         if (IS_ERR(g)) {
1039                 err = PTR_ERR(g);
1040                 esw_warn(dev, "Failed to create send-to-vport flow group err(%d)\n", err);
1041                 goto send_vport_err;
1042         }
1043         esw->fdb_table.offloads.send_to_vport_grp = g;
1044
1045         /* create peer esw miss group */
1046         memset(flow_group_in, 0, inlen);
1047         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
1048                  MLX5_MATCH_MISC_PARAMETERS);
1049
1050         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in,
1051                                       match_criteria);
1052
1053         MLX5_SET_TO_ONES(fte_match_param, match_criteria,
1054                          misc_parameters.source_port);
1055         MLX5_SET_TO_ONES(fte_match_param, match_criteria,
1056                          misc_parameters.source_eswitch_owner_vhca_id);
1057
1058         MLX5_SET(create_flow_group_in, flow_group_in,
1059                  source_eswitch_owner_vhca_id_valid, 1);
1060         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, ix);
1061         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index,
1062                  ix + esw->total_vports - 1);
1063         ix += esw->total_vports;
1064
1065         g = mlx5_create_flow_group(fdb, flow_group_in);
1066         if (IS_ERR(g)) {
1067                 err = PTR_ERR(g);
1068                 esw_warn(dev, "Failed to create peer miss flow group err(%d)\n", err);
1069                 goto peer_miss_err;
1070         }
1071         esw->fdb_table.offloads.peer_miss_grp = g;
1072
1073         /* create miss group */
1074         memset(flow_group_in, 0, inlen);
1075         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
1076                  MLX5_MATCH_OUTER_HEADERS);
1077         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in,
1078                                       match_criteria);
1079         dmac = MLX5_ADDR_OF(fte_match_param, match_criteria,
1080                             outer_headers.dmac_47_16);
1081         dmac[0] = 0x01;
1082
1083         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, ix);
1084         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index,
1085                  ix + MLX5_ESW_MISS_FLOWS);
1086
1087         g = mlx5_create_flow_group(fdb, flow_group_in);
1088         if (IS_ERR(g)) {
1089                 err = PTR_ERR(g);
1090                 esw_warn(dev, "Failed to create miss flow group err(%d)\n", err);
1091                 goto miss_err;
1092         }
1093         esw->fdb_table.offloads.miss_grp = g;
1094
1095         err = esw_add_fdb_miss_rule(esw);
1096         if (err)
1097                 goto miss_rule_err;
1098
1099         esw->nvports = nvports;
1100         kvfree(flow_group_in);
1101         return 0;
1102
1103 miss_rule_err:
1104         mlx5_destroy_flow_group(esw->fdb_table.offloads.miss_grp);
1105 miss_err:
1106         mlx5_destroy_flow_group(esw->fdb_table.offloads.peer_miss_grp);
1107 peer_miss_err:
1108         mlx5_destroy_flow_group(esw->fdb_table.offloads.send_to_vport_grp);
1109 send_vport_err:
1110         esw_destroy_offloads_fast_fdb_tables(esw);
1111         mlx5_destroy_flow_table(esw->fdb_table.offloads.slow_fdb);
1112 slow_fdb_err:
1113 ns_err:
1114         kvfree(flow_group_in);
1115         return err;
1116 }
1117
1118 static void esw_destroy_offloads_fdb_tables(struct mlx5_eswitch *esw)
1119 {
1120         if (!esw->fdb_table.offloads.slow_fdb)
1121                 return;
1122
1123         esw_debug(esw->dev, "Destroy offloads FDB Tables\n");
1124         mlx5_del_flow_rules(esw->fdb_table.offloads.miss_rule_multi);
1125         mlx5_del_flow_rules(esw->fdb_table.offloads.miss_rule_uni);
1126         mlx5_destroy_flow_group(esw->fdb_table.offloads.send_to_vport_grp);
1127         mlx5_destroy_flow_group(esw->fdb_table.offloads.peer_miss_grp);
1128         mlx5_destroy_flow_group(esw->fdb_table.offloads.miss_grp);
1129
1130         mlx5_destroy_flow_table(esw->fdb_table.offloads.slow_fdb);
1131         esw_destroy_offloads_fast_fdb_tables(esw);
1132 }
1133
1134 static int esw_create_offloads_table(struct mlx5_eswitch *esw, int nvports)
1135 {
1136         struct mlx5_flow_table_attr ft_attr = {};
1137         struct mlx5_core_dev *dev = esw->dev;
1138         struct mlx5_flow_table *ft_offloads;
1139         struct mlx5_flow_namespace *ns;
1140         int err = 0;
1141
1142         ns = mlx5_get_flow_namespace(dev, MLX5_FLOW_NAMESPACE_OFFLOADS);
1143         if (!ns) {
1144                 esw_warn(esw->dev, "Failed to get offloads flow namespace\n");
1145                 return -EOPNOTSUPP;
1146         }
1147
1148         ft_attr.max_fte = nvports + MLX5_ESW_MISS_FLOWS;
1149
1150         ft_offloads = mlx5_create_flow_table(ns, &ft_attr);
1151         if (IS_ERR(ft_offloads)) {
1152                 err = PTR_ERR(ft_offloads);
1153                 esw_warn(esw->dev, "Failed to create offloads table, err %d\n", err);
1154                 return err;
1155         }
1156
1157         esw->offloads.ft_offloads = ft_offloads;
1158         return 0;
1159 }
1160
1161 static void esw_destroy_offloads_table(struct mlx5_eswitch *esw)
1162 {
1163         struct mlx5_esw_offload *offloads = &esw->offloads;
1164
1165         mlx5_destroy_flow_table(offloads->ft_offloads);
1166 }
1167
1168 static int esw_create_vport_rx_group(struct mlx5_eswitch *esw, int nvports)
1169 {
1170         int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1171         struct mlx5_flow_group *g;
1172         u32 *flow_group_in;
1173         void *match_criteria, *misc;
1174         int err = 0;
1175
1176         nvports = nvports + MLX5_ESW_MISS_FLOWS;
1177         flow_group_in = kvzalloc(inlen, GFP_KERNEL);
1178         if (!flow_group_in)
1179                 return -ENOMEM;
1180
1181         /* create vport rx group */
1182         memset(flow_group_in, 0, inlen);
1183         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
1184                  MLX5_MATCH_MISC_PARAMETERS);
1185
1186         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
1187         misc = MLX5_ADDR_OF(fte_match_param, match_criteria, misc_parameters);
1188         MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
1189
1190         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
1191         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, nvports - 1);
1192
1193         g = mlx5_create_flow_group(esw->offloads.ft_offloads, flow_group_in);
1194
1195         if (IS_ERR(g)) {
1196                 err = PTR_ERR(g);
1197                 mlx5_core_warn(esw->dev, "Failed to create vport rx group err %d\n", err);
1198                 goto out;
1199         }
1200
1201         esw->offloads.vport_rx_group = g;
1202 out:
1203         kvfree(flow_group_in);
1204         return err;
1205 }
1206
1207 static void esw_destroy_vport_rx_group(struct mlx5_eswitch *esw)
1208 {
1209         mlx5_destroy_flow_group(esw->offloads.vport_rx_group);
1210 }
1211
1212 struct mlx5_flow_handle *
1213 mlx5_eswitch_create_vport_rx_rule(struct mlx5_eswitch *esw, int vport,
1214                                   struct mlx5_flow_destination *dest)
1215 {
1216         struct mlx5_flow_act flow_act = {0};
1217         struct mlx5_flow_handle *flow_rule;
1218         struct mlx5_flow_spec *spec;
1219         void *misc;
1220
1221         spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1222         if (!spec) {
1223                 flow_rule = ERR_PTR(-ENOMEM);
1224                 goto out;
1225         }
1226
1227         misc = MLX5_ADDR_OF(fte_match_param, spec->match_value, misc_parameters);
1228         MLX5_SET(fte_match_set_misc, misc, source_port, vport);
1229
1230         misc = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, misc_parameters);
1231         MLX5_SET_TO_ONES(fte_match_set_misc, misc, source_port);
1232
1233         spec->match_criteria_enable = MLX5_MATCH_MISC_PARAMETERS;
1234
1235         flow_act.action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
1236         flow_rule = mlx5_add_flow_rules(esw->offloads.ft_offloads, spec,
1237                                         &flow_act, dest, 1);
1238         if (IS_ERR(flow_rule)) {
1239                 esw_warn(esw->dev, "fs offloads: Failed to add vport rx rule err %ld\n", PTR_ERR(flow_rule));
1240                 goto out;
1241         }
1242
1243 out:
1244         kvfree(spec);
1245         return flow_rule;
1246 }
1247
1248 static int esw_offloads_start(struct mlx5_eswitch *esw,
1249                               struct netlink_ext_ack *extack)
1250 {
1251         int err, err1, num_vfs = esw->dev->priv.sriov.num_vfs;
1252
1253         if (esw->mode != SRIOV_LEGACY &&
1254             !mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1255                 NL_SET_ERR_MSG_MOD(extack,
1256                                    "Can't set offloads mode, SRIOV legacy not enabled");
1257                 return -EINVAL;
1258         }
1259
1260         mlx5_eswitch_disable_sriov(esw);
1261         err = mlx5_eswitch_enable_sriov(esw, num_vfs, SRIOV_OFFLOADS);
1262         if (err) {
1263                 NL_SET_ERR_MSG_MOD(extack,
1264                                    "Failed setting eswitch to offloads");
1265                 err1 = mlx5_eswitch_enable_sriov(esw, num_vfs, SRIOV_LEGACY);
1266                 if (err1) {
1267                         NL_SET_ERR_MSG_MOD(extack,
1268                                            "Failed setting eswitch back to legacy");
1269                 }
1270         }
1271         if (esw->offloads.inline_mode == MLX5_INLINE_MODE_NONE) {
1272                 if (mlx5_eswitch_inline_mode_get(esw,
1273                                                  num_vfs,
1274                                                  &esw->offloads.inline_mode)) {
1275                         esw->offloads.inline_mode = MLX5_INLINE_MODE_L2;
1276                         NL_SET_ERR_MSG_MOD(extack,
1277                                            "Inline mode is different between vports");
1278                 }
1279         }
1280         return err;
1281 }
1282
1283 void esw_offloads_cleanup_reps(struct mlx5_eswitch *esw)
1284 {
1285         kfree(esw->offloads.vport_reps);
1286 }
1287
1288 int esw_offloads_init_reps(struct mlx5_eswitch *esw)
1289 {
1290         int total_vfs = MLX5_TOTAL_VPORTS(esw->dev);
1291         struct mlx5_core_dev *dev = esw->dev;
1292         struct mlx5_eswitch_rep *rep;
1293         u8 hw_id[ETH_ALEN], rep_type;
1294         int vport;
1295
1296         esw->offloads.vport_reps = kcalloc(total_vfs,
1297                                            sizeof(struct mlx5_eswitch_rep),
1298                                            GFP_KERNEL);
1299         if (!esw->offloads.vport_reps)
1300                 return -ENOMEM;
1301
1302         mlx5_query_nic_vport_mac_address(dev, 0, hw_id);
1303
1304         mlx5_esw_for_all_reps(esw, vport, rep) {
1305                 rep->vport = mlx5_eswitch_index_to_vport_num(esw, vport);
1306                 ether_addr_copy(rep->hw_id, hw_id);
1307
1308                 for (rep_type = 0; rep_type < NUM_REP_TYPES; rep_type++)
1309                         rep->rep_if[rep_type].state = REP_UNREGISTERED;
1310         }
1311
1312         return 0;
1313 }
1314
1315 static void __esw_offloads_unload_rep(struct mlx5_eswitch *esw,
1316                                       struct mlx5_eswitch_rep *rep, u8 rep_type)
1317 {
1318         if (rep->rep_if[rep_type].state != REP_LOADED)
1319                 return;
1320
1321         rep->rep_if[rep_type].unload(rep);
1322         rep->rep_if[rep_type].state = REP_REGISTERED;
1323 }
1324
1325 static void __unload_reps_special_vport(struct mlx5_eswitch *esw, u8 rep_type)
1326 {
1327         struct mlx5_eswitch_rep *rep;
1328
1329         if (mlx5_ecpf_vport_exists(esw->dev)) {
1330                 rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_ECPF);
1331                 __esw_offloads_unload_rep(esw, rep, rep_type);
1332         }
1333
1334         if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1335                 rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_PF);
1336                 __esw_offloads_unload_rep(esw, rep, rep_type);
1337         }
1338
1339         rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_UPLINK);
1340         __esw_offloads_unload_rep(esw, rep, rep_type);
1341 }
1342
1343 static void __unload_reps_vf_vport(struct mlx5_eswitch *esw, int nvports,
1344                                    u8 rep_type)
1345 {
1346         struct mlx5_eswitch_rep *rep;
1347         int i;
1348
1349         mlx5_esw_for_each_vf_rep_reverse(esw, i, rep, nvports)
1350                 __esw_offloads_unload_rep(esw, rep, rep_type);
1351 }
1352
1353 static void esw_offloads_unload_vf_reps(struct mlx5_eswitch *esw, int nvports)
1354 {
1355         u8 rep_type = NUM_REP_TYPES;
1356
1357         while (rep_type-- > 0)
1358                 __unload_reps_vf_vport(esw, nvports, rep_type);
1359 }
1360
1361 static void __unload_reps_all_vport(struct mlx5_eswitch *esw, int nvports,
1362                                     u8 rep_type)
1363 {
1364         __unload_reps_vf_vport(esw, nvports, rep_type);
1365
1366         /* Special vports must be the last to unload. */
1367         __unload_reps_special_vport(esw, rep_type);
1368 }
1369
1370 static void esw_offloads_unload_all_reps(struct mlx5_eswitch *esw, int nvports)
1371 {
1372         u8 rep_type = NUM_REP_TYPES;
1373
1374         while (rep_type-- > 0)
1375                 __unload_reps_all_vport(esw, nvports, rep_type);
1376 }
1377
1378 static int __esw_offloads_load_rep(struct mlx5_eswitch *esw,
1379                                    struct mlx5_eswitch_rep *rep, u8 rep_type)
1380 {
1381         int err = 0;
1382
1383         if (rep->rep_if[rep_type].state != REP_REGISTERED)
1384                 return 0;
1385
1386         err = rep->rep_if[rep_type].load(esw->dev, rep);
1387         if (err)
1388                 return err;
1389
1390         rep->rep_if[rep_type].state = REP_LOADED;
1391
1392         return 0;
1393 }
1394
1395 static int __load_reps_special_vport(struct mlx5_eswitch *esw, u8 rep_type)
1396 {
1397         struct mlx5_eswitch_rep *rep;
1398         int err;
1399
1400         rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_UPLINK);
1401         err = __esw_offloads_load_rep(esw, rep, rep_type);
1402         if (err)
1403                 return err;
1404
1405         if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1406                 rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_PF);
1407                 err = __esw_offloads_load_rep(esw, rep, rep_type);
1408                 if (err)
1409                         goto err_pf;
1410         }
1411
1412         if (mlx5_ecpf_vport_exists(esw->dev)) {
1413                 rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_ECPF);
1414                 err = __esw_offloads_load_rep(esw, rep, rep_type);
1415                 if (err)
1416                         goto err_ecpf;
1417         }
1418
1419         return 0;
1420
1421 err_ecpf:
1422         if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1423                 rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_PF);
1424                 __esw_offloads_unload_rep(esw, rep, rep_type);
1425         }
1426
1427 err_pf:
1428         rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_UPLINK);
1429         __esw_offloads_unload_rep(esw, rep, rep_type);
1430         return err;
1431 }
1432
1433 static int __load_reps_vf_vport(struct mlx5_eswitch *esw, int nvports,
1434                                 u8 rep_type)
1435 {
1436         struct mlx5_eswitch_rep *rep;
1437         int err, i;
1438
1439         mlx5_esw_for_each_vf_rep(esw, i, rep, nvports) {
1440                 err = __esw_offloads_load_rep(esw, rep, rep_type);
1441                 if (err)
1442                         goto err_vf;
1443         }
1444
1445         return 0;
1446
1447 err_vf:
1448         __unload_reps_vf_vport(esw, --i, rep_type);
1449         return err;
1450 }
1451
1452 static int esw_offloads_load_vf_reps(struct mlx5_eswitch *esw, int nvports)
1453 {
1454         u8 rep_type = 0;
1455         int err;
1456
1457         for (rep_type = 0; rep_type < NUM_REP_TYPES; rep_type++) {
1458                 err = __load_reps_vf_vport(esw, nvports, rep_type);
1459                 if (err)
1460                         goto err_reps;
1461         }
1462
1463         return err;
1464
1465 err_reps:
1466         while (rep_type-- > 0)
1467                 __unload_reps_vf_vport(esw, nvports, rep_type);
1468         return err;
1469 }
1470
1471 static int __load_reps_all_vport(struct mlx5_eswitch *esw, int nvports,
1472                                  u8 rep_type)
1473 {
1474         int err;
1475
1476         /* Special vports must be loaded first. */
1477         err = __load_reps_special_vport(esw, rep_type);
1478         if (err)
1479                 return err;
1480
1481         err = __load_reps_vf_vport(esw, nvports, rep_type);
1482         if (err)
1483                 goto err_vfs;
1484
1485         return 0;
1486
1487 err_vfs:
1488         __unload_reps_special_vport(esw, rep_type);
1489         return err;
1490 }
1491
1492 static int esw_offloads_load_all_reps(struct mlx5_eswitch *esw, int nvports)
1493 {
1494         u8 rep_type = 0;
1495         int err;
1496
1497         for (rep_type = 0; rep_type < NUM_REP_TYPES; rep_type++) {
1498                 err = __load_reps_all_vport(esw, nvports, rep_type);
1499                 if (err)
1500                         goto err_reps;
1501         }
1502
1503         return err;
1504
1505 err_reps:
1506         while (rep_type-- > 0)
1507                 __unload_reps_all_vport(esw, nvports, rep_type);
1508         return err;
1509 }
1510
1511 #define ESW_OFFLOADS_DEVCOM_PAIR        (0)
1512 #define ESW_OFFLOADS_DEVCOM_UNPAIR      (1)
1513
1514 static int mlx5_esw_offloads_pair(struct mlx5_eswitch *esw,
1515                                   struct mlx5_eswitch *peer_esw)
1516 {
1517         int err;
1518
1519         err = esw_add_fdb_peer_miss_rules(esw, peer_esw->dev);
1520         if (err)
1521                 return err;
1522
1523         return 0;
1524 }
1525
1526 void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw);
1527
1528 static void mlx5_esw_offloads_unpair(struct mlx5_eswitch *esw)
1529 {
1530         mlx5e_tc_clean_fdb_peer_flows(esw);
1531         esw_del_fdb_peer_miss_rules(esw);
1532 }
1533
1534 static int mlx5_esw_offloads_devcom_event(int event,
1535                                           void *my_data,
1536                                           void *event_data)
1537 {
1538         struct mlx5_eswitch *esw = my_data;
1539         struct mlx5_eswitch *peer_esw = event_data;
1540         struct mlx5_devcom *devcom = esw->dev->priv.devcom;
1541         int err;
1542
1543         switch (event) {
1544         case ESW_OFFLOADS_DEVCOM_PAIR:
1545                 err = mlx5_esw_offloads_pair(esw, peer_esw);
1546                 if (err)
1547                         goto err_out;
1548
1549                 err = mlx5_esw_offloads_pair(peer_esw, esw);
1550                 if (err)
1551                         goto err_pair;
1552
1553                 mlx5_devcom_set_paired(devcom, MLX5_DEVCOM_ESW_OFFLOADS, true);
1554                 break;
1555
1556         case ESW_OFFLOADS_DEVCOM_UNPAIR:
1557                 if (!mlx5_devcom_is_paired(devcom, MLX5_DEVCOM_ESW_OFFLOADS))
1558                         break;
1559
1560                 mlx5_devcom_set_paired(devcom, MLX5_DEVCOM_ESW_OFFLOADS, false);
1561                 mlx5_esw_offloads_unpair(peer_esw);
1562                 mlx5_esw_offloads_unpair(esw);
1563                 break;
1564         }
1565
1566         return 0;
1567
1568 err_pair:
1569         mlx5_esw_offloads_unpair(esw);
1570
1571 err_out:
1572         mlx5_core_err(esw->dev, "esw offloads devcom event failure, event %u err %d",
1573                       event, err);
1574         return err;
1575 }
1576
1577 static void esw_offloads_devcom_init(struct mlx5_eswitch *esw)
1578 {
1579         struct mlx5_devcom *devcom = esw->dev->priv.devcom;
1580
1581         INIT_LIST_HEAD(&esw->offloads.peer_flows);
1582         mutex_init(&esw->offloads.peer_mutex);
1583
1584         if (!MLX5_CAP_ESW(esw->dev, merged_eswitch))
1585                 return;
1586
1587         mlx5_devcom_register_component(devcom,
1588                                        MLX5_DEVCOM_ESW_OFFLOADS,
1589                                        mlx5_esw_offloads_devcom_event,
1590                                        esw);
1591
1592         mlx5_devcom_send_event(devcom,
1593                                MLX5_DEVCOM_ESW_OFFLOADS,
1594                                ESW_OFFLOADS_DEVCOM_PAIR, esw);
1595 }
1596
1597 static void esw_offloads_devcom_cleanup(struct mlx5_eswitch *esw)
1598 {
1599         struct mlx5_devcom *devcom = esw->dev->priv.devcom;
1600
1601         if (!MLX5_CAP_ESW(esw->dev, merged_eswitch))
1602                 return;
1603
1604         mlx5_devcom_send_event(devcom, MLX5_DEVCOM_ESW_OFFLOADS,
1605                                ESW_OFFLOADS_DEVCOM_UNPAIR, esw);
1606
1607         mlx5_devcom_unregister_component(devcom, MLX5_DEVCOM_ESW_OFFLOADS);
1608 }
1609
1610 static int esw_offloads_steering_init(struct mlx5_eswitch *esw, int nvports)
1611 {
1612         int err;
1613
1614         memset(&esw->fdb_table.offloads, 0, sizeof(struct offloads_fdb));
1615         mutex_init(&esw->fdb_table.offloads.fdb_prio_lock);
1616
1617         err = esw_create_offloads_fdb_tables(esw, nvports);
1618         if (err)
1619                 return err;
1620
1621         err = esw_create_offloads_table(esw, nvports);
1622         if (err)
1623                 goto create_ft_err;
1624
1625         err = esw_create_vport_rx_group(esw, nvports);
1626         if (err)
1627                 goto create_fg_err;
1628
1629         return 0;
1630
1631 create_fg_err:
1632         esw_destroy_offloads_table(esw);
1633
1634 create_ft_err:
1635         esw_destroy_offloads_fdb_tables(esw);
1636
1637         return err;
1638 }
1639
1640 static void esw_offloads_steering_cleanup(struct mlx5_eswitch *esw)
1641 {
1642         esw_destroy_vport_rx_group(esw);
1643         esw_destroy_offloads_table(esw);
1644         esw_destroy_offloads_fdb_tables(esw);
1645 }
1646
1647 static void esw_host_params_event_handler(struct work_struct *work)
1648 {
1649         struct mlx5_host_work *host_work;
1650         struct mlx5_eswitch *esw;
1651         int err, num_vf = 0;
1652
1653         host_work = container_of(work, struct mlx5_host_work, work);
1654         esw = host_work->esw;
1655
1656         err = mlx5_query_host_params_num_vfs(esw->dev, &num_vf);
1657         if (err || num_vf == esw->host_info.num_vfs)
1658                 goto out;
1659
1660         /* Number of VFs can only change from "0 to x" or "x to 0". */
1661         if (esw->host_info.num_vfs > 0) {
1662                 esw_offloads_unload_vf_reps(esw, esw->host_info.num_vfs);
1663         } else {
1664                 err = esw_offloads_load_vf_reps(esw, num_vf);
1665
1666                 if (err)
1667                         goto out;
1668         }
1669
1670         esw->host_info.num_vfs = num_vf;
1671
1672 out:
1673         kfree(host_work);
1674 }
1675
1676 static int esw_host_params_event(struct notifier_block *nb,
1677                                  unsigned long type, void *data)
1678 {
1679         struct mlx5_host_work *host_work;
1680         struct mlx5_host_info *host_info;
1681         struct mlx5_eswitch *esw;
1682
1683         host_work = kzalloc(sizeof(*host_work), GFP_ATOMIC);
1684         if (!host_work)
1685                 return NOTIFY_DONE;
1686
1687         host_info = mlx5_nb_cof(nb, struct mlx5_host_info, nb);
1688         esw = container_of(host_info, struct mlx5_eswitch, host_info);
1689
1690         host_work->esw = esw;
1691
1692         INIT_WORK(&host_work->work, esw_host_params_event_handler);
1693         queue_work(esw->work_queue, &host_work->work);
1694
1695         return NOTIFY_OK;
1696 }
1697
1698 int esw_offloads_init(struct mlx5_eswitch *esw, int vf_nvports,
1699                       int total_nvports)
1700 {
1701         int err;
1702
1703         mutex_init(&esw->fdb_table.offloads.fdb_prio_lock);
1704
1705         err = esw_offloads_steering_init(esw, total_nvports);
1706         if (err)
1707                 return err;
1708
1709         err = esw_offloads_load_all_reps(esw, vf_nvports);
1710         if (err)
1711                 goto err_reps;
1712
1713         esw_offloads_devcom_init(esw);
1714
1715         if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1716                 MLX5_NB_INIT(&esw->host_info.nb, esw_host_params_event,
1717                              HOST_PARAMS_CHANGE);
1718                 mlx5_eq_notifier_register(esw->dev, &esw->host_info.nb);
1719                 esw->host_info.num_vfs = vf_nvports;
1720         }
1721
1722         return 0;
1723
1724 err_reps:
1725         esw_offloads_steering_cleanup(esw);
1726         return err;
1727 }
1728
1729 static int esw_offloads_stop(struct mlx5_eswitch *esw,
1730                              struct netlink_ext_ack *extack)
1731 {
1732         int err, err1, num_vfs = esw->dev->priv.sriov.num_vfs;
1733
1734         mlx5_eswitch_disable_sriov(esw);
1735         err = mlx5_eswitch_enable_sriov(esw, num_vfs, SRIOV_LEGACY);
1736         if (err) {
1737                 NL_SET_ERR_MSG_MOD(extack, "Failed setting eswitch to legacy");
1738                 err1 = mlx5_eswitch_enable_sriov(esw, num_vfs, SRIOV_OFFLOADS);
1739                 if (err1) {
1740                         NL_SET_ERR_MSG_MOD(extack,
1741                                            "Failed setting eswitch back to offloads");
1742                 }
1743         }
1744
1745         return err;
1746 }
1747
1748 void esw_offloads_cleanup(struct mlx5_eswitch *esw)
1749 {
1750         u16 num_vfs;
1751
1752         if (mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1753                 mlx5_eq_notifier_unregister(esw->dev, &esw->host_info.nb);
1754                 flush_workqueue(esw->work_queue);
1755                 num_vfs = esw->host_info.num_vfs;
1756         } else {
1757                 num_vfs = esw->dev->priv.sriov.num_vfs;
1758         }
1759
1760         esw_offloads_devcom_cleanup(esw);
1761         esw_offloads_unload_all_reps(esw, num_vfs);
1762         esw_offloads_steering_cleanup(esw);
1763 }
1764
1765 static int esw_mode_from_devlink(u16 mode, u16 *mlx5_mode)
1766 {
1767         switch (mode) {
1768         case DEVLINK_ESWITCH_MODE_LEGACY:
1769                 *mlx5_mode = SRIOV_LEGACY;
1770                 break;
1771         case DEVLINK_ESWITCH_MODE_SWITCHDEV:
1772                 *mlx5_mode = SRIOV_OFFLOADS;
1773                 break;
1774         default:
1775                 return -EINVAL;
1776         }
1777
1778         return 0;
1779 }
1780
1781 static int esw_mode_to_devlink(u16 mlx5_mode, u16 *mode)
1782 {
1783         switch (mlx5_mode) {
1784         case SRIOV_LEGACY:
1785                 *mode = DEVLINK_ESWITCH_MODE_LEGACY;
1786                 break;
1787         case SRIOV_OFFLOADS:
1788                 *mode = DEVLINK_ESWITCH_MODE_SWITCHDEV;
1789                 break;
1790         default:
1791                 return -EINVAL;
1792         }
1793
1794         return 0;
1795 }
1796
1797 static int esw_inline_mode_from_devlink(u8 mode, u8 *mlx5_mode)
1798 {
1799         switch (mode) {
1800         case DEVLINK_ESWITCH_INLINE_MODE_NONE:
1801                 *mlx5_mode = MLX5_INLINE_MODE_NONE;
1802                 break;
1803         case DEVLINK_ESWITCH_INLINE_MODE_LINK:
1804                 *mlx5_mode = MLX5_INLINE_MODE_L2;
1805                 break;
1806         case DEVLINK_ESWITCH_INLINE_MODE_NETWORK:
1807                 *mlx5_mode = MLX5_INLINE_MODE_IP;
1808                 break;
1809         case DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT:
1810                 *mlx5_mode = MLX5_INLINE_MODE_TCP_UDP;
1811                 break;
1812         default:
1813                 return -EINVAL;
1814         }
1815
1816         return 0;
1817 }
1818
1819 static int esw_inline_mode_to_devlink(u8 mlx5_mode, u8 *mode)
1820 {
1821         switch (mlx5_mode) {
1822         case MLX5_INLINE_MODE_NONE:
1823                 *mode = DEVLINK_ESWITCH_INLINE_MODE_NONE;
1824                 break;
1825         case MLX5_INLINE_MODE_L2:
1826                 *mode = DEVLINK_ESWITCH_INLINE_MODE_LINK;
1827                 break;
1828         case MLX5_INLINE_MODE_IP:
1829                 *mode = DEVLINK_ESWITCH_INLINE_MODE_NETWORK;
1830                 break;
1831         case MLX5_INLINE_MODE_TCP_UDP:
1832                 *mode = DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT;
1833                 break;
1834         default:
1835                 return -EINVAL;
1836         }
1837
1838         return 0;
1839 }
1840
1841 static int mlx5_devlink_eswitch_check(struct devlink *devlink)
1842 {
1843         struct mlx5_core_dev *dev = devlink_priv(devlink);
1844
1845         if (MLX5_CAP_GEN(dev, port_type) != MLX5_CAP_PORT_TYPE_ETH)
1846                 return -EOPNOTSUPP;
1847
1848         if(!MLX5_ESWITCH_MANAGER(dev))
1849                 return -EPERM;
1850
1851         if (dev->priv.eswitch->mode == SRIOV_NONE &&
1852             !mlx5_core_is_ecpf_esw_manager(dev))
1853                 return -EOPNOTSUPP;
1854
1855         return 0;
1856 }
1857
1858 int mlx5_devlink_eswitch_mode_set(struct devlink *devlink, u16 mode,
1859                                   struct netlink_ext_ack *extack)
1860 {
1861         struct mlx5_core_dev *dev = devlink_priv(devlink);
1862         u16 cur_mlx5_mode, mlx5_mode = 0;
1863         int err;
1864
1865         err = mlx5_devlink_eswitch_check(devlink);
1866         if (err)
1867                 return err;
1868
1869         cur_mlx5_mode = dev->priv.eswitch->mode;
1870
1871         if (esw_mode_from_devlink(mode, &mlx5_mode))
1872                 return -EINVAL;
1873
1874         if (cur_mlx5_mode == mlx5_mode)
1875                 return 0;
1876
1877         if (mode == DEVLINK_ESWITCH_MODE_SWITCHDEV)
1878                 return esw_offloads_start(dev->priv.eswitch, extack);
1879         else if (mode == DEVLINK_ESWITCH_MODE_LEGACY)
1880                 return esw_offloads_stop(dev->priv.eswitch, extack);
1881         else
1882                 return -EINVAL;
1883 }
1884
1885 int mlx5_devlink_eswitch_mode_get(struct devlink *devlink, u16 *mode)
1886 {
1887         struct mlx5_core_dev *dev = devlink_priv(devlink);
1888         int err;
1889
1890         err = mlx5_devlink_eswitch_check(devlink);
1891         if (err)
1892                 return err;
1893
1894         return esw_mode_to_devlink(dev->priv.eswitch->mode, mode);
1895 }
1896
1897 int mlx5_devlink_eswitch_inline_mode_set(struct devlink *devlink, u8 mode,
1898                                          struct netlink_ext_ack *extack)
1899 {
1900         struct mlx5_core_dev *dev = devlink_priv(devlink);
1901         struct mlx5_eswitch *esw = dev->priv.eswitch;
1902         int err, vport;
1903         u8 mlx5_mode;
1904
1905         err = mlx5_devlink_eswitch_check(devlink);
1906         if (err)
1907                 return err;
1908
1909         switch (MLX5_CAP_ETH(dev, wqe_inline_mode)) {
1910         case MLX5_CAP_INLINE_MODE_NOT_REQUIRED:
1911                 if (mode == DEVLINK_ESWITCH_INLINE_MODE_NONE)
1912                         return 0;
1913                 /* fall through */
1914         case MLX5_CAP_INLINE_MODE_L2:
1915                 NL_SET_ERR_MSG_MOD(extack, "Inline mode can't be set");
1916                 return -EOPNOTSUPP;
1917         case MLX5_CAP_INLINE_MODE_VPORT_CONTEXT:
1918                 break;
1919         }
1920
1921         if (esw->offloads.num_flows > 0) {
1922                 NL_SET_ERR_MSG_MOD(extack,
1923                                    "Can't set inline mode when flows are configured");
1924                 return -EOPNOTSUPP;
1925         }
1926
1927         err = esw_inline_mode_from_devlink(mode, &mlx5_mode);
1928         if (err)
1929                 goto out;
1930
1931         for (vport = 1; vport < esw->enabled_vports; vport++) {
1932                 err = mlx5_modify_nic_vport_min_inline(dev, vport, mlx5_mode);
1933                 if (err) {
1934                         NL_SET_ERR_MSG_MOD(extack,
1935                                            "Failed to set min inline on vport");
1936                         goto revert_inline_mode;
1937                 }
1938         }
1939
1940         esw->offloads.inline_mode = mlx5_mode;
1941         return 0;
1942
1943 revert_inline_mode:
1944         while (--vport > 0)
1945                 mlx5_modify_nic_vport_min_inline(dev,
1946                                                  vport,
1947                                                  esw->offloads.inline_mode);
1948 out:
1949         return err;
1950 }
1951
1952 int mlx5_devlink_eswitch_inline_mode_get(struct devlink *devlink, u8 *mode)
1953 {
1954         struct mlx5_core_dev *dev = devlink_priv(devlink);
1955         struct mlx5_eswitch *esw = dev->priv.eswitch;
1956         int err;
1957
1958         err = mlx5_devlink_eswitch_check(devlink);
1959         if (err)
1960                 return err;
1961
1962         return esw_inline_mode_to_devlink(esw->offloads.inline_mode, mode);
1963 }
1964
1965 int mlx5_eswitch_inline_mode_get(struct mlx5_eswitch *esw, int nvfs, u8 *mode)
1966 {
1967         u8 prev_mlx5_mode, mlx5_mode = MLX5_INLINE_MODE_L2;
1968         struct mlx5_core_dev *dev = esw->dev;
1969         int vport;
1970
1971         if (!MLX5_CAP_GEN(dev, vport_group_manager))
1972                 return -EOPNOTSUPP;
1973
1974         if (esw->mode == SRIOV_NONE)
1975                 return -EOPNOTSUPP;
1976
1977         switch (MLX5_CAP_ETH(dev, wqe_inline_mode)) {
1978         case MLX5_CAP_INLINE_MODE_NOT_REQUIRED:
1979                 mlx5_mode = MLX5_INLINE_MODE_NONE;
1980                 goto out;
1981         case MLX5_CAP_INLINE_MODE_L2:
1982                 mlx5_mode = MLX5_INLINE_MODE_L2;
1983                 goto out;
1984         case MLX5_CAP_INLINE_MODE_VPORT_CONTEXT:
1985                 goto query_vports;
1986         }
1987
1988 query_vports:
1989         for (vport = 1; vport <= nvfs; vport++) {
1990                 mlx5_query_nic_vport_min_inline(dev, vport, &mlx5_mode);
1991                 if (vport > 1 && prev_mlx5_mode != mlx5_mode)
1992                         return -EINVAL;
1993                 prev_mlx5_mode = mlx5_mode;
1994         }
1995
1996 out:
1997         *mode = mlx5_mode;
1998         return 0;
1999 }
2000
2001 int mlx5_devlink_eswitch_encap_mode_set(struct devlink *devlink, u8 encap,
2002                                         struct netlink_ext_ack *extack)
2003 {
2004         struct mlx5_core_dev *dev = devlink_priv(devlink);
2005         struct mlx5_eswitch *esw = dev->priv.eswitch;
2006         int err;
2007
2008         err = mlx5_devlink_eswitch_check(devlink);
2009         if (err)
2010                 return err;
2011
2012         if (encap != DEVLINK_ESWITCH_ENCAP_MODE_NONE &&
2013             (!MLX5_CAP_ESW_FLOWTABLE_FDB(dev, reformat) ||
2014              !MLX5_CAP_ESW_FLOWTABLE_FDB(dev, decap)))
2015                 return -EOPNOTSUPP;
2016
2017         if (encap && encap != DEVLINK_ESWITCH_ENCAP_MODE_BASIC)
2018                 return -EOPNOTSUPP;
2019
2020         if (esw->mode == SRIOV_LEGACY) {
2021                 esw->offloads.encap = encap;
2022                 return 0;
2023         }
2024
2025         if (esw->offloads.encap == encap)
2026                 return 0;
2027
2028         if (esw->offloads.num_flows > 0) {
2029                 NL_SET_ERR_MSG_MOD(extack,
2030                                    "Can't set encapsulation when flows are configured");
2031                 return -EOPNOTSUPP;
2032         }
2033
2034         esw_destroy_offloads_fdb_tables(esw);
2035
2036         esw->offloads.encap = encap;
2037
2038         err = esw_create_offloads_fdb_tables(esw, esw->nvports);
2039
2040         if (err) {
2041                 NL_SET_ERR_MSG_MOD(extack,
2042                                    "Failed re-creating fast FDB table");
2043                 esw->offloads.encap = !encap;
2044                 (void)esw_create_offloads_fdb_tables(esw, esw->nvports);
2045         }
2046
2047         return err;
2048 }
2049
2050 int mlx5_devlink_eswitch_encap_mode_get(struct devlink *devlink, u8 *encap)
2051 {
2052         struct mlx5_core_dev *dev = devlink_priv(devlink);
2053         struct mlx5_eswitch *esw = dev->priv.eswitch;
2054         int err;
2055
2056         err = mlx5_devlink_eswitch_check(devlink);
2057         if (err)
2058                 return err;
2059
2060         *encap = esw->offloads.encap;
2061         return 0;
2062 }
2063
2064 void mlx5_eswitch_register_vport_reps(struct mlx5_eswitch *esw,
2065                                       struct mlx5_eswitch_rep_if *__rep_if,
2066                                       u8 rep_type)
2067 {
2068         struct mlx5_eswitch_rep_if *rep_if;
2069         struct mlx5_eswitch_rep *rep;
2070         int i;
2071
2072         mlx5_esw_for_all_reps(esw, i, rep) {
2073                 rep_if = &rep->rep_if[rep_type];
2074                 rep_if->load   = __rep_if->load;
2075                 rep_if->unload = __rep_if->unload;
2076                 rep_if->get_proto_dev = __rep_if->get_proto_dev;
2077                 rep_if->priv = __rep_if->priv;
2078
2079                 rep_if->state = REP_REGISTERED;
2080         }
2081 }
2082 EXPORT_SYMBOL(mlx5_eswitch_register_vport_reps);
2083
2084 void mlx5_eswitch_unregister_vport_reps(struct mlx5_eswitch *esw, u8 rep_type)
2085 {
2086         u16 max_vf = mlx5_core_max_vfs(esw->dev);
2087         struct mlx5_eswitch_rep *rep;
2088         int i;
2089
2090         if (esw->mode == SRIOV_OFFLOADS)
2091                 __unload_reps_all_vport(esw, max_vf, rep_type);
2092
2093         mlx5_esw_for_all_reps(esw, i, rep)
2094                 rep->rep_if[rep_type].state = REP_UNREGISTERED;
2095 }
2096 EXPORT_SYMBOL(mlx5_eswitch_unregister_vport_reps);
2097
2098 void *mlx5_eswitch_get_uplink_priv(struct mlx5_eswitch *esw, u8 rep_type)
2099 {
2100         struct mlx5_eswitch_rep *rep;
2101
2102         rep = mlx5_eswitch_get_rep(esw, MLX5_VPORT_UPLINK);
2103         return rep->rep_if[rep_type].priv;
2104 }
2105
2106 void *mlx5_eswitch_get_proto_dev(struct mlx5_eswitch *esw,
2107                                  int vport,
2108                                  u8 rep_type)
2109 {
2110         struct mlx5_eswitch_rep *rep;
2111
2112         rep = mlx5_eswitch_get_rep(esw, vport);
2113
2114         if (rep->rep_if[rep_type].state == REP_LOADED &&
2115             rep->rep_if[rep_type].get_proto_dev)
2116                 return rep->rep_if[rep_type].get_proto_dev(rep);
2117         return NULL;
2118 }
2119 EXPORT_SYMBOL(mlx5_eswitch_get_proto_dev);
2120
2121 void *mlx5_eswitch_uplink_get_proto_dev(struct mlx5_eswitch *esw, u8 rep_type)
2122 {
2123         return mlx5_eswitch_get_proto_dev(esw, MLX5_VPORT_UPLINK, rep_type);
2124 }
2125 EXPORT_SYMBOL(mlx5_eswitch_uplink_get_proto_dev);
2126
2127 struct mlx5_eswitch_rep *mlx5_eswitch_vport_rep(struct mlx5_eswitch *esw,
2128                                                 int vport)
2129 {
2130         return mlx5_eswitch_get_rep(esw, vport);
2131 }
2132 EXPORT_SYMBOL(mlx5_eswitch_vport_rep);