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