drivers/net/ethernet/intel/ixgbe/ixgbe_sriov.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /* Copyright(c) 1999 - 2018 Intel Corporation. */
   3
   4 #include <linux/types.h>
   5 #include <linux/module.h>
   6 #include <linux/pci.h>
   7 #include <linux/netdevice.h>
   8 #include <linux/vmalloc.h>
   9 #include <linux/string.h>
  10 #include <linux/in.h>
  11 #include <linux/ip.h>
  12 #include <linux/tcp.h>
  13 #include <linux/ipv6.h>
  14 #include <linux/if_bridge.h>
  15 #ifdef NETIF_F_HW_VLAN_CTAG_TX
  16 #include <linux/if_vlan.h>
  17 #endif
  18
  19 #include "ixgbe.h"
  20 #include "ixgbe_type.h"
  21 #include "ixgbe_sriov.h"
  22
  23 #ifdef CONFIG_PCI_IOV
  24 static inline void ixgbe_alloc_vf_macvlans(struct ixgbe_adapter *adapter,
  25                                            unsigned int num_vfs)
  26 {
  27         struct ixgbe_hw *hw = &adapter->hw;
  28         struct vf_macvlans *mv_list;
  29         int num_vf_macvlans, i;
  30
  31         num_vf_macvlans = hw->mac.num_rar_entries -
  32                           (IXGBE_MAX_PF_MACVLANS + 1 + num_vfs);
  33         if (!num_vf_macvlans)
  34                 return;
  35
  36         mv_list = kcalloc(num_vf_macvlans, sizeof(struct vf_macvlans),
  37                           GFP_KERNEL);
  38         if (mv_list) {
  39                 /* Initialize list of VF macvlans */
  40                 INIT_LIST_HEAD(&adapter->vf_mvs.l);
  41                 for (i = 0; i < num_vf_macvlans; i++) {
  42                         mv_list[i].vf = -1;
  43                         mv_list[i].free = true;
  44                         list_add(&mv_list[i].l, &adapter->vf_mvs.l);
  45                 }
  46                 adapter->mv_list = mv_list;
  47         }
  48 }
  49
  50 static int __ixgbe_enable_sriov(struct ixgbe_adapter *adapter,
  51                                 unsigned int num_vfs)
  52 {
  53         struct ixgbe_hw *hw = &adapter->hw;
  54         int i;
  55
  56         /* Enable VMDq flag so device will be set in VM mode */
  57         adapter->flags |= IXGBE_FLAG_SRIOV_ENABLED |
  58                           IXGBE_FLAG_VMDQ_ENABLED;
  59
  60         /* Allocate memory for per VF control structures */
  61         adapter->vfinfo = kcalloc(num_vfs, sizeof(struct vf_data_storage),
  62                                   GFP_KERNEL);
  63         if (!adapter->vfinfo)
  64                 return -ENOMEM;
  65
  66         adapter->num_vfs = num_vfs;
  67
  68         ixgbe_alloc_vf_macvlans(adapter, num_vfs);
  69         adapter->ring_feature[RING_F_VMDQ].offset = num_vfs;
  70
  71         /* Initialize default switching mode VEB */
  72         IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);
  73         adapter->bridge_mode = BRIDGE_MODE_VEB;
  74
  75         /* limit trafffic classes based on VFs enabled */
  76         if ((adapter->hw.mac.type == ixgbe_mac_82599EB) && (num_vfs < 16)) {
  77                 adapter->dcb_cfg.num_tcs.pg_tcs = MAX_TRAFFIC_CLASS;
  78                 adapter->dcb_cfg.num_tcs.pfc_tcs = MAX_TRAFFIC_CLASS;
  79         } else if (num_vfs < 32) {
  80                 adapter->dcb_cfg.num_tcs.pg_tcs = 4;
  81                 adapter->dcb_cfg.num_tcs.pfc_tcs = 4;
  82         } else {
  83                 adapter->dcb_cfg.num_tcs.pg_tcs = 1;
  84                 adapter->dcb_cfg.num_tcs.pfc_tcs = 1;
  85         }
  86
  87         /* Disable RSC when in SR-IOV mode */
  88         adapter->flags2 &= ~(IXGBE_FLAG2_RSC_CAPABLE |
  89                              IXGBE_FLAG2_RSC_ENABLED);
  90
  91         for (i = 0; i < num_vfs; i++) {
  92                 /* enable spoof checking for all VFs */
  93                 adapter->vfinfo[i].spoofchk_enabled = true;
  94
  95                 /* We support VF RSS querying only for 82599 and x540
  96                  * devices at the moment. These devices share RSS
  97                  * indirection table and RSS hash key with PF therefore
  98                  * we want to disable the querying by default.
  99                  */
 100                 adapter->vfinfo[i].rss_query_enabled = 0;
 101
 102                 /* Untrust all VFs */
 103                 adapter->vfinfo[i].trusted = false;
 104
 105                 /* set the default xcast mode */
 106                 adapter->vfinfo[i].xcast_mode = IXGBEVF_XCAST_MODE_NONE;
 107         }
 108
 109         e_info(probe, "SR-IOV enabled with %d VFs\n", num_vfs);
 110         return 0;
 111 }
 112
 113 /**
 114  * ixgbe_get_vfs - Find and take references to all vf devices
 115  * @adapter: Pointer to adapter struct
 116  */
 117 static void ixgbe_get_vfs(struct ixgbe_adapter *adapter)
 118 {
 119         struct pci_dev *pdev = adapter->pdev;
 120         u16 vendor = pdev->vendor;
 121         struct pci_dev *vfdev;
 122         int vf = 0;
 123         u16 vf_id;
 124         int pos;
 125
 126         pos = pci_find_ext_capability(pdev, PCI_EXT_CAP_ID_SRIOV);
 127         if (!pos)
 128                 return;
 129         pci_read_config_word(pdev, pos + PCI_SRIOV_VF_DID, &vf_id);
 130
 131         vfdev = pci_get_device(vendor, vf_id, NULL);
 132         for (; vfdev; vfdev = pci_get_device(vendor, vf_id, vfdev)) {
 133                 if (!vfdev->is_virtfn)
 134                         continue;
 135                 if (vfdev->physfn != pdev)
 136                         continue;
 137                 if (vf >= adapter->num_vfs)
 138                         continue;
 139                 pci_dev_get(vfdev);
 140                 adapter->vfinfo[vf].vfdev = vfdev;
 141                 ++vf;
 142         }
 143 }
 144
 145 /* Note this function is called when the user wants to enable SR-IOV
 146  * VFs using the now deprecated module parameter
 147  */
 148 void ixgbe_enable_sriov(struct ixgbe_adapter *adapter, unsigned int max_vfs)
 149 {
 150         int pre_existing_vfs = 0;
 151         unsigned int num_vfs;
 152
 153         pre_existing_vfs = pci_num_vf(adapter->pdev);
 154         if (!pre_existing_vfs && !max_vfs)
 155                 return;
 156
 157         /* If there are pre-existing VFs then we have to force
 158          * use of that many - over ride any module parameter value.
 159          * This may result from the user unloading the PF driver
 160          * while VFs were assigned to guest VMs or because the VFs
 161          * have been created via the new PCI SR-IOV sysfs interface.
 162          */
 163         if (pre_existing_vfs) {
 164                 num_vfs = pre_existing_vfs;
 165                 dev_warn(&adapter->pdev->dev,
 166                          "Virtual Functions already enabled for this device - Please reload all VF drivers to avoid spoofed packet errors\n");
 167         } else {
 168                 int err;
 169                 /*
 170                  * The 82599 supports up to 64 VFs per physical function
 171                  * but this implementation limits allocation to 63 so that
 172                  * basic networking resources are still available to the
 173                  * physical function.  If the user requests greater than
 174                  * 63 VFs then it is an error - reset to default of zero.
 175                  */
 176                 num_vfs = min_t(unsigned int, max_vfs, IXGBE_MAX_VFS_DRV_LIMIT);
 177
 178                 err = pci_enable_sriov(adapter->pdev, num_vfs);
 179                 if (err) {
 180                         e_err(probe, "Failed to enable PCI sriov: %d\n", err);
 181                         return;
 182                 }
 183         }
 184
 185         if (!__ixgbe_enable_sriov(adapter, num_vfs)) {
 186                 ixgbe_get_vfs(adapter);
 187                 return;
 188         }
 189
 190         /* If we have gotten to this point then there is no memory available
 191          * to manage the VF devices - print message and bail.
 192          */
 193         e_err(probe, "Unable to allocate memory for VF Data Storage - "
 194               "SRIOV disabled\n");
 195         ixgbe_disable_sriov(adapter);
 196 }
 197
 198 #endif /* #ifdef CONFIG_PCI_IOV */
 199 int ixgbe_disable_sriov(struct ixgbe_adapter *adapter)
 200 {
 201         unsigned int num_vfs = adapter->num_vfs, vf;
 202         int rss;
 203
 204         /* set num VFs to 0 to prevent access to vfinfo */
 205         adapter->num_vfs = 0;
 206
 207         /* put the reference to all of the vf devices */
 208         for (vf = 0; vf < num_vfs; ++vf) {
 209                 struct pci_dev *vfdev = adapter->vfinfo[vf].vfdev;
 210
 211                 if (!vfdev)
 212                         continue;
 213                 adapter->vfinfo[vf].vfdev = NULL;
 214                 pci_dev_put(vfdev);
 215         }
 216
 217         /* free VF control structures */
 218         kfree(adapter->vfinfo);
 219         adapter->vfinfo = NULL;
 220
 221         /* free macvlan list */
 222         kfree(adapter->mv_list);
 223         adapter->mv_list = NULL;
 224
 225         /* if SR-IOV is already disabled then there is nothing to do */
 226         if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
 227                 return 0;
 228
 229 #ifdef CONFIG_PCI_IOV
 230         /*
 231          * If our VFs are assigned we cannot shut down SR-IOV
 232          * without causing issues, so just leave the hardware
 233          * available but disabled
 234          */
 235         if (pci_vfs_assigned(adapter->pdev)) {
 236                 e_dev_warn("Unloading driver while VFs are assigned - VFs will not be deallocated\n");
 237                 return -EPERM;
 238         }
 239         /* disable iov and allow time for transactions to clear */
 240         pci_disable_sriov(adapter->pdev);
 241 #endif
 242
 243         /* Disable VMDq flag so device will be set in VM mode */
 244         if (bitmap_weight(adapter->fwd_bitmask, adapter->num_rx_pools) == 1) {
 245                 adapter->flags &= ~IXGBE_FLAG_VMDQ_ENABLED;
 246                 adapter->flags &= ~IXGBE_FLAG_SRIOV_ENABLED;
 247                 rss = min_t(int, ixgbe_max_rss_indices(adapter),
 248                             num_online_cpus());
 249         } else {
 250                 rss = min_t(int, IXGBE_MAX_L2A_QUEUES, num_online_cpus());
 251         }
 252
 253         adapter->ring_feature[RING_F_VMDQ].offset = 0;
 254         adapter->ring_feature[RING_F_RSS].limit = rss;
 255
 256         /* take a breather then clean up driver data */
 257         msleep(100);
 258         return 0;
 259 }
 260
 261 static int ixgbe_pci_sriov_enable(struct pci_dev *dev, int num_vfs)
 262 {
 263 #ifdef CONFIG_PCI_IOV
 264         struct ixgbe_adapter *adapter = pci_get_drvdata(dev);
 265         int pre_existing_vfs = pci_num_vf(dev);
 266         int err = 0, num_rx_pools, i, limit;
 267         u8 num_tc;
 268
 269         if (pre_existing_vfs && pre_existing_vfs != num_vfs)
 270                 err = ixgbe_disable_sriov(adapter);
 271         else if (pre_existing_vfs && pre_existing_vfs == num_vfs)
 272                 return num_vfs;
 273
 274         if (err)
 275                 return err;
 276
 277         /* While the SR-IOV capability structure reports total VFs to be 64,
 278          * we limit the actual number allocated as below based on two factors.
 279          *    Num_TCs   MAX_VFs
 280          *      1         63
 281          *      <=4       31
 282          *      >4        15
 283          * First, we reserve some transmit/receive resources for the PF.
 284          * Second, VMDQ also uses the same pools that SR-IOV does. We need to
 285          * account for this, so that we don't accidentally allocate more VFs
 286          * than we have available pools. The PCI bus driver already checks for
 287          * other values out of range.
 288          */
 289         num_tc = adapter->hw_tcs;
 290         num_rx_pools = bitmap_weight(adapter->fwd_bitmask,
 291                                      adapter->num_rx_pools);
 292         limit = (num_tc > 4) ? IXGBE_MAX_VFS_8TC :
 293                 (num_tc > 1) ? IXGBE_MAX_VFS_4TC : IXGBE_MAX_VFS_1TC;
 294
 295         if (num_vfs > (limit - num_rx_pools)) {
 296                 e_dev_err("Currently configured with %d TCs, and %d offloaded macvlans. Creating more than %d VFs is not allowed\n",
 297                           num_tc, num_rx_pools - 1, limit - num_rx_pools);
 298                 return -EPERM;
 299         }
 300
 301         err = __ixgbe_enable_sriov(adapter, num_vfs);
 302         if (err)
 303                 return  err;
 304
 305         for (i = 0; i < num_vfs; i++)
 306                 ixgbe_vf_configuration(dev, (i | 0x10000000));
 307
 308         /* reset before enabling SRIOV to avoid mailbox issues */
 309         ixgbe_sriov_reinit(adapter);
 310
 311         err = pci_enable_sriov(dev, num_vfs);
 312         if (err) {
 313                 e_dev_warn("Failed to enable PCI sriov: %d\n", err);
 314                 return err;
 315         }
 316         ixgbe_get_vfs(adapter);
 317
 318         return num_vfs;
 319 #else
 320         return 0;
 321 #endif
 322 }
 323
 324 static int ixgbe_pci_sriov_disable(struct pci_dev *dev)
 325 {
 326         struct ixgbe_adapter *adapter = pci_get_drvdata(dev);
 327         int err;
 328 #ifdef CONFIG_PCI_IOV
 329         u32 current_flags = adapter->flags;
 330         int prev_num_vf = pci_num_vf(dev);
 331 #endif
 332
 333         err = ixgbe_disable_sriov(adapter);
 334
 335         /* Only reinit if no error and state changed */
 336 #ifdef CONFIG_PCI_IOV
 337         if (!err && (current_flags != adapter->flags ||
 338                      prev_num_vf != pci_num_vf(dev)))
 339                 ixgbe_sriov_reinit(adapter);
 340 #endif
 341
 342         return err;
 343 }
 344
 345 int ixgbe_pci_sriov_configure(struct pci_dev *dev, int num_vfs)
 346 {
 347         if (num_vfs == 0)
 348                 return ixgbe_pci_sriov_disable(dev);
 349         else
 350                 return ixgbe_pci_sriov_enable(dev, num_vfs);
 351 }
 352
 353 static int ixgbe_set_vf_multicasts(struct ixgbe_adapter *adapter,
 354                                    u32 *msgbuf, u32 vf)
 355 {
 356         int entries = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
 357                        >> IXGBE_VT_MSGINFO_SHIFT;
 358         u16 *hash_list = (u16 *)&msgbuf[1];
 359         struct vf_data_storage *vfinfo = &adapter->vfinfo[vf];
 360         struct ixgbe_hw *hw = &adapter->hw;
 361         int i;
 362         u32 vector_bit;
 363         u32 vector_reg;
 364         u32 mta_reg;
 365         u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
 366
 367         /* only so many hash values supported */
 368         entries = min(entries, IXGBE_MAX_VF_MC_ENTRIES);
 369
 370         /*
 371          * salt away the number of multi cast addresses assigned
 372          * to this VF for later use to restore when the PF multi cast
 373          * list changes
 374          */
 375         vfinfo->num_vf_mc_hashes = entries;
 376
 377         /*
 378          * VFs are limited to using the MTA hash table for their multicast
 379          * addresses
 380          */
 381         for (i = 0; i < entries; i++) {
 382                 vfinfo->vf_mc_hashes[i] = hash_list[i];
 383         }
 384
 385         for (i = 0; i < vfinfo->num_vf_mc_hashes; i++) {
 386                 vector_reg = (vfinfo->vf_mc_hashes[i] >> 5) & 0x7F;
 387                 vector_bit = vfinfo->vf_mc_hashes[i] & 0x1F;
 388                 mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
 389                 mta_reg |= BIT(vector_bit);
 390                 IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
 391         }
 392         vmolr |= IXGBE_VMOLR_ROMPE;
 393         IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
 394
 395         return 0;
 396 }
 397
 398 #ifdef CONFIG_PCI_IOV
 399 void ixgbe_restore_vf_multicasts(struct ixgbe_adapter *adapter)
 400 {
 401         struct ixgbe_hw *hw = &adapter->hw;
 402         struct vf_data_storage *vfinfo;
 403         int i, j;
 404         u32 vector_bit;
 405         u32 vector_reg;
 406         u32 mta_reg;
 407
 408         for (i = 0; i < adapter->num_vfs; i++) {
 409                 u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(i));
 410                 vfinfo = &adapter->vfinfo[i];
 411                 for (j = 0; j < vfinfo->num_vf_mc_hashes; j++) {
 412                         hw->addr_ctrl.mta_in_use++;
 413                         vector_reg = (vfinfo->vf_mc_hashes[j] >> 5) & 0x7F;
 414                         vector_bit = vfinfo->vf_mc_hashes[j] & 0x1F;
 415                         mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
 416                         mta_reg |= BIT(vector_bit);
 417                         IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
 418                 }
 419
 420                 if (vfinfo->num_vf_mc_hashes)
 421                         vmolr |= IXGBE_VMOLR_ROMPE;
 422                 else
 423                         vmolr &= ~IXGBE_VMOLR_ROMPE;
 424                 IXGBE_WRITE_REG(hw, IXGBE_VMOLR(i), vmolr);
 425         }
 426
 427         /* Restore any VF macvlans */
 428         ixgbe_full_sync_mac_table(adapter);
 429 }
 430 #endif
 431
 432 static int ixgbe_set_vf_vlan(struct ixgbe_adapter *adapter, int add, int vid,
 433                              u32 vf)
 434 {
 435         struct ixgbe_hw *hw = &adapter->hw;
 436         int err;
 437
 438         /* If VLAN overlaps with one the PF is currently monitoring make
 439          * sure that we are able to allocate a VLVF entry.  This may be
 440          * redundant but it guarantees PF will maintain visibility to
 441          * the VLAN.
 442          */
 443         if (add && test_bit(vid, adapter->active_vlans)) {
 444                 err = hw->mac.ops.set_vfta(hw, vid, VMDQ_P(0), true, false);
 445                 if (err)
 446                         return err;
 447         }
 448
 449         err = hw->mac.ops.set_vfta(hw, vid, vf, !!add, false);
 450
 451         if (add && !err)
 452                 return err;
 453
 454         /* If we failed to add the VF VLAN or we are removing the VF VLAN
 455          * we may need to drop the PF pool bit in order to allow us to free
 456          * up the VLVF resources.
 457          */
 458         if (test_bit(vid, adapter->active_vlans) ||
 459             (adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
 460                 ixgbe_update_pf_promisc_vlvf(adapter, vid);
 461
 462         return err;
 463 }
 464
 465 static s32 ixgbe_set_vf_lpe(struct ixgbe_adapter *adapter, u32 *msgbuf, u32 vf)
 466 {
 467         struct ixgbe_hw *hw = &adapter->hw;
 468         int max_frame = msgbuf[1];
 469         u32 max_frs;
 470
 471         /*
 472          * For 82599EB we have to keep all PFs and VFs operating with
 473          * the same max_frame value in order to avoid sending an oversize
 474          * frame to a VF.  In order to guarantee this is handled correctly
 475          * for all cases we have several special exceptions to take into
 476          * account before we can enable the VF for receive
 477          */
 478         if (adapter->hw.mac.type == ixgbe_mac_82599EB) {
 479                 struct net_device *dev = adapter->netdev;
 480                 int pf_max_frame = dev->mtu + ETH_HLEN;
 481                 u32 reg_offset, vf_shift, vfre;
 482                 s32 err = 0;
 483
 484 #ifdef CONFIG_FCOE
 485                 if (dev->features & NETIF_F_FCOE_MTU)
 486                         pf_max_frame = max_t(int, pf_max_frame,
 487                                              IXGBE_FCOE_JUMBO_FRAME_SIZE);
 488
 489 #endif /* CONFIG_FCOE */
 490                 switch (adapter->vfinfo[vf].vf_api) {
 491                 case ixgbe_mbox_api_11:
 492                 case ixgbe_mbox_api_12:
 493                 case ixgbe_mbox_api_13:
 494                         /* Version 1.1 supports jumbo frames on VFs if PF has
 495                          * jumbo frames enabled which means legacy VFs are
 496                          * disabled
 497                          */
 498                         if (pf_max_frame > ETH_FRAME_LEN)
 499                                 break;
 500                         /* fall through */
 501                 default:
 502                         /* If the PF or VF are running w/ jumbo frames enabled
 503                          * we need to shut down the VF Rx path as we cannot
 504                          * support jumbo frames on legacy VFs
 505                          */
 506                         if ((pf_max_frame > ETH_FRAME_LEN) ||
 507                             (max_frame > (ETH_FRAME_LEN + ETH_FCS_LEN)))
 508                                 err = -EINVAL;
 509                         break;
 510                 }
 511
 512                 /* determine VF receive enable location */
 513                 vf_shift = vf % 32;
 514                 reg_offset = vf / 32;
 515
 516                 /* enable or disable receive depending on error */
 517                 vfre = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
 518                 if (err)
 519                         vfre &= ~BIT(vf_shift);
 520                 else
 521                         vfre |= BIT(vf_shift);
 522                 IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), vfre);
 523
 524                 if (err) {
 525                         e_err(drv, "VF max_frame %d out of range\n", max_frame);
 526                         return err;
 527                 }
 528         }
 529
 530         /* MTU < 68 is an error and causes problems on some kernels */
 531         if (max_frame > IXGBE_MAX_JUMBO_FRAME_SIZE) {
 532                 e_err(drv, "VF max_frame %d out of range\n", max_frame);
 533                 return -EINVAL;
 534         }
 535
 536         /* pull current max frame size from hardware */
 537         max_frs = IXGBE_READ_REG(hw, IXGBE_MAXFRS);
 538         max_frs &= IXGBE_MHADD_MFS_MASK;
 539         max_frs >>= IXGBE_MHADD_MFS_SHIFT;
 540
 541         if (max_frs < max_frame) {
 542                 max_frs = max_frame << IXGBE_MHADD_MFS_SHIFT;
 543                 IXGBE_WRITE_REG(hw, IXGBE_MAXFRS, max_frs);
 544         }
 545
 546         e_info(hw, "VF requests change max MTU to %d\n", max_frame);
 547
 548         return 0;
 549 }
 550
 551 static void ixgbe_set_vmolr(struct ixgbe_hw *hw, u32 vf, bool aupe)
 552 {
 553         u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
 554         vmolr |= IXGBE_VMOLR_BAM;
 555         if (aupe)
 556                 vmolr |= IXGBE_VMOLR_AUPE;
 557         else
 558                 vmolr &= ~IXGBE_VMOLR_AUPE;
 559         IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
 560 }
 561
 562 static void ixgbe_clear_vmvir(struct ixgbe_adapter *adapter, u32 vf)
 563 {
 564         struct ixgbe_hw *hw = &adapter->hw;
 565
 566         IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf), 0);
 567 }
 568
 569 static void ixgbe_clear_vf_vlans(struct ixgbe_adapter *adapter, u32 vf)
 570 {
 571         struct ixgbe_hw *hw = &adapter->hw;
 572         u32 vlvfb_mask, pool_mask, i;
 573
 574         /* create mask for VF and other pools */
 575         pool_mask = ~BIT(VMDQ_P(0) % 32);
 576         vlvfb_mask = BIT(vf % 32);
 577
 578         /* post increment loop, covers VLVF_ENTRIES - 1 to 0 */
 579         for (i = IXGBE_VLVF_ENTRIES; i--;) {
 580                 u32 bits[2], vlvfb, vid, vfta, vlvf;
 581                 u32 word = i * 2 + vf / 32;
 582                 u32 mask;
 583
 584                 vlvfb = IXGBE_READ_REG(hw, IXGBE_VLVFB(word));
 585
 586                 /* if our bit isn't set we can skip it */
 587                 if (!(vlvfb & vlvfb_mask))
 588                         continue;
 589
 590                 /* clear our bit from vlvfb */
 591                 vlvfb ^= vlvfb_mask;
 592
 593                 /* create 64b mask to chedk to see if we should clear VLVF */
 594                 bits[word % 2] = vlvfb;
 595                 bits[~word % 2] = IXGBE_READ_REG(hw, IXGBE_VLVFB(word ^ 1));
 596
 597                 /* if other pools are present, just remove ourselves */
 598                 if (bits[(VMDQ_P(0) / 32) ^ 1] ||
 599                     (bits[VMDQ_P(0) / 32] & pool_mask))
 600                         goto update_vlvfb;
 601
 602                 /* if PF is present, leave VFTA */
 603                 if (bits[0] || bits[1])
 604                         goto update_vlvf;
 605
 606                 /* if we cannot determine VLAN just remove ourselves */
 607                 vlvf = IXGBE_READ_REG(hw, IXGBE_VLVF(i));
 608                 if (!vlvf)
 609                         goto update_vlvfb;
 610
 611                 vid = vlvf & VLAN_VID_MASK;
 612                 mask = BIT(vid % 32);
 613
 614                 /* clear bit from VFTA */
 615                 vfta = IXGBE_READ_REG(hw, IXGBE_VFTA(vid / 32));
 616                 if (vfta & mask)
 617                         IXGBE_WRITE_REG(hw, IXGBE_VFTA(vid / 32), vfta ^ mask);
 618 update_vlvf:
 619                 /* clear POOL selection enable */
 620                 IXGBE_WRITE_REG(hw, IXGBE_VLVF(i), 0);
 621
 622                 if (!(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
 623                         vlvfb = 0;
 624 update_vlvfb:
 625                 /* clear pool bits */
 626                 IXGBE_WRITE_REG(hw, IXGBE_VLVFB(word), vlvfb);
 627         }
 628 }
 629
 630 static int ixgbe_set_vf_macvlan(struct ixgbe_adapter *adapter,
 631                                 int vf, int index, unsigned char *mac_addr)
 632 {
 633         struct vf_macvlans *entry;
 634         struct list_head *pos;
 635         int retval = 0;
 636
 637         if (index <= 1) {
 638                 list_for_each(pos, &adapter->vf_mvs.l) {
 639                         entry = list_entry(pos, struct vf_macvlans, l);
 640                         if (entry->vf == vf) {
 641                                 entry->vf = -1;
 642                                 entry->free = true;
 643                                 entry->is_macvlan = false;
 644                                 ixgbe_del_mac_filter(adapter,
 645                                                      entry->vf_macvlan, vf);
 646                         }
 647                 }
 648         }
 649
 650         /*
 651          * If index was zero then we were asked to clear the uc list
 652          * for the VF.  We're done.
 653          */
 654         if (!index)
 655                 return 0;
 656
 657         entry = NULL;
 658
 659         list_for_each(pos, &adapter->vf_mvs.l) {
 660                 entry = list_entry(pos, struct vf_macvlans, l);
 661                 if (entry->free)
 662                         break;
 663         }
 664
 665         /*
 666          * If we traversed the entire list and didn't find a free entry
 667          * then we're out of space on the RAR table.  Also entry may
 668          * be NULL because the original memory allocation for the list
 669          * failed, which is not fatal but does mean we can't support
 670          * VF requests for MACVLAN because we couldn't allocate
 671          * memory for the list management required.
 672          */
 673         if (!entry || !entry->free)
 674                 return -ENOSPC;
 675
 676         retval = ixgbe_add_mac_filter(adapter, mac_addr, vf);
 677         if (retval < 0)
 678                 return retval;
 679
 680         entry->free = false;
 681         entry->is_macvlan = true;
 682         entry->vf = vf;
 683         memcpy(entry->vf_macvlan, mac_addr, ETH_ALEN);
 684
 685         return 0;
 686 }
 687
 688 static inline void ixgbe_vf_reset_event(struct ixgbe_adapter *adapter, u32 vf)
 689 {
 690         struct ixgbe_hw *hw = &adapter->hw;
 691         struct vf_data_storage *vfinfo = &adapter->vfinfo[vf];
 692         u8 num_tcs = adapter->hw_tcs;
 693
 694         /* remove VLAN filters beloning to this VF */
 695         ixgbe_clear_vf_vlans(adapter, vf);
 696
 697         /* add back PF assigned VLAN or VLAN 0 */
 698         ixgbe_set_vf_vlan(adapter, true, vfinfo->pf_vlan, vf);
 699
 700         /* reset offloads to defaults */
 701         ixgbe_set_vmolr(hw, vf, !vfinfo->pf_vlan);
 702
 703         /* set outgoing tags for VFs */
 704         if (!vfinfo->pf_vlan && !vfinfo->pf_qos && !num_tcs) {
 705                 ixgbe_clear_vmvir(adapter, vf);
 706         } else {
 707                 if (vfinfo->pf_qos || !num_tcs)
 708                         ixgbe_set_vmvir(adapter, vfinfo->pf_vlan,
 709                                         vfinfo->pf_qos, vf);
 710                 else
 711                         ixgbe_set_vmvir(adapter, vfinfo->pf_vlan,
 712                                         adapter->default_up, vf);
 713
 714                 if (vfinfo->spoofchk_enabled)
 715                         hw->mac.ops.set_vlan_anti_spoofing(hw, true, vf);
 716         }
 717
 718         /* reset multicast table array for vf */
 719         adapter->vfinfo[vf].num_vf_mc_hashes = 0;
 720
 721         /* Flush and reset the mta with the new values */
 722         ixgbe_set_rx_mode(adapter->netdev);
 723
 724         ixgbe_del_mac_filter(adapter, adapter->vfinfo[vf].vf_mac_addresses, vf);
 725         ixgbe_set_vf_macvlan(adapter, vf, 0, NULL);
 726
 727         /* reset VF api back to unknown */
 728         adapter->vfinfo[vf].vf_api = ixgbe_mbox_api_10;
 729 }
 730
 731 static int ixgbe_set_vf_mac(struct ixgbe_adapter *adapter,
 732                             int vf, unsigned char *mac_addr)
 733 {
 734         s32 retval;
 735
 736         ixgbe_del_mac_filter(adapter, adapter->vfinfo[vf].vf_mac_addresses, vf);
 737         retval = ixgbe_add_mac_filter(adapter, mac_addr, vf);
 738         if (retval >= 0)
 739                 memcpy(adapter->vfinfo[vf].vf_mac_addresses, mac_addr,
 740                        ETH_ALEN);
 741         else
 742                 memset(adapter->vfinfo[vf].vf_mac_addresses, 0, ETH_ALEN);
 743
 744         return retval;
 745 }
 746
 747 int ixgbe_vf_configuration(struct pci_dev *pdev, unsigned int event_mask)
 748 {
 749         struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
 750         unsigned int vfn = (event_mask & 0x3f);
 751
 752         bool enable = ((event_mask & 0x10000000U) != 0);
 753
 754         if (enable)
 755                 eth_zero_addr(adapter->vfinfo[vfn].vf_mac_addresses);
 756
 757         return 0;
 758 }
 759
 760 static inline void ixgbe_write_qde(struct ixgbe_adapter *adapter, u32 vf,
 761                                    u32 qde)
 762 {
 763         struct ixgbe_hw *hw = &adapter->hw;
 764         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
 765         u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
 766         int i;
 767
 768         for (i = vf * q_per_pool; i < ((vf + 1) * q_per_pool); i++) {
 769                 u32 reg;
 770
 771                 /* flush previous write */
 772                 IXGBE_WRITE_FLUSH(hw);
 773
 774                 /* indicate to hardware that we want to set drop enable */
 775                 reg = IXGBE_QDE_WRITE | qde;
 776                 reg |= i <<  IXGBE_QDE_IDX_SHIFT;
 777                 IXGBE_WRITE_REG(hw, IXGBE_QDE, reg);
 778         }
 779 }
 780
 781 static int ixgbe_vf_reset_msg(struct ixgbe_adapter *adapter, u32 vf)
 782 {
 783         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
 784         struct ixgbe_hw *hw = &adapter->hw;
 785         unsigned char *vf_mac = adapter->vfinfo[vf].vf_mac_addresses;
 786         u32 reg, reg_offset, vf_shift;
 787         u32 msgbuf[4] = {0, 0, 0, 0};
 788         u8 *addr = (u8 *)(&msgbuf[1]);
 789         u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
 790         int i;
 791
 792         e_info(probe, "VF Reset msg received from vf %d\n", vf);
 793
 794         /* reset the filters for the device */
 795         ixgbe_vf_reset_event(adapter, vf);
 796
 797         /* set vf mac address */
 798         if (!is_zero_ether_addr(vf_mac))
 799                 ixgbe_set_vf_mac(adapter, vf, vf_mac);
 800
 801         vf_shift = vf % 32;
 802         reg_offset = vf / 32;
 803
 804         /* enable transmit for vf */
 805         reg = IXGBE_READ_REG(hw, IXGBE_VFTE(reg_offset));
 806         reg |= BIT(vf_shift);
 807         IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), reg);
 808
 809         /* force drop enable for all VF Rx queues */
 810         reg = IXGBE_QDE_ENABLE;
 811         if (adapter->vfinfo[vf].pf_vlan)
 812                 reg |= IXGBE_QDE_HIDE_VLAN;
 813
 814         ixgbe_write_qde(adapter, vf, reg);
 815
 816         /* enable receive for vf */
 817         reg = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
 818         reg |= BIT(vf_shift);
 819         /*
 820          * The 82599 cannot support a mix of jumbo and non-jumbo PF/VFs.
 821          * For more info take a look at ixgbe_set_vf_lpe
 822          */
 823         if (adapter->hw.mac.type == ixgbe_mac_82599EB) {
 824                 struct net_device *dev = adapter->netdev;
 825                 int pf_max_frame = dev->mtu + ETH_HLEN;
 826
 827 #ifdef CONFIG_FCOE
 828                 if (dev->features & NETIF_F_FCOE_MTU)
 829                         pf_max_frame = max_t(int, pf_max_frame,
 830                                              IXGBE_FCOE_JUMBO_FRAME_SIZE);
 831
 832 #endif /* CONFIG_FCOE */
 833                 if (pf_max_frame > ETH_FRAME_LEN)
 834                         reg &= ~BIT(vf_shift);
 835         }
 836         IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), reg);
 837
 838         /* enable VF mailbox for further messages */
 839         adapter->vfinfo[vf].clear_to_send = true;
 840
 841         /* Enable counting of spoofed packets in the SSVPC register */
 842         reg = IXGBE_READ_REG(hw, IXGBE_VMECM(reg_offset));
 843         reg |= BIT(vf_shift);
 844         IXGBE_WRITE_REG(hw, IXGBE_VMECM(reg_offset), reg);
 845
 846         /*
 847          * Reset the VFs TDWBAL and TDWBAH registers
 848          * which are not cleared by an FLR
 849          */
 850         for (i = 0; i < q_per_pool; i++) {
 851                 IXGBE_WRITE_REG(hw, IXGBE_PVFTDWBAHn(q_per_pool, vf, i), 0);
 852                 IXGBE_WRITE_REG(hw, IXGBE_PVFTDWBALn(q_per_pool, vf, i), 0);
 853         }
 854
 855         /* reply to reset with ack and vf mac address */
 856         msgbuf[0] = IXGBE_VF_RESET;
 857         if (!is_zero_ether_addr(vf_mac) && adapter->vfinfo[vf].pf_set_mac) {
 858                 msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
 859                 memcpy(addr, vf_mac, ETH_ALEN);
 860         } else {
 861                 msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
 862         }
 863
 864         /*
 865          * Piggyback the multicast filter type so VF can compute the
 866          * correct vectors
 867          */
 868         msgbuf[3] = hw->mac.mc_filter_type;
 869         ixgbe_write_mbx(hw, msgbuf, IXGBE_VF_PERMADDR_MSG_LEN, vf);
 870
 871         return 0;
 872 }
 873
 874 static int ixgbe_set_vf_mac_addr(struct ixgbe_adapter *adapter,
 875                                  u32 *msgbuf, u32 vf)
 876 {
 877         u8 *new_mac = ((u8 *)(&msgbuf[1]));
 878
 879         if (!is_valid_ether_addr(new_mac)) {
 880                 e_warn(drv, "VF %d attempted to set invalid mac\n", vf);
 881                 return -1;
 882         }
 883
 884         if (adapter->vfinfo[vf].pf_set_mac && !adapter->vfinfo[vf].trusted &&
 885             !ether_addr_equal(adapter->vfinfo[vf].vf_mac_addresses, new_mac)) {
 886                 e_warn(drv,
 887                        "VF %d attempted to override administratively set MAC address\n"
 888                        "Reload the VF driver to resume operations\n",
 889                        vf);
 890                 return -1;
 891         }
 892
 893         return ixgbe_set_vf_mac(adapter, vf, new_mac) < 0;
 894 }
 895
 896 static int ixgbe_set_vf_vlan_msg(struct ixgbe_adapter *adapter,
 897                                  u32 *msgbuf, u32 vf)
 898 {
 899         u32 add = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >> IXGBE_VT_MSGINFO_SHIFT;
 900         u32 vid = (msgbuf[1] & IXGBE_VLVF_VLANID_MASK);
 901         u8 tcs = adapter->hw_tcs;
 902
 903         if (adapter->vfinfo[vf].pf_vlan || tcs) {
 904                 e_warn(drv,
 905                        "VF %d attempted to override administratively set VLAN configuration\n"
 906                        "Reload the VF driver to resume operations\n",
 907                        vf);
 908                 return -1;
 909         }
 910
 911         /* VLAN 0 is a special case, don't allow it to be removed */
 912         if (!vid && !add)
 913                 return 0;
 914
 915         return ixgbe_set_vf_vlan(adapter, add, vid, vf);
 916 }
 917
 918 static int ixgbe_set_vf_macvlan_msg(struct ixgbe_adapter *adapter,
 919                                     u32 *msgbuf, u32 vf)
 920 {
 921         u8 *new_mac = ((u8 *)(&msgbuf[1]));
 922         int index = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >>
 923                     IXGBE_VT_MSGINFO_SHIFT;
 924         int err;
 925
 926         if (adapter->vfinfo[vf].pf_set_mac && !adapter->vfinfo[vf].trusted &&
 927             index > 0) {
 928                 e_warn(drv,
 929                        "VF %d requested MACVLAN filter but is administratively denied\n",
 930                        vf);
 931                 return -1;
 932         }
 933
 934         /* An non-zero index indicates the VF is setting a filter */
 935         if (index) {
 936                 if (!is_valid_ether_addr(new_mac)) {
 937                         e_warn(drv, "VF %d attempted to set invalid mac\n", vf);
 938                         return -1;
 939                 }
 940
 941                 /*
 942                  * If the VF is allowed to set MAC filters then turn off
 943                  * anti-spoofing to avoid false positives.
 944                  */
 945                 if (adapter->vfinfo[vf].spoofchk_enabled) {
 946                         struct ixgbe_hw *hw = &adapter->hw;
 947
 948                         hw->mac.ops.set_mac_anti_spoofing(hw, false, vf);
 949                         hw->mac.ops.set_vlan_anti_spoofing(hw, false, vf);
 950                 }
 951         }
 952
 953         err = ixgbe_set_vf_macvlan(adapter, vf, index, new_mac);
 954         if (err == -ENOSPC)
 955                 e_warn(drv,
 956                        "VF %d has requested a MACVLAN filter but there is no space for it\n",
 957                        vf);
 958
 959         return err < 0;
 960 }
 961
 962 static int ixgbe_negotiate_vf_api(struct ixgbe_adapter *adapter,
 963                                   u32 *msgbuf, u32 vf)
 964 {
 965         int api = msgbuf[1];
 966
 967         switch (api) {
 968         case ixgbe_mbox_api_10:
 969         case ixgbe_mbox_api_11:
 970         case ixgbe_mbox_api_12:
 971         case ixgbe_mbox_api_13:
 972                 adapter->vfinfo[vf].vf_api = api;
 973                 return 0;
 974         default:
 975                 break;
 976         }
 977
 978         e_info(drv, "VF %d requested invalid api version %u\n", vf, api);
 979
 980         return -1;
 981 }
 982
 983 static int ixgbe_get_vf_queues(struct ixgbe_adapter *adapter,
 984                                u32 *msgbuf, u32 vf)
 985 {
 986         struct net_device *dev = adapter->netdev;
 987         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
 988         unsigned int default_tc = 0;
 989         u8 num_tcs = adapter->hw_tcs;
 990
 991         /* verify the PF is supporting the correct APIs */
 992         switch (adapter->vfinfo[vf].vf_api) {
 993         case ixgbe_mbox_api_20:
 994         case ixgbe_mbox_api_11:
 995         case ixgbe_mbox_api_12:
 996         case ixgbe_mbox_api_13:
 997                 break;
 998         default:
 999                 return -1;
1000         }
1001
1002         /* only allow 1 Tx queue for bandwidth limiting */
1003         msgbuf[IXGBE_VF_TX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
1004         msgbuf[IXGBE_VF_RX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
1005
1006         /* if TCs > 1 determine which TC belongs to default user priority */
1007         if (num_tcs > 1)
1008                 default_tc = netdev_get_prio_tc_map(dev, adapter->default_up);
1009
1010         /* notify VF of need for VLAN tag stripping, and correct queue */
1011         if (num_tcs)
1012                 msgbuf[IXGBE_VF_TRANS_VLAN] = num_tcs;
1013         else if (adapter->vfinfo[vf].pf_vlan || adapter->vfinfo[vf].pf_qos)
1014                 msgbuf[IXGBE_VF_TRANS_VLAN] = 1;
1015         else
1016                 msgbuf[IXGBE_VF_TRANS_VLAN] = 0;
1017
1018         /* notify VF of default queue */
1019         msgbuf[IXGBE_VF_DEF_QUEUE] = default_tc;
1020
1021         return 0;
1022 }
1023
1024 static int ixgbe_get_vf_reta(struct ixgbe_adapter *adapter, u32 *msgbuf, u32 vf)
1025 {
1026         u32 i, j;
1027         u32 *out_buf = &msgbuf[1];
1028         const u8 *reta = adapter->rss_indir_tbl;
1029         u32 reta_size = ixgbe_rss_indir_tbl_entries(adapter);
1030
1031         /* Check if operation is permitted */
1032         if (!adapter->vfinfo[vf].rss_query_enabled)
1033                 return -EPERM;
1034
1035         /* verify the PF is supporting the correct API */
1036         switch (adapter->vfinfo[vf].vf_api) {
1037         case ixgbe_mbox_api_13:
1038         case ixgbe_mbox_api_12:
1039                 break;
1040         default:
1041                 return -EOPNOTSUPP;
1042         }
1043
1044         /* This mailbox command is supported (required) only for 82599 and x540
1045          * VFs which support up to 4 RSS queues. Therefore we will compress the
1046          * RETA by saving only 2 bits from each entry. This way we will be able
1047          * to transfer the whole RETA in a single mailbox operation.
1048          */
1049         for (i = 0; i < reta_size / 16; i++) {
1050                 out_buf[i] = 0;
1051                 for (j = 0; j < 16; j++)
1052                         out_buf[i] |= (u32)(reta[16 * i + j] & 0x3) << (2 * j);
1053         }
1054
1055         return 0;
1056 }
1057
1058 static int ixgbe_get_vf_rss_key(struct ixgbe_adapter *adapter,
1059                                 u32 *msgbuf, u32 vf)
1060 {
1061         u32 *rss_key = &msgbuf[1];
1062
1063         /* Check if the operation is permitted */
1064         if (!adapter->vfinfo[vf].rss_query_enabled)
1065                 return -EPERM;
1066
1067         /* verify the PF is supporting the correct API */
1068         switch (adapter->vfinfo[vf].vf_api) {
1069         case ixgbe_mbox_api_13:
1070         case ixgbe_mbox_api_12:
1071                 break;
1072         default:
1073                 return -EOPNOTSUPP;
1074         }
1075
1076         memcpy(rss_key, adapter->rss_key, IXGBE_RSS_KEY_SIZE);
1077
1078         return 0;
1079 }
1080
1081 static int ixgbe_update_vf_xcast_mode(struct ixgbe_adapter *adapter,
1082                                       u32 *msgbuf, u32 vf)
1083 {
1084         struct ixgbe_hw *hw = &adapter->hw;
1085         int xcast_mode = msgbuf[1];
1086         u32 vmolr, fctrl, disable, enable;
1087
1088         /* verify the PF is supporting the correct APIs */
1089         switch (adapter->vfinfo[vf].vf_api) {
1090         case ixgbe_mbox_api_12:
1091                 /* promisc introduced in 1.3 version */
1092                 if (xcast_mode == IXGBEVF_XCAST_MODE_PROMISC)
1093                         return -EOPNOTSUPP;
1094                 /* Fall threw */
1095         case ixgbe_mbox_api_13:
1096                 break;
1097         default:
1098                 return -EOPNOTSUPP;
1099         }
1100
1101         if (xcast_mode > IXGBEVF_XCAST_MODE_MULTI &&
1102             !adapter->vfinfo[vf].trusted) {
1103                 xcast_mode = IXGBEVF_XCAST_MODE_MULTI;
1104         }
1105
1106         if (adapter->vfinfo[vf].xcast_mode == xcast_mode)
1107                 goto out;
1108
1109         switch (xcast_mode) {
1110         case IXGBEVF_XCAST_MODE_NONE:
1111                 disable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE |
1112                           IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1113                 enable = 0;
1114                 break;
1115         case IXGBEVF_XCAST_MODE_MULTI:
1116                 disable = IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1117                 enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE;
1118                 break;
1119         case IXGBEVF_XCAST_MODE_ALLMULTI:
1120                 disable = IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1121                 enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE | IXGBE_VMOLR_MPE;
1122                 break;
1123         case IXGBEVF_XCAST_MODE_PROMISC:
1124                 if (hw->mac.type <= ixgbe_mac_82599EB)
1125                         return -EOPNOTSUPP;
1126
1127                 fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
1128                 if (!(fctrl & IXGBE_FCTRL_UPE)) {
1129                         /* VF promisc requires PF in promisc */
1130                         e_warn(drv,
1131                                "Enabling VF promisc requires PF in promisc\n");
1132                         return -EPERM;
1133                 }
1134
1135                 disable = 0;
1136                 enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE |
1137                          IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1138                 break;
1139         default:
1140                 return -EOPNOTSUPP;
1141         }
1142
1143         vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
1144         vmolr &= ~disable;
1145         vmolr |= enable;
1146         IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
1147
1148         adapter->vfinfo[vf].xcast_mode = xcast_mode;
1149
1150 out:
1151         msgbuf[1] = xcast_mode;
1152
1153         return 0;
1154 }
1155
1156 static int ixgbe_rcv_msg_from_vf(struct ixgbe_adapter *adapter, u32 vf)
1157 {
1158         u32 mbx_size = IXGBE_VFMAILBOX_SIZE;
1159         u32 msgbuf[IXGBE_VFMAILBOX_SIZE];
1160         struct ixgbe_hw *hw = &adapter->hw;
1161         s32 retval;
1162
1163         retval = ixgbe_read_mbx(hw, msgbuf, mbx_size, vf);
1164
1165         if (retval) {
1166                 pr_err("Error receiving message from VF\n");
1167                 return retval;
1168         }
1169
1170         /* this is a message we already processed, do nothing */
1171         if (msgbuf[0] & (IXGBE_VT_MSGTYPE_ACK | IXGBE_VT_MSGTYPE_NACK))
1172                 return 0;
1173
1174         /* flush the ack before we write any messages back */
1175         IXGBE_WRITE_FLUSH(hw);
1176
1177         if (msgbuf[0] == IXGBE_VF_RESET)
1178                 return ixgbe_vf_reset_msg(adapter, vf);
1179
1180         /*
1181          * until the vf completes a virtual function reset it should not be
1182          * allowed to start any configuration.
1183          */
1184         if (!adapter->vfinfo[vf].clear_to_send) {
1185                 msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
1186                 ixgbe_write_mbx(hw, msgbuf, 1, vf);
1187                 return 0;
1188         }
1189
1190         switch ((msgbuf[0] & 0xFFFF)) {
1191         case IXGBE_VF_SET_MAC_ADDR:
1192                 retval = ixgbe_set_vf_mac_addr(adapter, msgbuf, vf);
1193                 break;
1194         case IXGBE_VF_SET_MULTICAST:
1195                 retval = ixgbe_set_vf_multicasts(adapter, msgbuf, vf);
1196                 break;
1197         case IXGBE_VF_SET_VLAN:
1198                 retval = ixgbe_set_vf_vlan_msg(adapter, msgbuf, vf);
1199                 break;
1200         case IXGBE_VF_SET_LPE:
1201                 retval = ixgbe_set_vf_lpe(adapter, msgbuf, vf);
1202                 break;
1203         case IXGBE_VF_SET_MACVLAN:
1204                 retval = ixgbe_set_vf_macvlan_msg(adapter, msgbuf, vf);
1205                 break;
1206         case IXGBE_VF_API_NEGOTIATE:
1207                 retval = ixgbe_negotiate_vf_api(adapter, msgbuf, vf);
1208                 break;
1209         case IXGBE_VF_GET_QUEUES:
1210                 retval = ixgbe_get_vf_queues(adapter, msgbuf, vf);
1211                 break;
1212         case IXGBE_VF_GET_RETA:
1213                 retval = ixgbe_get_vf_reta(adapter, msgbuf, vf);
1214                 break;
1215         case IXGBE_VF_GET_RSS_KEY:
1216                 retval = ixgbe_get_vf_rss_key(adapter, msgbuf, vf);
1217                 break;
1218         case IXGBE_VF_UPDATE_XCAST_MODE:
1219                 retval = ixgbe_update_vf_xcast_mode(adapter, msgbuf, vf);
1220                 break;
1221         default:
1222                 e_err(drv, "Unhandled Msg %8.8x\n", msgbuf[0]);
1223                 retval = IXGBE_ERR_MBX;
1224                 break;
1225         }
1226
1227         /* notify the VF of the results of what it sent us */
1228         if (retval)
1229                 msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
1230         else
1231                 msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
1232
1233         msgbuf[0] |= IXGBE_VT_MSGTYPE_CTS;
1234
1235         ixgbe_write_mbx(hw, msgbuf, mbx_size, vf);
1236
1237         return retval;
1238 }
1239
1240 static void ixgbe_rcv_ack_from_vf(struct ixgbe_adapter *adapter, u32 vf)
1241 {
1242         struct ixgbe_hw *hw = &adapter->hw;
1243         u32 msg = IXGBE_VT_MSGTYPE_NACK;
1244
1245         /* if device isn't clear to send it shouldn't be reading either */
1246         if (!adapter->vfinfo[vf].clear_to_send)
1247                 ixgbe_write_mbx(hw, &msg, 1, vf);
1248 }
1249
1250 void ixgbe_msg_task(struct ixgbe_adapter *adapter)
1251 {
1252         struct ixgbe_hw *hw = &adapter->hw;
1253         u32 vf;
1254
1255         for (vf = 0; vf < adapter->num_vfs; vf++) {
1256                 /* process any reset requests */
1257                 if (!ixgbe_check_for_rst(hw, vf))
1258                         ixgbe_vf_reset_event(adapter, vf);
1259
1260                 /* process any messages pending */
1261                 if (!ixgbe_check_for_msg(hw, vf))
1262                         ixgbe_rcv_msg_from_vf(adapter, vf);
1263
1264                 /* process any acks */
1265                 if (!ixgbe_check_for_ack(hw, vf))
1266                         ixgbe_rcv_ack_from_vf(adapter, vf);
1267         }
1268 }
1269
1270 void ixgbe_disable_tx_rx(struct ixgbe_adapter *adapter)
1271 {
1272         struct ixgbe_hw *hw = &adapter->hw;
1273
1274         /* disable transmit and receive for all vfs */
1275         IXGBE_WRITE_REG(hw, IXGBE_VFTE(0), 0);
1276         IXGBE_WRITE_REG(hw, IXGBE_VFTE(1), 0);
1277
1278         IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), 0);
1279         IXGBE_WRITE_REG(hw, IXGBE_VFRE(1), 0);
1280 }
1281
1282 static inline void ixgbe_ping_vf(struct ixgbe_adapter *adapter, int vf)
1283 {
1284         struct ixgbe_hw *hw = &adapter->hw;
1285         u32 ping;
1286
1287         ping = IXGBE_PF_CONTROL_MSG;
1288         if (adapter->vfinfo[vf].clear_to_send)
1289                 ping |= IXGBE_VT_MSGTYPE_CTS;
1290         ixgbe_write_mbx(hw, &ping, 1, vf);
1291 }
1292
1293 void ixgbe_ping_all_vfs(struct ixgbe_adapter *adapter)
1294 {
1295         struct ixgbe_hw *hw = &adapter->hw;
1296         u32 ping;
1297         int i;
1298
1299         for (i = 0 ; i < adapter->num_vfs; i++) {
1300                 ping = IXGBE_PF_CONTROL_MSG;
1301                 if (adapter->vfinfo[i].clear_to_send)
1302                         ping |= IXGBE_VT_MSGTYPE_CTS;
1303                 ixgbe_write_mbx(hw, &ping, 1, i);
1304         }
1305 }
1306
1307 int ixgbe_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
1308 {
1309         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1310         s32 retval;
1311
1312         if (vf >= adapter->num_vfs)
1313                 return -EINVAL;
1314
1315         if (is_valid_ether_addr(mac)) {
1316                 dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n",
1317                          mac, vf);
1318                 dev_info(&adapter->pdev->dev, "Reload the VF driver to make this change effective.");
1319
1320                 retval = ixgbe_set_vf_mac(adapter, vf, mac);
1321                 if (retval >= 0) {
1322                         adapter->vfinfo[vf].pf_set_mac = true;
1323
1324                         if (test_bit(__IXGBE_DOWN, &adapter->state)) {
1325                                 dev_warn(&adapter->pdev->dev, "The VF MAC address has been set, but the PF device is not up.\n");
1326                                 dev_warn(&adapter->pdev->dev, "Bring the PF device up before attempting to use the VF device.\n");
1327                         }
1328                 } else {
1329                         dev_warn(&adapter->pdev->dev, "The VF MAC address was NOT set due to invalid or duplicate MAC address.\n");
1330                 }
1331         } else if (is_zero_ether_addr(mac)) {
1332                 unsigned char *vf_mac_addr =
1333                                            adapter->vfinfo[vf].vf_mac_addresses;
1334
1335                 /* nothing to do */
1336                 if (is_zero_ether_addr(vf_mac_addr))
1337                         return 0;
1338
1339                 dev_info(&adapter->pdev->dev, "removing MAC on VF %d\n", vf);
1340
1341                 retval = ixgbe_del_mac_filter(adapter, vf_mac_addr, vf);
1342                 if (retval >= 0) {
1343                         adapter->vfinfo[vf].pf_set_mac = false;
1344                         memcpy(vf_mac_addr, mac, ETH_ALEN);
1345                 } else {
1346                         dev_warn(&adapter->pdev->dev, "Could NOT remove the VF MAC address.\n");
1347                 }
1348         } else {
1349                 retval = -EINVAL;
1350         }
1351
1352         return retval;
1353 }
1354
1355 static int ixgbe_enable_port_vlan(struct ixgbe_adapter *adapter, int vf,
1356                                   u16 vlan, u8 qos)
1357 {
1358         struct ixgbe_hw *hw = &adapter->hw;
1359         int err;
1360
1361         err = ixgbe_set_vf_vlan(adapter, true, vlan, vf);
1362         if (err)
1363                 goto out;
1364
1365         /* Revoke tagless access via VLAN 0 */
1366         ixgbe_set_vf_vlan(adapter, false, 0, vf);
1367
1368         ixgbe_set_vmvir(adapter, vlan, qos, vf);
1369         ixgbe_set_vmolr(hw, vf, false);
1370
1371         /* enable hide vlan on X550 */
1372         if (hw->mac.type >= ixgbe_mac_X550)
1373                 ixgbe_write_qde(adapter, vf, IXGBE_QDE_ENABLE |
1374                                 IXGBE_QDE_HIDE_VLAN);
1375
1376         adapter->vfinfo[vf].pf_vlan = vlan;
1377         adapter->vfinfo[vf].pf_qos = qos;
1378         dev_info(&adapter->pdev->dev,
1379                  "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
1380         if (test_bit(__IXGBE_DOWN, &adapter->state)) {
1381                 dev_warn(&adapter->pdev->dev,
1382                          "The VF VLAN has been set, but the PF device is not up.\n");
1383                 dev_warn(&adapter->pdev->dev,
1384                          "Bring the PF device up before attempting to use the VF device.\n");
1385         }
1386
1387 out:
1388         return err;
1389 }
1390
1391 static int ixgbe_disable_port_vlan(struct ixgbe_adapter *adapter, int vf)
1392 {
1393         struct ixgbe_hw *hw = &adapter->hw;
1394         int err;
1395
1396         err = ixgbe_set_vf_vlan(adapter, false,
1397                                 adapter->vfinfo[vf].pf_vlan, vf);
1398         /* Restore tagless access via VLAN 0 */
1399         ixgbe_set_vf_vlan(adapter, true, 0, vf);
1400         ixgbe_clear_vmvir(adapter, vf);
1401         ixgbe_set_vmolr(hw, vf, true);
1402
1403         /* disable hide VLAN on X550 */
1404         if (hw->mac.type >= ixgbe_mac_X550)
1405                 ixgbe_write_qde(adapter, vf, IXGBE_QDE_ENABLE);
1406
1407         adapter->vfinfo[vf].pf_vlan = 0;
1408         adapter->vfinfo[vf].pf_qos = 0;
1409
1410         return err;
1411 }
1412
1413 int ixgbe_ndo_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan,
1414                           u8 qos, __be16 vlan_proto)
1415 {
1416         int err = 0;
1417         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1418
1419         if ((vf >= adapter->num_vfs) || (vlan > 4095) || (qos > 7))
1420                 return -EINVAL;
1421         if (vlan_proto != htons(ETH_P_8021Q))
1422                 return -EPROTONOSUPPORT;
1423         if (vlan || qos) {
1424                 /* Check if there is already a port VLAN set, if so
1425                  * we have to delete the old one first before we
1426                  * can set the new one.  The usage model had
1427                  * previously assumed the user would delete the
1428                  * old port VLAN before setting a new one but this
1429                  * is not necessarily the case.
1430                  */
1431                 if (adapter->vfinfo[vf].pf_vlan)
1432                         err = ixgbe_disable_port_vlan(adapter, vf);
1433                 if (err)
1434                         goto out;
1435                 err = ixgbe_enable_port_vlan(adapter, vf, vlan, qos);
1436         } else {
1437                 err = ixgbe_disable_port_vlan(adapter, vf);
1438         }
1439
1440 out:
1441         return err;
1442 }
1443
1444 int ixgbe_link_mbps(struct ixgbe_adapter *adapter)
1445 {
1446         switch (adapter->link_speed) {
1447         case IXGBE_LINK_SPEED_100_FULL:
1448                 return 100;
1449         case IXGBE_LINK_SPEED_1GB_FULL:
1450                 return 1000;
1451         case IXGBE_LINK_SPEED_10GB_FULL:
1452                 return 10000;
1453         default:
1454                 return 0;
1455         }
1456 }
1457
1458 static void ixgbe_set_vf_rate_limit(struct ixgbe_adapter *adapter, int vf)
1459 {
1460         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
1461         struct ixgbe_hw *hw = &adapter->hw;
1462         u32 bcnrc_val = 0;
1463         u16 queue, queues_per_pool;
1464         u16 tx_rate = adapter->vfinfo[vf].tx_rate;
1465
1466         if (tx_rate) {
1467                 /* start with base link speed value */
1468                 bcnrc_val = adapter->vf_rate_link_speed;
1469
1470                 /* Calculate the rate factor values to set */
1471                 bcnrc_val <<= IXGBE_RTTBCNRC_RF_INT_SHIFT;
1472                 bcnrc_val /= tx_rate;
1473
1474                 /* clear everything but the rate factor */
1475                 bcnrc_val &= IXGBE_RTTBCNRC_RF_INT_MASK |
1476                              IXGBE_RTTBCNRC_RF_DEC_MASK;
1477
1478                 /* enable the rate scheduler */
1479                 bcnrc_val |= IXGBE_RTTBCNRC_RS_ENA;
1480         }
1481
1482         /*
1483          * Set global transmit compensation time to the MMW_SIZE in RTTBCNRM
1484          * register. Typically MMW_SIZE=0x014 if 9728-byte jumbo is supported
1485          * and 0x004 otherwise.
1486          */
1487         switch (hw->mac.type) {
1488         case ixgbe_mac_82599EB:
1489                 IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x4);
1490                 break;
1491         case ixgbe_mac_X540:
1492                 IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x14);
1493                 break;
1494         default:
1495                 break;
1496         }
1497
1498         /* determine how many queues per pool based on VMDq mask */
1499         queues_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
1500
1501         /* write value for all Tx queues belonging to VF */
1502         for (queue = 0; queue < queues_per_pool; queue++) {
1503                 unsigned int reg_idx = (vf * queues_per_pool) + queue;
1504
1505                 IXGBE_WRITE_REG(hw, IXGBE_RTTDQSEL, reg_idx);
1506                 IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRC, bcnrc_val);
1507         }
1508 }
1509
1510 void ixgbe_check_vf_rate_limit(struct ixgbe_adapter *adapter)
1511 {
1512         int i;
1513
1514         /* VF Tx rate limit was not set */
1515         if (!adapter->vf_rate_link_speed)
1516                 return;
1517
1518         if (ixgbe_link_mbps(adapter) != adapter->vf_rate_link_speed) {
1519                 adapter->vf_rate_link_speed = 0;
1520                 dev_info(&adapter->pdev->dev,
1521                          "Link speed has been changed. VF Transmit rate is disabled\n");
1522         }
1523
1524         for (i = 0; i < adapter->num_vfs; i++) {
1525                 if (!adapter->vf_rate_link_speed)
1526                         adapter->vfinfo[i].tx_rate = 0;
1527
1528                 ixgbe_set_vf_rate_limit(adapter, i);
1529         }
1530 }
1531
1532 int ixgbe_ndo_set_vf_bw(struct net_device *netdev, int vf, int min_tx_rate,
1533                         int max_tx_rate)
1534 {
1535         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1536         int link_speed;
1537
1538         /* verify VF is active */
1539         if (vf >= adapter->num_vfs)
1540                 return -EINVAL;
1541
1542         /* verify link is up */
1543         if (!adapter->link_up)
1544                 return -EINVAL;
1545
1546         /* verify we are linked at 10Gbps */
1547         link_speed = ixgbe_link_mbps(adapter);
1548         if (link_speed != 10000)
1549                 return -EINVAL;
1550
1551         if (min_tx_rate)
1552                 return -EINVAL;
1553
1554         /* rate limit cannot be less than 10Mbs or greater than link speed */
1555         if (max_tx_rate && ((max_tx_rate <= 10) || (max_tx_rate > link_speed)))
1556                 return -EINVAL;
1557
1558         /* store values */
1559         adapter->vf_rate_link_speed = link_speed;
1560         adapter->vfinfo[vf].tx_rate = max_tx_rate;
1561
1562         /* update hardware configuration */
1563         ixgbe_set_vf_rate_limit(adapter, vf);
1564
1565         return 0;
1566 }
1567
1568 int ixgbe_ndo_set_vf_spoofchk(struct net_device *netdev, int vf, bool setting)
1569 {
1570         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1571         struct ixgbe_hw *hw = &adapter->hw;
1572
1573         if (vf >= adapter->num_vfs)
1574                 return -EINVAL;
1575
1576         adapter->vfinfo[vf].spoofchk_enabled = setting;
1577
1578         /* configure MAC spoofing */
1579         hw->mac.ops.set_mac_anti_spoofing(hw, setting, vf);
1580
1581         /* configure VLAN spoofing */
1582         hw->mac.ops.set_vlan_anti_spoofing(hw, setting, vf);
1583
1584         /* Ensure LLDP and FC is set for Ethertype Antispoofing if we will be
1585          * calling set_ethertype_anti_spoofing for each VF in loop below
1586          */
1587         if (hw->mac.ops.set_ethertype_anti_spoofing) {
1588                 IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_LLDP),
1589                                 (IXGBE_ETQF_FILTER_EN    |
1590                                  IXGBE_ETQF_TX_ANTISPOOF |
1591                                  IXGBE_ETH_P_LLDP));
1592
1593                 IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_FC),
1594                                 (IXGBE_ETQF_FILTER_EN |
1595                                  IXGBE_ETQF_TX_ANTISPOOF |
1596                                  ETH_P_PAUSE));
1597
1598                 hw->mac.ops.set_ethertype_anti_spoofing(hw, setting, vf);
1599         }
1600
1601         return 0;
1602 }
1603
1604 int ixgbe_ndo_set_vf_rss_query_en(struct net_device *netdev, int vf,
1605                                   bool setting)
1606 {
1607         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1608
1609         /* This operation is currently supported only for 82599 and x540
1610          * devices.
1611          */
1612         if (adapter->hw.mac.type < ixgbe_mac_82599EB ||
1613             adapter->hw.mac.type >= ixgbe_mac_X550)
1614                 return -EOPNOTSUPP;
1615
1616         if (vf >= adapter->num_vfs)
1617                 return -EINVAL;
1618
1619         adapter->vfinfo[vf].rss_query_enabled = setting;
1620
1621         return 0;
1622 }
1623
1624 int ixgbe_ndo_set_vf_trust(struct net_device *netdev, int vf, bool setting)
1625 {
1626         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1627
1628         if (vf >= adapter->num_vfs)
1629                 return -EINVAL;
1630
1631         /* nothing to do */
1632         if (adapter->vfinfo[vf].trusted == setting)
1633                 return 0;
1634
1635         adapter->vfinfo[vf].trusted = setting;
1636
1637         /* reset VF to reconfigure features */
1638         adapter->vfinfo[vf].clear_to_send = false;
1639         ixgbe_ping_vf(adapter, vf);
1640
1641         e_info(drv, "VF %u is %strusted\n", vf, setting ? "" : "not ");
1642
1643         return 0;
1644 }
1645
1646 int ixgbe_ndo_get_vf_config(struct net_device *netdev,
1647                             int vf, struct ifla_vf_info *ivi)
1648 {
1649         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1650         if (vf >= adapter->num_vfs)
1651                 return -EINVAL;
1652         ivi->vf = vf;
1653         memcpy(&ivi->mac, adapter->vfinfo[vf].vf_mac_addresses, ETH_ALEN);
1654         ivi->max_tx_rate = adapter->vfinfo[vf].tx_rate;
1655         ivi->min_tx_rate = 0;
1656         ivi->vlan = adapter->vfinfo[vf].pf_vlan;
1657         ivi->qos = adapter->vfinfo[vf].pf_qos;
1658         ivi->spoofchk = adapter->vfinfo[vf].spoofchk_enabled;
1659         ivi->rss_query_en = adapter->vfinfo[vf].rss_query_enabled;
1660         ivi->trusted = adapter->vfinfo[vf].trusted;
1661         return 0;
1662 }