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

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