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

   1 /*
   2  * Copyright (c) 2015, Mellanox Technologies. All rights reserved.
   3  *
   4  * This software is available to you under a choice of one of two
   5  * licenses.  You may choose to be licensed under the terms of the GNU
   6  * General Public License (GPL) Version 2, available from the file
   7  * COPYING in the main directory of this source tree, or the
   8  * OpenIB.org BSD license below:
   9  *
  10  *     Redistribution and use in source and binary forms, with or
  11  *     without modification, are permitted provided that the following
  12  *     conditions are met:
  13  *
  14  *      - Redistributions of source code must retain the above
  15  *        copyright notice, this list of conditions and the following
  16  *        disclaimer.
  17  *
  18  *      - Redistributions in binary form must reproduce the above
  19  *        copyright notice, this list of conditions and the following
  20  *        disclaimer in the documentation and/or other materials
  21  *        provided with the distribution.
  22  *
  23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  30  * SOFTWARE.
  31  */
  32
  33 #include <linux/etherdevice.h>
  34 #include <linux/mlx5/driver.h>
  35 #include <linux/mlx5/mlx5_ifc.h>
  36 #include <linux/mlx5/vport.h>
  37 #include <linux/mlx5/fs.h>
  38 #include "mlx5_core.h"
  39 #include "eswitch.h"
  40
  41 #define UPLINK_VPORT 0xFFFF
  42
  43 #define MLX5_DEBUG_ESWITCH_MASK BIT(3)
  44
  45 #define esw_info(dev, format, ...)                              \
  46         pr_info("(%s): E-Switch: " format, (dev)->priv.name, ##__VA_ARGS__)
  47
  48 #define esw_warn(dev, format, ...)                              \
  49         pr_warn("(%s): E-Switch: " format, (dev)->priv.name, ##__VA_ARGS__)
  50
  51 #define esw_debug(dev, format, ...)                             \
  52         mlx5_core_dbg_mask(dev, MLX5_DEBUG_ESWITCH_MASK, format, ##__VA_ARGS__)
  53
  54 enum {
  55         MLX5_ACTION_NONE = 0,
  56         MLX5_ACTION_ADD  = 1,
  57         MLX5_ACTION_DEL  = 2,
  58 };
  59
  60 /* E-Switch UC L2 table hash node */
  61 struct esw_uc_addr {
  62         struct l2addr_node node;
  63         u32                table_index;
  64         u32                vport;
  65 };
  66
  67 /* E-Switch MC FDB table hash node */
  68 struct esw_mc_addr { /* SRIOV only */
  69         struct l2addr_node     node;
  70         struct mlx5_flow_rule *uplink_rule; /* Forward to uplink rule */
  71         u32                    refcnt;
  72 };
  73
  74 /* Vport UC/MC hash node */
  75 struct vport_addr {
  76         struct l2addr_node     node;
  77         u8                     action;
  78         u32                    vport;
  79         struct mlx5_flow_rule *flow_rule; /* SRIOV only */
  80 };
  81
  82 enum {
  83         UC_ADDR_CHANGE = BIT(0),
  84         MC_ADDR_CHANGE = BIT(1),
  85 };
  86
  87 /* Vport context events */
  88 #define SRIOV_VPORT_EVENTS (UC_ADDR_CHANGE | \
  89                             MC_ADDR_CHANGE)
  90
  91 static int arm_vport_context_events_cmd(struct mlx5_core_dev *dev, u16 vport,
  92                                         u32 events_mask)
  93 {
  94         int in[MLX5_ST_SZ_DW(modify_nic_vport_context_in)];
  95         int out[MLX5_ST_SZ_DW(modify_nic_vport_context_out)];
  96         void *nic_vport_ctx;
  97         int err;
  98
  99         memset(out, 0, sizeof(out));
 100         memset(in, 0, sizeof(in));
 101
 102         MLX5_SET(modify_nic_vport_context_in, in,
 103                  opcode, MLX5_CMD_OP_MODIFY_NIC_VPORT_CONTEXT);
 104         MLX5_SET(modify_nic_vport_context_in, in, field_select.change_event, 1);
 105         MLX5_SET(modify_nic_vport_context_in, in, vport_number, vport);
 106         if (vport)
 107                 MLX5_SET(modify_nic_vport_context_in, in, other_vport, 1);
 108         nic_vport_ctx = MLX5_ADDR_OF(modify_nic_vport_context_in,
 109                                      in, nic_vport_context);
 110
 111         MLX5_SET(nic_vport_context, nic_vport_ctx, arm_change_event, 1);
 112
 113         if (events_mask & UC_ADDR_CHANGE)
 114                 MLX5_SET(nic_vport_context, nic_vport_ctx,
 115                          event_on_uc_address_change, 1);
 116         if (events_mask & MC_ADDR_CHANGE)
 117                 MLX5_SET(nic_vport_context, nic_vport_ctx,
 118                          event_on_mc_address_change, 1);
 119
 120         err = mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
 121         if (err)
 122                 goto ex;
 123         err = mlx5_cmd_status_to_err_v2(out);
 124         if (err)
 125                 goto ex;
 126         return 0;
 127 ex:
 128         return err;
 129 }
 130
 131 /* E-Switch vport context HW commands */
 132 static int query_esw_vport_context_cmd(struct mlx5_core_dev *mdev, u32 vport,
 133                                        u32 *out, int outlen)
 134 {
 135         u32 in[MLX5_ST_SZ_DW(query_esw_vport_context_in)];
 136
 137         memset(in, 0, sizeof(in));
 138
 139         MLX5_SET(query_nic_vport_context_in, in, opcode,
 140                  MLX5_CMD_OP_QUERY_ESW_VPORT_CONTEXT);
 141
 142         MLX5_SET(query_esw_vport_context_in, in, vport_number, vport);
 143         if (vport)
 144                 MLX5_SET(query_esw_vport_context_in, in, other_vport, 1);
 145
 146         return mlx5_cmd_exec_check_status(mdev, in, sizeof(in), out, outlen);
 147 }
 148
 149 static int query_esw_vport_cvlan(struct mlx5_core_dev *dev, u32 vport,
 150                                  u16 *vlan, u8 *qos)
 151 {
 152         u32 out[MLX5_ST_SZ_DW(query_esw_vport_context_out)];
 153         int err;
 154         bool cvlan_strip;
 155         bool cvlan_insert;
 156
 157         memset(out, 0, sizeof(out));
 158
 159         *vlan = 0;
 160         *qos = 0;
 161
 162         if (!MLX5_CAP_ESW(dev, vport_cvlan_strip) ||
 163             !MLX5_CAP_ESW(dev, vport_cvlan_insert_if_not_exist))
 164                 return -ENOTSUPP;
 165
 166         err = query_esw_vport_context_cmd(dev, vport, out, sizeof(out));
 167         if (err)
 168                 goto out;
 169
 170         cvlan_strip = MLX5_GET(query_esw_vport_context_out, out,
 171                                esw_vport_context.vport_cvlan_strip);
 172
 173         cvlan_insert = MLX5_GET(query_esw_vport_context_out, out,
 174                                 esw_vport_context.vport_cvlan_insert);
 175
 176         if (cvlan_strip || cvlan_insert) {
 177                 *vlan = MLX5_GET(query_esw_vport_context_out, out,
 178                                  esw_vport_context.cvlan_id);
 179                 *qos = MLX5_GET(query_esw_vport_context_out, out,
 180                                 esw_vport_context.cvlan_pcp);
 181         }
 182
 183         esw_debug(dev, "Query Vport[%d] cvlan: VLAN %d qos=%d\n",
 184                   vport, *vlan, *qos);
 185 out:
 186         return err;
 187 }
 188
 189 static int modify_esw_vport_context_cmd(struct mlx5_core_dev *dev, u16 vport,
 190                                         void *in, int inlen)
 191 {
 192         u32 out[MLX5_ST_SZ_DW(modify_esw_vport_context_out)];
 193
 194         memset(out, 0, sizeof(out));
 195
 196         MLX5_SET(modify_esw_vport_context_in, in, vport_number, vport);
 197         if (vport)
 198                 MLX5_SET(modify_esw_vport_context_in, in, other_vport, 1);
 199
 200         MLX5_SET(modify_esw_vport_context_in, in, opcode,
 201                  MLX5_CMD_OP_MODIFY_ESW_VPORT_CONTEXT);
 202
 203         return mlx5_cmd_exec_check_status(dev, in, inlen,
 204                                           out, sizeof(out));
 205 }
 206
 207 static int modify_esw_vport_cvlan(struct mlx5_core_dev *dev, u32 vport,
 208                                   u16 vlan, u8 qos, bool set)
 209 {
 210         u32 in[MLX5_ST_SZ_DW(modify_esw_vport_context_in)];
 211
 212         memset(in, 0, sizeof(in));
 213
 214         if (!MLX5_CAP_ESW(dev, vport_cvlan_strip) ||
 215             !MLX5_CAP_ESW(dev, vport_cvlan_insert_if_not_exist))
 216                 return -ENOTSUPP;
 217
 218         esw_debug(dev, "Set Vport[%d] VLAN %d qos %d set=%d\n",
 219                   vport, vlan, qos, set);
 220
 221         if (set) {
 222                 MLX5_SET(modify_esw_vport_context_in, in,
 223                          esw_vport_context.vport_cvlan_strip, 1);
 224                 /* insert only if no vlan in packet */
 225                 MLX5_SET(modify_esw_vport_context_in, in,
 226                          esw_vport_context.vport_cvlan_insert, 1);
 227                 MLX5_SET(modify_esw_vport_context_in, in,
 228                          esw_vport_context.cvlan_pcp, qos);
 229                 MLX5_SET(modify_esw_vport_context_in, in,
 230                          esw_vport_context.cvlan_id, vlan);
 231         }
 232
 233         MLX5_SET(modify_esw_vport_context_in, in,
 234                  field_select.vport_cvlan_strip, 1);
 235         MLX5_SET(modify_esw_vport_context_in, in,
 236                  field_select.vport_cvlan_insert, 1);
 237
 238         return modify_esw_vport_context_cmd(dev, vport, in, sizeof(in));
 239 }
 240
 241 /* HW L2 Table (MPFS) management */
 242 static int set_l2_table_entry_cmd(struct mlx5_core_dev *dev, u32 index,
 243                                   u8 *mac, u8 vlan_valid, u16 vlan)
 244 {
 245         u32 in[MLX5_ST_SZ_DW(set_l2_table_entry_in)];
 246         u32 out[MLX5_ST_SZ_DW(set_l2_table_entry_out)];
 247         u8 *in_mac_addr;
 248
 249         memset(in, 0, sizeof(in));
 250         memset(out, 0, sizeof(out));
 251
 252         MLX5_SET(set_l2_table_entry_in, in, opcode,
 253                  MLX5_CMD_OP_SET_L2_TABLE_ENTRY);
 254         MLX5_SET(set_l2_table_entry_in, in, table_index, index);
 255         MLX5_SET(set_l2_table_entry_in, in, vlan_valid, vlan_valid);
 256         MLX5_SET(set_l2_table_entry_in, in, vlan, vlan);
 257
 258         in_mac_addr = MLX5_ADDR_OF(set_l2_table_entry_in, in, mac_address);
 259         ether_addr_copy(&in_mac_addr[2], mac);
 260
 261         return mlx5_cmd_exec_check_status(dev, in, sizeof(in),
 262                                           out, sizeof(out));
 263 }
 264
 265 static int del_l2_table_entry_cmd(struct mlx5_core_dev *dev, u32 index)
 266 {
 267         u32 in[MLX5_ST_SZ_DW(delete_l2_table_entry_in)];
 268         u32 out[MLX5_ST_SZ_DW(delete_l2_table_entry_out)];
 269
 270         memset(in, 0, sizeof(in));
 271         memset(out, 0, sizeof(out));
 272
 273         MLX5_SET(delete_l2_table_entry_in, in, opcode,
 274                  MLX5_CMD_OP_DELETE_L2_TABLE_ENTRY);
 275         MLX5_SET(delete_l2_table_entry_in, in, table_index, index);
 276         return mlx5_cmd_exec_check_status(dev, in, sizeof(in),
 277                                           out, sizeof(out));
 278 }
 279
 280 static int alloc_l2_table_index(struct mlx5_l2_table *l2_table, u32 *ix)
 281 {
 282         int err = 0;
 283
 284         *ix = find_first_zero_bit(l2_table->bitmap, l2_table->size);
 285         if (*ix >= l2_table->size)
 286                 err = -ENOSPC;
 287         else
 288                 __set_bit(*ix, l2_table->bitmap);
 289
 290         return err;
 291 }
 292
 293 static void free_l2_table_index(struct mlx5_l2_table *l2_table, u32 ix)
 294 {
 295         __clear_bit(ix, l2_table->bitmap);
 296 }
 297
 298 static int set_l2_table_entry(struct mlx5_core_dev *dev, u8 *mac,
 299                               u8 vlan_valid, u16 vlan,
 300                               u32 *index)
 301 {
 302         struct mlx5_l2_table *l2_table = &dev->priv.eswitch->l2_table;
 303         int err;
 304
 305         err = alloc_l2_table_index(l2_table, index);
 306         if (err)
 307                 return err;
 308
 309         err = set_l2_table_entry_cmd(dev, *index, mac, vlan_valid, vlan);
 310         if (err)
 311                 free_l2_table_index(l2_table, *index);
 312
 313         return err;
 314 }
 315
 316 static void del_l2_table_entry(struct mlx5_core_dev *dev, u32 index)
 317 {
 318         struct mlx5_l2_table *l2_table = &dev->priv.eswitch->l2_table;
 319
 320         del_l2_table_entry_cmd(dev, index);
 321         free_l2_table_index(l2_table, index);
 322 }
 323
 324 /* E-Switch FDB */
 325 static struct mlx5_flow_rule *
 326 esw_fdb_set_vport_rule(struct mlx5_eswitch *esw, u8 mac[ETH_ALEN], u32 vport)
 327 {
 328         int match_header = MLX5_MATCH_OUTER_HEADERS;
 329         struct mlx5_flow_destination dest;
 330         struct mlx5_flow_rule *flow_rule = NULL;
 331         u32 *match_v;
 332         u32 *match_c;
 333         u8 *dmac_v;
 334         u8 *dmac_c;
 335
 336         match_v = kzalloc(MLX5_ST_SZ_BYTES(fte_match_param), GFP_KERNEL);
 337         match_c = kzalloc(MLX5_ST_SZ_BYTES(fte_match_param), GFP_KERNEL);
 338         if (!match_v || !match_c) {
 339                 pr_warn("FDB: Failed to alloc match parameters\n");
 340                 goto out;
 341         }
 342         dmac_v = MLX5_ADDR_OF(fte_match_param, match_v,
 343                               outer_headers.dmac_47_16);
 344         dmac_c = MLX5_ADDR_OF(fte_match_param, match_c,
 345                               outer_headers.dmac_47_16);
 346
 347         ether_addr_copy(dmac_v, mac);
 348         /* Match criteria mask */
 349         memset(dmac_c, 0xff, 6);
 350
 351         dest.type = MLX5_FLOW_DESTINATION_TYPE_VPORT;
 352         dest.vport_num = vport;
 353
 354         esw_debug(esw->dev,
 355                   "\tFDB add rule dmac_v(%pM) dmac_c(%pM) -> vport(%d)\n",
 356                   dmac_v, dmac_c, vport);
 357         flow_rule =
 358                 mlx5_add_flow_rule(esw->fdb_table.fdb,
 359                                    match_header,
 360                                    match_c,
 361                                    match_v,
 362                                    MLX5_FLOW_CONTEXT_ACTION_FWD_DEST,
 363                                    0, &dest);
 364         if (IS_ERR_OR_NULL(flow_rule)) {
 365                 pr_warn(
 366                         "FDB: Failed to add flow rule: dmac_v(%pM) dmac_c(%pM) -> vport(%d), err(%ld)\n",
 367                          dmac_v, dmac_c, vport, PTR_ERR(flow_rule));
 368                 flow_rule = NULL;
 369         }
 370 out:
 371         kfree(match_v);
 372         kfree(match_c);
 373         return flow_rule;
 374 }
 375
 376 static int esw_create_fdb_table(struct mlx5_eswitch *esw, int nvports)
 377 {
 378         int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
 379         struct mlx5_core_dev *dev = esw->dev;
 380         struct mlx5_flow_namespace *root_ns;
 381         struct mlx5_flow_table *fdb;
 382         struct mlx5_flow_group *g;
 383         void *match_criteria;
 384         int table_size;
 385         u32 *flow_group_in;
 386         u8 *dmac;
 387         int err = 0;
 388
 389         esw_debug(dev, "Create FDB log_max_size(%d)\n",
 390                   MLX5_CAP_ESW_FLOWTABLE_FDB(dev, log_max_ft_size));
 391
 392         root_ns = mlx5_get_flow_namespace(dev, MLX5_FLOW_NAMESPACE_FDB);
 393         if (!root_ns) {
 394                 esw_warn(dev, "Failed to get FDB flow namespace\n");
 395                 return -ENOMEM;
 396         }
 397
 398         flow_group_in = mlx5_vzalloc(inlen);
 399         if (!flow_group_in)
 400                 return -ENOMEM;
 401         memset(flow_group_in, 0, inlen);
 402
 403         table_size = BIT(MLX5_CAP_ESW_FLOWTABLE_FDB(dev, log_max_ft_size));
 404         fdb = mlx5_create_flow_table(root_ns, 0, table_size, 0);
 405         if (IS_ERR_OR_NULL(fdb)) {
 406                 err = PTR_ERR(fdb);
 407                 esw_warn(dev, "Failed to create FDB Table err %d\n", err);
 408                 goto out;
 409         }
 410
 411         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable,
 412                  MLX5_MATCH_OUTER_HEADERS);
 413         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
 414         dmac = MLX5_ADDR_OF(fte_match_param, match_criteria, outer_headers.dmac_47_16);
 415         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
 416         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, table_size - 1);
 417         eth_broadcast_addr(dmac);
 418
 419         g = mlx5_create_flow_group(fdb, flow_group_in);
 420         if (IS_ERR_OR_NULL(g)) {
 421                 err = PTR_ERR(g);
 422                 esw_warn(dev, "Failed to create flow group err(%d)\n", err);
 423                 goto out;
 424         }
 425
 426         esw->fdb_table.addr_grp = g;
 427         esw->fdb_table.fdb = fdb;
 428 out:
 429         kfree(flow_group_in);
 430         if (err && !IS_ERR_OR_NULL(fdb))
 431                 mlx5_destroy_flow_table(fdb);
 432         return err;
 433 }
 434
 435 static void esw_destroy_fdb_table(struct mlx5_eswitch *esw)
 436 {
 437         if (!esw->fdb_table.fdb)
 438                 return;
 439
 440         esw_debug(esw->dev, "Destroy FDB Table\n");
 441         mlx5_destroy_flow_group(esw->fdb_table.addr_grp);
 442         mlx5_destroy_flow_table(esw->fdb_table.fdb);
 443         esw->fdb_table.fdb = NULL;
 444         esw->fdb_table.addr_grp = NULL;
 445 }
 446
 447 /* E-Switch vport UC/MC lists management */
 448 typedef int (*vport_addr_action)(struct mlx5_eswitch *esw,
 449                                  struct vport_addr *vaddr);
 450
 451 static int esw_add_uc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 452 {
 453         struct hlist_head *hash = esw->l2_table.l2_hash;
 454         struct esw_uc_addr *esw_uc;
 455         u8 *mac = vaddr->node.addr;
 456         u32 vport = vaddr->vport;
 457         int err;
 458
 459         esw_uc = l2addr_hash_find(hash, mac, struct esw_uc_addr);
 460         if (esw_uc) {
 461                 esw_warn(esw->dev,
 462                          "Failed to set L2 mac(%pM) for vport(%d), mac is already in use by vport(%d)\n",
 463                          mac, vport, esw_uc->vport);
 464                 return -EEXIST;
 465         }
 466
 467         esw_uc = l2addr_hash_add(hash, mac, struct esw_uc_addr, GFP_KERNEL);
 468         if (!esw_uc)
 469                 return -ENOMEM;
 470         esw_uc->vport = vport;
 471
 472         err = set_l2_table_entry(esw->dev, mac, 0, 0, &esw_uc->table_index);
 473         if (err)
 474                 goto abort;
 475
 476         if (esw->fdb_table.fdb) /* SRIOV is enabled: Forward UC MAC to vport */
 477                 vaddr->flow_rule = esw_fdb_set_vport_rule(esw, mac, vport);
 478
 479         esw_debug(esw->dev, "\tADDED UC MAC: vport[%d] %pM index:%d fr(%p)\n",
 480                   vport, mac, esw_uc->table_index, vaddr->flow_rule);
 481         return err;
 482 abort:
 483         l2addr_hash_del(esw_uc);
 484         return err;
 485 }
 486
 487 static int esw_del_uc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 488 {
 489         struct hlist_head *hash = esw->l2_table.l2_hash;
 490         struct esw_uc_addr *esw_uc;
 491         u8 *mac = vaddr->node.addr;
 492         u32 vport = vaddr->vport;
 493
 494         esw_uc = l2addr_hash_find(hash, mac, struct esw_uc_addr);
 495         if (!esw_uc || esw_uc->vport != vport) {
 496                 esw_debug(esw->dev,
 497                           "MAC(%pM) doesn't belong to vport (%d)\n",
 498                           mac, vport);
 499                 return -EINVAL;
 500         }
 501         esw_debug(esw->dev, "\tDELETE UC MAC: vport[%d] %pM index:%d fr(%p)\n",
 502                   vport, mac, esw_uc->table_index, vaddr->flow_rule);
 503
 504         del_l2_table_entry(esw->dev, esw_uc->table_index);
 505
 506         if (vaddr->flow_rule)
 507                 mlx5_del_flow_rule(vaddr->flow_rule);
 508         vaddr->flow_rule = NULL;
 509
 510         l2addr_hash_del(esw_uc);
 511         return 0;
 512 }
 513
 514 static int esw_add_mc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 515 {
 516         struct hlist_head *hash = esw->mc_table;
 517         struct esw_mc_addr *esw_mc;
 518         u8 *mac = vaddr->node.addr;
 519         u32 vport = vaddr->vport;
 520
 521         if (!esw->fdb_table.fdb)
 522                 return 0;
 523
 524         esw_mc = l2addr_hash_find(hash, mac, struct esw_mc_addr);
 525         if (esw_mc)
 526                 goto add;
 527
 528         esw_mc = l2addr_hash_add(hash, mac, struct esw_mc_addr, GFP_KERNEL);
 529         if (!esw_mc)
 530                 return -ENOMEM;
 531
 532         esw_mc->uplink_rule = /* Forward MC MAC to Uplink */
 533                 esw_fdb_set_vport_rule(esw, mac, UPLINK_VPORT);
 534 add:
 535         esw_mc->refcnt++;
 536         /* Forward MC MAC to vport */
 537         vaddr->flow_rule = esw_fdb_set_vport_rule(esw, mac, vport);
 538         esw_debug(esw->dev,
 539                   "\tADDED MC MAC: vport[%d] %pM fr(%p) refcnt(%d) uplinkfr(%p)\n",
 540                   vport, mac, vaddr->flow_rule,
 541                   esw_mc->refcnt, esw_mc->uplink_rule);
 542         return 0;
 543 }
 544
 545 static int esw_del_mc_addr(struct mlx5_eswitch *esw, struct vport_addr *vaddr)
 546 {
 547         struct hlist_head *hash = esw->mc_table;
 548         struct esw_mc_addr *esw_mc;
 549         u8 *mac = vaddr->node.addr;
 550         u32 vport = vaddr->vport;
 551
 552         if (!esw->fdb_table.fdb)
 553                 return 0;
 554
 555         esw_mc = l2addr_hash_find(hash, mac, struct esw_mc_addr);
 556         if (!esw_mc) {
 557                 esw_warn(esw->dev,
 558                          "Failed to find eswitch MC addr for MAC(%pM) vport(%d)",
 559                          mac, vport);
 560                 return -EINVAL;
 561         }
 562         esw_debug(esw->dev,
 563                   "\tDELETE MC MAC: vport[%d] %pM fr(%p) refcnt(%d) uplinkfr(%p)\n",
 564                   vport, mac, vaddr->flow_rule, esw_mc->refcnt,
 565                   esw_mc->uplink_rule);
 566
 567         if (vaddr->flow_rule)
 568                 mlx5_del_flow_rule(vaddr->flow_rule);
 569         vaddr->flow_rule = NULL;
 570
 571         if (--esw_mc->refcnt)
 572                 return 0;
 573
 574         if (esw_mc->uplink_rule)
 575                 mlx5_del_flow_rule(esw_mc->uplink_rule);
 576
 577         l2addr_hash_del(esw_mc);
 578         return 0;
 579 }
 580
 581 /* Apply vport UC/MC list to HW l2 table and FDB table */
 582 static void esw_apply_vport_addr_list(struct mlx5_eswitch *esw,
 583                                       u32 vport_num, int list_type)
 584 {
 585         struct mlx5_vport *vport = &esw->vports[vport_num];
 586         bool is_uc = list_type == MLX5_NVPRT_LIST_TYPE_UC;
 587         vport_addr_action vport_addr_add;
 588         vport_addr_action vport_addr_del;
 589         struct vport_addr *addr;
 590         struct l2addr_node *node;
 591         struct hlist_head *hash;
 592         struct hlist_node *tmp;
 593         int hi;
 594
 595         vport_addr_add = is_uc ? esw_add_uc_addr :
 596                                  esw_add_mc_addr;
 597         vport_addr_del = is_uc ? esw_del_uc_addr :
 598                                  esw_del_mc_addr;
 599
 600         hash = is_uc ? vport->uc_list : vport->mc_list;
 601         for_each_l2hash_node(node, tmp, hash, hi) {
 602                 addr = container_of(node, struct vport_addr, node);
 603                 switch (addr->action) {
 604                 case MLX5_ACTION_ADD:
 605                         vport_addr_add(esw, addr);
 606                         addr->action = MLX5_ACTION_NONE;
 607                         break;
 608                 case MLX5_ACTION_DEL:
 609                         vport_addr_del(esw, addr);
 610                         l2addr_hash_del(addr);
 611                         break;
 612                 }
 613         }
 614 }
 615
 616 /* Sync vport UC/MC list from vport context */
 617 static void esw_update_vport_addr_list(struct mlx5_eswitch *esw,
 618                                        u32 vport_num, int list_type)
 619 {
 620         struct mlx5_vport *vport = &esw->vports[vport_num];
 621         bool is_uc = list_type == MLX5_NVPRT_LIST_TYPE_UC;
 622         u8 (*mac_list)[ETH_ALEN];
 623         struct l2addr_node *node;
 624         struct vport_addr *addr;
 625         struct hlist_head *hash;
 626         struct hlist_node *tmp;
 627         int size;
 628         int err;
 629         int hi;
 630         int i;
 631
 632         size = is_uc ? MLX5_MAX_UC_PER_VPORT(esw->dev) :
 633                        MLX5_MAX_MC_PER_VPORT(esw->dev);
 634
 635         mac_list = kcalloc(size, ETH_ALEN, GFP_KERNEL);
 636         if (!mac_list)
 637                 return;
 638
 639         hash = is_uc ? vport->uc_list : vport->mc_list;
 640
 641         for_each_l2hash_node(node, tmp, hash, hi) {
 642                 addr = container_of(node, struct vport_addr, node);
 643                 addr->action = MLX5_ACTION_DEL;
 644         }
 645
 646         err = mlx5_query_nic_vport_mac_list(esw->dev, vport_num, list_type,
 647                                             mac_list, &size);
 648         if (err)
 649                 goto out;
 650         esw_debug(esw->dev, "vport[%d] context update %s list size (%d)\n",
 651                   vport_num, is_uc ? "UC" : "MC", size);
 652
 653         for (i = 0; i < size; i++) {
 654                 if (is_uc && !is_valid_ether_addr(mac_list[i]))
 655                         continue;
 656
 657                 if (!is_uc && !is_multicast_ether_addr(mac_list[i]))
 658                         continue;
 659
 660                 addr = l2addr_hash_find(hash, mac_list[i], struct vport_addr);
 661                 if (addr) {
 662                         addr->action = MLX5_ACTION_NONE;
 663                         continue;
 664                 }
 665
 666                 addr = l2addr_hash_add(hash, mac_list[i], struct vport_addr,
 667                                        GFP_KERNEL);
 668                 if (!addr) {
 669                         esw_warn(esw->dev,
 670                                  "Failed to add MAC(%pM) to vport[%d] DB\n",
 671                                  mac_list[i], vport_num);
 672                         continue;
 673                 }
 674                 addr->vport = vport_num;
 675                 addr->action = MLX5_ACTION_ADD;
 676         }
 677 out:
 678         kfree(mac_list);
 679 }
 680
 681 static void esw_vport_change_handler(struct work_struct *work)
 682 {
 683         struct mlx5_vport *vport =
 684                 container_of(work, struct mlx5_vport, vport_change_handler);
 685         struct mlx5_core_dev *dev = vport->dev;
 686         struct mlx5_eswitch *esw = dev->priv.eswitch;
 687         u8 mac[ETH_ALEN];
 688
 689         mlx5_query_nic_vport_mac_address(dev, vport->vport, mac);
 690         esw_debug(dev, "vport[%d] Context Changed: perm mac: %pM\n",
 691                   vport->vport, mac);
 692
 693         if (vport->enabled_events & UC_ADDR_CHANGE) {
 694                 esw_update_vport_addr_list(esw, vport->vport,
 695                                            MLX5_NVPRT_LIST_TYPE_UC);
 696                 esw_apply_vport_addr_list(esw, vport->vport,
 697                                           MLX5_NVPRT_LIST_TYPE_UC);
 698         }
 699
 700         if (vport->enabled_events & MC_ADDR_CHANGE) {
 701                 esw_update_vport_addr_list(esw, vport->vport,
 702                                            MLX5_NVPRT_LIST_TYPE_MC);
 703                 esw_apply_vport_addr_list(esw, vport->vport,
 704                                           MLX5_NVPRT_LIST_TYPE_MC);
 705         }
 706
 707         esw_debug(esw->dev, "vport[%d] Context Changed: Done\n", vport->vport);
 708         if (vport->enabled)
 709                 arm_vport_context_events_cmd(dev, vport->vport,
 710                                              vport->enabled_events);
 711 }
 712
 713 static void esw_vport_enable_egress_acl(struct mlx5_eswitch *esw,
 714                                         struct mlx5_vport *vport)
 715 {
 716         int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
 717         struct mlx5_flow_group *vlan_grp = NULL;
 718         struct mlx5_flow_group *drop_grp = NULL;
 719         struct mlx5_core_dev *dev = esw->dev;
 720         struct mlx5_flow_namespace *root_ns;
 721         struct mlx5_flow_table *acl;
 722         void *match_criteria;
 723         u32 *flow_group_in;
 724         /* The egress acl table contains 2 rules:
 725          * 1)Allow traffic with vlan_tag=vst_vlan_id
 726          * 2)Drop all other traffic.
 727          */
 728         int table_size = 2;
 729         int err = 0;
 730
 731         if (!MLX5_CAP_ESW_EGRESS_ACL(dev, ft_support))
 732                 return;
 733
 734         esw_debug(dev, "Create vport[%d] egress ACL log_max_size(%d)\n",
 735                   vport->vport, MLX5_CAP_ESW_EGRESS_ACL(dev, log_max_ft_size));
 736
 737         root_ns = mlx5_get_flow_namespace(dev, MLX5_FLOW_NAMESPACE_ESW_EGRESS);
 738         if (!root_ns) {
 739                 esw_warn(dev, "Failed to get E-Switch egress flow namespace\n");
 740                 return;
 741         }
 742
 743         flow_group_in = mlx5_vzalloc(inlen);
 744         if (!flow_group_in)
 745                 return;
 746
 747         acl = mlx5_create_vport_flow_table(root_ns, 0, table_size, 0, vport->vport);
 748         if (IS_ERR_OR_NULL(acl)) {
 749                 err = PTR_ERR(acl);
 750                 esw_warn(dev, "Failed to create E-Switch vport[%d] egress flow Table, err(%d)\n",
 751                          vport->vport, err);
 752                 goto out;
 753         }
 754
 755         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
 756         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
 757         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.vlan_tag);
 758         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.first_vid);
 759         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
 760         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 0);
 761
 762         vlan_grp = mlx5_create_flow_group(acl, flow_group_in);
 763         if (IS_ERR_OR_NULL(vlan_grp)) {
 764                 err = PTR_ERR(vlan_grp);
 765                 esw_warn(dev, "Failed to create E-Switch vport[%d] egress allowed vlans flow group, err(%d)\n",
 766                          vport->vport, err);
 767                 goto out;
 768         }
 769
 770         memset(flow_group_in, 0, inlen);
 771         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 1);
 772         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 1);
 773         drop_grp = mlx5_create_flow_group(acl, flow_group_in);
 774         if (IS_ERR_OR_NULL(drop_grp)) {
 775                 err = PTR_ERR(drop_grp);
 776                 esw_warn(dev, "Failed to create E-Switch vport[%d] egress drop flow group, err(%d)\n",
 777                          vport->vport, err);
 778                 goto out;
 779         }
 780
 781         vport->egress.acl = acl;
 782         vport->egress.drop_grp = drop_grp;
 783         vport->egress.allowed_vlans_grp = vlan_grp;
 784 out:
 785         kfree(flow_group_in);
 786         if (err && !IS_ERR_OR_NULL(vlan_grp))
 787                 mlx5_destroy_flow_group(vlan_grp);
 788         if (err && !IS_ERR_OR_NULL(acl))
 789                 mlx5_destroy_flow_table(acl);
 790 }
 791
 792 static void esw_vport_disable_egress_acl(struct mlx5_eswitch *esw,
 793                                          struct mlx5_vport *vport)
 794 {
 795         if (IS_ERR_OR_NULL(vport->egress.acl))
 796                 return;
 797
 798         esw_debug(esw->dev, "Destroy vport[%d] E-Switch egress ACL\n", vport->vport);
 799
 800         mlx5_destroy_flow_group(vport->egress.allowed_vlans_grp);
 801         mlx5_destroy_flow_group(vport->egress.drop_grp);
 802         mlx5_destroy_flow_table(vport->egress.acl);
 803         vport->egress.allowed_vlans_grp = NULL;
 804         vport->egress.drop_grp = NULL;
 805         vport->egress.acl = NULL;
 806 }
 807
 808 static void esw_vport_enable_ingress_acl(struct mlx5_eswitch *esw,
 809                                          struct mlx5_vport *vport)
 810 {
 811         int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
 812         struct mlx5_core_dev *dev = esw->dev;
 813         struct mlx5_flow_namespace *root_ns;
 814         struct mlx5_flow_table *acl;
 815         struct mlx5_flow_group *g;
 816         void *match_criteria;
 817         u32 *flow_group_in;
 818         /* The ingress acl table contains 4 groups
 819          * (2 active rules at the same time -
 820          *      1 allow rule from one of the first 3 groups.
 821          *      1 drop rule from the last group):
 822          * 1)Allow untagged traffic with smac=original mac.
 823          * 2)Allow untagged traffic.
 824          * 3)Allow traffic with smac=original mac.
 825          * 4)Drop all other traffic.
 826          */
 827         int table_size = 4;
 828         int err = 0;
 829
 830         if (!MLX5_CAP_ESW_INGRESS_ACL(dev, ft_support))
 831                 return;
 832
 833         esw_debug(dev, "Create vport[%d] ingress ACL log_max_size(%d)\n",
 834                   vport->vport, MLX5_CAP_ESW_INGRESS_ACL(dev, log_max_ft_size));
 835
 836         root_ns = mlx5_get_flow_namespace(dev, MLX5_FLOW_NAMESPACE_ESW_INGRESS);
 837         if (!root_ns) {
 838                 esw_warn(dev, "Failed to get E-Switch ingress flow namespace\n");
 839                 return;
 840         }
 841
 842         flow_group_in = mlx5_vzalloc(inlen);
 843         if (!flow_group_in)
 844                 return;
 845
 846         acl = mlx5_create_vport_flow_table(root_ns, 0, table_size, 0, vport->vport);
 847         if (IS_ERR_OR_NULL(acl)) {
 848                 err = PTR_ERR(acl);
 849                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress flow Table, err(%d)\n",
 850                          vport->vport, err);
 851                 goto out;
 852         }
 853         vport->ingress.acl = acl;
 854
 855         match_criteria = MLX5_ADDR_OF(create_flow_group_in, flow_group_in, match_criteria);
 856
 857         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
 858         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.vlan_tag);
 859         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.smac_47_16);
 860         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.smac_15_0);
 861         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 0);
 862         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 0);
 863
 864         g = mlx5_create_flow_group(acl, flow_group_in);
 865         if (IS_ERR_OR_NULL(g)) {
 866                 err = PTR_ERR(g);
 867                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress untagged spoofchk flow group, err(%d)\n",
 868                          vport->vport, err);
 869                 goto out;
 870         }
 871         vport->ingress.allow_untagged_spoofchk_grp = g;
 872
 873         memset(flow_group_in, 0, inlen);
 874         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
 875         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.vlan_tag);
 876         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 1);
 877         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 1);
 878
 879         g = mlx5_create_flow_group(acl, flow_group_in);
 880         if (IS_ERR_OR_NULL(g)) {
 881                 err = PTR_ERR(g);
 882                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress untagged flow group, err(%d)\n",
 883                          vport->vport, err);
 884                 goto out;
 885         }
 886         vport->ingress.allow_untagged_only_grp = g;
 887
 888         memset(flow_group_in, 0, inlen);
 889         MLX5_SET(create_flow_group_in, flow_group_in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
 890         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.smac_47_16);
 891         MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.smac_15_0);
 892         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 2);
 893         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 2);
 894
 895         g = mlx5_create_flow_group(acl, flow_group_in);
 896         if (IS_ERR_OR_NULL(g)) {
 897                 err = PTR_ERR(g);
 898                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress spoofchk flow group, err(%d)\n",
 899                          vport->vport, err);
 900                 goto out;
 901         }
 902         vport->ingress.allow_spoofchk_only_grp = g;
 903
 904         memset(flow_group_in, 0, inlen);
 905         MLX5_SET(create_flow_group_in, flow_group_in, start_flow_index, 3);
 906         MLX5_SET(create_flow_group_in, flow_group_in, end_flow_index, 3);
 907
 908         g = mlx5_create_flow_group(acl, flow_group_in);
 909         if (IS_ERR_OR_NULL(g)) {
 910                 err = PTR_ERR(g);
 911                 esw_warn(dev, "Failed to create E-Switch vport[%d] ingress drop flow group, err(%d)\n",
 912                          vport->vport, err);
 913                 goto out;
 914         }
 915         vport->ingress.drop_grp = g;
 916
 917 out:
 918         if (err) {
 919                 if (!IS_ERR_OR_NULL(vport->ingress.allow_spoofchk_only_grp))
 920                         mlx5_destroy_flow_group(
 921                                         vport->ingress.allow_spoofchk_only_grp);
 922                 if (!IS_ERR_OR_NULL(vport->ingress.allow_untagged_only_grp))
 923                         mlx5_destroy_flow_group(
 924                                         vport->ingress.allow_untagged_only_grp);
 925                 if (!IS_ERR_OR_NULL(vport->ingress.allow_untagged_spoofchk_grp))
 926                         mlx5_destroy_flow_group(
 927                                 vport->ingress.allow_untagged_spoofchk_grp);
 928                 if (!IS_ERR_OR_NULL(vport->ingress.acl))
 929                         mlx5_destroy_flow_table(vport->ingress.acl);
 930         }
 931
 932         kfree(flow_group_in);
 933 }
 934
 935 static void esw_vport_disable_ingress_acl(struct mlx5_eswitch *esw,
 936                                           struct mlx5_vport *vport)
 937 {
 938         if (IS_ERR_OR_NULL(vport->ingress.acl))
 939                 return;
 940
 941         esw_debug(esw->dev, "Destroy vport[%d] E-Switch ingress ACL\n", vport->vport);
 942
 943         mlx5_destroy_flow_group(vport->ingress.allow_spoofchk_only_grp);
 944         mlx5_destroy_flow_group(vport->ingress.allow_untagged_only_grp);
 945         mlx5_destroy_flow_group(vport->ingress.allow_untagged_spoofchk_grp);
 946         mlx5_destroy_flow_group(vport->ingress.drop_grp);
 947         mlx5_destroy_flow_table(vport->ingress.acl);
 948         vport->ingress.acl = NULL;
 949         vport->ingress.drop_grp = NULL;
 950         vport->ingress.allow_spoofchk_only_grp = NULL;
 951         vport->ingress.allow_untagged_only_grp = NULL;
 952         vport->ingress.allow_untagged_spoofchk_grp = NULL;
 953 }
 954
 955 static void esw_enable_vport(struct mlx5_eswitch *esw, int vport_num,
 956                              int enable_events)
 957 {
 958         struct mlx5_vport *vport = &esw->vports[vport_num];
 959
 960         WARN_ON(vport->enabled);
 961
 962         esw_debug(esw->dev, "Enabling VPORT(%d)\n", vport_num);
 963
 964         if (vport_num) { /* Only VFs need ACLs for VST and spoofchk filtering */
 965                 esw_vport_enable_ingress_acl(esw, vport);
 966                 esw_vport_enable_egress_acl(esw, vport);
 967         }
 968
 969         mlx5_modify_vport_admin_state(esw->dev,
 970                                       MLX5_QUERY_VPORT_STATE_IN_OP_MOD_ESW_VPORT,
 971                                       vport_num,
 972                                       MLX5_ESW_VPORT_ADMIN_STATE_AUTO);
 973
 974         /* Sync with current vport context */
 975         vport->enabled_events = enable_events;
 976         esw_vport_change_handler(&vport->vport_change_handler);
 977
 978         vport->enabled = true;
 979
 980         arm_vport_context_events_cmd(esw->dev, vport_num, enable_events);
 981
 982         esw->enabled_vports++;
 983         esw_debug(esw->dev, "Enabled VPORT(%d)\n", vport_num);
 984 }
 985
 986 static void esw_cleanup_vport(struct mlx5_eswitch *esw, u16 vport_num)
 987 {
 988         struct mlx5_vport *vport = &esw->vports[vport_num];
 989         struct l2addr_node *node;
 990         struct vport_addr *addr;
 991         struct hlist_node *tmp;
 992         int hi;
 993
 994         for_each_l2hash_node(node, tmp, vport->uc_list, hi) {
 995                 addr = container_of(node, struct vport_addr, node);
 996                 addr->action = MLX5_ACTION_DEL;
 997         }
 998         esw_apply_vport_addr_list(esw, vport_num, MLX5_NVPRT_LIST_TYPE_UC);
 999
1000         for_each_l2hash_node(node, tmp, vport->mc_list, hi) {
1001                 addr = container_of(node, struct vport_addr, node);
1002                 addr->action = MLX5_ACTION_DEL;
1003         }
1004         esw_apply_vport_addr_list(esw, vport_num, MLX5_NVPRT_LIST_TYPE_MC);
1005 }
1006
1007 static void esw_disable_vport(struct mlx5_eswitch *esw, int vport_num)
1008 {
1009         struct mlx5_vport *vport = &esw->vports[vport_num];
1010
1011         if (!vport->enabled)
1012                 return;
1013
1014         esw_debug(esw->dev, "Disabling vport(%d)\n", vport_num);
1015         /* Mark this vport as disabled to discard new events */
1016         vport->enabled = false;
1017         vport->enabled_events = 0;
1018
1019         synchronize_irq(mlx5_get_msix_vec(esw->dev, MLX5_EQ_VEC_ASYNC));
1020
1021         mlx5_modify_vport_admin_state(esw->dev,
1022                                       MLX5_QUERY_VPORT_STATE_IN_OP_MOD_ESW_VPORT,
1023                                       vport_num,
1024                                       MLX5_ESW_VPORT_ADMIN_STATE_DOWN);
1025         /* Wait for current already scheduled events to complete */
1026         flush_workqueue(esw->work_queue);
1027         /* Disable events from this vport */
1028         arm_vport_context_events_cmd(esw->dev, vport->vport, 0);
1029         /* We don't assume VFs will cleanup after themselves */
1030         esw_cleanup_vport(esw, vport_num);
1031         if (vport_num) {
1032                 esw_vport_disable_egress_acl(esw, vport);
1033                 esw_vport_disable_ingress_acl(esw, vport);
1034         }
1035         esw->enabled_vports--;
1036 }
1037
1038 /* Public E-Switch API */
1039 int mlx5_eswitch_enable_sriov(struct mlx5_eswitch *esw, int nvfs)
1040 {
1041         int err;
1042         int i;
1043
1044         if (!esw || !MLX5_CAP_GEN(esw->dev, vport_group_manager) ||
1045             MLX5_CAP_GEN(esw->dev, port_type) != MLX5_CAP_PORT_TYPE_ETH)
1046                 return 0;
1047
1048         if (!MLX5_CAP_GEN(esw->dev, eswitch_flow_table) ||
1049             !MLX5_CAP_ESW_FLOWTABLE_FDB(esw->dev, ft_support)) {
1050                 esw_warn(esw->dev, "E-Switch FDB is not supported, aborting ...\n");
1051                 return -ENOTSUPP;
1052         }
1053
1054         if (!MLX5_CAP_ESW_INGRESS_ACL(esw->dev, ft_support))
1055                 esw_warn(esw->dev, "E-Switch ingress ACL is not supported by FW\n");
1056
1057         if (!MLX5_CAP_ESW_EGRESS_ACL(esw->dev, ft_support))
1058                 esw_warn(esw->dev, "E-Switch engress ACL is not supported by FW\n");
1059
1060         esw_info(esw->dev, "E-Switch enable SRIOV: nvfs(%d)\n", nvfs);
1061
1062         esw_disable_vport(esw, 0);
1063
1064         err = esw_create_fdb_table(esw, nvfs + 1);
1065         if (err)
1066                 goto abort;
1067
1068         for (i = 0; i <= nvfs; i++)
1069                 esw_enable_vport(esw, i, SRIOV_VPORT_EVENTS);
1070
1071         esw_info(esw->dev, "SRIOV enabled: active vports(%d)\n",
1072                  esw->enabled_vports);
1073         return 0;
1074
1075 abort:
1076         esw_enable_vport(esw, 0, UC_ADDR_CHANGE);
1077         return err;
1078 }
1079
1080 void mlx5_eswitch_disable_sriov(struct mlx5_eswitch *esw)
1081 {
1082         int i;
1083
1084         if (!esw || !MLX5_CAP_GEN(esw->dev, vport_group_manager) ||
1085             MLX5_CAP_GEN(esw->dev, port_type) != MLX5_CAP_PORT_TYPE_ETH)
1086                 return;
1087
1088         esw_info(esw->dev, "disable SRIOV: active vports(%d)\n",
1089                  esw->enabled_vports);
1090
1091         for (i = 0; i < esw->total_vports; i++)
1092                 esw_disable_vport(esw, i);
1093
1094         esw_destroy_fdb_table(esw);
1095
1096         /* VPORT 0 (PF) must be enabled back with non-sriov configuration */
1097         esw_enable_vport(esw, 0, UC_ADDR_CHANGE);
1098 }
1099
1100 int mlx5_eswitch_init(struct mlx5_core_dev *dev)
1101 {
1102         int l2_table_size = 1 << MLX5_CAP_GEN(dev, log_max_l2_table);
1103         int total_vports = MLX5_TOTAL_VPORTS(dev);
1104         struct mlx5_eswitch *esw;
1105         int vport_num;
1106         int err;
1107
1108         if (!MLX5_CAP_GEN(dev, vport_group_manager) ||
1109             MLX5_CAP_GEN(dev, port_type) != MLX5_CAP_PORT_TYPE_ETH)
1110                 return 0;
1111
1112         esw_info(dev,
1113                  "Total vports %d, l2 table size(%d), per vport: max uc(%d) max mc(%d)\n",
1114                  total_vports, l2_table_size,
1115                  MLX5_MAX_UC_PER_VPORT(dev),
1116                  MLX5_MAX_MC_PER_VPORT(dev));
1117
1118         esw = kzalloc(sizeof(*esw), GFP_KERNEL);
1119         if (!esw)
1120                 return -ENOMEM;
1121
1122         esw->dev = dev;
1123
1124         esw->l2_table.bitmap = kcalloc(BITS_TO_LONGS(l2_table_size),
1125                                    sizeof(uintptr_t), GFP_KERNEL);
1126         if (!esw->l2_table.bitmap) {
1127                 err = -ENOMEM;
1128                 goto abort;
1129         }
1130         esw->l2_table.size = l2_table_size;
1131
1132         esw->work_queue = create_singlethread_workqueue("mlx5_esw_wq");
1133         if (!esw->work_queue) {
1134                 err = -ENOMEM;
1135                 goto abort;
1136         }
1137
1138         esw->vports = kcalloc(total_vports, sizeof(struct mlx5_vport),
1139                               GFP_KERNEL);
1140         if (!esw->vports) {
1141                 err = -ENOMEM;
1142                 goto abort;
1143         }
1144
1145         for (vport_num = 0; vport_num < total_vports; vport_num++) {
1146                 struct mlx5_vport *vport = &esw->vports[vport_num];
1147
1148                 vport->vport = vport_num;
1149                 vport->dev = dev;
1150                 INIT_WORK(&vport->vport_change_handler,
1151                           esw_vport_change_handler);
1152         }
1153
1154         esw->total_vports = total_vports;
1155         esw->enabled_vports = 0;
1156
1157         dev->priv.eswitch = esw;
1158         esw_enable_vport(esw, 0, UC_ADDR_CHANGE);
1159         /* VF Vports will be enabled when SRIOV is enabled */
1160         return 0;
1161 abort:
1162         if (esw->work_queue)
1163                 destroy_workqueue(esw->work_queue);
1164         kfree(esw->l2_table.bitmap);
1165         kfree(esw->vports);
1166         kfree(esw);
1167         return err;
1168 }
1169
1170 void mlx5_eswitch_cleanup(struct mlx5_eswitch *esw)
1171 {
1172         if (!esw || !MLX5_CAP_GEN(esw->dev, vport_group_manager) ||
1173             MLX5_CAP_GEN(esw->dev, port_type) != MLX5_CAP_PORT_TYPE_ETH)
1174                 return;
1175
1176         esw_info(esw->dev, "cleanup\n");
1177         esw_disable_vport(esw, 0);
1178
1179         esw->dev->priv.eswitch = NULL;
1180         destroy_workqueue(esw->work_queue);
1181         kfree(esw->l2_table.bitmap);
1182         kfree(esw->vports);
1183         kfree(esw);
1184 }
1185
1186 void mlx5_eswitch_vport_event(struct mlx5_eswitch *esw, struct mlx5_eqe *eqe)
1187 {
1188         struct mlx5_eqe_vport_change *vc_eqe = &eqe->data.vport_change;
1189         u16 vport_num = be16_to_cpu(vc_eqe->vport_num);
1190         struct mlx5_vport *vport;
1191
1192         if (!esw) {
1193                 pr_warn("MLX5 E-Switch: vport %d got an event while eswitch is not initialized\n",
1194                         vport_num);
1195                 return;
1196         }
1197
1198         vport = &esw->vports[vport_num];
1199         if (vport->enabled)
1200                 queue_work(esw->work_queue, &vport->vport_change_handler);
1201 }
1202
1203 /* Vport Administration */
1204 #define ESW_ALLOWED(esw) \
1205         (esw && MLX5_CAP_GEN(esw->dev, vport_group_manager) && mlx5_core_is_pf(esw->dev))
1206 #define LEGAL_VPORT(esw, vport) (vport >= 0 && vport < esw->total_vports)
1207
1208 int mlx5_eswitch_set_vport_mac(struct mlx5_eswitch *esw,
1209                                int vport, u8 mac[ETH_ALEN])
1210 {
1211         int err = 0;
1212
1213         if (!ESW_ALLOWED(esw))
1214                 return -EPERM;
1215         if (!LEGAL_VPORT(esw, vport))
1216                 return -EINVAL;
1217
1218         err = mlx5_modify_nic_vport_mac_address(esw->dev, vport, mac);
1219         if (err) {
1220                 mlx5_core_warn(esw->dev,
1221                                "Failed to mlx5_modify_nic_vport_mac vport(%d) err=(%d)\n",
1222                                vport, err);
1223                 return err;
1224         }
1225
1226         return err;
1227 }
1228
1229 int mlx5_eswitch_set_vport_state(struct mlx5_eswitch *esw,
1230                                  int vport, int link_state)
1231 {
1232         if (!ESW_ALLOWED(esw))
1233                 return -EPERM;
1234         if (!LEGAL_VPORT(esw, vport))
1235                 return -EINVAL;
1236
1237         return mlx5_modify_vport_admin_state(esw->dev,
1238                                              MLX5_QUERY_VPORT_STATE_IN_OP_MOD_ESW_VPORT,
1239                                              vport, link_state);
1240 }
1241
1242 int mlx5_eswitch_get_vport_config(struct mlx5_eswitch *esw,
1243                                   int vport, struct ifla_vf_info *ivi)
1244 {
1245         u16 vlan;
1246         u8 qos;
1247
1248         if (!ESW_ALLOWED(esw))
1249                 return -EPERM;
1250         if (!LEGAL_VPORT(esw, vport))
1251                 return -EINVAL;
1252
1253         memset(ivi, 0, sizeof(*ivi));
1254         ivi->vf = vport - 1;
1255
1256         mlx5_query_nic_vport_mac_address(esw->dev, vport, ivi->mac);
1257         ivi->linkstate = mlx5_query_vport_admin_state(esw->dev,
1258                                                       MLX5_QUERY_VPORT_STATE_IN_OP_MOD_ESW_VPORT,
1259                                                       vport);
1260         query_esw_vport_cvlan(esw->dev, vport, &vlan, &qos);
1261         ivi->vlan = vlan;
1262         ivi->qos = qos;
1263         ivi->spoofchk = 0;
1264
1265         return 0;
1266 }
1267
1268 int mlx5_eswitch_set_vport_vlan(struct mlx5_eswitch *esw,
1269                                 int vport, u16 vlan, u8 qos)
1270 {
1271         int set = 0;
1272
1273         if (!ESW_ALLOWED(esw))
1274                 return -EPERM;
1275         if (!LEGAL_VPORT(esw, vport) || (vlan > 4095) || (qos > 7))
1276                 return -EINVAL;
1277
1278         if (vlan || qos)
1279                 set = 1;
1280
1281         return modify_esw_vport_cvlan(esw->dev, vport, vlan, qos, set);
1282 }
1283
1284 int mlx5_eswitch_get_vport_stats(struct mlx5_eswitch *esw,
1285                                  int vport,
1286                                  struct ifla_vf_stats *vf_stats)
1287 {
1288         int outlen = MLX5_ST_SZ_BYTES(query_vport_counter_out);
1289         u32 in[MLX5_ST_SZ_DW(query_vport_counter_in)];
1290         int err = 0;
1291         u32 *out;
1292
1293         if (!ESW_ALLOWED(esw))
1294                 return -EPERM;
1295         if (!LEGAL_VPORT(esw, vport))
1296                 return -EINVAL;
1297
1298         out = mlx5_vzalloc(outlen);
1299         if (!out)
1300                 return -ENOMEM;
1301
1302         memset(in, 0, sizeof(in));
1303
1304         MLX5_SET(query_vport_counter_in, in, opcode,
1305                  MLX5_CMD_OP_QUERY_VPORT_COUNTER);
1306         MLX5_SET(query_vport_counter_in, in, op_mod, 0);
1307         MLX5_SET(query_vport_counter_in, in, vport_number, vport);
1308         if (vport)
1309                 MLX5_SET(query_vport_counter_in, in, other_vport, 1);
1310
1311         memset(out, 0, outlen);
1312         err = mlx5_cmd_exec(esw->dev, in, sizeof(in), out, outlen);
1313         if (err)
1314                 goto free_out;
1315
1316         #define MLX5_GET_CTR(p, x) \
1317                 MLX5_GET64(query_vport_counter_out, p, x)
1318
1319         memset(vf_stats, 0, sizeof(*vf_stats));
1320         vf_stats->rx_packets =
1321                 MLX5_GET_CTR(out, received_eth_unicast.packets) +
1322                 MLX5_GET_CTR(out, received_eth_multicast.packets) +
1323                 MLX5_GET_CTR(out, received_eth_broadcast.packets);
1324
1325         vf_stats->rx_bytes =
1326                 MLX5_GET_CTR(out, received_eth_unicast.octets) +
1327                 MLX5_GET_CTR(out, received_eth_multicast.octets) +
1328                 MLX5_GET_CTR(out, received_eth_broadcast.octets);
1329
1330         vf_stats->tx_packets =
1331                 MLX5_GET_CTR(out, transmitted_eth_unicast.packets) +
1332                 MLX5_GET_CTR(out, transmitted_eth_multicast.packets) +
1333                 MLX5_GET_CTR(out, transmitted_eth_broadcast.packets);
1334
1335         vf_stats->tx_bytes =
1336                 MLX5_GET_CTR(out, transmitted_eth_unicast.octets) +
1337                 MLX5_GET_CTR(out, transmitted_eth_multicast.octets) +
1338                 MLX5_GET_CTR(out, transmitted_eth_broadcast.octets);
1339
1340         vf_stats->multicast =
1341                 MLX5_GET_CTR(out, received_eth_multicast.packets);
1342
1343         vf_stats->broadcast =
1344                 MLX5_GET_CTR(out, received_eth_broadcast.packets);
1345
1346 free_out:
1347         kvfree(out);
1348         return err;
1349 }