Pileus Git - ~andy/linux/blob - drivers/net/ethernet/intel/ixgbe/ixgbe_sriov.c

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