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