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 <linux/mlx5/mpfs.h>
  39 #include "esw/acl/lgcy.h"
  40 #include "esw/legacy.h"
  41 #include "mlx5_core.h"
  42 #include "lib/eq.h"
  43 #include "eswitch.h"
  44 #include "fs_core.h"
  45 #include "devlink.h"
  46 #include "ecpf.h"
  47 #include "en/mod_hdr.h"
  48
  49 enum {
  50         MLX5_ACTION_NONE = 0,
  51         MLX5_ACTION_ADD  = 1,
  52         MLX5_ACTION_DEL  = 2,
  53 };
  54
  55 /* Vport UC/MC hash node */
  56 struct vport_addr {
  57         struct l2addr_node     node;
  58         u8                     action;
  59         u16                    vport;
  60         struct mlx5_flow_handle *flow_rule;
  61         bool mpfs; /* UC MAC was added to MPFs */
  62         /* A flag indicating that mac was added due to mc promiscuous vport */
  63         bool mc_promisc;
  64 };
  65
  66 static int mlx5_eswitch_check(const struct mlx5_core_dev *dev)
  67 {
  68         if (MLX5_CAP_GEN(dev, port_type) != MLX5_CAP_PORT_TYPE_ETH)
  69                 return -EOPNOTSUPP;
  70
  71         if (!MLX5_ESWITCH_MANAGER(dev))
  72                 return -EOPNOTSUPP;
  73
  74         return 0;
  75 }
  76
  77 struct mlx5_eswitch *mlx5_devlink_eswitch_get(struct devlink *devlink)
  78 {
  79         struct mlx5_core_dev *dev = devlink_priv(devlink);
  80         int err;
  81
  82         err = mlx5_eswitch_check(dev);
  83         if (err)
  84                 return ERR_PTR(err);
  85
  86         return dev->priv.eswitch;
  87 }
  88
  89 struct mlx5_vport *__must_check
  90 mlx5_eswitch_get_vport(struct mlx5_eswitch *esw, u16 vport_num)
  91 {
  92         struct mlx5_vport *vport;
  93
  94         if (!esw || !MLX5_CAP_GEN(esw->dev, vport_group_manager))
  95                 return ERR_PTR(-EPERM);
  96
  97         vport = xa_load(&esw->vports, vport_num);
  98         if (!vport) {
  99                 esw_debug(esw->dev, "vport out of range: num(0x%x)\n", vport_num);
 100                 return ERR_PTR(-EINVAL);
 101         }
 102         return vport;
 103 }
 104
 105 static int arm_vport_context_events_cmd(struct mlx5_core_dev *dev, u16 vport,
 106                                         u32 events_mask)
 107 {
 108         u32 in[MLX5_ST_SZ_DW(modify_nic_vport_context_in)] = {};
 109         void *nic_vport_ctx;
 110
 111         MLX5_SET(modify_nic_vport_context_in, in,
 112                  opcode, MLX5_CMD_OP_MODIFY_NIC_VPORT_CONTEXT);
 113         MLX5_SET(modify_nic_vport_context_in, in, field_select.change_event, 1);
 114         MLX5_SET(modify_nic_vport_context_in, in, vport_number, vport);
 115         MLX5_SET(modify_nic_vport_context_in, in, other_vport, 1);
 116         nic_vport_ctx = MLX5_ADDR_OF(modify_nic_vport_context_in,
 117                                      in, nic_vport_context);
 118
 119         MLX5_SET(nic_vport_context, nic_vport_ctx, arm_change_event, 1);
 120
 121         if (events_mask & MLX5_VPORT_UC_ADDR_CHANGE)
 122                 MLX5_SET(nic_vport_context, nic_vport_ctx,
 123                          event_on_uc_address_change, 1);
 124         if (events_mask & MLX5_VPORT_MC_ADDR_CHANGE)
 125                 MLX5_SET(nic_vport_context, nic_vport_ctx,
 126                          event_on_mc_address_change, 1);
 127         if (events_mask & MLX5_VPORT_PROMISC_CHANGE)
 128                 MLX5_SET(nic_vport_context, nic_vport_ctx,
 129                          event_on_promisc_change, 1);
 130
 131         return mlx5_cmd_exec_in(dev, modify_nic_vport_context, in);
 132 }
 133
 134 /* E-Switch vport context HW commands */
 135 int mlx5_eswitch_modify_esw_vport_context(struct mlx5_core_dev *dev, u16 vport,
 136                                           bool other_vport, void *in)
 137 {
 138         MLX5_SET(modify_esw_vport_context_in, in, opcode,
 139                  MLX5_CMD_OP_MODIFY_ESW_VPORT_CONTEXT);
 140         MLX5_SET(modify_esw_vport_context_in, in, vport_number, vport);
 141         MLX5_SET(modify_esw_vport_context_in, in, other_vport, other_vport);
 142         return mlx5_cmd_exec_in(dev, modify_esw_vport_context, in);
 143 }
 144
 145 static int modify_esw_vport_cvlan(struct mlx5_core_dev *dev, u16 vport,
 146                                   u16 vlan, u8 qos, u8 set_flags)
 147 {
 148         u32 in[MLX5_ST_SZ_DW(modify_esw_vport_context_in)] = {};
 149
 150         if (!MLX5_CAP_ESW(dev, vport_cvlan_strip) ||
 151             !MLX5_CAP_ESW(dev, vport_cvlan_insert_if_not_exist))
 152                 return -EOPNOTSUPP;
 153
 154         esw_debug(dev, "Set Vport[%d] VLAN %d qos %d set=%x\n",
 155                   vport, vlan, qos, set_flags);
 156
 157         if (set_flags & SET_VLAN_STRIP)
 158                 MLX5_SET(modify_esw_vport_context_in, in,
 159                          esw_vport_context.vport_cvlan_strip, 1);
 160
 161         if (set_flags & SET_VLAN_INSERT) {
 162                 /* insert only if no vlan in packet */
 163                 MLX5_SET(modify_esw_vport_context_in, in,
 164                          esw_vport_context.vport_cvlan_insert, 1);
 165
 166                 MLX5_SET(modify_esw_vport_context_in, in,
 167                          esw_vport_context.cvlan_pcp, qos);
 168                 MLX5_SET(modify_esw_vport_context_in, in,
 169                          esw_vport_context.cvlan_id, vlan);
 170         }
 171
 172         MLX5_SET(modify_esw_vport_context_in, in,
 173                  field_select.vport_cvlan_strip, 1);
 174         MLX5_SET(modify_esw_vport_context_in, in,
 175                  field_select.vport_cvlan_insert, 1);
 176
 177         return mlx5_eswitch_modify_esw_vport_context(dev, vport, true, in);
 178 }
 179
 180 /* E-Switch FDB */
 181 static struct mlx5_flow_handle *
 182 __esw_fdb_set_vport_rule(struct mlx5_eswitch *esw, u16 vport, bool rx_rule,
 183                          u8 mac_c[ETH_ALEN], u8 mac_v[ETH_ALEN])
 184 {
 185         int match_header = (is_zero_ether_addr(mac_c) ? 0 :
 186                             MLX5_MATCH_OUTER_HEADERS);
 187         struct mlx5_flow_handle *flow_rule = NULL;
 188         struct mlx5_flow_act flow_act = {0};
 189         struct mlx5_flow_destination dest = {};
 190         struct mlx5_flow_spec *spec;
 191         void *mv_misc = NULL;
 192         void *mc_misc = NULL;
 193         u8 *dmac_v = NULL;
 194         u8 *dmac_c = NULL;
 195
 196         if (rx_rule)
 197                 match_header |= MLX5_MATCH_MISC_PARAMETERS;
 198
 199         spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
 200         if (!spec)
 201                 return NULL;
 202
 203         dmac_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
 204                               outer_headers.dmac_47_16);
 205         dmac_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
 206                               outer_headers.dmac_47_16);
 207
 208         if (match_header & MLX5_MATCH_OUTER_HEADERS) {
 209                 ether_addr_copy(dmac_v, mac_v);
 210                 ether_addr_copy(dmac_c, mac_c);
 211         }
 212
 213         if (match_header & MLX5_MATCH_MISC_PARAMETERS) {
 214                 mv_misc  = MLX5_ADDR_OF(fte_match_param, spec->match_value,
 215                                         misc_parameters);
 216                 mc_misc  = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
 217                                         misc_parameters);
 218                 MLX5_SET(fte_match_set_misc, mv_misc, source_port, MLX5_VPORT_UPLINK);
 219                 MLX5_SET_TO_ONES(fte_match_set_misc, mc_misc, source_port);
 220         }
 221
 222         dest.type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
 223         dest.vport.num = vport;
 224
 225         esw_debug(esw->dev,
 226                   "\tFDB add rule dmac_v(%pM) dmac_c(%pM) -> vport(%d)\n",
 227                   dmac_v, dmac_c, vport);
 228         spec->match_criteria_enable = match_header;
 229         flow_act.action =  MLX5_FLOW_CONTEXT_ACTION_FWD_DEST;
 230         flow_rule =
 231                 mlx5_add_flow_rules(esw->fdb_table.legacy.fdb, spec,
 232                                     &flow_act, &dest, 1);
 233         if (IS_ERR(flow_rule)) {
 234                 esw_warn(esw->dev,
 235                          "FDB: Failed to add flow rule: dmac_v(%pM) dmac_c(%pM) -> vport(%d), err(%ld)\n",
 236                          dmac_v, dmac_c, vport, PTR_ERR(flow_rule));
 237                 flow_rule = NULL;
 238         }
 239
 240         kvfree(spec);
 241         return flow_rule;
 242 }
 243
 244 static struct mlx5_flow_handle *
 245 esw_fdb_set_vport_rule(struct mlx5_eswitch *esw, u8 mac[ETH_ALEN], u16 vport)
 246 {
 247         u8 mac_c[ETH_ALEN];
 248
 249         eth_broadcast_addr(mac_c);
 250         return __esw_fdb_set_vport_rule(esw, vport, false, mac_c, mac);
 251 }
 252
 253 static struct mlx5_flow_handle *
 254 esw_fdb_set_vport_allmulti_rule(struct mlx5_eswitch *esw, u16 vport)
 255 {
 256         u8 mac_c[ETH_ALEN];
 257         u8 mac_v[ETH_ALEN];
 258
 259         eth_zero_addr(mac_c);
 260         eth_zero_addr(mac_v);
 261         mac_c[0] = 0x01;
 262         mac_v[0] = 0x01;
 263         return __esw_fdb_set_vport_rule(esw, vport, false, mac_c, mac_v);
 264 }
 265
 266 static struct mlx5_flow_handle *
 267 esw_fdb_set_vport_promisc_rule(struct mlx5_eswitch *esw, u16 vport)
 268 {
 269         u8 mac_c[ETH_ALEN];
 270         u8 mac_v[ETH_ALEN];
 271
 272         eth_zero_addr(mac_c);
 273         eth_zero_addr(mac_v);
 274         return __esw_fdb_set_vport_rule(esw, vport, true, mac_c, mac_v);
 275 }
 276
 277 /* E-Switch vport UC/MC lists management */
 278 typedef int (*vport_addr_action)(struct mlx5_eswitch *esw,
 279                                  struct vport_addr *vaddr);
 280
 281 static int esw_add_uc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 282 {
 283         u8 *mac = vaddr->node.addr;
 284         u16 vport = vaddr->vport;
 285         int err;
 286
 287         /* Skip mlx5_mpfs_add_mac for eswitch_managers,
 288          * it is already done by its netdev in mlx5e_execute_l2_action
 289          */
 290         if (mlx5_esw_is_manager_vport(esw, vport))
 291                 goto fdb_add;
 292
 293         err = mlx5_mpfs_add_mac(esw->dev, mac);
 294         if (err) {
 295                 esw_warn(esw->dev,
 296                          "Failed to add L2 table mac(%pM) for vport(0x%x), err(%d)\n",
 297                          mac, vport, err);
 298                 return err;
 299         }
 300         vaddr->mpfs = true;
 301
 302 fdb_add:
 303         /* SRIOV is enabled: Forward UC MAC to vport */
 304         if (esw->fdb_table.legacy.fdb && esw->mode == MLX5_ESWITCH_LEGACY)
 305                 vaddr->flow_rule = esw_fdb_set_vport_rule(esw, mac, vport);
 306
 307         esw_debug(esw->dev, "\tADDED UC MAC: vport[%d] %pM fr(%p)\n",
 308                   vport, mac, vaddr->flow_rule);
 309
 310         return 0;
 311 }
 312
 313 static int esw_del_uc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 314 {
 315         u8 *mac = vaddr->node.addr;
 316         u16 vport = vaddr->vport;
 317         int err = 0;
 318
 319         /* Skip mlx5_mpfs_del_mac for eswitch managers,
 320          * it is already done by its netdev in mlx5e_execute_l2_action
 321          */
 322         if (!vaddr->mpfs || mlx5_esw_is_manager_vport(esw, vport))
 323                 goto fdb_del;
 324
 325         err = mlx5_mpfs_del_mac(esw->dev, mac);
 326         if (err)
 327                 esw_warn(esw->dev,
 328                          "Failed to del L2 table mac(%pM) for vport(%d), err(%d)\n",
 329                          mac, vport, err);
 330         vaddr->mpfs = false;
 331
 332 fdb_del:
 333         if (vaddr->flow_rule)
 334                 mlx5_del_flow_rules(vaddr->flow_rule);
 335         vaddr->flow_rule = NULL;
 336
 337         return 0;
 338 }
 339
 340 static void update_allmulti_vports(struct mlx5_eswitch *esw,
 341                                    struct vport_addr *vaddr,
 342                                    struct esw_mc_addr *esw_mc)
 343 {
 344         u8 *mac = vaddr->node.addr;
 345         struct mlx5_vport *vport;
 346         unsigned long i;
 347         u16 vport_num;
 348
 349         mlx5_esw_for_each_vport(esw, i, vport) {
 350                 struct hlist_head *vport_hash = vport->mc_list;
 351                 struct vport_addr *iter_vaddr =
 352                                         l2addr_hash_find(vport_hash,
 353                                                          mac,
 354                                                          struct vport_addr);
 355                 vport_num = vport->vport;
 356                 if (IS_ERR_OR_NULL(vport->allmulti_rule) ||
 357                     vaddr->vport == vport_num)
 358                         continue;
 359                 switch (vaddr->action) {
 360                 case MLX5_ACTION_ADD:
 361                         if (iter_vaddr)
 362                                 continue;
 363                         iter_vaddr = l2addr_hash_add(vport_hash, mac,
 364                                                      struct vport_addr,
 365                                                      GFP_KERNEL);
 366                         if (!iter_vaddr) {
 367                                 esw_warn(esw->dev,
 368                                          "ALL-MULTI: Failed to add MAC(%pM) to vport[%d] DB\n",
 369                                          mac, vport_num);
 370                                 continue;
 371                         }
 372                         iter_vaddr->vport = vport_num;
 373                         iter_vaddr->flow_rule =
 374                                         esw_fdb_set_vport_rule(esw,
 375                                                                mac,
 376                                                                vport_num);
 377                         iter_vaddr->mc_promisc = true;
 378                         break;
 379                 case MLX5_ACTION_DEL:
 380                         if (!iter_vaddr)
 381                                 continue;
 382                         mlx5_del_flow_rules(iter_vaddr->flow_rule);
 383                         l2addr_hash_del(iter_vaddr);
 384                         break;
 385                 }
 386         }
 387 }
 388
 389 static int esw_add_mc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 390 {
 391         struct hlist_head *hash = esw->mc_table;
 392         struct esw_mc_addr *esw_mc;
 393         u8 *mac = vaddr->node.addr;
 394         u16 vport = vaddr->vport;
 395
 396         if (!esw->fdb_table.legacy.fdb)
 397                 return 0;
 398
 399         esw_mc = l2addr_hash_find(hash, mac, struct esw_mc_addr);
 400         if (esw_mc)
 401                 goto add;
 402
 403         esw_mc = l2addr_hash_add(hash, mac, struct esw_mc_addr, GFP_KERNEL);
 404         if (!esw_mc)
 405                 return -ENOMEM;
 406
 407         esw_mc->uplink_rule = /* Forward MC MAC to Uplink */
 408                 esw_fdb_set_vport_rule(esw, mac, MLX5_VPORT_UPLINK);
 409
 410         /* Add this multicast mac to all the mc promiscuous vports */
 411         update_allmulti_vports(esw, vaddr, esw_mc);
 412
 413 add:
 414         /* If the multicast mac is added as a result of mc promiscuous vport,
 415          * don't increment the multicast ref count
 416          */
 417         if (!vaddr->mc_promisc)
 418                 esw_mc->refcnt++;
 419
 420         /* Forward MC MAC to vport */
 421         vaddr->flow_rule = esw_fdb_set_vport_rule(esw, mac, vport);
 422         esw_debug(esw->dev,
 423                   "\tADDED MC MAC: vport[%d] %pM fr(%p) refcnt(%d) uplinkfr(%p)\n",
 424                   vport, mac, vaddr->flow_rule,
 425                   esw_mc->refcnt, esw_mc->uplink_rule);
 426         return 0;
 427 }
 428
 429 static int esw_del_mc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 430 {
 431         struct hlist_head *hash = esw->mc_table;
 432         struct esw_mc_addr *esw_mc;
 433         u8 *mac = vaddr->node.addr;
 434         u16 vport = vaddr->vport;
 435
 436         if (!esw->fdb_table.legacy.fdb)
 437                 return 0;
 438
 439         esw_mc = l2addr_hash_find(hash, mac, struct esw_mc_addr);
 440         if (!esw_mc) {
 441                 esw_warn(esw->dev,
 442                          "Failed to find eswitch MC addr for MAC(%pM) vport(%d)",
 443                          mac, vport);
 444                 return -EINVAL;
 445         }
 446         esw_debug(esw->dev,
 447                   "\tDELETE MC MAC: vport[%d] %pM fr(%p) refcnt(%d) uplinkfr(%p)\n",
 448                   vport, mac, vaddr->flow_rule, esw_mc->refcnt,
 449                   esw_mc->uplink_rule);
 450
 451         if (vaddr->flow_rule)
 452                 mlx5_del_flow_rules(vaddr->flow_rule);
 453         vaddr->flow_rule = NULL;
 454
 455         /* If the multicast mac is added as a result of mc promiscuous vport,
 456          * don't decrement the multicast ref count.
 457          */
 458         if (vaddr->mc_promisc || (--esw_mc->refcnt > 0))
 459                 return 0;
 460
 461         /* Remove this multicast mac from all the mc promiscuous vports */
 462         update_allmulti_vports(esw, vaddr, esw_mc);
 463
 464         if (esw_mc->uplink_rule)
 465                 mlx5_del_flow_rules(esw_mc->uplink_rule);
 466
 467         l2addr_hash_del(esw_mc);
 468         return 0;
 469 }
 470
 471 /* Apply vport UC/MC list to HW l2 table and FDB table */
 472 static void esw_apply_vport_addr_list(struct mlx5_eswitch *esw,
 473                                       struct mlx5_vport *vport, int list_type)
 474 {
 475         bool is_uc = list_type == MLX5_NVPRT_LIST_TYPE_UC;
 476         vport_addr_action vport_addr_add;
 477         vport_addr_action vport_addr_del;
 478         struct vport_addr *addr;
 479         struct l2addr_node *node;
 480         struct hlist_head *hash;
 481         struct hlist_node *tmp;
 482         int hi;
 483
 484         vport_addr_add = is_uc ? esw_add_uc_addr :
 485                                  esw_add_mc_addr;
 486         vport_addr_del = is_uc ? esw_del_uc_addr :
 487                                  esw_del_mc_addr;
 488
 489         hash = is_uc ? vport->uc_list : vport->mc_list;
 490         for_each_l2hash_node(node, tmp, hash, hi) {
 491                 addr = container_of(node, struct vport_addr, node);
 492                 switch (addr->action) {
 493                 case MLX5_ACTION_ADD:
 494                         vport_addr_add(esw, addr);
 495                         addr->action = MLX5_ACTION_NONE;
 496                         break;
 497                 case MLX5_ACTION_DEL:
 498                         vport_addr_del(esw, addr);
 499                         l2addr_hash_del(addr);
 500                         break;
 501                 }
 502         }
 503 }
 504
 505 /* Sync vport UC/MC list from vport context */
 506 static void esw_update_vport_addr_list(struct mlx5_eswitch *esw,
 507                                        struct mlx5_vport *vport, int list_type)
 508 {
 509         bool is_uc = list_type == MLX5_NVPRT_LIST_TYPE_UC;
 510         u8 (*mac_list)[ETH_ALEN];
 511         struct l2addr_node *node;
 512         struct vport_addr *addr;
 513         struct hlist_head *hash;
 514         struct hlist_node *tmp;
 515         int size;
 516         int err;
 517         int hi;
 518         int i;
 519
 520         size = is_uc ? MLX5_MAX_UC_PER_VPORT(esw->dev) :
 521                        MLX5_MAX_MC_PER_VPORT(esw->dev);
 522
 523         mac_list = kcalloc(size, ETH_ALEN, GFP_KERNEL);
 524         if (!mac_list)
 525                 return;
 526
 527         hash = is_uc ? vport->uc_list : vport->mc_list;
 528
 529         for_each_l2hash_node(node, tmp, hash, hi) {
 530                 addr = container_of(node, struct vport_addr, node);
 531                 addr->action = MLX5_ACTION_DEL;
 532         }
 533
 534         if (!vport->enabled)
 535                 goto out;
 536
 537         err = mlx5_query_nic_vport_mac_list(esw->dev, vport->vport, list_type,
 538                                             mac_list, &size);
 539         if (err)
 540                 goto out;
 541         esw_debug(esw->dev, "vport[%d] context update %s list size (%d)\n",
 542                   vport->vport, is_uc ? "UC" : "MC", size);
 543
 544         for (i = 0; i < size; i++) {
 545                 if (is_uc && !is_valid_ether_addr(mac_list[i]))
 546                         continue;
 547
 548                 if (!is_uc && !is_multicast_ether_addr(mac_list[i]))
 549                         continue;
 550
 551                 addr = l2addr_hash_find(hash, mac_list[i], struct vport_addr);
 552                 if (addr) {
 553                         addr->action = MLX5_ACTION_NONE;
 554                         /* If this mac was previously added because of allmulti
 555                          * promiscuous rx mode, its now converted to be original
 556                          * vport mac.
 557                          */
 558                         if (addr->mc_promisc) {
 559                                 struct esw_mc_addr *esw_mc =
 560                                         l2addr_hash_find(esw->mc_table,
 561                                                          mac_list[i],
 562                                                          struct esw_mc_addr);
 563                                 if (!esw_mc) {
 564                                         esw_warn(esw->dev,
 565                                                  "Failed to MAC(%pM) in mcast DB\n",
 566                                                  mac_list[i]);
 567                                         continue;
 568                                 }
 569                                 esw_mc->refcnt++;
 570                                 addr->mc_promisc = false;
 571                         }
 572                         continue;
 573                 }
 574
 575                 addr = l2addr_hash_add(hash, mac_list[i], struct vport_addr,
 576                                        GFP_KERNEL);
 577                 if (!addr) {
 578                         esw_warn(esw->dev,
 579                                  "Failed to add MAC(%pM) to vport[%d] DB\n",
 580                                  mac_list[i], vport->vport);
 581                         continue;
 582                 }
 583                 addr->vport = vport->vport;
 584                 addr->action = MLX5_ACTION_ADD;
 585         }
 586 out:
 587         kfree(mac_list);
 588 }
 589
 590 /* Sync vport UC/MC list from vport context
 591  * Must be called after esw_update_vport_addr_list
 592  */
 593 static void esw_update_vport_mc_promisc(struct mlx5_eswitch *esw,
 594                                         struct mlx5_vport *vport)
 595 {
 596         struct l2addr_node *node;
 597         struct vport_addr *addr;
 598         struct hlist_head *hash;
 599         struct hlist_node *tmp;
 600         int hi;
 601
 602         hash = vport->mc_list;
 603
 604         for_each_l2hash_node(node, tmp, esw->mc_table, hi) {
 605                 u8 *mac = node->addr;
 606
 607                 addr = l2addr_hash_find(hash, mac, struct vport_addr);
 608                 if (addr) {
 609                         if (addr->action == MLX5_ACTION_DEL)
 610                                 addr->action = MLX5_ACTION_NONE;
 611                         continue;
 612                 }
 613                 addr = l2addr_hash_add(hash, mac, struct vport_addr,
 614                                        GFP_KERNEL);
 615                 if (!addr) {
 616                         esw_warn(esw->dev,
 617                                  "Failed to add allmulti MAC(%pM) to vport[%d] DB\n",
 618                                  mac, vport->vport);
 619                         continue;
 620                 }
 621                 addr->vport = vport->vport;
 622                 addr->action = MLX5_ACTION_ADD;
 623                 addr->mc_promisc = true;
 624         }
 625 }
 626
 627 /* Apply vport rx mode to HW FDB table */
 628 static void esw_apply_vport_rx_mode(struct mlx5_eswitch *esw,
 629                                     struct mlx5_vport *vport,
 630                                     bool promisc, bool mc_promisc)
 631 {
 632         struct esw_mc_addr *allmulti_addr = &esw->mc_promisc;
 633
 634         if (IS_ERR_OR_NULL(vport->allmulti_rule) != mc_promisc)
 635                 goto promisc;
 636
 637         if (mc_promisc) {
 638                 vport->allmulti_rule =
 639                         esw_fdb_set_vport_allmulti_rule(esw, vport->vport);
 640                 if (!allmulti_addr->uplink_rule)
 641                         allmulti_addr->uplink_rule =
 642                                 esw_fdb_set_vport_allmulti_rule(esw,
 643                                                                 MLX5_VPORT_UPLINK);
 644                 allmulti_addr->refcnt++;
 645         } else if (vport->allmulti_rule) {
 646                 mlx5_del_flow_rules(vport->allmulti_rule);
 647                 vport->allmulti_rule = NULL;
 648
 649                 if (--allmulti_addr->refcnt > 0)
 650                         goto promisc;
 651
 652                 if (allmulti_addr->uplink_rule)
 653                         mlx5_del_flow_rules(allmulti_addr->uplink_rule);
 654                 allmulti_addr->uplink_rule = NULL;
 655         }
 656
 657 promisc:
 658         if (IS_ERR_OR_NULL(vport->promisc_rule) != promisc)
 659                 return;
 660
 661         if (promisc) {
 662                 vport->promisc_rule =
 663                         esw_fdb_set_vport_promisc_rule(esw, vport->vport);
 664         } else if (vport->promisc_rule) {
 665                 mlx5_del_flow_rules(vport->promisc_rule);
 666                 vport->promisc_rule = NULL;
 667         }
 668 }
 669
 670 /* Sync vport rx mode from vport context */
 671 static void esw_update_vport_rx_mode(struct mlx5_eswitch *esw,
 672                                      struct mlx5_vport *vport)
 673 {
 674         int promisc_all = 0;
 675         int promisc_uc = 0;
 676         int promisc_mc = 0;
 677         int err;
 678
 679         err = mlx5_query_nic_vport_promisc(esw->dev,
 680                                            vport->vport,
 681                                            &promisc_uc,
 682                                            &promisc_mc,
 683                                            &promisc_all);
 684         if (err)
 685                 return;
 686         esw_debug(esw->dev, "vport[%d] context update rx mode promisc_all=%d, all_multi=%d\n",
 687                   vport->vport, promisc_all, promisc_mc);
 688
 689         if (!vport->info.trusted || !vport->enabled) {
 690                 promisc_uc = 0;
 691                 promisc_mc = 0;
 692                 promisc_all = 0;
 693         }
 694
 695         esw_apply_vport_rx_mode(esw, vport, promisc_all,
 696                                 (promisc_all || promisc_mc));
 697 }
 698
 699 void esw_vport_change_handle_locked(struct mlx5_vport *vport)
 700 {
 701         struct mlx5_core_dev *dev = vport->dev;
 702         struct mlx5_eswitch *esw = dev->priv.eswitch;
 703         u8 mac[ETH_ALEN];
 704
 705         mlx5_query_nic_vport_mac_address(dev, vport->vport, true, mac);
 706         esw_debug(dev, "vport[%d] Context Changed: perm mac: %pM\n",
 707                   vport->vport, mac);
 708
 709         if (vport->enabled_events & MLX5_VPORT_UC_ADDR_CHANGE) {
 710                 esw_update_vport_addr_list(esw, vport, MLX5_NVPRT_LIST_TYPE_UC);
 711                 esw_apply_vport_addr_list(esw, vport, MLX5_NVPRT_LIST_TYPE_UC);
 712         }
 713
 714         if (vport->enabled_events & MLX5_VPORT_MC_ADDR_CHANGE)
 715                 esw_update_vport_addr_list(esw, vport, MLX5_NVPRT_LIST_TYPE_MC);
 716
 717         if (vport->enabled_events & MLX5_VPORT_PROMISC_CHANGE) {
 718                 esw_update_vport_rx_mode(esw, vport);
 719                 if (!IS_ERR_OR_NULL(vport->allmulti_rule))
 720                         esw_update_vport_mc_promisc(esw, vport);
 721         }
 722
 723         if (vport->enabled_events & (MLX5_VPORT_PROMISC_CHANGE | MLX5_VPORT_MC_ADDR_CHANGE))
 724                 esw_apply_vport_addr_list(esw, vport, MLX5_NVPRT_LIST_TYPE_MC);
 725
 726         esw_debug(esw->dev, "vport[%d] Context Changed: Done\n", vport->vport);
 727         if (vport->enabled)
 728                 arm_vport_context_events_cmd(dev, vport->vport,
 729                                              vport->enabled_events);
 730 }
 731
 732 static void esw_vport_change_handler(struct work_struct *work)
 733 {
 734         struct mlx5_vport *vport =
 735                 container_of(work, struct mlx5_vport, vport_change_handler);
 736         struct mlx5_eswitch *esw = vport->dev->priv.eswitch;
 737
 738         mutex_lock(&esw->state_lock);
 739         esw_vport_change_handle_locked(vport);
 740         mutex_unlock(&esw->state_lock);
 741 }
 742
 743 static bool element_type_supported(struct mlx5_eswitch *esw, int type)
 744 {
 745         const struct mlx5_core_dev *dev = esw->dev;
 746
 747         switch (type) {
 748         case SCHEDULING_CONTEXT_ELEMENT_TYPE_TSAR:
 749                 return MLX5_CAP_QOS(dev, esw_element_type) &
 750                        ELEMENT_TYPE_CAP_MASK_TASR;
 751         case SCHEDULING_CONTEXT_ELEMENT_TYPE_VPORT:
 752                 return MLX5_CAP_QOS(dev, esw_element_type) &
 753                        ELEMENT_TYPE_CAP_MASK_VPORT;
 754         case SCHEDULING_CONTEXT_ELEMENT_TYPE_VPORT_TC:
 755                 return MLX5_CAP_QOS(dev, esw_element_type) &
 756                        ELEMENT_TYPE_CAP_MASK_VPORT_TC;
 757         case SCHEDULING_CONTEXT_ELEMENT_TYPE_PARA_VPORT_TC:
 758                 return MLX5_CAP_QOS(dev, esw_element_type) &
 759                        ELEMENT_TYPE_CAP_MASK_PARA_VPORT_TC;
 760         }
 761         return false;
 762 }
 763
 764 /* Vport QoS management */
 765 static void esw_create_tsar(struct mlx5_eswitch *esw)
 766 {
 767         u32 tsar_ctx[MLX5_ST_SZ_DW(scheduling_context)] = {0};
 768         struct mlx5_core_dev *dev = esw->dev;
 769         __be32 *attr;
 770         int err;
 771
 772         if (!MLX5_CAP_GEN(dev, qos) || !MLX5_CAP_QOS(dev, esw_scheduling))
 773                 return;
 774
 775         if (!element_type_supported(esw, SCHEDULING_CONTEXT_ELEMENT_TYPE_TSAR))
 776                 return;
 777
 778         if (esw->qos.enabled)
 779                 return;
 780
 781         MLX5_SET(scheduling_context, tsar_ctx, element_type,
 782                  SCHEDULING_CONTEXT_ELEMENT_TYPE_TSAR);
 783
 784         attr = MLX5_ADDR_OF(scheduling_context, tsar_ctx, element_attributes);
 785         *attr = cpu_to_be32(TSAR_ELEMENT_TSAR_TYPE_DWRR << 16);
 786
 787         err = mlx5_create_scheduling_element_cmd(dev,
 788                                                  SCHEDULING_HIERARCHY_E_SWITCH,
 789                                                  tsar_ctx,
 790                                                  &esw->qos.root_tsar_id);
 791         if (err) {
 792                 esw_warn(esw->dev, "E-Switch create TSAR failed (%d)\n", err);
 793                 return;
 794         }
 795
 796         esw->qos.enabled = true;
 797 }
 798
 799 static void esw_destroy_tsar(struct mlx5_eswitch *esw)
 800 {
 801         int err;
 802
 803         if (!esw->qos.enabled)
 804                 return;
 805
 806         err = mlx5_destroy_scheduling_element_cmd(esw->dev,
 807                                                   SCHEDULING_HIERARCHY_E_SWITCH,
 808                                                   esw->qos.root_tsar_id);
 809         if (err)
 810                 esw_warn(esw->dev, "E-Switch destroy TSAR failed (%d)\n", err);
 811
 812         esw->qos.enabled = false;
 813 }
 814
 815 static int esw_vport_enable_qos(struct mlx5_eswitch *esw,
 816                                 struct mlx5_vport *vport,
 817                                 u32 initial_max_rate, u32 initial_bw_share)
 818 {
 819         u32 sched_ctx[MLX5_ST_SZ_DW(scheduling_context)] = {0};
 820         struct mlx5_core_dev *dev = esw->dev;
 821         void *vport_elem;
 822         int err = 0;
 823
 824         if (!esw->qos.enabled)
 825                 return 0;
 826
 827         if (vport->qos.enabled)
 828                 return -EEXIST;
 829
 830         MLX5_SET(scheduling_context, sched_ctx, element_type,
 831                  SCHEDULING_CONTEXT_ELEMENT_TYPE_VPORT);
 832         vport_elem = MLX5_ADDR_OF(scheduling_context, sched_ctx,
 833                                   element_attributes);
 834         MLX5_SET(vport_element, vport_elem, vport_number, vport->vport);
 835         MLX5_SET(scheduling_context, sched_ctx, parent_element_id,
 836                  esw->qos.root_tsar_id);
 837         MLX5_SET(scheduling_context, sched_ctx, max_average_bw,
 838                  initial_max_rate);
 839         MLX5_SET(scheduling_context, sched_ctx, bw_share, initial_bw_share);
 840
 841         err = mlx5_create_scheduling_element_cmd(dev,
 842                                                  SCHEDULING_HIERARCHY_E_SWITCH,
 843                                                  sched_ctx,
 844                                                  &vport->qos.esw_tsar_ix);
 845         if (err) {
 846                 esw_warn(esw->dev, "E-Switch create TSAR vport element failed (vport=%d,err=%d)\n",
 847                          vport->vport, err);
 848                 return err;
 849         }
 850
 851         vport->qos.enabled = true;
 852         return 0;
 853 }
 854
 855 static void esw_vport_disable_qos(struct mlx5_eswitch *esw,
 856                                   struct mlx5_vport *vport)
 857 {
 858         int err;
 859
 860         if (!vport->qos.enabled)
 861                 return;
 862
 863         err = mlx5_destroy_scheduling_element_cmd(esw->dev,
 864                                                   SCHEDULING_HIERARCHY_E_SWITCH,
 865                                                   vport->qos.esw_tsar_ix);
 866         if (err)
 867                 esw_warn(esw->dev, "E-Switch destroy TSAR vport element failed (vport=%d,err=%d)\n",
 868                          vport->vport, err);
 869
 870         vport->qos.enabled = false;
 871 }
 872
 873 static int esw_vport_qos_config(struct mlx5_eswitch *esw,
 874                                 struct mlx5_vport *vport,
 875                                 u32 max_rate, u32 bw_share)
 876 {
 877         u32 sched_ctx[MLX5_ST_SZ_DW(scheduling_context)] = {0};
 878         struct mlx5_core_dev *dev = esw->dev;
 879         void *vport_elem;
 880         u32 bitmask = 0;
 881         int err = 0;
 882
 883         if (!MLX5_CAP_GEN(dev, qos) || !MLX5_CAP_QOS(dev, esw_scheduling))
 884                 return -EOPNOTSUPP;
 885
 886         if (!vport->qos.enabled)
 887                 return -EIO;
 888
 889         MLX5_SET(scheduling_context, sched_ctx, element_type,
 890                  SCHEDULING_CONTEXT_ELEMENT_TYPE_VPORT);
 891         vport_elem = MLX5_ADDR_OF(scheduling_context, sched_ctx,
 892                                   element_attributes);
 893         MLX5_SET(vport_element, vport_elem, vport_number, vport->vport);
 894         MLX5_SET(scheduling_context, sched_ctx, parent_element_id,
 895                  esw->qos.root_tsar_id);
 896         MLX5_SET(scheduling_context, sched_ctx, max_average_bw,
 897                  max_rate);
 898         MLX5_SET(scheduling_context, sched_ctx, bw_share, bw_share);
 899         bitmask |= MODIFY_SCHEDULING_ELEMENT_IN_MODIFY_BITMASK_MAX_AVERAGE_BW;
 900         bitmask |= MODIFY_SCHEDULING_ELEMENT_IN_MODIFY_BITMASK_BW_SHARE;
 901
 902         err = mlx5_modify_scheduling_element_cmd(dev,
 903                                                  SCHEDULING_HIERARCHY_E_SWITCH,
 904                                                  sched_ctx,
 905                                                  vport->qos.esw_tsar_ix,
 906                                                  bitmask);
 907         if (err) {
 908                 esw_warn(esw->dev, "E-Switch modify TSAR vport element failed (vport=%d,err=%d)\n",
 909                          vport->vport, err);
 910                 return err;
 911         }
 912
 913         return 0;
 914 }
 915
 916 int mlx5_esw_modify_vport_rate(struct mlx5_eswitch *esw, u16 vport_num,
 917                                u32 rate_mbps)
 918 {
 919         u32 ctx[MLX5_ST_SZ_DW(scheduling_context)] = {};
 920         struct mlx5_vport *vport;
 921
 922         vport = mlx5_eswitch_get_vport(esw, vport_num);
 923         if (IS_ERR(vport))
 924                 return PTR_ERR(vport);
 925
 926         if (!vport->qos.enabled)
 927                 return -EOPNOTSUPP;
 928
 929         MLX5_SET(scheduling_context, ctx, max_average_bw, rate_mbps);
 930
 931         return mlx5_modify_scheduling_element_cmd(esw->dev,
 932                                                   SCHEDULING_HIERARCHY_E_SWITCH,
 933                                                   ctx,
 934                                                   vport->qos.esw_tsar_ix,
 935                                                   MODIFY_SCHEDULING_ELEMENT_IN_MODIFY_BITMASK_MAX_AVERAGE_BW);
 936 }
 937
 938 static void node_guid_gen_from_mac(u64 *node_guid, const u8 *mac)
 939 {
 940         ((u8 *)node_guid)[7] = mac[0];
 941         ((u8 *)node_guid)[6] = mac[1];
 942         ((u8 *)node_guid)[5] = mac[2];
 943         ((u8 *)node_guid)[4] = 0xff;
 944         ((u8 *)node_guid)[3] = 0xfe;
 945         ((u8 *)node_guid)[2] = mac[3];
 946         ((u8 *)node_guid)[1] = mac[4];
 947         ((u8 *)node_guid)[0] = mac[5];
 948 }
 949
 950 static int esw_vport_setup_acl(struct mlx5_eswitch *esw,
 951                                struct mlx5_vport *vport)
 952 {
 953         if (esw->mode == MLX5_ESWITCH_LEGACY)
 954                 return esw_legacy_vport_acl_setup(esw, vport);
 955         else
 956                 return esw_vport_create_offloads_acl_tables(esw, vport);
 957 }
 958
 959 static void esw_vport_cleanup_acl(struct mlx5_eswitch *esw,
 960                                   struct mlx5_vport *vport)
 961 {
 962         if (esw->mode == MLX5_ESWITCH_LEGACY)
 963                 esw_legacy_vport_acl_cleanup(esw, vport);
 964         else
 965                 esw_vport_destroy_offloads_acl_tables(esw, vport);
 966 }
 967
 968 static int esw_vport_setup(struct mlx5_eswitch *esw, struct mlx5_vport *vport)
 969 {
 970         u16 vport_num = vport->vport;
 971         int flags;
 972         int err;
 973
 974         err = esw_vport_setup_acl(esw, vport);
 975         if (err)
 976                 return err;
 977
 978         /* Attach vport to the eswitch rate limiter */
 979         esw_vport_enable_qos(esw, vport, vport->qos.max_rate, vport->qos.bw_share);
 980
 981         if (mlx5_esw_is_manager_vport(esw, vport_num))
 982                 return 0;
 983
 984         mlx5_modify_vport_admin_state(esw->dev,
 985                                       MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
 986                                       vport_num, 1,
 987                                       vport->info.link_state);
 988
 989         /* Host PF has its own mac/guid. */
 990         if (vport_num) {
 991                 mlx5_modify_nic_vport_mac_address(esw->dev, vport_num,
 992                                                   vport->info.mac);
 993                 mlx5_modify_nic_vport_node_guid(esw->dev, vport_num,
 994                                                 vport->info.node_guid);
 995         }
 996
 997         flags = (vport->info.vlan || vport->info.qos) ?
 998                 SET_VLAN_STRIP | SET_VLAN_INSERT : 0;
 999         modify_esw_vport_cvlan(esw->dev, vport_num, vport->info.vlan,
1000                                vport->info.qos, flags);
1001
1002         return 0;
1003 }
1004
1005 /* Don't cleanup vport->info, it's needed to restore vport configuration */
1006 static void esw_vport_cleanup(struct mlx5_eswitch *esw, struct mlx5_vport *vport)
1007 {
1008         u16 vport_num = vport->vport;
1009
1010         if (!mlx5_esw_is_manager_vport(esw, vport_num))
1011                 mlx5_modify_vport_admin_state(esw->dev,
1012                                               MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
1013                                               vport_num, 1,
1014                                               MLX5_VPORT_ADMIN_STATE_DOWN);
1015
1016         esw_vport_disable_qos(esw, vport);
1017         esw_vport_cleanup_acl(esw, vport);
1018 }
1019
1020 int mlx5_esw_vport_enable(struct mlx5_eswitch *esw, u16 vport_num,
1021                           enum mlx5_eswitch_vport_event enabled_events)
1022 {
1023         struct mlx5_vport *vport;
1024         int ret;
1025
1026         vport = mlx5_eswitch_get_vport(esw, vport_num);
1027         if (IS_ERR(vport))
1028                 return PTR_ERR(vport);
1029
1030         mutex_lock(&esw->state_lock);
1031         WARN_ON(vport->enabled);
1032
1033         esw_debug(esw->dev, "Enabling VPORT(%d)\n", vport_num);
1034
1035         ret = esw_vport_setup(esw, vport);
1036         if (ret)
1037                 goto done;
1038
1039         /* Sync with current vport context */
1040         vport->enabled_events = enabled_events;
1041         vport->enabled = true;
1042
1043         /* Esw manager is trusted by default. Host PF (vport 0) is trusted as well
1044          * in smartNIC as it's a vport group manager.
1045          */
1046         if (mlx5_esw_is_manager_vport(esw, vport_num) ||
1047             (!vport_num && mlx5_core_is_ecpf(esw->dev)))
1048                 vport->info.trusted = true;
1049
1050         if (!mlx5_esw_is_manager_vport(esw, vport->vport) &&
1051             MLX5_CAP_GEN(esw->dev, vhca_resource_manager)) {
1052                 ret = mlx5_esw_vport_vhca_id_set(esw, vport_num);
1053                 if (ret)
1054                         goto err_vhca_mapping;
1055         }
1056
1057         /* External controller host PF has factory programmed MAC.
1058          * Read it from the device.
1059          */
1060         if (mlx5_core_is_ecpf(esw->dev) && vport_num == MLX5_VPORT_PF)
1061                 mlx5_query_nic_vport_mac_address(esw->dev, vport_num, true, vport->info.mac);
1062
1063         esw_vport_change_handle_locked(vport);
1064
1065         esw->enabled_vports++;
1066         esw_debug(esw->dev, "Enabled VPORT(%d)\n", vport_num);
1067 done:
1068         mutex_unlock(&esw->state_lock);
1069         return ret;
1070
1071 err_vhca_mapping:
1072         esw_vport_cleanup(esw, vport);
1073         mutex_unlock(&esw->state_lock);
1074         return ret;
1075 }
1076
1077 void mlx5_esw_vport_disable(struct mlx5_eswitch *esw, u16 vport_num)
1078 {
1079         struct mlx5_vport *vport;
1080
1081         vport = mlx5_eswitch_get_vport(esw, vport_num);
1082         if (IS_ERR(vport))
1083                 return;
1084
1085         mutex_lock(&esw->state_lock);
1086         if (!vport->enabled)
1087                 goto done;
1088
1089         esw_debug(esw->dev, "Disabling vport(%d)\n", vport_num);
1090         /* Mark this vport as disabled to discard new events */
1091         vport->enabled = false;
1092
1093         /* Disable events from this vport */
1094         arm_vport_context_events_cmd(esw->dev, vport->vport, 0);
1095
1096         if (!mlx5_esw_is_manager_vport(esw, vport->vport) &&
1097             MLX5_CAP_GEN(esw->dev, vhca_resource_manager))
1098                 mlx5_esw_vport_vhca_id_clear(esw, vport_num);
1099
1100         /* We don't assume VFs will cleanup after themselves.
1101          * Calling vport change handler while vport is disabled will cleanup
1102          * the vport resources.
1103          */
1104         esw_vport_change_handle_locked(vport);
1105         vport->enabled_events = 0;
1106         esw_vport_cleanup(esw, vport);
1107         esw->enabled_vports--;
1108
1109 done:
1110         mutex_unlock(&esw->state_lock);
1111 }
1112
1113 static int eswitch_vport_event(struct notifier_block *nb,
1114                                unsigned long type, void *data)
1115 {
1116         struct mlx5_eswitch *esw = mlx5_nb_cof(nb, struct mlx5_eswitch, nb);
1117         struct mlx5_eqe *eqe = data;
1118         struct mlx5_vport *vport;
1119         u16 vport_num;
1120
1121         vport_num = be16_to_cpu(eqe->data.vport_change.vport_num);
1122         vport = mlx5_eswitch_get_vport(esw, vport_num);
1123         if (!IS_ERR(vport))
1124                 queue_work(esw->work_queue, &vport->vport_change_handler);
1125         return NOTIFY_OK;
1126 }
1127
1128 /**
1129  * mlx5_esw_query_functions - Returns raw output about functions state
1130  * @dev:        Pointer to device to query
1131  *
1132  * mlx5_esw_query_functions() allocates and returns functions changed
1133  * raw output memory pointer from device on success. Otherwise returns ERR_PTR.
1134  * Caller must free the memory using kvfree() when valid pointer is returned.
1135  */
1136 const u32 *mlx5_esw_query_functions(struct mlx5_core_dev *dev)
1137 {
1138         int outlen = MLX5_ST_SZ_BYTES(query_esw_functions_out);
1139         u32 in[MLX5_ST_SZ_DW(query_esw_functions_in)] = {};
1140         u32 *out;
1141         int err;
1142
1143         out = kvzalloc(outlen, GFP_KERNEL);
1144         if (!out)
1145                 return ERR_PTR(-ENOMEM);
1146
1147         MLX5_SET(query_esw_functions_in, in, opcode,
1148                  MLX5_CMD_OP_QUERY_ESW_FUNCTIONS);
1149
1150         err = mlx5_cmd_exec(dev, in, sizeof(in), out, outlen);
1151         if (!err)
1152                 return out;
1153
1154         kvfree(out);
1155         return ERR_PTR(err);
1156 }
1157
1158 static void mlx5_eswitch_event_handlers_register(struct mlx5_eswitch *esw)
1159 {
1160         MLX5_NB_INIT(&esw->nb, eswitch_vport_event, NIC_VPORT_CHANGE);
1161         mlx5_eq_notifier_register(esw->dev, &esw->nb);
1162
1163         if (esw->mode == MLX5_ESWITCH_OFFLOADS && mlx5_eswitch_is_funcs_handler(esw->dev)) {
1164                 MLX5_NB_INIT(&esw->esw_funcs.nb, mlx5_esw_funcs_changed_handler,
1165                              ESW_FUNCTIONS_CHANGED);
1166                 mlx5_eq_notifier_register(esw->dev, &esw->esw_funcs.nb);
1167         }
1168 }
1169
1170 static void mlx5_eswitch_event_handlers_unregister(struct mlx5_eswitch *esw)
1171 {
1172         if (esw->mode == MLX5_ESWITCH_OFFLOADS && mlx5_eswitch_is_funcs_handler(esw->dev))
1173                 mlx5_eq_notifier_unregister(esw->dev, &esw->esw_funcs.nb);
1174
1175         mlx5_eq_notifier_unregister(esw->dev, &esw->nb);
1176
1177         flush_workqueue(esw->work_queue);
1178 }
1179
1180 static void mlx5_eswitch_clear_vf_vports_info(struct mlx5_eswitch *esw)
1181 {
1182         struct mlx5_vport *vport;
1183         unsigned long i;
1184
1185         mlx5_esw_for_each_vf_vport(esw, i, vport, esw->esw_funcs.num_vfs) {
1186                 memset(&vport->qos, 0, sizeof(vport->qos));
1187                 memset(&vport->info, 0, sizeof(vport->info));
1188                 vport->info.link_state = MLX5_VPORT_ADMIN_STATE_AUTO;
1189         }
1190 }
1191
1192 /* Public E-Switch API */
1193 int mlx5_eswitch_load_vport(struct mlx5_eswitch *esw, u16 vport_num,
1194                             enum mlx5_eswitch_vport_event enabled_events)
1195 {
1196         int err;
1197
1198         err = mlx5_esw_vport_enable(esw, vport_num, enabled_events);
1199         if (err)
1200                 return err;
1201
1202         err = esw_offloads_load_rep(esw, vport_num);
1203         if (err)
1204                 goto err_rep;
1205
1206         return err;
1207
1208 err_rep:
1209         mlx5_esw_vport_disable(esw, vport_num);
1210         return err;
1211 }
1212
1213 void mlx5_eswitch_unload_vport(struct mlx5_eswitch *esw, u16 vport_num)
1214 {
1215         esw_offloads_unload_rep(esw, vport_num);
1216         mlx5_esw_vport_disable(esw, vport_num);
1217 }
1218
1219 void mlx5_eswitch_unload_vf_vports(struct mlx5_eswitch *esw, u16 num_vfs)
1220 {
1221         struct mlx5_vport *vport;
1222         unsigned long i;
1223
1224         mlx5_esw_for_each_vf_vport(esw, i, vport, num_vfs) {
1225                 if (!vport->enabled)
1226                         continue;
1227                 mlx5_eswitch_unload_vport(esw, vport->vport);
1228         }
1229 }
1230
1231 int mlx5_eswitch_load_vf_vports(struct mlx5_eswitch *esw, u16 num_vfs,
1232                                 enum mlx5_eswitch_vport_event enabled_events)
1233 {
1234         struct mlx5_vport *vport;
1235         unsigned long i;
1236         int err;
1237
1238         mlx5_esw_for_each_vf_vport(esw, i, vport, num_vfs) {
1239                 err = mlx5_eswitch_load_vport(esw, vport->vport, enabled_events);
1240                 if (err)
1241                         goto vf_err;
1242         }
1243
1244         return 0;
1245
1246 vf_err:
1247         mlx5_eswitch_unload_vf_vports(esw, num_vfs);
1248         return err;
1249 }
1250
1251 static int host_pf_enable_hca(struct mlx5_core_dev *dev)
1252 {
1253         if (!mlx5_core_is_ecpf(dev))
1254                 return 0;
1255
1256         /* Once vport and representor are ready, take out the external host PF
1257          * out of initializing state. Enabling HCA clears the iser->initializing
1258          * bit and host PF driver loading can progress.
1259          */
1260         return mlx5_cmd_host_pf_enable_hca(dev);
1261 }
1262
1263 static void host_pf_disable_hca(struct mlx5_core_dev *dev)
1264 {
1265         if (!mlx5_core_is_ecpf(dev))
1266                 return;
1267
1268         mlx5_cmd_host_pf_disable_hca(dev);
1269 }
1270
1271 /* mlx5_eswitch_enable_pf_vf_vports() enables vports of PF, ECPF and VFs
1272  * whichever are present on the eswitch.
1273  */
1274 int
1275 mlx5_eswitch_enable_pf_vf_vports(struct mlx5_eswitch *esw,
1276                                  enum mlx5_eswitch_vport_event enabled_events)
1277 {
1278         int ret;
1279
1280         /* Enable PF vport */
1281         ret = mlx5_eswitch_load_vport(esw, MLX5_VPORT_PF, enabled_events);
1282         if (ret)
1283                 return ret;
1284
1285         /* Enable external host PF HCA */
1286         ret = host_pf_enable_hca(esw->dev);
1287         if (ret)
1288                 goto pf_hca_err;
1289
1290         /* Enable ECPF vport */
1291         if (mlx5_ecpf_vport_exists(esw->dev)) {
1292                 ret = mlx5_eswitch_load_vport(esw, MLX5_VPORT_ECPF, enabled_events);
1293                 if (ret)
1294                         goto ecpf_err;
1295         }
1296
1297         /* Enable VF vports */
1298         ret = mlx5_eswitch_load_vf_vports(esw, esw->esw_funcs.num_vfs,
1299                                           enabled_events);
1300         if (ret)
1301                 goto vf_err;
1302         return 0;
1303
1304 vf_err:
1305         if (mlx5_ecpf_vport_exists(esw->dev))
1306                 mlx5_eswitch_unload_vport(esw, MLX5_VPORT_ECPF);
1307 ecpf_err:
1308         host_pf_disable_hca(esw->dev);
1309 pf_hca_err:
1310         mlx5_eswitch_unload_vport(esw, MLX5_VPORT_PF);
1311         return ret;
1312 }
1313
1314 /* mlx5_eswitch_disable_pf_vf_vports() disables vports of PF, ECPF and VFs
1315  * whichever are previously enabled on the eswitch.
1316  */
1317 void mlx5_eswitch_disable_pf_vf_vports(struct mlx5_eswitch *esw)
1318 {
1319         mlx5_eswitch_unload_vf_vports(esw, esw->esw_funcs.num_vfs);
1320
1321         if (mlx5_ecpf_vport_exists(esw->dev))
1322                 mlx5_eswitch_unload_vport(esw, MLX5_VPORT_ECPF);
1323
1324         host_pf_disable_hca(esw->dev);
1325         mlx5_eswitch_unload_vport(esw, MLX5_VPORT_PF);
1326 }
1327
1328 static void mlx5_eswitch_get_devlink_param(struct mlx5_eswitch *esw)
1329 {
1330         struct devlink *devlink = priv_to_devlink(esw->dev);
1331         union devlink_param_value val;
1332         int err;
1333
1334         err = devlink_param_driverinit_value_get(devlink,
1335                                                  MLX5_DEVLINK_PARAM_ID_ESW_LARGE_GROUP_NUM,
1336                                                  &val);
1337         if (!err) {
1338                 esw->params.large_group_num = val.vu32;
1339         } else {
1340                 esw_warn(esw->dev,
1341                          "Devlink can't get param fdb_large_groups, uses default (%d).\n",
1342                          ESW_OFFLOADS_DEFAULT_NUM_GROUPS);
1343                 esw->params.large_group_num = ESW_OFFLOADS_DEFAULT_NUM_GROUPS;
1344         }
1345 }
1346
1347 static void
1348 mlx5_eswitch_update_num_of_vfs(struct mlx5_eswitch *esw, int num_vfs)
1349 {
1350         const u32 *out;
1351
1352         WARN_ON_ONCE(esw->mode != MLX5_ESWITCH_NONE);
1353
1354         if (num_vfs < 0)
1355                 return;
1356
1357         if (!mlx5_core_is_ecpf_esw_manager(esw->dev)) {
1358                 esw->esw_funcs.num_vfs = num_vfs;
1359                 return;
1360         }
1361
1362         out = mlx5_esw_query_functions(esw->dev);
1363         if (IS_ERR(out))
1364                 return;
1365
1366         esw->esw_funcs.num_vfs = MLX5_GET(query_esw_functions_out, out,
1367                                           host_params_context.host_num_of_vfs);
1368         kvfree(out);
1369 }
1370
1371 static void mlx5_esw_mode_change_notify(struct mlx5_eswitch *esw, u16 mode)
1372 {
1373         struct mlx5_esw_event_info info = {};
1374
1375         info.new_mode = mode;
1376
1377         blocking_notifier_call_chain(&esw->n_head, 0, &info);
1378 }
1379
1380 static int mlx5_esw_acls_ns_init(struct mlx5_eswitch *esw)
1381 {
1382         struct mlx5_core_dev *dev = esw->dev;
1383         int total_vports;
1384         int err;
1385
1386         total_vports = mlx5_eswitch_get_total_vports(dev);
1387
1388         if (MLX5_CAP_ESW_EGRESS_ACL(dev, ft_support)) {
1389                 err = mlx5_fs_egress_acls_init(dev, total_vports);
1390                 if (err)
1391                         return err;
1392         } else {
1393                 esw_warn(dev, "engress ACL is not supported by FW\n");
1394         }
1395
1396         if (MLX5_CAP_ESW_INGRESS_ACL(dev, ft_support)) {
1397                 err = mlx5_fs_ingress_acls_init(dev, total_vports);
1398                 if (err)
1399                         goto err;
1400         } else {
1401                 esw_warn(dev, "ingress ACL is not supported by FW\n");
1402         }
1403         return 0;
1404
1405 err:
1406         if (MLX5_CAP_ESW_EGRESS_ACL(dev, ft_support))
1407                 mlx5_fs_egress_acls_cleanup(dev);
1408         return err;
1409 }
1410
1411 static void mlx5_esw_acls_ns_cleanup(struct mlx5_eswitch *esw)
1412 {
1413         struct mlx5_core_dev *dev = esw->dev;
1414
1415         if (MLX5_CAP_ESW_INGRESS_ACL(dev, ft_support))
1416                 mlx5_fs_ingress_acls_cleanup(dev);
1417         if (MLX5_CAP_ESW_EGRESS_ACL(dev, ft_support))
1418                 mlx5_fs_egress_acls_cleanup(dev);
1419 }
1420
1421 /**
1422  * mlx5_eswitch_enable_locked - Enable eswitch
1423  * @esw:        Pointer to eswitch
1424  * @mode:       Eswitch mode to enable
1425  * @num_vfs:    Enable eswitch for given number of VFs. This is optional.
1426  *              Valid value are 0, > 0 and MLX5_ESWITCH_IGNORE_NUM_VFS.
1427  *              Caller should pass num_vfs > 0 when enabling eswitch for
1428  *              vf vports. Caller should pass num_vfs = 0, when eswitch
1429  *              is enabled without sriov VFs or when caller
1430  *              is unaware of the sriov state of the host PF on ECPF based
1431  *              eswitch. Caller should pass < 0 when num_vfs should be
1432  *              completely ignored. This is typically the case when eswitch
1433  *              is enabled without sriov regardless of PF/ECPF system.
1434  * mlx5_eswitch_enable_locked() Enables eswitch in either legacy or offloads
1435  * mode. If num_vfs >=0 is provided, it setup VF related eswitch vports.
1436  * It returns 0 on success or error code on failure.
1437  */
1438 int mlx5_eswitch_enable_locked(struct mlx5_eswitch *esw, int mode, int num_vfs)
1439 {
1440         int err;
1441
1442         lockdep_assert_held(&esw->mode_lock);
1443
1444         if (!MLX5_CAP_ESW_FLOWTABLE_FDB(esw->dev, ft_support)) {
1445                 esw_warn(esw->dev, "FDB is not supported, aborting ...\n");
1446                 return -EOPNOTSUPP;
1447         }
1448
1449         mlx5_eswitch_get_devlink_param(esw);
1450
1451         err = mlx5_esw_acls_ns_init(esw);
1452         if (err)
1453                 return err;
1454
1455         mlx5_eswitch_update_num_of_vfs(esw, num_vfs);
1456
1457         esw_create_tsar(esw);
1458
1459         esw->mode = mode;
1460
1461         mlx5_lag_update(esw->dev);
1462
1463         if (mode == MLX5_ESWITCH_LEGACY) {
1464                 err = esw_legacy_enable(esw);
1465         } else {
1466                 mlx5_rescan_drivers(esw->dev);
1467                 err = esw_offloads_enable(esw);
1468         }
1469
1470         if (err)
1471                 goto abort;
1472
1473         mlx5_eswitch_event_handlers_register(esw);
1474
1475         esw_info(esw->dev, "Enable: mode(%s), nvfs(%d), active vports(%d)\n",
1476                  mode == MLX5_ESWITCH_LEGACY ? "LEGACY" : "OFFLOADS",
1477                  esw->esw_funcs.num_vfs, esw->enabled_vports);
1478
1479         mlx5_esw_mode_change_notify(esw, mode);
1480
1481         return 0;
1482
1483 abort:
1484         esw->mode = MLX5_ESWITCH_NONE;
1485
1486         if (mode == MLX5_ESWITCH_OFFLOADS)
1487                 mlx5_rescan_drivers(esw->dev);
1488
1489         esw_destroy_tsar(esw);
1490         mlx5_esw_acls_ns_cleanup(esw);
1491         return err;
1492 }
1493
1494 /**
1495  * mlx5_eswitch_enable - Enable eswitch
1496  * @esw:        Pointer to eswitch
1497  * @num_vfs:    Enable eswitch swich for given number of VFs.
1498  *              Caller must pass num_vfs > 0 when enabling eswitch for
1499  *              vf vports.
1500  * mlx5_eswitch_enable() returns 0 on success or error code on failure.
1501  */
1502 int mlx5_eswitch_enable(struct mlx5_eswitch *esw, int num_vfs)
1503 {
1504         int ret;
1505
1506         if (!mlx5_esw_allowed(esw))
1507                 return 0;
1508
1509         down_write(&esw->mode_lock);
1510         if (esw->mode == MLX5_ESWITCH_NONE) {
1511                 ret = mlx5_eswitch_enable_locked(esw, MLX5_ESWITCH_LEGACY, num_vfs);
1512         } else {
1513                 enum mlx5_eswitch_vport_event vport_events;
1514
1515                 vport_events = (esw->mode == MLX5_ESWITCH_LEGACY) ?
1516                                         MLX5_LEGACY_SRIOV_VPORT_EVENTS : MLX5_VPORT_UC_ADDR_CHANGE;
1517                 ret = mlx5_eswitch_load_vf_vports(esw, num_vfs, vport_events);
1518                 if (!ret)
1519                         esw->esw_funcs.num_vfs = num_vfs;
1520         }
1521         up_write(&esw->mode_lock);
1522         return ret;
1523 }
1524
1525 void mlx5_eswitch_disable_locked(struct mlx5_eswitch *esw, bool clear_vf)
1526 {
1527         int old_mode;
1528
1529         lockdep_assert_held_write(&esw->mode_lock);
1530
1531         if (esw->mode == MLX5_ESWITCH_NONE)
1532                 return;
1533
1534         esw_info(esw->dev, "Disable: mode(%s), nvfs(%d), active vports(%d)\n",
1535                  esw->mode == MLX5_ESWITCH_LEGACY ? "LEGACY" : "OFFLOADS",
1536                  esw->esw_funcs.num_vfs, esw->enabled_vports);
1537
1538         /* Notify eswitch users that it is exiting from current mode.
1539          * So that it can do necessary cleanup before the eswitch is disabled.
1540          */
1541         mlx5_esw_mode_change_notify(esw, MLX5_ESWITCH_NONE);
1542
1543         mlx5_eswitch_event_handlers_unregister(esw);
1544
1545         if (esw->mode == MLX5_ESWITCH_LEGACY)
1546                 esw_legacy_disable(esw);
1547         else if (esw->mode == MLX5_ESWITCH_OFFLOADS)
1548                 esw_offloads_disable(esw);
1549
1550         old_mode = esw->mode;
1551         esw->mode = MLX5_ESWITCH_NONE;
1552
1553         mlx5_lag_update(esw->dev);
1554
1555         if (old_mode == MLX5_ESWITCH_OFFLOADS)
1556                 mlx5_rescan_drivers(esw->dev);
1557
1558         esw_destroy_tsar(esw);
1559         mlx5_esw_acls_ns_cleanup(esw);
1560
1561         if (clear_vf)
1562                 mlx5_eswitch_clear_vf_vports_info(esw);
1563 }
1564
1565 void mlx5_eswitch_disable(struct mlx5_eswitch *esw, bool clear_vf)
1566 {
1567         if (!mlx5_esw_allowed(esw))
1568                 return;
1569
1570         down_write(&esw->mode_lock);
1571         mlx5_eswitch_disable_locked(esw, clear_vf);
1572         esw->esw_funcs.num_vfs = 0;
1573         up_write(&esw->mode_lock);
1574 }
1575
1576 static int mlx5_query_hca_cap_host_pf(struct mlx5_core_dev *dev, void *out)
1577 {
1578         u16 opmod = (MLX5_CAP_GENERAL << 1) | (HCA_CAP_OPMOD_GET_MAX & 0x01);
1579         u8 in[MLX5_ST_SZ_BYTES(query_hca_cap_in)] = {};
1580
1581         MLX5_SET(query_hca_cap_in, in, opcode, MLX5_CMD_OP_QUERY_HCA_CAP);
1582         MLX5_SET(query_hca_cap_in, in, op_mod, opmod);
1583         MLX5_SET(query_hca_cap_in, in, function_id, MLX5_VPORT_PF);
1584         MLX5_SET(query_hca_cap_in, in, other_function, true);
1585         return mlx5_cmd_exec_inout(dev, query_hca_cap, in, out);
1586 }
1587
1588 int mlx5_esw_sf_max_hpf_functions(struct mlx5_core_dev *dev, u16 *max_sfs, u16 *sf_base_id)
1589
1590 {
1591         int query_out_sz = MLX5_ST_SZ_BYTES(query_hca_cap_out);
1592         void *query_ctx;
1593         void *hca_caps;
1594         int err;
1595
1596         if (!mlx5_core_is_ecpf(dev)) {
1597                 *max_sfs = 0;
1598                 return 0;
1599         }
1600
1601         query_ctx = kzalloc(query_out_sz, GFP_KERNEL);
1602         if (!query_ctx)
1603                 return -ENOMEM;
1604
1605         err = mlx5_query_hca_cap_host_pf(dev, query_ctx);
1606         if (err)
1607                 goto out_free;
1608
1609         hca_caps = MLX5_ADDR_OF(query_hca_cap_out, query_ctx, capability);
1610         *max_sfs = MLX5_GET(cmd_hca_cap, hca_caps, max_num_sf);
1611         *sf_base_id = MLX5_GET(cmd_hca_cap, hca_caps, sf_base_id);
1612
1613 out_free:
1614         kfree(query_ctx);
1615         return err;
1616 }
1617
1618 static int mlx5_esw_vport_alloc(struct mlx5_eswitch *esw, struct mlx5_core_dev *dev,
1619                                 int index, u16 vport_num)
1620 {
1621         struct mlx5_vport *vport;
1622         int err;
1623
1624         vport = kzalloc(sizeof(*vport), GFP_KERNEL);
1625         if (!vport)
1626                 return -ENOMEM;
1627
1628         vport->dev = esw->dev;
1629         vport->vport = vport_num;
1630         vport->index = index;
1631         vport->info.link_state = MLX5_VPORT_ADMIN_STATE_AUTO;
1632         INIT_WORK(&vport->vport_change_handler, esw_vport_change_handler);
1633         err = xa_insert(&esw->vports, vport_num, vport, GFP_KERNEL);
1634         if (err)
1635                 goto insert_err;
1636
1637         esw->total_vports++;
1638         return 0;
1639
1640 insert_err:
1641         kfree(vport);
1642         return err;
1643 }
1644
1645 static void mlx5_esw_vport_free(struct mlx5_eswitch *esw, struct mlx5_vport *vport)
1646 {
1647         xa_erase(&esw->vports, vport->vport);
1648         kfree(vport);
1649 }
1650
1651 static void mlx5_esw_vports_cleanup(struct mlx5_eswitch *esw)
1652 {
1653         struct mlx5_vport *vport;
1654         unsigned long i;
1655
1656         mlx5_esw_for_each_vport(esw, i, vport)
1657                 mlx5_esw_vport_free(esw, vport);
1658         xa_destroy(&esw->vports);
1659 }
1660
1661 static int mlx5_esw_vports_init(struct mlx5_eswitch *esw)
1662 {
1663         struct mlx5_core_dev *dev = esw->dev;
1664         u16 max_host_pf_sfs;
1665         u16 base_sf_num;
1666         int idx = 0;
1667         int err;
1668         int i;
1669
1670         xa_init(&esw->vports);
1671
1672         err = mlx5_esw_vport_alloc(esw, dev, idx, MLX5_VPORT_PF);
1673         if (err)
1674                 goto err;
1675         if (esw->first_host_vport == MLX5_VPORT_PF)
1676                 xa_set_mark(&esw->vports, idx, MLX5_ESW_VPT_HOST_FN);
1677         idx++;
1678
1679         for (i = 0; i < mlx5_core_max_vfs(dev); i++) {
1680                 err = mlx5_esw_vport_alloc(esw, dev, idx, idx);
1681                 if (err)
1682                         goto err;
1683                 xa_set_mark(&esw->vports, idx, MLX5_ESW_VPT_VF);
1684                 xa_set_mark(&esw->vports, idx, MLX5_ESW_VPT_HOST_FN);
1685                 idx++;
1686         }
1687         base_sf_num = mlx5_sf_start_function_id(dev);
1688         for (i = 0; i < mlx5_sf_max_functions(dev); i++) {
1689                 err = mlx5_esw_vport_alloc(esw, dev, idx, base_sf_num + i);
1690                 if (err)
1691                         goto err;
1692                 xa_set_mark(&esw->vports, base_sf_num + i, MLX5_ESW_VPT_SF);
1693                 idx++;
1694         }
1695
1696         err = mlx5_esw_sf_max_hpf_functions(dev, &max_host_pf_sfs, &base_sf_num);
1697         if (err)
1698                 goto err;
1699         for (i = 0; i < max_host_pf_sfs; i++) {
1700                 err = mlx5_esw_vport_alloc(esw, dev, idx, base_sf_num + i);
1701                 if (err)
1702                         goto err;
1703                 xa_set_mark(&esw->vports, base_sf_num + i, MLX5_ESW_VPT_SF);
1704                 idx++;
1705         }
1706
1707         if (mlx5_ecpf_vport_exists(dev)) {
1708                 err = mlx5_esw_vport_alloc(esw, dev, idx, MLX5_VPORT_ECPF);
1709                 if (err)
1710                         goto err;
1711                 idx++;
1712         }
1713         err = mlx5_esw_vport_alloc(esw, dev, idx, MLX5_VPORT_UPLINK);
1714         if (err)
1715                 goto err;
1716         return 0;
1717
1718 err:
1719         mlx5_esw_vports_cleanup(esw);
1720         return err;
1721 }
1722
1723 int mlx5_eswitch_init(struct mlx5_core_dev *dev)
1724 {
1725         struct mlx5_eswitch *esw;
1726         int err;
1727
1728         if (!MLX5_VPORT_MANAGER(dev))
1729                 return 0;
1730
1731         esw = kzalloc(sizeof(*esw), GFP_KERNEL);
1732         if (!esw)
1733                 return -ENOMEM;
1734
1735         esw->dev = dev;
1736         esw->manager_vport = mlx5_eswitch_manager_vport(dev);
1737         esw->first_host_vport = mlx5_eswitch_first_host_vport_num(dev);
1738
1739         esw->work_queue = create_singlethread_workqueue("mlx5_esw_wq");
1740         if (!esw->work_queue) {
1741                 err = -ENOMEM;
1742                 goto abort;
1743         }
1744
1745         err = mlx5_esw_vports_init(esw);
1746         if (err)
1747                 goto abort;
1748
1749         err = esw_offloads_init_reps(esw);
1750         if (err)
1751                 goto reps_err;
1752
1753         mutex_init(&esw->offloads.encap_tbl_lock);
1754         hash_init(esw->offloads.encap_tbl);
1755         mutex_init(&esw->offloads.decap_tbl_lock);
1756         hash_init(esw->offloads.decap_tbl);
1757         mlx5e_mod_hdr_tbl_init(&esw->offloads.mod_hdr);
1758         atomic64_set(&esw->offloads.num_flows, 0);
1759         ida_init(&esw->offloads.vport_metadata_ida);
1760         xa_init_flags(&esw->offloads.vhca_map, XA_FLAGS_ALLOC);
1761         mutex_init(&esw->state_lock);
1762         init_rwsem(&esw->mode_lock);
1763
1764         esw->enabled_vports = 0;
1765         esw->mode = MLX5_ESWITCH_NONE;
1766         esw->offloads.inline_mode = MLX5_INLINE_MODE_NONE;
1767
1768         dev->priv.eswitch = esw;
1769         BLOCKING_INIT_NOTIFIER_HEAD(&esw->n_head);
1770
1771         esw_info(dev,
1772                  "Total vports %d, per vport: max uc(%d) max mc(%d)\n",
1773                  esw->total_vports,
1774                  MLX5_MAX_UC_PER_VPORT(dev),
1775                  MLX5_MAX_MC_PER_VPORT(dev));
1776         return 0;
1777
1778 reps_err:
1779         mlx5_esw_vports_cleanup(esw);
1780 abort:
1781         if (esw->work_queue)
1782                 destroy_workqueue(esw->work_queue);
1783         kfree(esw);
1784         return err;
1785 }
1786
1787 void mlx5_eswitch_cleanup(struct mlx5_eswitch *esw)
1788 {
1789         if (!esw || !MLX5_VPORT_MANAGER(esw->dev))
1790                 return;
1791
1792         esw_info(esw->dev, "cleanup\n");
1793
1794         esw->dev->priv.eswitch = NULL;
1795         destroy_workqueue(esw->work_queue);
1796         mutex_destroy(&esw->state_lock);
1797         WARN_ON(!xa_empty(&esw->offloads.vhca_map));
1798         xa_destroy(&esw->offloads.vhca_map);
1799         ida_destroy(&esw->offloads.vport_metadata_ida);
1800         mlx5e_mod_hdr_tbl_destroy(&esw->offloads.mod_hdr);
1801         mutex_destroy(&esw->offloads.encap_tbl_lock);
1802         mutex_destroy(&esw->offloads.decap_tbl_lock);
1803         esw_offloads_cleanup_reps(esw);
1804         mlx5_esw_vports_cleanup(esw);
1805         kfree(esw);
1806 }
1807
1808 /* Vport Administration */
1809 static int
1810 mlx5_esw_set_vport_mac_locked(struct mlx5_eswitch *esw,
1811                               struct mlx5_vport *evport, const u8 *mac)
1812 {
1813         u16 vport_num = evport->vport;
1814         u64 node_guid;
1815         int err = 0;
1816
1817         if (is_multicast_ether_addr(mac))
1818                 return -EINVAL;
1819
1820         if (evport->info.spoofchk && !is_valid_ether_addr(mac))
1821                 mlx5_core_warn(esw->dev,
1822                                "Set invalid MAC while spoofchk is on, vport(%d)\n",
1823                                vport_num);
1824
1825         err = mlx5_modify_nic_vport_mac_address(esw->dev, vport_num, mac);
1826         if (err) {
1827                 mlx5_core_warn(esw->dev,
1828                                "Failed to mlx5_modify_nic_vport_mac vport(%d) err=(%d)\n",
1829                                vport_num, err);
1830                 return err;
1831         }
1832
1833         node_guid_gen_from_mac(&node_guid, mac);
1834         err = mlx5_modify_nic_vport_node_guid(esw->dev, vport_num, node_guid);
1835         if (err)
1836                 mlx5_core_warn(esw->dev,
1837                                "Failed to set vport %d node guid, err = %d. RDMA_CM will not function properly for this VF.\n",
1838                                vport_num, err);
1839
1840         ether_addr_copy(evport->info.mac, mac);
1841         evport->info.node_guid = node_guid;
1842         if (evport->enabled && esw->mode == MLX5_ESWITCH_LEGACY)
1843                 err = esw_acl_ingress_lgcy_setup(esw, evport);
1844
1845         return err;
1846 }
1847
1848 int mlx5_eswitch_set_vport_mac(struct mlx5_eswitch *esw,
1849                                u16 vport, const u8 *mac)
1850 {
1851         struct mlx5_vport *evport = mlx5_eswitch_get_vport(esw, vport);
1852         int err = 0;
1853
1854         if (IS_ERR(evport))
1855                 return PTR_ERR(evport);
1856
1857         mutex_lock(&esw->state_lock);
1858         err = mlx5_esw_set_vport_mac_locked(esw, evport, mac);
1859         mutex_unlock(&esw->state_lock);
1860         return err;
1861 }
1862
1863 static bool mlx5_esw_check_port_type(struct mlx5_eswitch *esw, u16 vport_num, xa_mark_t mark)
1864 {
1865         struct mlx5_vport *vport;
1866
1867         vport = mlx5_eswitch_get_vport(esw, vport_num);
1868         if (IS_ERR(vport))
1869                 return false;
1870
1871         return xa_get_mark(&esw->vports, vport_num, mark);
1872 }
1873
1874 bool mlx5_eswitch_is_vf_vport(struct mlx5_eswitch *esw, u16 vport_num)
1875 {
1876         return mlx5_esw_check_port_type(esw, vport_num, MLX5_ESW_VPT_VF);
1877 }
1878
1879 bool mlx5_esw_is_sf_vport(struct mlx5_eswitch *esw, u16 vport_num)
1880 {
1881         return mlx5_esw_check_port_type(esw, vport_num, MLX5_ESW_VPT_SF);
1882 }
1883
1884 static bool
1885 is_port_function_supported(struct mlx5_eswitch *esw, u16 vport_num)
1886 {
1887         return vport_num == MLX5_VPORT_PF ||
1888                mlx5_eswitch_is_vf_vport(esw, vport_num) ||
1889                mlx5_esw_is_sf_vport(esw, vport_num);
1890 }
1891
1892 int mlx5_devlink_port_function_hw_addr_get(struct devlink *devlink,
1893                                            struct devlink_port *port,
1894                                            u8 *hw_addr, int *hw_addr_len,
1895                                            struct netlink_ext_ack *extack)
1896 {
1897         struct mlx5_eswitch *esw;
1898         struct mlx5_vport *vport;
1899         int err = -EOPNOTSUPP;
1900         u16 vport_num;
1901
1902         esw = mlx5_devlink_eswitch_get(devlink);
1903         if (IS_ERR(esw))
1904                 return PTR_ERR(esw);
1905
1906         vport_num = mlx5_esw_devlink_port_index_to_vport_num(port->index);
1907         if (!is_port_function_supported(esw, vport_num))
1908                 return -EOPNOTSUPP;
1909
1910         vport = mlx5_eswitch_get_vport(esw, vport_num);
1911         if (IS_ERR(vport)) {
1912                 NL_SET_ERR_MSG_MOD(extack, "Invalid port");
1913                 return PTR_ERR(vport);
1914         }
1915
1916         mutex_lock(&esw->state_lock);
1917         if (vport->enabled) {
1918                 ether_addr_copy(hw_addr, vport->info.mac);
1919                 *hw_addr_len = ETH_ALEN;
1920                 err = 0;
1921         }
1922         mutex_unlock(&esw->state_lock);
1923         return err;
1924 }
1925
1926 int mlx5_devlink_port_function_hw_addr_set(struct devlink *devlink,
1927                                            struct devlink_port *port,
1928                                            const u8 *hw_addr, int hw_addr_len,
1929                                            struct netlink_ext_ack *extack)
1930 {
1931         struct mlx5_eswitch *esw;
1932         struct mlx5_vport *vport;
1933         int err = -EOPNOTSUPP;
1934         u16 vport_num;
1935
1936         esw = mlx5_devlink_eswitch_get(devlink);
1937         if (IS_ERR(esw)) {
1938                 NL_SET_ERR_MSG_MOD(extack, "Eswitch doesn't support set hw_addr");
1939                 return PTR_ERR(esw);
1940         }
1941
1942         vport_num = mlx5_esw_devlink_port_index_to_vport_num(port->index);
1943         if (!is_port_function_supported(esw, vport_num)) {
1944                 NL_SET_ERR_MSG_MOD(extack, "Port doesn't support set hw_addr");
1945                 return -EINVAL;
1946         }
1947         vport = mlx5_eswitch_get_vport(esw, vport_num);
1948         if (IS_ERR(vport)) {
1949                 NL_SET_ERR_MSG_MOD(extack, "Invalid port");
1950                 return PTR_ERR(vport);
1951         }
1952
1953         mutex_lock(&esw->state_lock);
1954         if (vport->enabled)
1955                 err = mlx5_esw_set_vport_mac_locked(esw, vport, hw_addr);
1956         else
1957                 NL_SET_ERR_MSG_MOD(extack, "Eswitch vport is disabled");
1958         mutex_unlock(&esw->state_lock);
1959         return err;
1960 }
1961
1962 int mlx5_eswitch_set_vport_state(struct mlx5_eswitch *esw,
1963                                  u16 vport, int link_state)
1964 {
1965         struct mlx5_vport *evport = mlx5_eswitch_get_vport(esw, vport);
1966         int opmod = MLX5_VPORT_STATE_OP_MOD_ESW_VPORT;
1967         int other_vport = 1;
1968         int err = 0;
1969
1970         if (!mlx5_esw_allowed(esw))
1971                 return -EPERM;
1972         if (IS_ERR(evport))
1973                 return PTR_ERR(evport);
1974
1975         if (vport == MLX5_VPORT_UPLINK) {
1976                 opmod = MLX5_VPORT_STATE_OP_MOD_UPLINK;
1977                 other_vport = 0;
1978                 vport = 0;
1979         }
1980         mutex_lock(&esw->state_lock);
1981         if (esw->mode != MLX5_ESWITCH_LEGACY) {
1982                 err = -EOPNOTSUPP;
1983                 goto unlock;
1984         }
1985
1986         err = mlx5_modify_vport_admin_state(esw->dev, opmod, vport, other_vport, link_state);
1987         if (err) {
1988                 mlx5_core_warn(esw->dev, "Failed to set vport %d link state, opmod = %d, err = %d",
1989                                vport, opmod, err);
1990                 goto unlock;
1991         }
1992
1993         evport->info.link_state = link_state;
1994
1995 unlock:
1996         mutex_unlock(&esw->state_lock);
1997         return err;
1998 }
1999
2000 int mlx5_eswitch_get_vport_config(struct mlx5_eswitch *esw,
2001                                   u16 vport, struct ifla_vf_info *ivi)
2002 {
2003         struct mlx5_vport *evport = mlx5_eswitch_get_vport(esw, vport);
2004
2005         if (IS_ERR(evport))
2006                 return PTR_ERR(evport);
2007
2008         memset(ivi, 0, sizeof(*ivi));
2009         ivi->vf = vport - 1;
2010
2011         mutex_lock(&esw->state_lock);
2012         ether_addr_copy(ivi->mac, evport->info.mac);
2013         ivi->linkstate = evport->info.link_state;
2014         ivi->vlan = evport->info.vlan;
2015         ivi->qos = evport->info.qos;
2016         ivi->spoofchk = evport->info.spoofchk;
2017         ivi->trusted = evport->info.trusted;
2018         ivi->min_tx_rate = evport->qos.min_rate;
2019         ivi->max_tx_rate = evport->qos.max_rate;
2020         mutex_unlock(&esw->state_lock);
2021
2022         return 0;
2023 }
2024
2025 int __mlx5_eswitch_set_vport_vlan(struct mlx5_eswitch *esw,
2026                                   u16 vport, u16 vlan, u8 qos, u8 set_flags)
2027 {
2028         struct mlx5_vport *evport = mlx5_eswitch_get_vport(esw, vport);
2029         int err = 0;
2030
2031         if (IS_ERR(evport))
2032                 return PTR_ERR(evport);
2033         if (vlan > 4095 || qos > 7)
2034                 return -EINVAL;
2035
2036         err = modify_esw_vport_cvlan(esw->dev, vport, vlan, qos, set_flags);
2037         if (err)
2038                 return err;
2039
2040         evport->info.vlan = vlan;
2041         evport->info.qos = qos;
2042         if (evport->enabled && esw->mode == MLX5_ESWITCH_LEGACY) {
2043                 err = esw_acl_ingress_lgcy_setup(esw, evport);
2044                 if (err)
2045                         return err;
2046                 err = esw_acl_egress_lgcy_setup(esw, evport);
2047         }
2048
2049         return err;
2050 }
2051
2052 static u32 calculate_vports_min_rate_divider(struct mlx5_eswitch *esw)
2053 {
2054         u32 fw_max_bw_share = MLX5_CAP_QOS(esw->dev, max_tsar_bw_share);
2055         struct mlx5_vport *evport;
2056         u32 max_guarantee = 0;
2057         unsigned long i;
2058
2059         mlx5_esw_for_each_vport(esw, i, evport) {
2060                 if (!evport->enabled || evport->qos.min_rate < max_guarantee)
2061                         continue;
2062                 max_guarantee = evport->qos.min_rate;
2063         }
2064
2065         if (max_guarantee)
2066                 return max_t(u32, max_guarantee / fw_max_bw_share, 1);
2067         return 0;
2068 }
2069
2070 static int normalize_vports_min_rate(struct mlx5_eswitch *esw)
2071 {
2072         u32 fw_max_bw_share = MLX5_CAP_QOS(esw->dev, max_tsar_bw_share);
2073         u32 divider = calculate_vports_min_rate_divider(esw);
2074         struct mlx5_vport *evport;
2075         u32 vport_max_rate;
2076         u32 vport_min_rate;
2077         unsigned long i;
2078         u32 bw_share;
2079         int err;
2080
2081         mlx5_esw_for_each_vport(esw, i, evport) {
2082                 if (!evport->enabled)
2083                         continue;
2084                 vport_min_rate = evport->qos.min_rate;
2085                 vport_max_rate = evport->qos.max_rate;
2086                 bw_share = 0;
2087
2088                 if (divider)
2089                         bw_share = MLX5_RATE_TO_BW_SHARE(vport_min_rate,
2090                                                          divider,
2091                                                          fw_max_bw_share);
2092
2093                 if (bw_share == evport->qos.bw_share)
2094                         continue;
2095
2096                 err = esw_vport_qos_config(esw, evport, vport_max_rate,
2097                                            bw_share);
2098                 if (!err)
2099                         evport->qos.bw_share = bw_share;
2100                 else
2101                         return err;
2102         }
2103
2104         return 0;
2105 }
2106
2107 int mlx5_eswitch_set_vport_rate(struct mlx5_eswitch *esw, u16 vport,
2108                                 u32 max_rate, u32 min_rate)
2109 {
2110         struct mlx5_vport *evport = mlx5_eswitch_get_vport(esw, vport);
2111         u32 fw_max_bw_share;
2112         u32 previous_min_rate;
2113         bool min_rate_supported;
2114         bool max_rate_supported;
2115         int err = 0;
2116
2117         if (!mlx5_esw_allowed(esw))
2118                 return -EPERM;
2119         if (IS_ERR(evport))
2120                 return PTR_ERR(evport);
2121
2122         fw_max_bw_share = MLX5_CAP_QOS(esw->dev, max_tsar_bw_share);
2123         min_rate_supported = MLX5_CAP_QOS(esw->dev, esw_bw_share) &&
2124                                 fw_max_bw_share >= MLX5_MIN_BW_SHARE;
2125         max_rate_supported = MLX5_CAP_QOS(esw->dev, esw_rate_limit);
2126
2127         if ((min_rate && !min_rate_supported) || (max_rate && !max_rate_supported))
2128                 return -EOPNOTSUPP;
2129
2130         mutex_lock(&esw->state_lock);
2131
2132         if (min_rate == evport->qos.min_rate)
2133                 goto set_max_rate;
2134
2135         previous_min_rate = evport->qos.min_rate;
2136         evport->qos.min_rate = min_rate;
2137         err = normalize_vports_min_rate(esw);
2138         if (err) {
2139                 evport->qos.min_rate = previous_min_rate;
2140                 goto unlock;
2141         }
2142
2143 set_max_rate:
2144         if (max_rate == evport->qos.max_rate)
2145                 goto unlock;
2146
2147         err = esw_vport_qos_config(esw, evport, max_rate, evport->qos.bw_share);
2148         if (!err)
2149                 evport->qos.max_rate = max_rate;
2150
2151 unlock:
2152         mutex_unlock(&esw->state_lock);
2153         return err;
2154 }
2155
2156 int mlx5_eswitch_get_vport_stats(struct mlx5_eswitch *esw,
2157                                  u16 vport_num,
2158                                  struct ifla_vf_stats *vf_stats)
2159 {
2160         struct mlx5_vport *vport = mlx5_eswitch_get_vport(esw, vport_num);
2161         int outlen = MLX5_ST_SZ_BYTES(query_vport_counter_out);
2162         u32 in[MLX5_ST_SZ_DW(query_vport_counter_in)] = {};
2163         struct mlx5_vport_drop_stats stats = {};
2164         int err = 0;
2165         u32 *out;
2166
2167         if (IS_ERR(vport))
2168                 return PTR_ERR(vport);
2169
2170         out = kvzalloc(outlen, GFP_KERNEL);
2171         if (!out)
2172                 return -ENOMEM;
2173
2174         MLX5_SET(query_vport_counter_in, in, opcode,
2175                  MLX5_CMD_OP_QUERY_VPORT_COUNTER);
2176         MLX5_SET(query_vport_counter_in, in, op_mod, 0);
2177         MLX5_SET(query_vport_counter_in, in, vport_number, vport->vport);
2178         MLX5_SET(query_vport_counter_in, in, other_vport, 1);
2179
2180         err = mlx5_cmd_exec_inout(esw->dev, query_vport_counter, in, out);
2181         if (err)
2182                 goto free_out;
2183
2184         #define MLX5_GET_CTR(p, x) \
2185                 MLX5_GET64(query_vport_counter_out, p, x)
2186
2187         memset(vf_stats, 0, sizeof(*vf_stats));
2188         vf_stats->rx_packets =
2189                 MLX5_GET_CTR(out, received_eth_unicast.packets) +
2190                 MLX5_GET_CTR(out, received_ib_unicast.packets) +
2191                 MLX5_GET_CTR(out, received_eth_multicast.packets) +
2192                 MLX5_GET_CTR(out, received_ib_multicast.packets) +
2193                 MLX5_GET_CTR(out, received_eth_broadcast.packets);
2194
2195         vf_stats->rx_bytes =
2196                 MLX5_GET_CTR(out, received_eth_unicast.octets) +
2197                 MLX5_GET_CTR(out, received_ib_unicast.octets) +
2198                 MLX5_GET_CTR(out, received_eth_multicast.octets) +
2199                 MLX5_GET_CTR(out, received_ib_multicast.octets) +
2200                 MLX5_GET_CTR(out, received_eth_broadcast.octets);
2201
2202         vf_stats->tx_packets =
2203                 MLX5_GET_CTR(out, transmitted_eth_unicast.packets) +
2204                 MLX5_GET_CTR(out, transmitted_ib_unicast.packets) +
2205                 MLX5_GET_CTR(out, transmitted_eth_multicast.packets) +
2206                 MLX5_GET_CTR(out, transmitted_ib_multicast.packets) +
2207                 MLX5_GET_CTR(out, transmitted_eth_broadcast.packets);
2208
2209         vf_stats->tx_bytes =
2210                 MLX5_GET_CTR(out, transmitted_eth_unicast.octets) +
2211                 MLX5_GET_CTR(out, transmitted_ib_unicast.octets) +
2212                 MLX5_GET_CTR(out, transmitted_eth_multicast.octets) +
2213                 MLX5_GET_CTR(out, transmitted_ib_multicast.octets) +
2214                 MLX5_GET_CTR(out, transmitted_eth_broadcast.octets);
2215
2216         vf_stats->multicast =
2217                 MLX5_GET_CTR(out, received_eth_multicast.packets) +
2218                 MLX5_GET_CTR(out, received_ib_multicast.packets);
2219
2220         vf_stats->broadcast =
2221                 MLX5_GET_CTR(out, received_eth_broadcast.packets);
2222
2223         err = mlx5_esw_query_vport_drop_stats(esw->dev, vport, &stats);
2224         if (err)
2225                 goto free_out;
2226         vf_stats->rx_dropped = stats.rx_dropped;
2227         vf_stats->tx_dropped = stats.tx_dropped;
2228
2229 free_out:
2230         kvfree(out);
2231         return err;
2232 }
2233
2234 u8 mlx5_eswitch_mode(struct mlx5_core_dev *dev)
2235 {
2236         struct mlx5_eswitch *esw = dev->priv.eswitch;
2237
2238         return mlx5_esw_allowed(esw) ? esw->mode : MLX5_ESWITCH_NONE;
2239 }
2240 EXPORT_SYMBOL_GPL(mlx5_eswitch_mode);
2241
2242 enum devlink_eswitch_encap_mode
2243 mlx5_eswitch_get_encap_mode(const struct mlx5_core_dev *dev)
2244 {
2245         struct mlx5_eswitch *esw;
2246
2247         esw = dev->priv.eswitch;
2248         return mlx5_esw_allowed(esw) ? esw->offloads.encap :
2249                 DEVLINK_ESWITCH_ENCAP_MODE_NONE;
2250 }
2251 EXPORT_SYMBOL(mlx5_eswitch_get_encap_mode);
2252
2253 bool mlx5_esw_lag_prereq(struct mlx5_core_dev *dev0, struct mlx5_core_dev *dev1)
2254 {
2255         if ((dev0->priv.eswitch->mode == MLX5_ESWITCH_NONE &&
2256              dev1->priv.eswitch->mode == MLX5_ESWITCH_NONE) ||
2257             (dev0->priv.eswitch->mode == MLX5_ESWITCH_OFFLOADS &&
2258              dev1->priv.eswitch->mode == MLX5_ESWITCH_OFFLOADS))
2259                 return true;
2260
2261         return false;
2262 }
2263
2264 bool mlx5_esw_multipath_prereq(struct mlx5_core_dev *dev0,
2265                                struct mlx5_core_dev *dev1)
2266 {
2267         return (dev0->priv.eswitch->mode == MLX5_ESWITCH_OFFLOADS &&
2268                 dev1->priv.eswitch->mode == MLX5_ESWITCH_OFFLOADS);
2269 }
2270
2271 int mlx5_esw_event_notifier_register(struct mlx5_eswitch *esw, struct notifier_block *nb)
2272 {
2273         return blocking_notifier_chain_register(&esw->n_head, nb);
2274 }
2275
2276 void mlx5_esw_event_notifier_unregister(struct mlx5_eswitch *esw, struct notifier_block *nb)
2277 {
2278         blocking_notifier_chain_unregister(&esw->n_head, nb);
2279 }
2280
2281 /**
2282  * mlx5_esw_hold() - Try to take a read lock on esw mode lock.
2283  * @mdev: mlx5 core device.
2284  *
2285  * Should be called by esw resources callers.
2286  *
2287  * Return: true on success or false.
2288  */
2289 bool mlx5_esw_hold(struct mlx5_core_dev *mdev)
2290 {
2291         struct mlx5_eswitch *esw = mdev->priv.eswitch;
2292
2293         /* e.g. VF doesn't have eswitch so nothing to do */
2294         if (!mlx5_esw_allowed(esw))
2295                 return true;
2296
2297         if (down_read_trylock(&esw->mode_lock) != 0)
2298                 return true;
2299
2300         return false;
2301 }
2302
2303 /**
2304  * mlx5_esw_release() - Release a read lock on esw mode lock.
2305  * @mdev: mlx5 core device.
2306  */
2307 void mlx5_esw_release(struct mlx5_core_dev *mdev)
2308 {
2309         struct mlx5_eswitch *esw = mdev->priv.eswitch;
2310
2311         if (mlx5_esw_allowed(esw))
2312                 up_read(&esw->mode_lock);
2313 }
2314
2315 /**
2316  * mlx5_esw_get() - Increase esw user count.
2317  * @mdev: mlx5 core device.
2318  */
2319 void mlx5_esw_get(struct mlx5_core_dev *mdev)
2320 {
2321         struct mlx5_eswitch *esw = mdev->priv.eswitch;
2322
2323         if (mlx5_esw_allowed(esw))
2324                 atomic64_inc(&esw->user_count);
2325 }
2326
2327 /**
2328  * mlx5_esw_put() - Decrease esw user count.
2329  * @mdev: mlx5 core device.
2330  */
2331 void mlx5_esw_put(struct mlx5_core_dev *mdev)
2332 {
2333         struct mlx5_eswitch *esw = mdev->priv.eswitch;
2334
2335         if (mlx5_esw_allowed(esw))
2336                 atomic64_dec_if_positive(&esw->user_count);
2337 }
2338
2339 /**
2340  * mlx5_esw_try_lock() - Take a write lock on esw mode lock.
2341  * @esw: eswitch device.
2342  *
2343  * Should be called by esw mode change routine.
2344  *
2345  * Return:
2346  * * 0       - esw mode if successfully locked and refcount is 0.
2347  * * -EBUSY  - refcount is not 0.
2348  * * -EINVAL - In the middle of switching mode or lock is already held.
2349  */
2350 int mlx5_esw_try_lock(struct mlx5_eswitch *esw)
2351 {
2352         if (down_write_trylock(&esw->mode_lock) == 0)
2353                 return -EINVAL;
2354
2355         if (atomic64_read(&esw->user_count) > 0) {
2356                 up_write(&esw->mode_lock);
2357                 return -EBUSY;
2358         }
2359
2360         return esw->mode;
2361 }
2362
2363 /**
2364  * mlx5_esw_unlock() - Release write lock on esw mode lock
2365  * @esw: eswitch device.
2366  */
2367 void mlx5_esw_unlock(struct mlx5_eswitch *esw)
2368 {
2369         up_write(&esw->mode_lock);
2370 }
2371
2372 /**
2373  * mlx5_eswitch_get_total_vports - Get total vports of the eswitch
2374  *
2375  * @dev: Pointer to core device
2376  *
2377  * mlx5_eswitch_get_total_vports returns total number of eswitch vports.
2378  */
2379 u16 mlx5_eswitch_get_total_vports(const struct mlx5_core_dev *dev)
2380 {
2381         struct mlx5_eswitch *esw;
2382
2383         esw = dev->priv.eswitch;
2384         return mlx5_esw_allowed(esw) ? esw->total_vports : 0;
2385 }
2386 EXPORT_SYMBOL_GPL(mlx5_eswitch_get_total_vports);