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