drivers/net/ethernet/mellanox/mlx5/core/eswitch.c

   1 /*
   2  * Copyright (c) 2015, 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 "lib/eq.h"
  40 #include "eswitch.h"
  41 #include "fs_core.h"
  42
  43 #define UPLINK_VPORT 0xFFFF
  44
  45 enum {
  46         MLX5_ACTION_NONE = 0,
  47         MLX5_ACTION_ADD  = 1,
  48         MLX5_ACTION_DEL  = 2,
  49 };
  50
  51 /* Vport UC/MC hash node */
  52 struct vport_addr {
  53         struct l2addr_node     node;
  54         u8                     action;
  55         u32                    vport;
  56         struct mlx5_flow_handle *flow_rule;
  57         bool mpfs; /* UC MAC was added to MPFs */
  58         /* A flag indicating that mac was added due to mc promiscuous vport */
  59         bool mc_promisc;
  60 };
  61
  62 enum {
  63         UC_ADDR_CHANGE = BIT(0),
  64         MC_ADDR_CHANGE = BIT(1),
  65         PROMISC_CHANGE = BIT(3),
  66 };
  67
  68 /* Vport context events */
  69 #define SRIOV_VPORT_EVENTS (UC_ADDR_CHANGE | \
  70                             MC_ADDR_CHANGE | \
  71                             PROMISC_CHANGE)
  72
  73 static int arm_vport_context_events_cmd(struct mlx5_core_dev *dev, u16 vport,
  74                                         u32 events_mask)
  75 {
  76         int in[MLX5_ST_SZ_DW(modify_nic_vport_context_in)]   = {0};
  77         int out[MLX5_ST_SZ_DW(modify_nic_vport_context_out)] = {0};
  78         void *nic_vport_ctx;
  79
  80         MLX5_SET(modify_nic_vport_context_in, in,
  81                  opcode, MLX5_CMD_OP_MODIFY_NIC_VPORT_CONTEXT);
  82         MLX5_SET(modify_nic_vport_context_in, in, field_select.change_event, 1);
  83         MLX5_SET(modify_nic_vport_context_in, in, vport_number, vport);
  84         if (vport)
  85                 MLX5_SET(modify_nic_vport_context_in, in, other_vport, 1);
  86         nic_vport_ctx = MLX5_ADDR_OF(modify_nic_vport_context_in,
  87                                      in, nic_vport_context);
  88
  89         MLX5_SET(nic_vport_context, nic_vport_ctx, arm_change_event, 1);
  90
  91         if (events_mask & UC_ADDR_CHANGE)
  92                 MLX5_SET(nic_vport_context, nic_vport_ctx,
  93                          event_on_uc_address_change, 1);
  94         if (events_mask & MC_ADDR_CHANGE)
  95                 MLX5_SET(nic_vport_context, nic_vport_ctx,
  96                          event_on_mc_address_change, 1);
  97         if (events_mask & PROMISC_CHANGE)
  98                 MLX5_SET(nic_vport_context, nic_vport_ctx,
  99                          event_on_promisc_change, 1);
 100
 101         return mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
 102 }
 103
 104 /* E-Switch vport context HW commands */
 105 static int modify_esw_vport_context_cmd(struct mlx5_core_dev *dev, u16 vport,
 106                                         void *in, int inlen)
 107 {
 108         u32 out[MLX5_ST_SZ_DW(modify_esw_vport_context_out)] = {0};
 109
 110         MLX5_SET(modify_esw_vport_context_in, in, opcode,
 111                  MLX5_CMD_OP_MODIFY_ESW_VPORT_CONTEXT);
 112         MLX5_SET(modify_esw_vport_context_in, in, vport_number, vport);
 113         if (vport)
 114                 MLX5_SET(modify_esw_vport_context_in, in, other_vport, 1);
 115         return mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
 116 }
 117
 118 static int modify_esw_vport_cvlan(struct mlx5_core_dev *dev, u32 vport,
 119                                   u16 vlan, u8 qos, u8 set_flags)
 120 {
 121         u32 in[MLX5_ST_SZ_DW(modify_esw_vport_context_in)] = {0};
 122
 123         if (!MLX5_CAP_ESW(dev, vport_cvlan_strip) ||
 124             !MLX5_CAP_ESW(dev, vport_cvlan_insert_if_not_exist))
 125                 return -EOPNOTSUPP;
 126
 127         esw_debug(dev, "Set Vport[%d] VLAN %d qos %d set=%x\n",
 128                   vport, vlan, qos, set_flags);
 129
 130         if (set_flags & SET_VLAN_STRIP)
 131                 MLX5_SET(modify_esw_vport_context_in, in,
 132                          esw_vport_context.vport_cvlan_strip, 1);
 133
 134         if (set_flags & SET_VLAN_INSERT) {
 135                 /* insert only if no vlan in packet */
 136                 MLX5_SET(modify_esw_vport_context_in, in,
 137                          esw_vport_context.vport_cvlan_insert, 1);
 138
 139                 MLX5_SET(modify_esw_vport_context_in, in,
 140                          esw_vport_context.cvlan_pcp, qos);
 141                 MLX5_SET(modify_esw_vport_context_in, in,
 142                          esw_vport_context.cvlan_id, vlan);
 143         }
 144
 145         MLX5_SET(modify_esw_vport_context_in, in,
 146                  field_select.vport_cvlan_strip, 1);
 147         MLX5_SET(modify_esw_vport_context_in, in,
 148                  field_select.vport_cvlan_insert, 1);
 149
 150         return modify_esw_vport_context_cmd(dev, vport, in, sizeof(in));
 151 }
 152
 153 /* E-Switch FDB */
 154 static struct mlx5_flow_handle *
 155 __esw_fdb_set_vport_rule(struct mlx5_eswitch *esw, u32 vport, bool rx_rule,
 156                          u8 mac_c[ETH_ALEN], u8 mac_v[ETH_ALEN])
 157 {
 158         int match_header = (is_zero_ether_addr(mac_c) ? 0 :
 159                             MLX5_MATCH_OUTER_HEADERS);
 160         struct mlx5_flow_handle *flow_rule = NULL;
 161         struct mlx5_flow_act flow_act = {0};
 162         struct mlx5_flow_destination dest = {};
 163         struct mlx5_flow_spec *spec;
 164         void *mv_misc = NULL;
 165         void *mc_misc = NULL;
 166         u8 *dmac_v = NULL;
 167         u8 *dmac_c = NULL;
 168
 169         if (rx_rule)
 170                 match_header |= MLX5_MATCH_MISC_PARAMETERS;
 171
 172         spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
 173         if (!spec)
 174                 return NULL;
 175
 176         dmac_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
 177                               outer_headers.dmac_47_16);
 178         dmac_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
 179                               outer_headers.dmac_47_16);
 180
 181         if (match_header & MLX5_MATCH_OUTER_HEADERS) {
 182                 ether_addr_copy(dmac_v, mac_v);
 183                 ether_addr_copy(dmac_c, mac_c);
 184         }
 185
 186         if (match_header & MLX5_MATCH_MISC_PARAMETERS) {
 187                 mv_misc  = MLX5_ADDR_OF(fte_match_param, spec->match_value,
 188                                         misc_parameters);
 189                 mc_misc  = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
 190                                         misc_parameters);
 191                 MLX5_SET(fte_match_set_misc, mv_misc, source_port, UPLINK_VPORT);
 192                 MLX5_SET_TO_ONES(fte_match_set_misc, mc_misc, source_port);
 193         }
 194
 195         dest.type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
 196         dest.vport.num = vport;
 197
 198         esw_debug(esw->dev,
 199                   "\tFDB add rule dmac_v(%pM) dmac_c(%pM) -> vport(%d)\n",
 200                   dmac_v, dmac_c, vport);
 201         spec->match_criteria_enable = match_header;
 202         flow_act.action =  MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
 203         flow_rule =
 204                 mlx5_add_flow_rules(esw->fdb_table.legacy.fdb, spec,
 205                                     &flow_act, &dest, 1);
 206         if (IS_ERR(flow_rule)) {
 207                 esw_warn(esw->dev,
 208                          "FDB: Failed to add flow rule: dmac_v(%pM) dmac_c(%pM) -> vport(%d), err(%ld)\n",
 209                          dmac_v, dmac_c, vport, PTR_ERR(flow_rule));
 210                 flow_rule = NULL;
 211         }
 212
 213         kvfree(spec);
 214         return flow_rule;
 215 }
 216
 217 static struct mlx5_flow_handle *
 218 esw_fdb_set_vport_rule(struct mlx5_eswitch *esw, u8 mac[ETH_ALEN], u32 vport)
 219 {
 220         u8 mac_c[ETH_ALEN];
 221
 222         eth_broadcast_addr(mac_c);
 223         return __esw_fdb_set_vport_rule(esw, vport, false, mac_c, mac);
 224 }
 225
 226 static struct mlx5_flow_handle *
 227 esw_fdb_set_vport_allmulti_rule(struct mlx5_eswitch *esw, u32 vport)
 228 {
 229         u8 mac_c[ETH_ALEN];
 230         u8 mac_v[ETH_ALEN];
 231
 232         eth_zero_addr(mac_c);
 233         eth_zero_addr(mac_v);
 234         mac_c[0] = 0x01;
 235         mac_v[0] = 0x01;
 236         return __esw_fdb_set_vport_rule(esw, vport, false, mac_c, mac_v);
 237 }
 238
 239 static struct mlx5_flow_handle *
 240 esw_fdb_set_vport_promisc_rule(struct mlx5_eswitch *esw, u32 vport)
 241 {
 242         u8 mac_c[ETH_ALEN];
 243         u8 mac_v[ETH_ALEN];
 244
 245         eth_zero_addr(mac_c);
 246         eth_zero_addr(mac_v);
 247         return __esw_fdb_set_vport_rule(esw, vport, true, mac_c, mac_v);
 248 }
 249
 250 static int esw_create_legacy_fdb_table(struct mlx5_eswitch *esw)
 251 {
 252         int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
 253         struct mlx5_flow_table_attr ft_attr = {};
 254         struct mlx5_core_dev *dev = esw->dev;
 255         struct mlx5_flow_namespace *root_ns;
 256         struct mlx5_flow_table *fdb;
 257         struct mlx5_flow_group *g;
 258         void *match_criteria;
 259         int table_size;
 260         u32 *flow_group_in;
 261         u8 *dmac;
 262         int err = 0;
 263
 264         esw_debug(dev, "Create FDB log_max_size(%d)\n",
 265                   MLX5_CAP_ESW_FLOWTABLE_FDB(dev, log_max_ft_size));
 266
 267         root_ns = mlx5_get_fdb_sub_ns(dev, 0);
 268         if (!root_ns) {
 269                 esw_warn(dev, "Failed to get FDB flow namespace\n");
 270                 return -EOPNOTSUPP;
 271         }
 272
 273         flow_group_in = kvzalloc(inlen, GFP_KERNEL);
 274         if (!flow_group_in)
 275                 return -ENOMEM;
 276
 277         table_size = BIT(MLX5_CAP_ESW_FLOWTABLE_FDB(dev, log_max_ft_size));
 278
 279         ft_attr.max_fte = table_size;
 280         fdb = mlx5_create_flow_table(root_ns, &ft_attr);
 281         if (IS_ERR(fdb)) {
 282                 err = PTR_ERR(fdb);
 283                 esw_warn(dev, "Failed to create FDB Table err %d\n", err);
 284                 goto out;
 285         }
 286         esw->fdb_table.legacy.fdb = fdb;
 287
 288         /* Addresses group : Full match unicast/multicast addresses */
 289         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
 290                  MLX5_MATCH_OUTER_HEADERS);
 291         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
 292         dmac = MLX5_ADDR_OF(fte_match_param, match_criteria, outer_headers.dmac_47_16);
 293         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
 294         /* Preserve 2 entries for allmulti and promisc rules*/
 295         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, table_size - 3);
 296         eth_broadcast_addr(dmac);
 297         g = mlx5_create_flow_group(fdb, flow_group_in);
 298         if (IS_ERR(g)) {
 299                 err = PTR_ERR(g);
 300                 esw_warn(dev, "Failed to create flow group err(%d)\n", err);
 301                 goto out;
 302         }
 303         esw->fdb_table.legacy.addr_grp = g;
 304
 305         /* Allmulti group : One rule that forwards any mcast traffic */
 306         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
 307                  MLX5_MATCH_OUTER_HEADERS);
 308         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, table_size - 2);
 309         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, table_size - 2);
 310         eth_zero_addr(dmac);
 311         dmac[0] = 0x01;
 312         g = mlx5_create_flow_group(fdb, flow_group_in);
 313         if (IS_ERR(g)) {
 314                 err = PTR_ERR(g);
 315                 esw_warn(dev, "Failed to create allmulti flow group err(%d)\n", err);
 316                 goto out;
 317         }
 318         esw->fdb_table.legacy.allmulti_grp = g;
 319
 320         /* Promiscuous group :
 321          * One rule that forward all unmatched traffic from previous groups
 322          */
 323         eth_zero_addr(dmac);
 324         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
 325                  MLX5_MATCH_MISC_PARAMETERS);
 326         MLX5_SET_TO_ONES(fte_match_param, match_criteria, misc_parameters.source_port);
 327         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, table_size - 1);
 328         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, table_size - 1);
 329         g = mlx5_create_flow_group(fdb, flow_group_in);
 330         if (IS_ERR(g)) {
 331                 err = PTR_ERR(g);
 332                 esw_warn(dev, "Failed to create promisc flow group err(%d)\n", err);
 333                 goto out;
 334         }
 335         esw->fdb_table.legacy.promisc_grp = g;
 336
 337 out:
 338         if (err) {
 339                 if (!IS_ERR_OR_NULL(esw->fdb_table.legacy.allmulti_grp)) {
 340                         mlx5_destroy_flow_group(esw->fdb_table.legacy.allmulti_grp);
 341                         esw->fdb_table.legacy.allmulti_grp = NULL;
 342                 }
 343                 if (!IS_ERR_OR_NULL(esw->fdb_table.legacy.addr_grp)) {
 344                         mlx5_destroy_flow_group(esw->fdb_table.legacy.addr_grp);
 345                         esw->fdb_table.legacy.addr_grp = NULL;
 346                 }
 347                 if (!IS_ERR_OR_NULL(esw->fdb_table.legacy.fdb)) {
 348                         mlx5_destroy_flow_table(esw->fdb_table.legacy.fdb);
 349                         esw->fdb_table.legacy.fdb = NULL;
 350                 }
 351         }
 352
 353         kvfree(flow_group_in);
 354         return err;
 355 }
 356
 357 static void esw_destroy_legacy_fdb_table(struct mlx5_eswitch *esw)
 358 {
 359         if (!esw->fdb_table.legacy.fdb)
 360                 return;
 361
 362         esw_debug(esw->dev, "Destroy FDB Table\n");
 363         mlx5_destroy_flow_group(esw->fdb_table.legacy.promisc_grp);
 364         mlx5_destroy_flow_group(esw->fdb_table.legacy.allmulti_grp);
 365         mlx5_destroy_flow_group(esw->fdb_table.legacy.addr_grp);
 366         mlx5_destroy_flow_table(esw->fdb_table.legacy.fdb);
 367         esw->fdb_table.legacy.fdb = NULL;
 368         esw->fdb_table.legacy.addr_grp = NULL;
 369         esw->fdb_table.legacy.allmulti_grp = NULL;
 370         esw->fdb_table.legacy.promisc_grp = NULL;
 371 }
 372
 373 /* E-Switch vport UC/MC lists management */
 374 typedef int (*vport_addr_action)(struct mlx5_eswitch *esw,
 375                                  struct vport_addr *vaddr);
 376
 377 static int esw_add_uc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 378 {
 379         u8 *mac = vaddr->node.addr;
 380         u32 vport = vaddr->vport;
 381         int err;
 382
 383         /* Skip mlx5_mpfs_add_mac for PFs,
 384          * it is already done by the PF netdev in mlx5e_execute_l2_action
 385          */
 386         if (!vport)
 387                 goto fdb_add;
 388
 389         err = mlx5_mpfs_add_mac(esw->dev, mac);
 390         if (err) {
 391                 esw_warn(esw->dev,
 392                          "Failed to add L2 table mac(%pM) for vport(%d), err(%d)\n",
 393                          mac, vport, err);
 394                 return err;
 395         }
 396         vaddr->mpfs = true;
 397
 398 fdb_add:
 399         /* SRIOV is enabled: Forward UC MAC to vport */
 400         if (esw->fdb_table.legacy.fdb && esw->mode == SRIOV_LEGACY)
 401                 vaddr->flow_rule = esw_fdb_set_vport_rule(esw, mac, vport);
 402
 403         esw_debug(esw->dev, "\tADDED UC MAC: vport[%d] %pM fr(%p)\n",
 404                   vport, mac, vaddr->flow_rule);
 405
 406         return 0;
 407 }
 408
 409 static int esw_del_uc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 410 {
 411         u8 *mac = vaddr->node.addr;
 412         u32 vport = vaddr->vport;
 413         int err = 0;
 414
 415         /* Skip mlx5_mpfs_del_mac for PFs,
 416          * it is already done by the PF netdev in mlx5e_execute_l2_action
 417          */
 418         if (!vport || !vaddr->mpfs)
 419                 goto fdb_del;
 420
 421         err = mlx5_mpfs_del_mac(esw->dev, mac);
 422         if (err)
 423                 esw_warn(esw->dev,
 424                          "Failed to del L2 table mac(%pM) for vport(%d), err(%d)\n",
 425                          mac, vport, err);
 426         vaddr->mpfs = false;
 427
 428 fdb_del:
 429         if (vaddr->flow_rule)
 430                 mlx5_del_flow_rules(vaddr->flow_rule);
 431         vaddr->flow_rule = NULL;
 432
 433         return 0;
 434 }
 435
 436 static void update_allmulti_vports(struct mlx5_eswitch *esw,
 437                                    struct vport_addr *vaddr,
 438                                    struct esw_mc_addr *esw_mc)
 439 {
 440         u8 *mac = vaddr->node.addr;
 441         u32 vport_idx = 0;
 442
 443         for (vport_idx = 0; vport_idx < esw->total_vports; vport_idx++) {
 444                 struct mlx5_vport *vport = &esw->vports[vport_idx];
 445                 struct hlist_head *vport_hash = vport->mc_list;
 446                 struct vport_addr *iter_vaddr =
 447                                         l2addr_hash_find(vport_hash,
 448                                                          mac,
 449                                                          struct vport_addr);
 450                 if (IS_ERR_OR_NULL(vport->allmulti_rule) ||
 451                     vaddr->vport == vport_idx)
 452                         continue;
 453                 switch (vaddr->action) {
 454                 case MLX5_ACTION_ADD:
 455                         if (iter_vaddr)
 456                                 continue;
 457                         iter_vaddr = l2addr_hash_add(vport_hash, mac,
 458                                                      struct vport_addr,
 459                                                      GFP_KERNEL);
 460                         if (!iter_vaddr) {
 461                                 esw_warn(esw->dev,
 462                                          "ALL-MULTI: Failed to add MAC(%pM) to vport[%d] DB\n",
 463                                          mac, vport_idx);
 464                                 continue;
 465                         }
 466                         iter_vaddr->vport = vport_idx;
 467                         iter_vaddr->flow_rule =
 468                                         esw_fdb_set_vport_rule(esw,
 469                                                                mac,
 470                                                                vport_idx);
 471                         iter_vaddr->mc_promisc = true;
 472                         break;
 473                 case MLX5_ACTION_DEL:
 474                         if (!iter_vaddr)
 475                                 continue;
 476                         mlx5_del_flow_rules(iter_vaddr->flow_rule);
 477                         l2addr_hash_del(iter_vaddr);
 478                         break;
 479                 }
 480         }
 481 }
 482
 483 static int esw_add_mc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 484 {
 485         struct hlist_head *hash = esw->mc_table;
 486         struct esw_mc_addr *esw_mc;
 487         u8 *mac = vaddr->node.addr;
 488         u32 vport = vaddr->vport;
 489
 490         if (!esw->fdb_table.legacy.fdb)
 491                 return 0;
 492
 493         esw_mc = l2addr_hash_find(hash, mac, struct esw_mc_addr);
 494         if (esw_mc)
 495                 goto add;
 496
 497         esw_mc = l2addr_hash_add(hash, mac, struct esw_mc_addr, GFP_KERNEL);
 498         if (!esw_mc)
 499                 return -ENOMEM;
 500
 501         esw_mc->uplink_rule = /* Forward MC MAC to Uplink */
 502                 esw_fdb_set_vport_rule(esw, mac, UPLINK_VPORT);
 503
 504         /* Add this multicast mac to all the mc promiscuous vports */
 505         update_allmulti_vports(esw, vaddr, esw_mc);
 506
 507 add:
 508         /* If the multicast mac is added as a result of mc promiscuous vport,
 509          * don't increment the multicast ref count
 510          */
 511         if (!vaddr->mc_promisc)
 512                 esw_mc->refcnt++;
 513
 514         /* Forward MC MAC to vport */
 515         vaddr->flow_rule = esw_fdb_set_vport_rule(esw, mac, vport);
 516         esw_debug(esw->dev,
 517                   "\tADDED MC MAC: vport[%d] %pM fr(%p) refcnt(%d) uplinkfr(%p)\n",
 518                   vport, mac, vaddr->flow_rule,
 519                   esw_mc->refcnt, esw_mc->uplink_rule);
 520         return 0;
 521 }
 522
 523 static int esw_del_mc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 524 {
 525         struct hlist_head *hash = esw->mc_table;
 526         struct esw_mc_addr *esw_mc;
 527         u8 *mac = vaddr->node.addr;
 528         u32 vport = vaddr->vport;
 529
 530         if (!esw->fdb_table.legacy.fdb)
 531                 return 0;
 532
 533         esw_mc = l2addr_hash_find(hash, mac, struct esw_mc_addr);
 534         if (!esw_mc) {
 535                 esw_warn(esw->dev,
 536                          "Failed to find eswitch MC addr for MAC(%pM) vport(%d)",
 537                          mac, vport);
 538                 return -EINVAL;
 539         }
 540         esw_debug(esw->dev,
 541                   "\tDELETE MC MAC: vport[%d] %pM fr(%p) refcnt(%d) uplinkfr(%p)\n",
 542                   vport, mac, vaddr->flow_rule, esw_mc->refcnt,
 543                   esw_mc->uplink_rule);
 544
 545         if (vaddr->flow_rule)
 546                 mlx5_del_flow_rules(vaddr->flow_rule);
 547         vaddr->flow_rule = NULL;
 548
 549         /* If the multicast mac is added as a result of mc promiscuous vport,
 550          * don't decrement the multicast ref count.
 551          */
 552         if (vaddr->mc_promisc || (--esw_mc->refcnt > 0))
 553                 return 0;
 554
 555         /* Remove this multicast mac from all the mc promiscuous vports */
 556         update_allmulti_vports(esw, vaddr, esw_mc);
 557
 558         if (esw_mc->uplink_rule)
 559                 mlx5_del_flow_rules(esw_mc->uplink_rule);
 560
 561         l2addr_hash_del(esw_mc);
 562         return 0;
 563 }
 564
 565 /* Apply vport UC/MC list to HW l2 table and FDB table */
 566 static void esw_apply_vport_addr_list(struct mlx5_eswitch *esw,
 567                                       u32 vport_num, int list_type)
 568 {
 569         struct mlx5_vport *vport = &esw->vports[vport_num];
 570         bool is_uc = list_type == MLX5_NVPRT_LIST_TYPE_UC;
 571         vport_addr_action vport_addr_add;
 572         vport_addr_action vport_addr_del;
 573         struct vport_addr *addr;
 574         struct l2addr_node *node;
 575         struct hlist_head *hash;
 576         struct hlist_node *tmp;
 577         int hi;
 578
 579         vport_addr_add = is_uc ? esw_add_uc_addr :
 580                                  esw_add_mc_addr;
 581         vport_addr_del = is_uc ? esw_del_uc_addr :
 582                                  esw_del_mc_addr;
 583
 584         hash = is_uc ? vport->uc_list : vport->mc_list;
 585         for_each_l2hash_node(node, tmp, hash, hi) {
 586                 addr = container_of(node, struct vport_addr, node);
 587                 switch (addr->action) {
 588                 case MLX5_ACTION_ADD:
 589                         vport_addr_add(esw, addr);
 590                         addr->action = MLX5_ACTION_NONE;
 591                         break;
 592                 case MLX5_ACTION_DEL:
 593                         vport_addr_del(esw, addr);
 594                         l2addr_hash_del(addr);
 595                         break;
 596                 }
 597         }
 598 }
 599
 600 /* Sync vport UC/MC list from vport context */
 601 static void esw_update_vport_addr_list(struct mlx5_eswitch *esw,
 602                                        u32 vport_num, int list_type)
 603 {
 604         struct mlx5_vport *vport = &esw->vports[vport_num];
 605         bool is_uc = list_type == MLX5_NVPRT_LIST_TYPE_UC;
 606         u8 (*mac_list)[ETH_ALEN];
 607         struct l2addr_node *node;
 608         struct vport_addr *addr;
 609         struct hlist_head *hash;
 610         struct hlist_node *tmp;
 611         int size;
 612         int err;
 613         int hi;
 614         int i;
 615
 616         size = is_uc ? MLX5_MAX_UC_PER_VPORT(esw->dev) :
 617                        MLX5_MAX_MC_PER_VPORT(esw->dev);
 618
 619         mac_list = kcalloc(size, ETH_ALEN, GFP_KERNEL);
 620         if (!mac_list)
 621                 return;
 622
 623         hash = is_uc ? vport->uc_list : vport->mc_list;
 624
 625         for_each_l2hash_node(node, tmp, hash, hi) {
 626                 addr = container_of(node, struct vport_addr, node);
 627                 addr->action = MLX5_ACTION_DEL;
 628         }
 629
 630         if (!vport->enabled)
 631                 goto out;
 632
 633         err = mlx5_query_nic_vport_mac_list(esw->dev, vport_num, list_type,
 634                                             mac_list, &size);
 635         if (err)
 636                 goto out;
 637         esw_debug(esw->dev, "vport[%d] context update %s list size (%d)\n",
 638                   vport_num, is_uc ? "UC" : "MC", size);
 639
 640         for (i = 0; i < size; i++) {
 641                 if (is_uc && !is_valid_ether_addr(mac_list[i]))
 642                         continue;
 643
 644                 if (!is_uc && !is_multicast_ether_addr(mac_list[i]))
 645                         continue;
 646
 647                 addr = l2addr_hash_find(hash, mac_list[i], struct vport_addr);
 648                 if (addr) {
 649                         addr->action = MLX5_ACTION_NONE;
 650                         /* If this mac was previously added because of allmulti
 651                          * promiscuous rx mode, its now converted to be original
 652                          * vport mac.
 653                          */
 654                         if (addr->mc_promisc) {
 655                                 struct esw_mc_addr *esw_mc =
 656                                         l2addr_hash_find(esw->mc_table,
 657                                                          mac_list[i],
 658                                                          struct esw_mc_addr);
 659                                 if (!esw_mc) {
 660                                         esw_warn(esw->dev,
 661                                                  "Failed to MAC(%pM) in mcast DB\n",
 662                                                  mac_list[i]);
 663                                         continue;
 664                                 }
 665                                 esw_mc->refcnt++;
 666                                 addr->mc_promisc = false;
 667                         }
 668                         continue;
 669                 }
 670
 671                 addr = l2addr_hash_add(hash, mac_list[i], struct vport_addr,
 672                                        GFP_KERNEL);
 673                 if (!addr) {
 674                         esw_warn(esw->dev,
 675                                  "Failed to add MAC(%pM) to vport[%d] DB\n",
 676                                  mac_list[i], vport_num);
 677                         continue;
 678                 }
 679                 addr->vport = vport_num;
 680                 addr->action = MLX5_ACTION_ADD;
 681         }
 682 out:
 683         kfree(mac_list);
 684 }
 685
 686 /* Sync vport UC/MC list from vport context
 687  * Must be called after esw_update_vport_addr_list
 688  */
 689 static void esw_update_vport_mc_promisc(struct mlx5_eswitch *esw, u32 vport_num)
 690 {
 691         struct mlx5_vport *vport = &esw->vports[vport_num];
 692         struct l2addr_node *node;
 693         struct vport_addr *addr;
 694         struct hlist_head *hash;
 695         struct hlist_node *tmp;
 696         int hi;
 697
 698         hash = vport->mc_list;
 699
 700         for_each_l2hash_node(node, tmp, esw->mc_table, hi) {
 701                 u8 *mac = node->addr;
 702
 703                 addr = l2addr_hash_find(hash, mac, struct vport_addr);
 704                 if (addr) {
 705                         if (addr->action == MLX5_ACTION_DEL)
 706                                 addr->action = MLX5_ACTION_NONE;
 707                         continue;
 708                 }
 709                 addr = l2addr_hash_add(hash, mac, struct vport_addr,
 710                                        GFP_KERNEL);
 711                 if (!addr) {
 712                         esw_warn(esw->dev,
 713                                  "Failed to add allmulti MAC(%pM) to vport[%d] DB\n",
 714                                  mac, vport_num);
 715                         continue;
 716                 }
 717                 addr->vport = vport_num;
 718                 addr->action = MLX5_ACTION_ADD;
 719                 addr->mc_promisc = true;
 720         }
 721 }
 722
 723 /* Apply vport rx mode to HW FDB table */
 724 static void esw_apply_vport_rx_mode(struct mlx5_eswitch *esw, u32 vport_num,
 725                                     bool promisc, bool mc_promisc)
 726 {
 727         struct esw_mc_addr *allmulti_addr = &esw->mc_promisc;
 728         struct mlx5_vport *vport = &esw->vports[vport_num];
 729
 730         if (IS_ERR_OR_NULL(vport->allmulti_rule) != mc_promisc)
 731                 goto promisc;
 732
 733         if (mc_promisc) {
 734                 vport->allmulti_rule =
 735                                 esw_fdb_set_vport_allmulti_rule(esw, vport_num);
 736                 if (!allmulti_addr->uplink_rule)
 737                         allmulti_addr->uplink_rule =
 738                                 esw_fdb_set_vport_allmulti_rule(esw,
 739                                                                 UPLINK_VPORT);
 740                 allmulti_addr->refcnt++;
 741         } else if (vport->allmulti_rule) {
 742                 mlx5_del_flow_rules(vport->allmulti_rule);
 743                 vport->allmulti_rule = NULL;
 744
 745                 if (--allmulti_addr->refcnt > 0)
 746                         goto promisc;
 747
 748                 if (allmulti_addr->uplink_rule)
 749                         mlx5_del_flow_rules(allmulti_addr->uplink_rule);
 750                 allmulti_addr->uplink_rule = NULL;
 751         }
 752
 753 promisc:
 754         if (IS_ERR_OR_NULL(vport->promisc_rule) != promisc)
 755                 return;
 756
 757         if (promisc) {
 758                 vport->promisc_rule = esw_fdb_set_vport_promisc_rule(esw,
 759                                                                      vport_num);
 760         } else if (vport->promisc_rule) {
 761                 mlx5_del_flow_rules(vport->promisc_rule);
 762                 vport->promisc_rule = NULL;
 763         }
 764 }
 765
 766 /* Sync vport rx mode from vport context */
 767 static void esw_update_vport_rx_mode(struct mlx5_eswitch *esw, u32 vport_num)
 768 {
 769         struct mlx5_vport *vport = &esw->vports[vport_num];
 770         int promisc_all = 0;
 771         int promisc_uc = 0;
 772         int promisc_mc = 0;
 773         int err;
 774
 775         err = mlx5_query_nic_vport_promisc(esw->dev,
 776                                            vport_num,
 777                                            &promisc_uc,
 778                                            &promisc_mc,
 779                                            &promisc_all);
 780         if (err)
 781                 return;
 782         esw_debug(esw->dev, "vport[%d] context update rx mode promisc_all=%d, all_multi=%d\n",
 783                   vport_num, promisc_all, promisc_mc);
 784
 785         if (!vport->info.trusted || !vport->enabled) {
 786                 promisc_uc = 0;
 787                 promisc_mc = 0;
 788                 promisc_all = 0;
 789         }
 790
 791         esw_apply_vport_rx_mode(esw, vport_num, promisc_all,
 792                                 (promisc_all || promisc_mc));
 793 }
 794
 795 static void esw_vport_change_handle_locked(struct mlx5_vport *vport)
 796 {
 797         struct mlx5_core_dev *dev = vport->dev;
 798         struct mlx5_eswitch *esw = dev->priv.eswitch;
 799         u8 mac[ETH_ALEN];
 800
 801         mlx5_query_nic_vport_mac_address(dev, vport->vport, mac);
 802         esw_debug(dev, "vport[%d] Context Changed: perm mac: %pM\n",
 803                   vport->vport, mac);
 804
 805         if (vport->enabled_events & UC_ADDR_CHANGE) {
 806                 esw_update_vport_addr_list(esw, vport->vport,
 807                                            MLX5_NVPRT_LIST_TYPE_UC);
 808                 esw_apply_vport_addr_list(esw, vport->vport,
 809                                           MLX5_NVPRT_LIST_TYPE_UC);
 810         }
 811
 812         if (vport->enabled_events & MC_ADDR_CHANGE) {
 813                 esw_update_vport_addr_list(esw, vport->vport,
 814                                            MLX5_NVPRT_LIST_TYPE_MC);
 815         }
 816
 817         if (vport->enabled_events & PROMISC_CHANGE) {
 818                 esw_update_vport_rx_mode(esw, vport->vport);
 819                 if (!IS_ERR_OR_NULL(vport->allmulti_rule))
 820                         esw_update_vport_mc_promisc(esw, vport->vport);
 821         }
 822
 823         if (vport->enabled_events & (PROMISC_CHANGE | MC_ADDR_CHANGE)) {
 824                 esw_apply_vport_addr_list(esw, vport->vport,
 825                                           MLX5_NVPRT_LIST_TYPE_MC);
 826         }
 827
 828         esw_debug(esw->dev, "vport[%d] Context Changed: Done\n", vport->vport);
 829         if (vport->enabled)
 830                 arm_vport_context_events_cmd(dev, vport->vport,
 831                                              vport->enabled_events);
 832 }
 833
 834 static void esw_vport_change_handler(struct work_struct *work)
 835 {
 836         struct mlx5_vport *vport =
 837                 container_of(work, struct mlx5_vport, vport_change_handler);
 838         struct mlx5_eswitch *esw = vport->dev->priv.eswitch;
 839
 840         mutex_lock(&esw->state_lock);
 841         esw_vport_change_handle_locked(vport);
 842         mutex_unlock(&esw->state_lock);
 843 }
 844
 845 static int esw_vport_enable_egress_acl(struct mlx5_eswitch *esw,
 846                                        struct mlx5_vport *vport)
 847 {
 848         int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
 849         struct mlx5_flow_group *vlan_grp = NULL;
 850         struct mlx5_flow_group *drop_grp = NULL;
 851         struct mlx5_core_dev *dev = esw->dev;
 852         struct mlx5_flow_namespace *root_ns;
 853         struct mlx5_flow_table *acl;
 854         void *match_criteria;
 855         u32 *flow_group_in;
 856         /* The egress acl table contains 2 rules:
 857          * 1)Allow traffic with vlan_tag=vst_vlan_id
 858          * 2)Drop all other traffic.
 859          */
 860         int table_size = 2;
 861         int err = 0;
 862
 863         if (!MLX5_CAP_ESW_EGRESS_ACL(dev, ft_support))
 864                 return -EOPNOTSUPP;
 865
 866         if (!IS_ERR_OR_NULL(vport->egress.acl))
 867                 return 0;
 868
 869         esw_debug(dev, "Create vport[%d] egress ACL log_max_size(%d)\n",
 870                   vport->vport, MLX5_CAP_ESW_EGRESS_ACL(dev, log_max_ft_size));
 871
 872         root_ns = mlx5_get_flow_vport_acl_namespace(dev, MLX5_FLOW_NAMESPACE_ESW_EGRESS,
 873                                                     vport->vport);
 874         if (!root_ns) {
 875                 esw_warn(dev, "Failed to get E-Switch egress flow namespace for vport (%d)\n", vport->vport);
 876                 return -EOPNOTSUPP;
 877         }
 878
 879         flow_group_in = kvzalloc(inlen, GFP_KERNEL);
 880         if (!flow_group_in)
 881                 return -ENOMEM;
 882
 883         acl = mlx5_create_vport_flow_table(root_ns, 0, table_size, 0, vport->vport);
 884         if (IS_ERR(acl)) {
 885                 err = PTR_ERR(acl);
 886                 esw_warn(dev, "Failed to create E-Switch vport[%d] egress flow Table, err(%d)\n",
 887                          vport->vport, err);
 888                 goto out;
 889         }
 890
 891         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
 892         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
 893         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.cvlan_tag);
 894         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.first_vid);
 895         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
 896         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 0);
 897
 898         vlan_grp = mlx5_create_flow_group(acl, flow_group_in);
 899         if (IS_ERR(vlan_grp)) {
 900                 err = PTR_ERR(vlan_grp);
 901                 esw_warn(dev, "Failed to create E-Switch vport[%d] egress allowed vlans flow group, err(%d)\n",
 902                          vport->vport, err);
 903                 goto out;
 904         }
 905
 906         memset(flow_group_in, 0, inlen);
 907         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 1);
 908         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 1);
 909         drop_grp = mlx5_create_flow_group(acl, flow_group_in);
 910         if (IS_ERR(drop_grp)) {
 911                 err = PTR_ERR(drop_grp);
 912                 esw_warn(dev, "Failed to create E-Switch vport[%d] egress drop flow group, err(%d)\n",
 913                          vport->vport, err);
 914                 goto out;
 915         }
 916
 917         vport->egress.acl = acl;
 918         vport->egress.drop_grp = drop_grp;
 919         vport->egress.allowed_vlans_grp = vlan_grp;
 920 out:
 921         kvfree(flow_group_in);
 922         if (err && !IS_ERR_OR_NULL(vlan_grp))
 923                 mlx5_destroy_flow_group(vlan_grp);
 924         if (err && !IS_ERR_OR_NULL(acl))
 925                 mlx5_destroy_flow_table(acl);
 926         return err;
 927 }
 928
 929 static void esw_vport_cleanup_egress_rules(struct mlx5_eswitch *esw,
 930                                            struct mlx5_vport *vport)
 931 {
 932         if (!IS_ERR_OR_NULL(vport->egress.allowed_vlan))
 933                 mlx5_del_flow_rules(vport->egress.allowed_vlan);
 934
 935         if (!IS_ERR_OR_NULL(vport->egress.drop_rule))
 936                 mlx5_del_flow_rules(vport->egress.drop_rule);
 937
 938         vport->egress.allowed_vlan = NULL;
 939         vport->egress.drop_rule = NULL;
 940 }
 941
 942 static void esw_vport_disable_egress_acl(struct mlx5_eswitch *esw,
 943                                          struct mlx5_vport *vport)
 944 {
 945         if (IS_ERR_OR_NULL(vport->egress.acl))
 946                 return;
 947
 948         esw_debug(esw->dev, "Destroy vport[%d] E-Switch egress ACL\n", vport->vport);
 949
 950         esw_vport_cleanup_egress_rules(esw, vport);
 951         mlx5_destroy_flow_group(vport->egress.allowed_vlans_grp);
 952         mlx5_destroy_flow_group(vport->egress.drop_grp);
 953         mlx5_destroy_flow_table(vport->egress.acl);
 954         vport->egress.allowed_vlans_grp = NULL;
 955         vport->egress.drop_grp = NULL;
 956         vport->egress.acl = NULL;
 957 }
 958
 959 static int esw_vport_enable_ingress_acl(struct mlx5_eswitch *esw,
 960                                         struct mlx5_vport *vport)
 961 {
 962         int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
 963         struct mlx5_core_dev *dev = esw->dev;
 964         struct mlx5_flow_namespace *root_ns;
 965         struct mlx5_flow_table *acl;
 966         struct mlx5_flow_group *g;
 967         void *match_criteria;
 968         u32 *flow_group_in;
 969         /* The ingress acl table contains 4 groups
 970          * (2 active rules at the same time -
 971          *      1 allow rule from one of the first 3 groups.
 972          *      1 drop rule from the last group):
 973          * 1)Allow untagged traffic with smac=original mac.
 974          * 2)Allow untagged traffic.
 975          * 3)Allow traffic with smac=original mac.
 976          * 4)Drop all other traffic.
 977          */
 978         int table_size = 4;
 979         int err = 0;
 980
 981         if (!MLX5_CAP_ESW_INGRESS_ACL(dev, ft_support))
 982                 return -EOPNOTSUPP;
 983
 984         if (!IS_ERR_OR_NULL(vport->ingress.acl))
 985                 return 0;
 986
 987         esw_debug(dev, "Create vport[%d] ingress ACL log_max_size(%d)\n",
 988                   vport->vport, MLX5_CAP_ESW_INGRESS_ACL(dev, log_max_ft_size));
 989
 990         root_ns = mlx5_get_flow_vport_acl_namespace(dev, MLX5_FLOW_NAMESPACE_ESW_INGRESS,
 991                                                     vport->vport);
 992         if (!root_ns) {
 993                 esw_warn(dev, "Failed to get E-Switch ingress flow namespace for vport (%d)\n", vport->vport);
 994                 return -EOPNOTSUPP;
 995         }
 996
 997         flow_group_in = kvzalloc(inlen, GFP_KERNEL);
 998         if (!flow_group_in)
 999                 return -ENOMEM;
1000
1001         acl = mlx5_create_vport_flow_table(root_ns, 0, table_size, 0, vport->vport);
1002         if (IS_ERR(acl)) {
1003                 err = PTR_ERR(acl);
1004                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress flow Table, err(%d)\n",
1005                          vport->vport, err);
1006                 goto out;
1007         }
1008         vport->ingress.acl = acl;
1009
1010         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
1011
1012         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1013         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.cvlan_tag);
1014         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.smac_47_16);
1015         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.smac_15_0);
1016         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
1017         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 0);
1018
1019         g = mlx5_create_flow_group(acl, flow_group_in);
1020         if (IS_ERR(g)) {
1021                 err = PTR_ERR(g);
1022                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress untagged spoofchk flow group, err(%d)\n",
1023                          vport->vport, err);
1024                 goto out;
1025         }
1026         vport->ingress.allow_untagged_spoofchk_grp = g;
1027
1028         memset(flow_group_in, 0, inlen);
1029         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1030         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.cvlan_tag);
1031         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 1);
1032         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 1);
1033
1034         g = mlx5_create_flow_group(acl, flow_group_in);
1035         if (IS_ERR(g)) {
1036                 err = PTR_ERR(g);
1037                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress untagged flow group, err(%d)\n",
1038                          vport->vport, err);
1039                 goto out;
1040         }
1041         vport->ingress.allow_untagged_only_grp = g;
1042
1043         memset(flow_group_in, 0, inlen);
1044         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1045         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.smac_47_16);
1046         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.smac_15_0);
1047         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 2);
1048         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 2);
1049
1050         g = mlx5_create_flow_group(acl, flow_group_in);
1051         if (IS_ERR(g)) {
1052                 err = PTR_ERR(g);
1053                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress spoofchk flow group, err(%d)\n",
1054                          vport->vport, err);
1055                 goto out;
1056         }
1057         vport->ingress.allow_spoofchk_only_grp = g;
1058
1059         memset(flow_group_in, 0, inlen);
1060         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 3);
1061         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 3);
1062
1063         g = mlx5_create_flow_group(acl, flow_group_in);
1064         if (IS_ERR(g)) {
1065                 err = PTR_ERR(g);
1066                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress drop flow group, err(%d)\n",
1067                          vport->vport, err);
1068                 goto out;
1069         }
1070         vport->ingress.drop_grp = g;
1071
1072 out:
1073         if (err) {
1074                 if (!IS_ERR_OR_NULL(vport->ingress.allow_spoofchk_only_grp))
1075                         mlx5_destroy_flow_group(
1076                                         vport->ingress.allow_spoofchk_only_grp);
1077                 if (!IS_ERR_OR_NULL(vport->ingress.allow_untagged_only_grp))
1078                         mlx5_destroy_flow_group(
1079                                         vport->ingress.allow_untagged_only_grp);
1080                 if (!IS_ERR_OR_NULL(vport->ingress.allow_untagged_spoofchk_grp))
1081                         mlx5_destroy_flow_group(
1082                                 vport->ingress.allow_untagged_spoofchk_grp);
1083                 if (!IS_ERR_OR_NULL(vport->ingress.acl))
1084                         mlx5_destroy_flow_table(vport->ingress.acl);
1085         }
1086
1087         kvfree(flow_group_in);
1088         return err;
1089 }
1090
1091 static void esw_vport_cleanup_ingress_rules(struct mlx5_eswitch *esw,
1092                                             struct mlx5_vport *vport)
1093 {
1094         if (!IS_ERR_OR_NULL(vport->ingress.drop_rule))
1095                 mlx5_del_flow_rules(vport->ingress.drop_rule);
1096
1097         if (!IS_ERR_OR_NULL(vport->ingress.allow_rule))
1098                 mlx5_del_flow_rules(vport->ingress.allow_rule);
1099
1100         vport->ingress.drop_rule = NULL;
1101         vport->ingress.allow_rule = NULL;
1102 }
1103
1104 static void esw_vport_disable_ingress_acl(struct mlx5_eswitch *esw,
1105                                           struct mlx5_vport *vport)
1106 {
1107         if (IS_ERR_OR_NULL(vport->ingress.acl))
1108                 return;
1109
1110         esw_debug(esw->dev, "Destroy vport[%d] E-Switch ingress ACL\n", vport->vport);
1111
1112         esw_vport_cleanup_ingress_rules(esw, vport);
1113         mlx5_destroy_flow_group(vport->ingress.allow_spoofchk_only_grp);
1114         mlx5_destroy_flow_group(vport->ingress.allow_untagged_only_grp);
1115         mlx5_destroy_flow_group(vport->ingress.allow_untagged_spoofchk_grp);
1116         mlx5_destroy_flow_group(vport->ingress.drop_grp);
1117         mlx5_destroy_flow_table(vport->ingress.acl);
1118         vport->ingress.acl = NULL;
1119         vport->ingress.drop_grp = NULL;
1120         vport->ingress.allow_spoofchk_only_grp = NULL;
1121         vport->ingress.allow_untagged_only_grp = NULL;
1122         vport->ingress.allow_untagged_spoofchk_grp = NULL;
1123 }
1124
1125 static int esw_vport_ingress_config(struct mlx5_eswitch *esw,
1126                                     struct mlx5_vport *vport)
1127 {
1128         struct mlx5_fc *counter = vport->ingress.drop_counter;
1129         struct mlx5_flow_destination drop_ctr_dst = {0};
1130         struct mlx5_flow_destination *dst = NULL;
1131         struct mlx5_flow_act flow_act = {0};
1132         struct mlx5_flow_spec *spec;
1133         int dest_num = 0;
1134         int err = 0;
1135         u8 *smac_v;
1136
1137         if (vport->info.spoofchk && !is_valid_ether_addr(vport->info.mac)) {
1138                 mlx5_core_warn(esw->dev,
1139                                "vport[%d] configure ingress rules failed, illegal mac with spoofchk\n",
1140                                vport->vport);
1141                 return -EPERM;
1142         }
1143
1144         esw_vport_cleanup_ingress_rules(esw, vport);
1145
1146         if (!vport->info.vlan && !vport->info.qos && !vport->info.spoofchk) {
1147                 esw_vport_disable_ingress_acl(esw, vport);
1148                 return 0;
1149         }
1150
1151         err = esw_vport_enable_ingress_acl(esw, vport);
1152         if (err) {
1153                 mlx5_core_warn(esw->dev,
1154                                "failed to enable ingress acl (%d) on vport[%d]\n",
1155                                err, vport->vport);
1156                 return err;
1157         }
1158
1159         esw_debug(esw->dev,
1160                   "vport[%d] configure ingress rules, vlan(%d) qos(%d)\n",
1161                   vport->vport, vport->info.vlan, vport->info.qos);
1162
1163         spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1164         if (!spec) {
1165                 err = -ENOMEM;
1166                 goto out;
1167         }
1168
1169         if (vport->info.vlan || vport->info.qos)
1170                 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, outer_headers.cvlan_tag);
1171
1172         if (vport->info.spoofchk) {
1173                 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, outer_headers.smac_47_16);
1174                 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, outer_headers.smac_15_0);
1175                 smac_v = MLX5_ADDR_OF(fte_match_param,
1176                                       spec->match_value,
1177                                       outer_headers.smac_47_16);
1178                 ether_addr_copy(smac_v, vport->info.mac);
1179         }
1180
1181         spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
1182         flow_act.action = MLX5_FLOW_CONTEXT_ACTION_ALLOW;
1183         vport->ingress.allow_rule =
1184                 mlx5_add_flow_rules(vport->ingress.acl, spec,
1185                                     &flow_act, NULL, 0);
1186         if (IS_ERR(vport->ingress.allow_rule)) {
1187                 err = PTR_ERR(vport->ingress.allow_rule);
1188                 esw_warn(esw->dev,
1189                          "vport[%d] configure ingress allow rule, err(%d)\n",
1190                          vport->vport, err);
1191                 vport->ingress.allow_rule = NULL;
1192                 goto out;
1193         }
1194
1195         memset(spec, 0, sizeof(*spec));
1196         flow_act.action = MLX5_FLOW_CONTEXT_ACTION_DROP;
1197
1198         /* Attach drop flow counter */
1199         if (counter) {
1200                 flow_act.action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
1201                 drop_ctr_dst.type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
1202                 drop_ctr_dst.counter_id = mlx5_fc_id(counter);
1203                 dst = &drop_ctr_dst;
1204                 dest_num++;
1205         }
1206         vport->ingress.drop_rule =
1207                 mlx5_add_flow_rules(vport->ingress.acl, spec,
1208                                     &flow_act, dst, dest_num);
1209         if (IS_ERR(vport->ingress.drop_rule)) {
1210                 err = PTR_ERR(vport->ingress.drop_rule);
1211                 esw_warn(esw->dev,
1212                          "vport[%d] configure ingress drop rule, err(%d)\n",
1213                          vport->vport, err);
1214                 vport->ingress.drop_rule = NULL;
1215                 goto out;
1216         }
1217
1218 out:
1219         if (err)
1220                 esw_vport_cleanup_ingress_rules(esw, vport);
1221         kvfree(spec);
1222         return err;
1223 }
1224
1225 static int esw_vport_egress_config(struct mlx5_eswitch *esw,
1226                                    struct mlx5_vport *vport)
1227 {
1228         struct mlx5_fc *counter = vport->egress.drop_counter;
1229         struct mlx5_flow_destination drop_ctr_dst = {0};
1230         struct mlx5_flow_destination *dst = NULL;
1231         struct mlx5_flow_act flow_act = {0};
1232         struct mlx5_flow_spec *spec;
1233         int dest_num = 0;
1234         int err = 0;
1235
1236         esw_vport_cleanup_egress_rules(esw, vport);
1237
1238         if (!vport->info.vlan && !vport->info.qos) {
1239                 esw_vport_disable_egress_acl(esw, vport);
1240                 return 0;
1241         }
1242
1243         err = esw_vport_enable_egress_acl(esw, vport);
1244         if (err) {
1245                 mlx5_core_warn(esw->dev,
1246                                "failed to enable egress acl (%d) on vport[%d]\n",
1247                                err, vport->vport);
1248                 return err;
1249         }
1250
1251         esw_debug(esw->dev,
1252                   "vport[%d] configure egress rules, vlan(%d) qos(%d)\n",
1253                   vport->vport, vport->info.vlan, vport->info.qos);
1254
1255         spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1256         if (!spec) {
1257                 err = -ENOMEM;
1258                 goto out;
1259         }
1260
1261         /* Allowed vlan rule */
1262         MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, outer_headers.cvlan_tag);
1263         MLX5_SET_TO_ONES(fte_match_param, spec->match_value, outer_headers.cvlan_tag);
1264         MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, outer_headers.first_vid);
1265         MLX5_SET(fte_match_param, spec->match_value, outer_headers.first_vid, vport->info.vlan);
1266
1267         spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
1268         flow_act.action = MLX5_FLOW_CONTEXT_ACTION_ALLOW;
1269         vport->egress.allowed_vlan =
1270                 mlx5_add_flow_rules(vport->egress.acl, spec,
1271                                     &flow_act, NULL, 0);
1272         if (IS_ERR(vport->egress.allowed_vlan)) {
1273                 err = PTR_ERR(vport->egress.allowed_vlan);
1274                 esw_warn(esw->dev,
1275                          "vport[%d] configure egress allowed vlan rule failed, err(%d)\n",
1276                          vport->vport, err);
1277                 vport->egress.allowed_vlan = NULL;
1278                 goto out;
1279         }
1280
1281         /* Drop others rule (star rule) */
1282         memset(spec, 0, sizeof(*spec));
1283         flow_act.action = MLX5_FLOW_CONTEXT_ACTION_DROP;
1284
1285         /* Attach egress drop flow counter */
1286         if (counter) {
1287                 flow_act.action |= MLX5_FLOW_CONTEXT_ACTION_COUNT;
1288                 drop_ctr_dst.type = MLX5_FLOW_DESTINATION_TYPE_COUNTER;
1289                 drop_ctr_dst.counter_id = mlx5_fc_id(counter);
1290                 dst = &drop_ctr_dst;
1291                 dest_num++;
1292         }
1293         vport->egress.drop_rule =
1294                 mlx5_add_flow_rules(vport->egress.acl, spec,
1295                                     &flow_act, dst, dest_num);
1296         if (IS_ERR(vport->egress.drop_rule)) {
1297                 err = PTR_ERR(vport->egress.drop_rule);
1298                 esw_warn(esw->dev,
1299                          "vport[%d] configure egress drop rule failed, err(%d)\n",
1300                          vport->vport, err);
1301                 vport->egress.drop_rule = NULL;
1302         }
1303 out:
1304         kvfree(spec);
1305         return err;
1306 }
1307
1308 /* Vport QoS management */
1309 static int esw_create_tsar(struct mlx5_eswitch *esw)
1310 {
1311         u32 tsar_ctx[MLX5_ST_SZ_DW(scheduling_context)] = {0};
1312         struct mlx5_core_dev *dev = esw->dev;
1313         int err;
1314
1315         if (!MLX5_CAP_GEN(dev, qos) || !MLX5_CAP_QOS(dev, esw_scheduling))
1316                 return 0;
1317
1318         if (esw->qos.enabled)
1319                 return -EEXIST;
1320
1321         err = mlx5_create_scheduling_element_cmd(dev,
1322                                                  SCHEDULING_HIERARCHY_E_SWITCH,
1323                                                  tsar_ctx,
1324                                                  &esw->qos.root_tsar_id);
1325         if (err) {
1326                 esw_warn(esw->dev, "E-Switch create TSAR failed (%d)\n", err);
1327                 return err;
1328         }
1329
1330         esw->qos.enabled = true;
1331         return 0;
1332 }
1333
1334 static void esw_destroy_tsar(struct mlx5_eswitch *esw)
1335 {
1336         int err;
1337
1338         if (!esw->qos.enabled)
1339                 return;
1340
1341         err = mlx5_destroy_scheduling_element_cmd(esw->dev,
1342                                                   SCHEDULING_HIERARCHY_E_SWITCH,
1343                                                   esw->qos.root_tsar_id);
1344         if (err)
1345                 esw_warn(esw->dev, "E-Switch destroy TSAR failed (%d)\n", err);
1346
1347         esw->qos.enabled = false;
1348 }
1349
1350 static int esw_vport_enable_qos(struct mlx5_eswitch *esw, int vport_num,
1351                                 u32 initial_max_rate, u32 initial_bw_share)
1352 {
1353         u32 sched_ctx[MLX5_ST_SZ_DW(scheduling_context)] = {0};
1354         struct mlx5_vport *vport = &esw->vports[vport_num];
1355         struct mlx5_core_dev *dev = esw->dev;
1356         void *vport_elem;
1357         int err = 0;
1358
1359         if (!esw->qos.enabled || !MLX5_CAP_GEN(dev, qos) ||
1360             !MLX5_CAP_QOS(dev, esw_scheduling))
1361                 return 0;
1362
1363         if (vport->qos.enabled)
1364                 return -EEXIST;
1365
1366         MLX5_SET(scheduling_context, sched_ctx, element_type,
1367                  SCHEDULING_CONTEXT_ELEMENT_TYPE_VPORT);
1368         vport_elem = MLX5_ADDR_OF(scheduling_context, sched_ctx,
1369                                   element_attributes);
1370         MLX5_SET(vport_element, vport_elem, vport_number, vport_num);
1371         MLX5_SET(scheduling_context, sched_ctx, parent_element_id,
1372                  esw->qos.root_tsar_id);
1373         MLX5_SET(scheduling_context, sched_ctx, max_average_bw,
1374                  initial_max_rate);
1375         MLX5_SET(scheduling_context, sched_ctx, bw_share, initial_bw_share);
1376
1377         err = mlx5_create_scheduling_element_cmd(dev,
1378                                                  SCHEDULING_HIERARCHY_E_SWITCH,
1379                                                  sched_ctx,
1380                                                  &vport->qos.esw_tsar_ix);
1381         if (err) {
1382                 esw_warn(esw->dev, "E-Switch create TSAR vport element failed (vport=%d,err=%d)\n",
1383                          vport_num, err);
1384                 return err;
1385         }
1386
1387         vport->qos.enabled = true;
1388         return 0;
1389 }
1390
1391 static void esw_vport_disable_qos(struct mlx5_eswitch *esw, int vport_num)
1392 {
1393         struct mlx5_vport *vport = &esw->vports[vport_num];
1394         int err = 0;
1395
1396         if (!vport->qos.enabled)
1397                 return;
1398
1399         err = mlx5_destroy_scheduling_element_cmd(esw->dev,
1400                                                   SCHEDULING_HIERARCHY_E_SWITCH,
1401                                                   vport->qos.esw_tsar_ix);
1402         if (err)
1403                 esw_warn(esw->dev, "E-Switch destroy TSAR vport element failed (vport=%d,err=%d)\n",
1404                          vport_num, err);
1405
1406         vport->qos.enabled = false;
1407 }
1408
1409 static int esw_vport_qos_config(struct mlx5_eswitch *esw, int vport_num,
1410                                 u32 max_rate, u32 bw_share)
1411 {
1412         u32 sched_ctx[MLX5_ST_SZ_DW(scheduling_context)] = {0};
1413         struct mlx5_vport *vport = &esw->vports[vport_num];
1414         struct mlx5_core_dev *dev = esw->dev;
1415         void *vport_elem;
1416         u32 bitmask = 0;
1417         int err = 0;
1418
1419         if (!MLX5_CAP_GEN(dev, qos) || !MLX5_CAP_QOS(dev, esw_scheduling))
1420                 return -EOPNOTSUPP;
1421
1422         if (!vport->qos.enabled)
1423                 return -EIO;
1424
1425         MLX5_SET(scheduling_context, sched_ctx, element_type,
1426                  SCHEDULING_CONTEXT_ELEMENT_TYPE_VPORT);
1427         vport_elem = MLX5_ADDR_OF(scheduling_context, sched_ctx,
1428                                   element_attributes);
1429         MLX5_SET(vport_element, vport_elem, vport_number, vport_num);
1430         MLX5_SET(scheduling_context, sched_ctx, parent_element_id,
1431                  esw->qos.root_tsar_id);
1432         MLX5_SET(scheduling_context, sched_ctx, max_average_bw,
1433                  max_rate);
1434         MLX5_SET(scheduling_context, sched_ctx, bw_share, bw_share);
1435         bitmask |= MODIFY_SCHEDULING_ELEMENT_IN_MODIFY_BITMASK_MAX_AVERAGE_BW;
1436         bitmask |= MODIFY_SCHEDULING_ELEMENT_IN_MODIFY_BITMASK_BW_SHARE;
1437
1438         err = mlx5_modify_scheduling_element_cmd(dev,
1439                                                  SCHEDULING_HIERARCHY_E_SWITCH,
1440                                                  sched_ctx,
1441                                                  vport->qos.esw_tsar_ix,
1442                                                  bitmask);
1443         if (err) {
1444                 esw_warn(esw->dev, "E-Switch modify TSAR vport element failed (vport=%d,err=%d)\n",
1445                          vport_num, err);
1446                 return err;
1447         }
1448
1449         return 0;
1450 }
1451
1452 static void node_guid_gen_from_mac(u64 *node_guid, u8 mac[ETH_ALEN])
1453 {
1454         ((u8 *)node_guid)[7] = mac[0];
1455         ((u8 *)node_guid)[6] = mac[1];
1456         ((u8 *)node_guid)[5] = mac[2];
1457         ((u8 *)node_guid)[4] = 0xff;
1458         ((u8 *)node_guid)[3] = 0xfe;
1459         ((u8 *)node_guid)[2] = mac[3];
1460         ((u8 *)node_guid)[1] = mac[4];
1461         ((u8 *)node_guid)[0] = mac[5];
1462 }
1463
1464 static void esw_apply_vport_conf(struct mlx5_eswitch *esw,
1465                                  struct mlx5_vport *vport)
1466 {
1467         int vport_num = vport->vport;
1468
1469         if (!vport_num)
1470                 return;
1471
1472         mlx5_modify_vport_admin_state(esw->dev,
1473                                       MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
1474                                       vport_num,
1475                                       vport->info.link_state);
1476         mlx5_modify_nic_vport_mac_address(esw->dev, vport_num, vport->info.mac);
1477         mlx5_modify_nic_vport_node_guid(esw->dev, vport_num, vport->info.node_guid);
1478         modify_esw_vport_cvlan(esw->dev, vport_num, vport->info.vlan, vport->info.qos,
1479                                (vport->info.vlan || vport->info.qos));
1480
1481         /* Only legacy mode needs ACLs */
1482         if (esw->mode == SRIOV_LEGACY) {
1483                 esw_vport_ingress_config(esw, vport);
1484                 esw_vport_egress_config(esw, vport);
1485         }
1486 }
1487
1488 static void esw_vport_create_drop_counters(struct mlx5_vport *vport)
1489 {
1490         struct mlx5_core_dev *dev = vport->dev;
1491
1492         if (MLX5_CAP_ESW_INGRESS_ACL(dev, flow_counter)) {
1493                 vport->ingress.drop_counter = mlx5_fc_create(dev, false);
1494                 if (IS_ERR(vport->ingress.drop_counter)) {
1495                         esw_warn(dev,
1496                                  "vport[%d] configure ingress drop rule counter failed\n",
1497                                  vport->vport);
1498                         vport->ingress.drop_counter = NULL;
1499                 }
1500         }
1501
1502         if (MLX5_CAP_ESW_EGRESS_ACL(dev, flow_counter)) {
1503                 vport->egress.drop_counter = mlx5_fc_create(dev, false);
1504                 if (IS_ERR(vport->egress.drop_counter)) {
1505                         esw_warn(dev,
1506                                  "vport[%d] configure egress drop rule counter failed\n",
1507                                  vport->vport);
1508                         vport->egress.drop_counter = NULL;
1509                 }
1510         }
1511 }
1512
1513 static void esw_vport_destroy_drop_counters(struct mlx5_vport *vport)
1514 {
1515         struct mlx5_core_dev *dev = vport->dev;
1516
1517         if (vport->ingress.drop_counter)
1518                 mlx5_fc_destroy(dev, vport->ingress.drop_counter);
1519         if (vport->egress.drop_counter)
1520                 mlx5_fc_destroy(dev, vport->egress.drop_counter);
1521 }
1522
1523 static void esw_enable_vport(struct mlx5_eswitch *esw, int vport_num,
1524                              int enable_events)
1525 {
1526         struct mlx5_vport *vport = &esw->vports[vport_num];
1527
1528         mutex_lock(&esw->state_lock);
1529         WARN_ON(vport->enabled);
1530
1531         esw_debug(esw->dev, "Enabling VPORT(%d)\n", vport_num);
1532
1533         /* Create steering drop counters for ingress and egress ACLs */
1534         if (vport_num && esw->mode == SRIOV_LEGACY)
1535                 esw_vport_create_drop_counters(vport);
1536
1537         /* Restore old vport configuration */
1538         esw_apply_vport_conf(esw, vport);
1539
1540         /* Attach vport to the eswitch rate limiter */
1541         if (esw_vport_enable_qos(esw, vport_num, vport->info.max_rate,
1542                                  vport->qos.bw_share))
1543                 esw_warn(esw->dev, "Failed to attach vport %d to eswitch rate limiter", vport_num);
1544
1545         /* Sync with current vport context */
1546         vport->enabled_events = enable_events;
1547         vport->enabled = true;
1548
1549         /* only PF is trusted by default */
1550         if (!vport_num)
1551                 vport->info.trusted = true;
1552
1553         esw_vport_change_handle_locked(vport);
1554
1555         esw->enabled_vports++;
1556         esw_debug(esw->dev, "Enabled VPORT(%d)\n", vport_num);
1557         mutex_unlock(&esw->state_lock);
1558 }
1559
1560 static void esw_disable_vport(struct mlx5_eswitch *esw, int vport_num)
1561 {
1562         struct mlx5_vport *vport = &esw->vports[vport_num];
1563
1564         if (!vport->enabled)
1565                 return;
1566
1567         esw_debug(esw->dev, "Disabling vport(%d)\n", vport_num);
1568         /* Mark this vport as disabled to discard new events */
1569         vport->enabled = false;
1570
1571         /* Wait for current already scheduled events to complete */
1572         flush_workqueue(esw->work_queue);
1573         /* Disable events from this vport */
1574         arm_vport_context_events_cmd(esw->dev, vport->vport, 0);
1575         mutex_lock(&esw->state_lock);
1576         /* We don't assume VFs will cleanup after themselves.
1577          * Calling vport change handler while vport is disabled will cleanup
1578          * the vport resources.
1579          */
1580         esw_vport_change_handle_locked(vport);
1581         vport->enabled_events = 0;
1582         esw_vport_disable_qos(esw, vport_num);
1583         if (vport_num && esw->mode == SRIOV_LEGACY) {
1584                 mlx5_modify_vport_admin_state(esw->dev,
1585                                               MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
1586                                               vport_num,
1587                                               MLX5_VPORT_ADMIN_STATE_DOWN);
1588                 esw_vport_disable_egress_acl(esw, vport);
1589                 esw_vport_disable_ingress_acl(esw, vport);
1590                 esw_vport_destroy_drop_counters(vport);
1591         }
1592         esw->enabled_vports--;
1593         mutex_unlock(&esw->state_lock);
1594 }
1595
1596 static int eswitch_vport_event(struct notifier_block *nb,
1597                                unsigned long type, void *data)
1598 {
1599         struct mlx5_eswitch *esw = mlx5_nb_cof(nb, struct mlx5_eswitch, nb);
1600         struct mlx5_eqe *eqe = data;
1601         struct mlx5_vport *vport;
1602         u16 vport_num;
1603
1604         vport_num = be16_to_cpu(eqe->data.vport_change.vport_num);
1605         vport = &esw->vports[vport_num];
1606         if (vport->enabled)
1607                 queue_work(esw->work_queue, &vport->vport_change_handler);
1608
1609         return NOTIFY_OK;
1610 }
1611
1612 /* Public E-Switch API */
1613 #define ESW_ALLOWED(esw) ((esw) && MLX5_ESWITCH_MANAGER((esw)->dev))
1614
1615 int mlx5_eswitch_enable_sriov(struct mlx5_eswitch *esw, int nvfs, int mode)
1616 {
1617         int err;
1618         int i, enabled_events;
1619
1620         if (!ESW_ALLOWED(esw) ||
1621             !MLX5_CAP_ESW_FLOWTABLE_FDB(esw->dev, ft_support)) {
1622                 esw_warn(esw->dev, "E-Switch FDB is not supported, aborting ...\n");
1623                 return -EOPNOTSUPP;
1624         }
1625
1626         if (!MLX5_CAP_ESW_INGRESS_ACL(esw->dev, ft_support))
1627                 esw_warn(esw->dev, "E-Switch ingress ACL is not supported by FW\n");
1628
1629         if (!MLX5_CAP_ESW_EGRESS_ACL(esw->dev, ft_support))
1630                 esw_warn(esw->dev, "E-Switch engress ACL is not supported by FW\n");
1631
1632         esw_info(esw->dev, "E-Switch enable SRIOV: nvfs(%d) mode (%d)\n", nvfs, mode);
1633
1634         esw->mode = mode;
1635
1636         mlx5_lag_update(esw->dev);
1637
1638         if (mode == SRIOV_LEGACY) {
1639                 err = esw_create_legacy_fdb_table(esw);
1640         } else {
1641                 mlx5_reload_interface(esw->dev, MLX5_INTERFACE_PROTOCOL_ETH);
1642                 mlx5_reload_interface(esw->dev, MLX5_INTERFACE_PROTOCOL_IB);
1643                 err = esw_offloads_init(esw, nvfs + 1);
1644         }
1645
1646         if (err)
1647                 goto abort;
1648
1649         err = esw_create_tsar(esw);
1650         if (err)
1651                 esw_warn(esw->dev, "Failed to create eswitch TSAR");
1652
1653         /* Don't enable vport events when in SRIOV_OFFLOADS mode, since:
1654          * 1. L2 table (MPFS) is programmed by PF/VF representors netdevs set_rx_mode
1655          * 2. FDB/Eswitch is programmed by user space tools
1656          */
1657         enabled_events = (mode == SRIOV_LEGACY) ? SRIOV_VPORT_EVENTS : 0;
1658         for (i = 0; i <= nvfs; i++)
1659                 esw_enable_vport(esw, i, enabled_events);
1660
1661         if (mode == SRIOV_LEGACY) {
1662                 MLX5_NB_INIT(&esw->nb, eswitch_vport_event, NIC_VPORT_CHANGE);
1663                 mlx5_eq_notifier_register(esw->dev, &esw->nb);
1664         }
1665
1666         esw_info(esw->dev, "SRIOV enabled: active vports(%d)\n",
1667                  esw->enabled_vports);
1668         return 0;
1669
1670 abort:
1671         esw->mode = SRIOV_NONE;
1672
1673         if (mode == SRIOV_OFFLOADS) {
1674                 mlx5_reload_interface(esw->dev, MLX5_INTERFACE_PROTOCOL_IB);
1675                 mlx5_reload_interface(esw->dev, MLX5_INTERFACE_PROTOCOL_ETH);
1676         }
1677
1678         return err;
1679 }
1680
1681 void mlx5_eswitch_disable_sriov(struct mlx5_eswitch *esw)
1682 {
1683         struct esw_mc_addr *mc_promisc;
1684         int old_mode;
1685         int nvports;
1686         int i;
1687
1688         if (!ESW_ALLOWED(esw) || esw->mode == SRIOV_NONE)
1689                 return;
1690
1691         esw_info(esw->dev, "disable SRIOV: active vports(%d) mode(%d)\n",
1692                  esw->enabled_vports, esw->mode);
1693
1694         mc_promisc = &esw->mc_promisc;
1695         nvports = esw->enabled_vports;
1696
1697         if (esw->mode == SRIOV_LEGACY)
1698                 mlx5_eq_notifier_unregister(esw->dev, &esw->nb);
1699
1700         for (i = 0; i < esw->total_vports; i++)
1701                 esw_disable_vport(esw, i);
1702
1703         if (mc_promisc && mc_promisc->uplink_rule)
1704                 mlx5_del_flow_rules(mc_promisc->uplink_rule);
1705
1706         esw_destroy_tsar(esw);
1707
1708         if (esw->mode == SRIOV_LEGACY)
1709                 esw_destroy_legacy_fdb_table(esw);
1710         else if (esw->mode == SRIOV_OFFLOADS)
1711                 esw_offloads_cleanup(esw, nvports);
1712
1713         old_mode = esw->mode;
1714         esw->mode = SRIOV_NONE;
1715
1716         mlx5_lag_update(esw->dev);
1717
1718         if (old_mode == SRIOV_OFFLOADS) {
1719                 mlx5_reload_interface(esw->dev, MLX5_INTERFACE_PROTOCOL_IB);
1720                 mlx5_reload_interface(esw->dev, MLX5_INTERFACE_PROTOCOL_ETH);
1721         }
1722 }
1723
1724 int mlx5_eswitch_init(struct mlx5_core_dev *dev)
1725 {
1726         int total_vports = MLX5_TOTAL_VPORTS(dev);
1727         struct mlx5_eswitch *esw;
1728         int vport_num;
1729         int err;
1730
1731         if (!MLX5_ESWITCH_MANAGER(dev))
1732                 return 0;
1733
1734         esw_info(dev,
1735                  "Total vports %d, per vport: max uc(%d) max mc(%d)\n",
1736                  total_vports,
1737                  MLX5_MAX_UC_PER_VPORT(dev),
1738                  MLX5_MAX_MC_PER_VPORT(dev));
1739
1740         esw = kzalloc(sizeof(*esw), GFP_KERNEL);
1741         if (!esw)
1742                 return -ENOMEM;
1743
1744         esw->dev = dev;
1745
1746         esw->work_queue = create_singlethread_workqueue("mlx5_esw_wq");
1747         if (!esw->work_queue) {
1748                 err = -ENOMEM;
1749                 goto abort;
1750         }
1751
1752         esw->vports = kcalloc(total_vports, sizeof(struct mlx5_vport),
1753                               GFP_KERNEL);
1754         if (!esw->vports) {
1755                 err = -ENOMEM;
1756                 goto abort;
1757         }
1758
1759         err = esw_offloads_init_reps(esw);
1760         if (err)
1761                 goto abort;
1762
1763         hash_init(esw->offloads.encap_tbl);
1764         hash_init(esw->offloads.mod_hdr_tbl);
1765         mutex_init(&esw->state_lock);
1766
1767         for (vport_num = 0; vport_num < total_vports; vport_num++) {
1768                 struct mlx5_vport *vport = &esw->vports[vport_num];
1769
1770                 vport->vport = vport_num;
1771                 vport->info.link_state = MLX5_VPORT_ADMIN_STATE_AUTO;
1772                 vport->dev = dev;
1773                 INIT_WORK(&vport->vport_change_handler,
1774                           esw_vport_change_handler);
1775         }
1776
1777         esw->total_vports = total_vports;
1778         esw->enabled_vports = 0;
1779         esw->mode = SRIOV_NONE;
1780         esw->offloads.inline_mode = MLX5_INLINE_MODE_NONE;
1781         if (MLX5_CAP_ESW_FLOWTABLE_FDB(dev, reformat) &&
1782             MLX5_CAP_ESW_FLOWTABLE_FDB(dev, decap))
1783                 esw->offloads.encap = DEVLINK_ESWITCH_ENCAP_MODE_BASIC;
1784         else
1785                 esw->offloads.encap = DEVLINK_ESWITCH_ENCAP_MODE_NONE;
1786
1787         dev->priv.eswitch = esw;
1788         return 0;
1789 abort:
1790         if (esw->work_queue)
1791                 destroy_workqueue(esw->work_queue);
1792         esw_offloads_cleanup_reps(esw);
1793         kfree(esw->vports);
1794         kfree(esw);
1795         return err;
1796 }
1797
1798 void mlx5_eswitch_cleanup(struct mlx5_eswitch *esw)
1799 {
1800         if (!esw || !MLX5_ESWITCH_MANAGER(esw->dev))
1801                 return;
1802
1803         esw_info(esw->dev, "cleanup\n");
1804
1805         esw->dev->priv.eswitch = NULL;
1806         destroy_workqueue(esw->work_queue);
1807         esw_offloads_cleanup_reps(esw);
1808         kfree(esw->vports);
1809         kfree(esw);
1810 }
1811
1812 /* Vport Administration */
1813 #define LEGAL_VPORT(esw, vport) (vport >= 0 && vport < esw->total_vports)
1814
1815 int mlx5_eswitch_set_vport_mac(struct mlx5_eswitch *esw,
1816                                int vport, u8 mac[ETH_ALEN])
1817 {
1818         struct mlx5_vport *evport;
1819         u64 node_guid;
1820         int err = 0;
1821
1822         if (!MLX5_CAP_GEN(esw->dev, vport_group_manager))
1823                 return -EPERM;
1824         if (!LEGAL_VPORT(esw, vport) || is_multicast_ether_addr(mac))
1825                 return -EINVAL;
1826
1827         mutex_lock(&esw->state_lock);
1828         evport = &esw->vports[vport];
1829
1830         if (evport->info.spoofchk && !is_valid_ether_addr(mac)) {
1831                 mlx5_core_warn(esw->dev,
1832                                "MAC invalidation is not allowed when spoofchk is on, vport(%d)\n",
1833                                vport);
1834                 err = -EPERM;
1835                 goto unlock;
1836         }
1837
1838         err = mlx5_modify_nic_vport_mac_address(esw->dev, vport, mac);
1839         if (err) {
1840                 mlx5_core_warn(esw->dev,
1841                                "Failed to mlx5_modify_nic_vport_mac vport(%d) err=(%d)\n",
1842                                vport, err);
1843                 goto unlock;
1844         }
1845
1846         node_guid_gen_from_mac(&node_guid, mac);
1847         err = mlx5_modify_nic_vport_node_guid(esw->dev, vport, node_guid);
1848         if (err)
1849                 mlx5_core_warn(esw->dev,
1850                                "Failed to set vport %d node guid, err = %d. RDMA_CM will not function properly for this VF.\n",
1851                                vport, err);
1852
1853         ether_addr_copy(evport->info.mac, mac);
1854         evport->info.node_guid = node_guid;
1855         if (evport->enabled && esw->mode == SRIOV_LEGACY)
1856                 err = esw_vport_ingress_config(esw, evport);
1857
1858 unlock:
1859         mutex_unlock(&esw->state_lock);
1860         return err;
1861 }
1862
1863 int mlx5_eswitch_set_vport_state(struct mlx5_eswitch *esw,
1864                                  int vport, int link_state)
1865 {
1866         struct mlx5_vport *evport;
1867         int err = 0;
1868
1869         if (!ESW_ALLOWED(esw))
1870                 return -EPERM;
1871         if (!LEGAL_VPORT(esw, vport))
1872                 return -EINVAL;
1873
1874         mutex_lock(&esw->state_lock);
1875         evport = &esw->vports[vport];
1876
1877         err = mlx5_modify_vport_admin_state(esw->dev,
1878                                             MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
1879                                             vport, link_state);
1880         if (err) {
1881                 mlx5_core_warn(esw->dev,
1882                                "Failed to set vport %d link state, err = %d",
1883                                vport, err);
1884                 goto unlock;
1885         }
1886
1887         evport->info.link_state = link_state;
1888
1889 unlock:
1890         mutex_unlock(&esw->state_lock);
1891         return 0;
1892 }
1893
1894 int mlx5_eswitch_get_vport_config(struct mlx5_eswitch *esw,
1895                                   int vport, struct ifla_vf_info *ivi)
1896 {
1897         struct mlx5_vport *evport;
1898
1899         if (!MLX5_CAP_GEN(esw->dev, vport_group_manager))
1900                 return -EPERM;
1901         if (!LEGAL_VPORT(esw, vport))
1902                 return -EINVAL;
1903
1904         evport = &esw->vports[vport];
1905
1906         memset(ivi, 0, sizeof(*ivi));
1907         ivi->vf = vport - 1;
1908
1909         mutex_lock(&esw->state_lock);
1910         ether_addr_copy(ivi->mac, evport->info.mac);
1911         ivi->linkstate = evport->info.link_state;
1912         ivi->vlan = evport->info.vlan;
1913         ivi->qos = evport->info.qos;
1914         ivi->spoofchk = evport->info.spoofchk;
1915         ivi->trusted = evport->info.trusted;
1916         ivi->min_tx_rate = evport->info.min_rate;
1917         ivi->max_tx_rate = evport->info.max_rate;
1918         mutex_unlock(&esw->state_lock);
1919
1920         return 0;
1921 }
1922
1923 int __mlx5_eswitch_set_vport_vlan(struct mlx5_eswitch *esw,
1924                                   int vport, u16 vlan, u8 qos, u8 set_flags)
1925 {
1926         struct mlx5_vport *evport;
1927         int err = 0;
1928
1929         if (!ESW_ALLOWED(esw))
1930                 return -EPERM;
1931         if (!LEGAL_VPORT(esw, vport) || (vlan > 4095) || (qos > 7))
1932                 return -EINVAL;
1933
1934         mutex_lock(&esw->state_lock);
1935         evport = &esw->vports[vport];
1936
1937         err = modify_esw_vport_cvlan(esw->dev, vport, vlan, qos, set_flags);
1938         if (err)
1939                 goto unlock;
1940
1941         evport->info.vlan = vlan;
1942         evport->info.qos = qos;
1943         if (evport->enabled && esw->mode == SRIOV_LEGACY) {
1944                 err = esw_vport_ingress_config(esw, evport);
1945                 if (err)
1946                         goto unlock;
1947                 err = esw_vport_egress_config(esw, evport);
1948         }
1949
1950 unlock:
1951         mutex_unlock(&esw->state_lock);
1952         return err;
1953 }
1954
1955 int mlx5_eswitch_set_vport_vlan(struct mlx5_eswitch *esw,
1956                                 int vport, u16 vlan, u8 qos)
1957 {
1958         u8 set_flags = 0;
1959
1960         if (vlan || qos)
1961                 set_flags = SET_VLAN_STRIP | SET_VLAN_INSERT;
1962
1963         return __mlx5_eswitch_set_vport_vlan(esw, vport, vlan, qos, set_flags);
1964 }
1965
1966 int mlx5_eswitch_set_vport_spoofchk(struct mlx5_eswitch *esw,
1967                                     int vport, bool spoofchk)
1968 {
1969         struct mlx5_vport *evport;
1970         bool pschk;
1971         int err = 0;
1972
1973         if (!ESW_ALLOWED(esw))
1974                 return -EPERM;
1975         if (!LEGAL_VPORT(esw, vport))
1976                 return -EINVAL;
1977
1978         mutex_lock(&esw->state_lock);
1979         evport = &esw->vports[vport];
1980         pschk = evport->info.spoofchk;
1981         evport->info.spoofchk = spoofchk;
1982         if (evport->enabled && esw->mode == SRIOV_LEGACY)
1983                 err = esw_vport_ingress_config(esw, evport);
1984         if (err)
1985                 evport->info.spoofchk = pschk;
1986         mutex_unlock(&esw->state_lock);
1987
1988         return err;
1989 }
1990
1991 int mlx5_eswitch_set_vport_trust(struct mlx5_eswitch *esw,
1992                                  int vport, bool setting)
1993 {
1994         struct mlx5_vport *evport;
1995
1996         if (!ESW_ALLOWED(esw))
1997                 return -EPERM;
1998         if (!LEGAL_VPORT(esw, vport))
1999                 return -EINVAL;
2000
2001         mutex_lock(&esw->state_lock);
2002         evport = &esw->vports[vport];
2003         evport->info.trusted = setting;
2004         if (evport->enabled)
2005                 esw_vport_change_handle_locked(evport);
2006         mutex_unlock(&esw->state_lock);
2007
2008         return 0;
2009 }
2010
2011 static u32 calculate_vports_min_rate_divider(struct mlx5_eswitch *esw)
2012 {
2013         u32 fw_max_bw_share = MLX5_CAP_QOS(esw->dev, max_tsar_bw_share);
2014         struct mlx5_vport *evport;
2015         u32 max_guarantee = 0;
2016         int i;
2017
2018         for (i = 0; i < esw->total_vports; i++) {
2019                 evport = &esw->vports[i];
2020                 if (!evport->enabled || evport->info.min_rate < max_guarantee)
2021                         continue;
2022                 max_guarantee = evport->info.min_rate;
2023         }
2024
2025         return max_t(u32, max_guarantee / fw_max_bw_share, 1);
2026 }
2027
2028 static int normalize_vports_min_rate(struct mlx5_eswitch *esw, u32 divider)
2029 {
2030         u32 fw_max_bw_share = MLX5_CAP_QOS(esw->dev, max_tsar_bw_share);
2031         struct mlx5_vport *evport;
2032         u32 vport_max_rate;
2033         u32 vport_min_rate;
2034         u32 bw_share;
2035         int err;
2036         int i;
2037
2038         for (i = 0; i < esw->total_vports; i++) {
2039                 evport = &esw->vports[i];
2040                 if (!evport->enabled)
2041                         continue;
2042                 vport_min_rate = evport->info.min_rate;
2043                 vport_max_rate = evport->info.max_rate;
2044                 bw_share = MLX5_MIN_BW_SHARE;
2045
2046                 if (vport_min_rate)
2047                         bw_share = MLX5_RATE_TO_BW_SHARE(vport_min_rate,
2048                                                          divider,
2049                                                          fw_max_bw_share);
2050
2051                 if (bw_share == evport->qos.bw_share)
2052                         continue;
2053
2054                 err = esw_vport_qos_config(esw, i, vport_max_rate,
2055                                            bw_share);
2056                 if (!err)
2057                         evport->qos.bw_share = bw_share;
2058                 else
2059                         return err;
2060         }
2061
2062         return 0;
2063 }
2064
2065 int mlx5_eswitch_set_vport_rate(struct mlx5_eswitch *esw, int vport,
2066                                 u32 max_rate, u32 min_rate)
2067 {
2068         u32 fw_max_bw_share = MLX5_CAP_QOS(esw->dev, max_tsar_bw_share);
2069         bool min_rate_supported = MLX5_CAP_QOS(esw->dev, esw_bw_share) &&
2070                                         fw_max_bw_share >= MLX5_MIN_BW_SHARE;
2071         bool max_rate_supported = MLX5_CAP_QOS(esw->dev, esw_rate_limit);
2072         struct mlx5_vport *evport;
2073         u32 previous_min_rate;
2074         u32 divider;
2075         int err = 0;
2076
2077         if (!ESW_ALLOWED(esw))
2078                 return -EPERM;
2079         if (!LEGAL_VPORT(esw, vport))
2080                 return -EINVAL;
2081         if ((min_rate && !min_rate_supported) || (max_rate && !max_rate_supported))
2082                 return -EOPNOTSUPP;
2083
2084         mutex_lock(&esw->state_lock);
2085         evport = &esw->vports[vport];
2086
2087         if (min_rate == evport->info.min_rate)
2088                 goto set_max_rate;
2089
2090         previous_min_rate = evport->info.min_rate;
2091         evport->info.min_rate = min_rate;
2092         divider = calculate_vports_min_rate_divider(esw);
2093         err = normalize_vports_min_rate(esw, divider);
2094         if (err) {
2095                 evport->info.min_rate = previous_min_rate;
2096                 goto unlock;
2097         }
2098
2099 set_max_rate:
2100         if (max_rate == evport->info.max_rate)
2101                 goto unlock;
2102
2103         err = esw_vport_qos_config(esw, vport, max_rate, evport->qos.bw_share);
2104         if (!err)
2105                 evport->info.max_rate = max_rate;
2106
2107 unlock:
2108         mutex_unlock(&esw->state_lock);
2109         return err;
2110 }
2111
2112 static int mlx5_eswitch_query_vport_drop_stats(struct mlx5_core_dev *dev,
2113                                                int vport_idx,
2114                                                struct mlx5_vport_drop_stats *stats)
2115 {
2116         struct mlx5_eswitch *esw = dev->priv.eswitch;
2117         struct mlx5_vport *vport = &esw->vports[vport_idx];
2118         u64 rx_discard_vport_down, tx_discard_vport_down;
2119         u64 bytes = 0;
2120         int err = 0;
2121
2122         if (!vport->enabled || esw->mode != SRIOV_LEGACY)
2123                 return 0;
2124
2125         if (vport->egress.drop_counter)
2126                 mlx5_fc_query(dev, vport->egress.drop_counter,
2127                               &stats->rx_dropped, &bytes);
2128
2129         if (vport->ingress.drop_counter)
2130                 mlx5_fc_query(dev, vport->ingress.drop_counter,
2131                               &stats->tx_dropped, &bytes);
2132
2133         if (!MLX5_CAP_GEN(dev, receive_discard_vport_down) &&
2134             !MLX5_CAP_GEN(dev, transmit_discard_vport_down))
2135                 return 0;
2136
2137         err = mlx5_query_vport_down_stats(dev, vport_idx,
2138                                           &rx_discard_vport_down,
2139                                           &tx_discard_vport_down);
2140         if (err)
2141                 return err;
2142
2143         if (MLX5_CAP_GEN(dev, receive_discard_vport_down))
2144                 stats->rx_dropped += rx_discard_vport_down;
2145         if (MLX5_CAP_GEN(dev, transmit_discard_vport_down))
2146                 stats->tx_dropped += tx_discard_vport_down;
2147
2148         return 0;
2149 }
2150
2151 int mlx5_eswitch_get_vport_stats(struct mlx5_eswitch *esw,
2152                                  int vport,
2153                                  struct ifla_vf_stats *vf_stats)
2154 {
2155         int outlen = MLX5_ST_SZ_BYTES(query_vport_counter_out);
2156         u32 in[MLX5_ST_SZ_DW(query_vport_counter_in)] = {0};
2157         struct mlx5_vport_drop_stats stats = {0};
2158         int err = 0;
2159         u32 *out;
2160
2161         if (!ESW_ALLOWED(esw))
2162                 return -EPERM;
2163         if (!LEGAL_VPORT(esw, vport))
2164                 return -EINVAL;
2165
2166         out = kvzalloc(outlen, GFP_KERNEL);
2167         if (!out)
2168                 return -ENOMEM;
2169
2170         MLX5_SET(query_vport_counter_in, in, opcode,
2171                  MLX5_CMD_OP_QUERY_VPORT_COUNTER);
2172         MLX5_SET(query_vport_counter_in, in, op_mod, 0);
2173         MLX5_SET(query_vport_counter_in, in, vport_number, vport);
2174         if (vport)
2175                 MLX5_SET(query_vport_counter_in, in, other_vport, 1);
2176
2177         memset(out, 0, outlen);
2178         err = mlx5_cmd_exec(esw->dev, in, sizeof(in), out, outlen);
2179         if (err)
2180                 goto free_out;
2181
2182         #define MLX5_GET_CTR(p, x) \
2183                 MLX5_GET64(query_vport_counter_out, p, x)
2184
2185         memset(vf_stats, 0, sizeof(*vf_stats));
2186         vf_stats->rx_packets =
2187                 MLX5_GET_CTR(out, received_eth_unicast.packets) +
2188                 MLX5_GET_CTR(out, received_ib_unicast.packets) +
2189                 MLX5_GET_CTR(out, received_eth_multicast.packets) +
2190                 MLX5_GET_CTR(out, received_ib_multicast.packets) +
2191                 MLX5_GET_CTR(out, received_eth_broadcast.packets);
2192
2193         vf_stats->rx_bytes =
2194                 MLX5_GET_CTR(out, received_eth_unicast.octets) +
2195                 MLX5_GET_CTR(out, received_ib_unicast.octets) +
2196                 MLX5_GET_CTR(out, received_eth_multicast.octets) +
2197                 MLX5_GET_CTR(out, received_ib_multicast.octets) +
2198                 MLX5_GET_CTR(out, received_eth_broadcast.octets);
2199
2200         vf_stats->tx_packets =
2201                 MLX5_GET_CTR(out, transmitted_eth_unicast.packets) +
2202                 MLX5_GET_CTR(out, transmitted_ib_unicast.packets) +
2203                 MLX5_GET_CTR(out, transmitted_eth_multicast.packets) +
2204                 MLX5_GET_CTR(out, transmitted_ib_multicast.packets) +
2205                 MLX5_GET_CTR(out, transmitted_eth_broadcast.packets);
2206
2207         vf_stats->tx_bytes =
2208                 MLX5_GET_CTR(out, transmitted_eth_unicast.octets) +
2209                 MLX5_GET_CTR(out, transmitted_ib_unicast.octets) +
2210                 MLX5_GET_CTR(out, transmitted_eth_multicast.octets) +
2211                 MLX5_GET_CTR(out, transmitted_ib_multicast.octets) +
2212                 MLX5_GET_CTR(out, transmitted_eth_broadcast.octets);
2213
2214         vf_stats->multicast =
2215                 MLX5_GET_CTR(out, received_eth_multicast.packets) +
2216                 MLX5_GET_CTR(out, received_ib_multicast.packets);
2217
2218         vf_stats->broadcast =
2219                 MLX5_GET_CTR(out, received_eth_broadcast.packets);
2220
2221         err = mlx5_eswitch_query_vport_drop_stats(esw->dev, vport, &stats);
2222         if (err)
2223                 goto free_out;
2224         vf_stats->rx_dropped = stats.rx_dropped;
2225         vf_stats->tx_dropped = stats.tx_dropped;
2226
2227 free_out:
2228         kvfree(out);
2229         return err;
2230 }
2231
2232 u8 mlx5_eswitch_mode(struct mlx5_eswitch *esw)
2233 {
2234         return ESW_ALLOWED(esw) ? esw->mode : SRIOV_NONE;
2235 }
2236 EXPORT_SYMBOL_GPL(mlx5_eswitch_mode);
2237
2238 bool mlx5_esw_lag_prereq(struct mlx5_core_dev *dev0, struct mlx5_core_dev *dev1)
2239 {
2240         if ((dev0->priv.eswitch->mode == SRIOV_NONE &&
2241              dev1->priv.eswitch->mode == SRIOV_NONE) ||
2242             (dev0->priv.eswitch->mode == SRIOV_OFFLOADS &&
2243              dev1->priv.eswitch->mode == SRIOV_OFFLOADS))
2244                 return true;
2245
2246         return false;
2247 }