af25a8fffeb8ba4f19a79f11f6d96f3d7f252047
[muen/linux.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         u32 word;
704
705         /* remove VLAN filters beloning to this VF */
706         ixgbe_clear_vf_vlans(adapter, vf);
707
708         /* add back PF assigned VLAN or VLAN 0 */
709         ixgbe_set_vf_vlan(adapter, true, vfinfo->pf_vlan, vf);
710
711         /* reset offloads to defaults */
712         ixgbe_set_vmolr(hw, vf, !vfinfo->pf_vlan);
713
714         /* set outgoing tags for VFs */
715         if (!vfinfo->pf_vlan && !vfinfo->pf_qos && !num_tcs) {
716                 ixgbe_clear_vmvir(adapter, vf);
717         } else {
718                 if (vfinfo->pf_qos || !num_tcs)
719                         ixgbe_set_vmvir(adapter, vfinfo->pf_vlan,
720                                         vfinfo->pf_qos, vf);
721                 else
722                         ixgbe_set_vmvir(adapter, vfinfo->pf_vlan,
723                                         adapter->default_up, vf);
724
725                 if (vfinfo->spoofchk_enabled)
726                         hw->mac.ops.set_vlan_anti_spoofing(hw, true, vf);
727         }
728
729         /* reset multicast table array for vf */
730         adapter->vfinfo[vf].num_vf_mc_hashes = 0;
731
732         /* clear any ipsec table info */
733         ixgbe_ipsec_vf_clear(adapter, vf);
734
735         /* Flush and reset the mta with the new values */
736         ixgbe_set_rx_mode(adapter->netdev);
737
738         ixgbe_del_mac_filter(adapter, adapter->vfinfo[vf].vf_mac_addresses, vf);
739         ixgbe_set_vf_macvlan(adapter, vf, 0, NULL);
740
741         /* reset VF api back to unknown */
742         adapter->vfinfo[vf].vf_api = ixgbe_mbox_api_10;
743
744         /* Restart each queue for given VF */
745         for (queue = 0; queue < q_per_pool; queue++) {
746                 unsigned int reg_idx = (vf * q_per_pool) + queue;
747
748                 reg_val = IXGBE_READ_REG(hw, IXGBE_PVFTXDCTL(reg_idx));
749
750                 /* Re-enabling only configured queues */
751                 if (reg_val) {
752                         reg_val |= IXGBE_TXDCTL_ENABLE;
753                         IXGBE_WRITE_REG(hw, IXGBE_PVFTXDCTL(reg_idx), reg_val);
754                         reg_val &= ~IXGBE_TXDCTL_ENABLE;
755                         IXGBE_WRITE_REG(hw, IXGBE_PVFTXDCTL(reg_idx), reg_val);
756                 }
757         }
758
759         /* Clear VF's mailbox memory */
760         for (word = 0; word < IXGBE_VFMAILBOX_SIZE; word++)
761                 IXGBE_WRITE_REG_ARRAY(hw, IXGBE_PFMBMEM(vf), word, 0);
762
763         IXGBE_WRITE_FLUSH(hw);
764 }
765
766 static int ixgbe_set_vf_mac(struct ixgbe_adapter *adapter,
767                             int vf, unsigned char *mac_addr)
768 {
769         s32 retval;
770
771         ixgbe_del_mac_filter(adapter, adapter->vfinfo[vf].vf_mac_addresses, vf);
772         retval = ixgbe_add_mac_filter(adapter, mac_addr, vf);
773         if (retval >= 0)
774                 memcpy(adapter->vfinfo[vf].vf_mac_addresses, mac_addr,
775                        ETH_ALEN);
776         else
777                 memset(adapter->vfinfo[vf].vf_mac_addresses, 0, ETH_ALEN);
778
779         return retval;
780 }
781
782 int ixgbe_vf_configuration(struct pci_dev *pdev, unsigned int event_mask)
783 {
784         struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
785         unsigned int vfn = (event_mask & 0x3f);
786
787         bool enable = ((event_mask & 0x10000000U) != 0);
788
789         if (enable)
790                 eth_zero_addr(adapter->vfinfo[vfn].vf_mac_addresses);
791
792         return 0;
793 }
794
795 static inline void ixgbe_write_qde(struct ixgbe_adapter *adapter, u32 vf,
796                                    u32 qde)
797 {
798         struct ixgbe_hw *hw = &adapter->hw;
799         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
800         u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
801         int i;
802
803         for (i = vf * q_per_pool; i < ((vf + 1) * q_per_pool); i++) {
804                 u32 reg;
805
806                 /* flush previous write */
807                 IXGBE_WRITE_FLUSH(hw);
808
809                 /* indicate to hardware that we want to set drop enable */
810                 reg = IXGBE_QDE_WRITE | qde;
811                 reg |= i <<  IXGBE_QDE_IDX_SHIFT;
812                 IXGBE_WRITE_REG(hw, IXGBE_QDE, reg);
813         }
814 }
815
816 static int ixgbe_vf_reset_msg(struct ixgbe_adapter *adapter, u32 vf)
817 {
818         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
819         struct ixgbe_hw *hw = &adapter->hw;
820         unsigned char *vf_mac = adapter->vfinfo[vf].vf_mac_addresses;
821         u32 reg, reg_offset, vf_shift;
822         u32 msgbuf[4] = {0, 0, 0, 0};
823         u8 *addr = (u8 *)(&msgbuf[1]);
824         u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
825         int i;
826
827         e_info(probe, "VF Reset msg received from vf %d\n", vf);
828
829         /* reset the filters for the device */
830         ixgbe_vf_reset_event(adapter, vf);
831
832         /* set vf mac address */
833         if (!is_zero_ether_addr(vf_mac))
834                 ixgbe_set_vf_mac(adapter, vf, vf_mac);
835
836         vf_shift = vf % 32;
837         reg_offset = vf / 32;
838
839         /* enable transmit for vf */
840         reg = IXGBE_READ_REG(hw, IXGBE_VFTE(reg_offset));
841         reg |= BIT(vf_shift);
842         IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), reg);
843
844         /* force drop enable for all VF Rx queues */
845         reg = IXGBE_QDE_ENABLE;
846         if (adapter->vfinfo[vf].pf_vlan)
847                 reg |= IXGBE_QDE_HIDE_VLAN;
848
849         ixgbe_write_qde(adapter, vf, reg);
850
851         /* enable receive for vf */
852         reg = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
853         reg |= BIT(vf_shift);
854         /*
855          * The 82599 cannot support a mix of jumbo and non-jumbo PF/VFs.
856          * For more info take a look at ixgbe_set_vf_lpe
857          */
858         if (adapter->hw.mac.type == ixgbe_mac_82599EB) {
859                 struct net_device *dev = adapter->netdev;
860                 int pf_max_frame = dev->mtu + ETH_HLEN;
861
862 #ifdef CONFIG_FCOE
863                 if (dev->features & NETIF_F_FCOE_MTU)
864                         pf_max_frame = max_t(int, pf_max_frame,
865                                              IXGBE_FCOE_JUMBO_FRAME_SIZE);
866
867 #endif /* CONFIG_FCOE */
868                 if (pf_max_frame > ETH_FRAME_LEN)
869                         reg &= ~BIT(vf_shift);
870         }
871         IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), reg);
872
873         /* enable VF mailbox for further messages */
874         adapter->vfinfo[vf].clear_to_send = true;
875
876         /* Enable counting of spoofed packets in the SSVPC register */
877         reg = IXGBE_READ_REG(hw, IXGBE_VMECM(reg_offset));
878         reg |= BIT(vf_shift);
879         IXGBE_WRITE_REG(hw, IXGBE_VMECM(reg_offset), reg);
880
881         /*
882          * Reset the VFs TDWBAL and TDWBAH registers
883          * which are not cleared by an FLR
884          */
885         for (i = 0; i < q_per_pool; i++) {
886                 IXGBE_WRITE_REG(hw, IXGBE_PVFTDWBAHn(q_per_pool, vf, i), 0);
887                 IXGBE_WRITE_REG(hw, IXGBE_PVFTDWBALn(q_per_pool, vf, i), 0);
888         }
889
890         /* reply to reset with ack and vf mac address */
891         msgbuf[0] = IXGBE_VF_RESET;
892         if (!is_zero_ether_addr(vf_mac) && adapter->vfinfo[vf].pf_set_mac) {
893                 msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
894                 memcpy(addr, vf_mac, ETH_ALEN);
895         } else {
896                 msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
897         }
898
899         /*
900          * Piggyback the multicast filter type so VF can compute the
901          * correct vectors
902          */
903         msgbuf[3] = hw->mac.mc_filter_type;
904         ixgbe_write_mbx(hw, msgbuf, IXGBE_VF_PERMADDR_MSG_LEN, vf);
905
906         return 0;
907 }
908
909 static int ixgbe_set_vf_mac_addr(struct ixgbe_adapter *adapter,
910                                  u32 *msgbuf, u32 vf)
911 {
912         u8 *new_mac = ((u8 *)(&msgbuf[1]));
913
914         if (!is_valid_ether_addr(new_mac)) {
915                 e_warn(drv, "VF %d attempted to set invalid mac\n", vf);
916                 return -1;
917         }
918
919         if (adapter->vfinfo[vf].pf_set_mac && !adapter->vfinfo[vf].trusted &&
920             !ether_addr_equal(adapter->vfinfo[vf].vf_mac_addresses, new_mac)) {
921                 e_warn(drv,
922                        "VF %d attempted to override administratively set MAC address\n"
923                        "Reload the VF driver to resume operations\n",
924                        vf);
925                 return -1;
926         }
927
928         return ixgbe_set_vf_mac(adapter, vf, new_mac) < 0;
929 }
930
931 static int ixgbe_set_vf_vlan_msg(struct ixgbe_adapter *adapter,
932                                  u32 *msgbuf, u32 vf)
933 {
934         u32 add = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >> IXGBE_VT_MSGINFO_SHIFT;
935         u32 vid = (msgbuf[1] & IXGBE_VLVF_VLANID_MASK);
936         u8 tcs = adapter->hw_tcs;
937
938         if (adapter->vfinfo[vf].pf_vlan || tcs) {
939                 e_warn(drv,
940                        "VF %d attempted to override administratively set VLAN configuration\n"
941                        "Reload the VF driver to resume operations\n",
942                        vf);
943                 return -1;
944         }
945
946         /* VLAN 0 is a special case, don't allow it to be removed */
947         if (!vid && !add)
948                 return 0;
949
950         return ixgbe_set_vf_vlan(adapter, add, vid, vf);
951 }
952
953 static int ixgbe_set_vf_macvlan_msg(struct ixgbe_adapter *adapter,
954                                     u32 *msgbuf, u32 vf)
955 {
956         u8 *new_mac = ((u8 *)(&msgbuf[1]));
957         int index = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >>
958                     IXGBE_VT_MSGINFO_SHIFT;
959         int err;
960
961         if (adapter->vfinfo[vf].pf_set_mac && !adapter->vfinfo[vf].trusted &&
962             index > 0) {
963                 e_warn(drv,
964                        "VF %d requested MACVLAN filter but is administratively denied\n",
965                        vf);
966                 return -1;
967         }
968
969         /* An non-zero index indicates the VF is setting a filter */
970         if (index) {
971                 if (!is_valid_ether_addr(new_mac)) {
972                         e_warn(drv, "VF %d attempted to set invalid mac\n", vf);
973                         return -1;
974                 }
975
976                 /*
977                  * If the VF is allowed to set MAC filters then turn off
978                  * anti-spoofing to avoid false positives.
979                  */
980                 if (adapter->vfinfo[vf].spoofchk_enabled) {
981                         struct ixgbe_hw *hw = &adapter->hw;
982
983                         hw->mac.ops.set_mac_anti_spoofing(hw, false, vf);
984                         hw->mac.ops.set_vlan_anti_spoofing(hw, false, vf);
985                 }
986         }
987
988         err = ixgbe_set_vf_macvlan(adapter, vf, index, new_mac);
989         if (err == -ENOSPC)
990                 e_warn(drv,
991                        "VF %d has requested a MACVLAN filter but there is no space for it\n",
992                        vf);
993
994         return err < 0;
995 }
996
997 static int ixgbe_negotiate_vf_api(struct ixgbe_adapter *adapter,
998                                   u32 *msgbuf, u32 vf)
999 {
1000         int api = msgbuf[1];
1001
1002         switch (api) {
1003         case ixgbe_mbox_api_10:
1004         case ixgbe_mbox_api_11:
1005         case ixgbe_mbox_api_12:
1006         case ixgbe_mbox_api_13:
1007         case ixgbe_mbox_api_14:
1008                 adapter->vfinfo[vf].vf_api = api;
1009                 return 0;
1010         default:
1011                 break;
1012         }
1013
1014         e_info(drv, "VF %d requested invalid api version %u\n", vf, api);
1015
1016         return -1;
1017 }
1018
1019 static int ixgbe_get_vf_queues(struct ixgbe_adapter *adapter,
1020                                u32 *msgbuf, u32 vf)
1021 {
1022         struct net_device *dev = adapter->netdev;
1023         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
1024         unsigned int default_tc = 0;
1025         u8 num_tcs = adapter->hw_tcs;
1026
1027         /* verify the PF is supporting the correct APIs */
1028         switch (adapter->vfinfo[vf].vf_api) {
1029         case ixgbe_mbox_api_20:
1030         case ixgbe_mbox_api_11:
1031         case ixgbe_mbox_api_12:
1032         case ixgbe_mbox_api_13:
1033         case ixgbe_mbox_api_14:
1034                 break;
1035         default:
1036                 return -1;
1037         }
1038
1039         /* only allow 1 Tx queue for bandwidth limiting */
1040         msgbuf[IXGBE_VF_TX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
1041         msgbuf[IXGBE_VF_RX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
1042
1043         /* if TCs > 1 determine which TC belongs to default user priority */
1044         if (num_tcs > 1)
1045                 default_tc = netdev_get_prio_tc_map(dev, adapter->default_up);
1046
1047         /* notify VF of need for VLAN tag stripping, and correct queue */
1048         if (num_tcs)
1049                 msgbuf[IXGBE_VF_TRANS_VLAN] = num_tcs;
1050         else if (adapter->vfinfo[vf].pf_vlan || adapter->vfinfo[vf].pf_qos)
1051                 msgbuf[IXGBE_VF_TRANS_VLAN] = 1;
1052         else
1053                 msgbuf[IXGBE_VF_TRANS_VLAN] = 0;
1054
1055         /* notify VF of default queue */
1056         msgbuf[IXGBE_VF_DEF_QUEUE] = default_tc;
1057
1058         return 0;
1059 }
1060
1061 static int ixgbe_get_vf_reta(struct ixgbe_adapter *adapter, u32 *msgbuf, u32 vf)
1062 {
1063         u32 i, j;
1064         u32 *out_buf = &msgbuf[1];
1065         const u8 *reta = adapter->rss_indir_tbl;
1066         u32 reta_size = ixgbe_rss_indir_tbl_entries(adapter);
1067
1068         /* Check if operation is permitted */
1069         if (!adapter->vfinfo[vf].rss_query_enabled)
1070                 return -EPERM;
1071
1072         /* verify the PF is supporting the correct API */
1073         switch (adapter->vfinfo[vf].vf_api) {
1074         case ixgbe_mbox_api_14:
1075         case ixgbe_mbox_api_13:
1076         case ixgbe_mbox_api_12:
1077                 break;
1078         default:
1079                 return -EOPNOTSUPP;
1080         }
1081
1082         /* This mailbox command is supported (required) only for 82599 and x540
1083          * VFs which support up to 4 RSS queues. Therefore we will compress the
1084          * RETA by saving only 2 bits from each entry. This way we will be able
1085          * to transfer the whole RETA in a single mailbox operation.
1086          */
1087         for (i = 0; i < reta_size / 16; i++) {
1088                 out_buf[i] = 0;
1089                 for (j = 0; j < 16; j++)
1090                         out_buf[i] |= (u32)(reta[16 * i + j] & 0x3) << (2 * j);
1091         }
1092
1093         return 0;
1094 }
1095
1096 static int ixgbe_get_vf_rss_key(struct ixgbe_adapter *adapter,
1097                                 u32 *msgbuf, u32 vf)
1098 {
1099         u32 *rss_key = &msgbuf[1];
1100
1101         /* Check if the operation is permitted */
1102         if (!adapter->vfinfo[vf].rss_query_enabled)
1103                 return -EPERM;
1104
1105         /* verify the PF is supporting the correct API */
1106         switch (adapter->vfinfo[vf].vf_api) {
1107         case ixgbe_mbox_api_14:
1108         case ixgbe_mbox_api_13:
1109         case ixgbe_mbox_api_12:
1110                 break;
1111         default:
1112                 return -EOPNOTSUPP;
1113         }
1114
1115         memcpy(rss_key, adapter->rss_key, IXGBE_RSS_KEY_SIZE);
1116
1117         return 0;
1118 }
1119
1120 static int ixgbe_update_vf_xcast_mode(struct ixgbe_adapter *adapter,
1121                                       u32 *msgbuf, u32 vf)
1122 {
1123         struct ixgbe_hw *hw = &adapter->hw;
1124         int xcast_mode = msgbuf[1];
1125         u32 vmolr, fctrl, disable, enable;
1126
1127         /* verify the PF is supporting the correct APIs */
1128         switch (adapter->vfinfo[vf].vf_api) {
1129         case ixgbe_mbox_api_12:
1130                 /* promisc introduced in 1.3 version */
1131                 if (xcast_mode == IXGBEVF_XCAST_MODE_PROMISC)
1132                         return -EOPNOTSUPP;
1133                 /* Fall through */
1134         case ixgbe_mbox_api_13:
1135         case ixgbe_mbox_api_14:
1136                 break;
1137         default:
1138                 return -EOPNOTSUPP;
1139         }
1140
1141         if (xcast_mode > IXGBEVF_XCAST_MODE_MULTI &&
1142             !adapter->vfinfo[vf].trusted) {
1143                 xcast_mode = IXGBEVF_XCAST_MODE_MULTI;
1144         }
1145
1146         if (adapter->vfinfo[vf].xcast_mode == xcast_mode)
1147                 goto out;
1148
1149         switch (xcast_mode) {
1150         case IXGBEVF_XCAST_MODE_NONE:
1151                 disable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE |
1152                           IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1153                 enable = 0;
1154                 break;
1155         case IXGBEVF_XCAST_MODE_MULTI:
1156                 disable = IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1157                 enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE;
1158                 break;
1159         case IXGBEVF_XCAST_MODE_ALLMULTI:
1160                 disable = IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1161                 enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE | IXGBE_VMOLR_MPE;
1162                 break;
1163         case IXGBEVF_XCAST_MODE_PROMISC:
1164                 if (hw->mac.type <= ixgbe_mac_82599EB)
1165                         return -EOPNOTSUPP;
1166
1167                 fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
1168                 if (!(fctrl & IXGBE_FCTRL_UPE)) {
1169                         /* VF promisc requires PF in promisc */
1170                         e_warn(drv,
1171                                "Enabling VF promisc requires PF in promisc\n");
1172                         return -EPERM;
1173                 }
1174
1175                 disable = 0;
1176                 enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE |
1177                          IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1178                 break;
1179         default:
1180                 return -EOPNOTSUPP;
1181         }
1182
1183         vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
1184         vmolr &= ~disable;
1185         vmolr |= enable;
1186         IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
1187
1188         adapter->vfinfo[vf].xcast_mode = xcast_mode;
1189
1190 out:
1191         msgbuf[1] = xcast_mode;
1192
1193         return 0;
1194 }
1195
1196 static int ixgbe_rcv_msg_from_vf(struct ixgbe_adapter *adapter, u32 vf)
1197 {
1198         u32 mbx_size = IXGBE_VFMAILBOX_SIZE;
1199         u32 msgbuf[IXGBE_VFMAILBOX_SIZE];
1200         struct ixgbe_hw *hw = &adapter->hw;
1201         s32 retval;
1202
1203         retval = ixgbe_read_mbx(hw, msgbuf, mbx_size, vf);
1204
1205         if (retval) {
1206                 pr_err("Error receiving message from VF\n");
1207                 return retval;
1208         }
1209
1210         /* this is a message we already processed, do nothing */
1211         if (msgbuf[0] & (IXGBE_VT_MSGTYPE_ACK | IXGBE_VT_MSGTYPE_NACK))
1212                 return 0;
1213
1214         /* flush the ack before we write any messages back */
1215         IXGBE_WRITE_FLUSH(hw);
1216
1217         if (msgbuf[0] == IXGBE_VF_RESET)
1218                 return ixgbe_vf_reset_msg(adapter, vf);
1219
1220         /*
1221          * until the vf completes a virtual function reset it should not be
1222          * allowed to start any configuration.
1223          */
1224         if (!adapter->vfinfo[vf].clear_to_send) {
1225                 msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
1226                 ixgbe_write_mbx(hw, msgbuf, 1, vf);
1227                 return 0;
1228         }
1229
1230         switch ((msgbuf[0] & 0xFFFF)) {
1231         case IXGBE_VF_SET_MAC_ADDR:
1232                 retval = ixgbe_set_vf_mac_addr(adapter, msgbuf, vf);
1233                 break;
1234         case IXGBE_VF_SET_MULTICAST:
1235                 retval = ixgbe_set_vf_multicasts(adapter, msgbuf, vf);
1236                 break;
1237         case IXGBE_VF_SET_VLAN:
1238                 retval = ixgbe_set_vf_vlan_msg(adapter, msgbuf, vf);
1239                 break;
1240         case IXGBE_VF_SET_LPE:
1241                 retval = ixgbe_set_vf_lpe(adapter, msgbuf, vf);
1242                 break;
1243         case IXGBE_VF_SET_MACVLAN:
1244                 retval = ixgbe_set_vf_macvlan_msg(adapter, msgbuf, vf);
1245                 break;
1246         case IXGBE_VF_API_NEGOTIATE:
1247                 retval = ixgbe_negotiate_vf_api(adapter, msgbuf, vf);
1248                 break;
1249         case IXGBE_VF_GET_QUEUES:
1250                 retval = ixgbe_get_vf_queues(adapter, msgbuf, vf);
1251                 break;
1252         case IXGBE_VF_GET_RETA:
1253                 retval = ixgbe_get_vf_reta(adapter, msgbuf, vf);
1254                 break;
1255         case IXGBE_VF_GET_RSS_KEY:
1256                 retval = ixgbe_get_vf_rss_key(adapter, msgbuf, vf);
1257                 break;
1258         case IXGBE_VF_UPDATE_XCAST_MODE:
1259                 retval = ixgbe_update_vf_xcast_mode(adapter, msgbuf, vf);
1260                 break;
1261         case IXGBE_VF_IPSEC_ADD:
1262                 retval = ixgbe_ipsec_vf_add_sa(adapter, msgbuf, vf);
1263                 break;
1264         case IXGBE_VF_IPSEC_DEL:
1265                 retval = ixgbe_ipsec_vf_del_sa(adapter, msgbuf, vf);
1266                 break;
1267         default:
1268                 e_err(drv, "Unhandled Msg %8.8x\n", msgbuf[0]);
1269                 retval = IXGBE_ERR_MBX;
1270                 break;
1271         }
1272
1273         /* notify the VF of the results of what it sent us */
1274         if (retval)
1275                 msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
1276         else
1277                 msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
1278
1279         msgbuf[0] |= IXGBE_VT_MSGTYPE_CTS;
1280
1281         ixgbe_write_mbx(hw, msgbuf, mbx_size, vf);
1282
1283         return retval;
1284 }
1285
1286 static void ixgbe_rcv_ack_from_vf(struct ixgbe_adapter *adapter, u32 vf)
1287 {
1288         struct ixgbe_hw *hw = &adapter->hw;
1289         u32 msg = IXGBE_VT_MSGTYPE_NACK;
1290
1291         /* if device isn't clear to send it shouldn't be reading either */
1292         if (!adapter->vfinfo[vf].clear_to_send)
1293                 ixgbe_write_mbx(hw, &msg, 1, vf);
1294 }
1295
1296 void ixgbe_msg_task(struct ixgbe_adapter *adapter)
1297 {
1298         struct ixgbe_hw *hw = &adapter->hw;
1299         u32 vf;
1300
1301         for (vf = 0; vf < adapter->num_vfs; vf++) {
1302                 /* process any reset requests */
1303                 if (!ixgbe_check_for_rst(hw, vf))
1304                         ixgbe_vf_reset_event(adapter, vf);
1305
1306                 /* process any messages pending */
1307                 if (!ixgbe_check_for_msg(hw, vf))
1308                         ixgbe_rcv_msg_from_vf(adapter, vf);
1309
1310                 /* process any acks */
1311                 if (!ixgbe_check_for_ack(hw, vf))
1312                         ixgbe_rcv_ack_from_vf(adapter, vf);
1313         }
1314 }
1315
1316 void ixgbe_disable_tx_rx(struct ixgbe_adapter *adapter)
1317 {
1318         struct ixgbe_hw *hw = &adapter->hw;
1319
1320         /* disable transmit and receive for all vfs */
1321         IXGBE_WRITE_REG(hw, IXGBE_VFTE(0), 0);
1322         IXGBE_WRITE_REG(hw, IXGBE_VFTE(1), 0);
1323
1324         IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), 0);
1325         IXGBE_WRITE_REG(hw, IXGBE_VFRE(1), 0);
1326 }
1327
1328 static inline void ixgbe_ping_vf(struct ixgbe_adapter *adapter, int vf)
1329 {
1330         struct ixgbe_hw *hw = &adapter->hw;
1331         u32 ping;
1332
1333         ping = IXGBE_PF_CONTROL_MSG;
1334         if (adapter->vfinfo[vf].clear_to_send)
1335                 ping |= IXGBE_VT_MSGTYPE_CTS;
1336         ixgbe_write_mbx(hw, &ping, 1, vf);
1337 }
1338
1339 void ixgbe_ping_all_vfs(struct ixgbe_adapter *adapter)
1340 {
1341         struct ixgbe_hw *hw = &adapter->hw;
1342         u32 ping;
1343         int i;
1344
1345         for (i = 0 ; i < adapter->num_vfs; i++) {
1346                 ping = IXGBE_PF_CONTROL_MSG;
1347                 if (adapter->vfinfo[i].clear_to_send)
1348                         ping |= IXGBE_VT_MSGTYPE_CTS;
1349                 ixgbe_write_mbx(hw, &ping, 1, i);
1350         }
1351 }
1352
1353 int ixgbe_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
1354 {
1355         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1356         s32 retval;
1357
1358         if (vf >= adapter->num_vfs)
1359                 return -EINVAL;
1360
1361         if (is_valid_ether_addr(mac)) {
1362                 dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n",
1363                          mac, vf);
1364                 dev_info(&adapter->pdev->dev, "Reload the VF driver to make this change effective.");
1365
1366                 retval = ixgbe_set_vf_mac(adapter, vf, mac);
1367                 if (retval >= 0) {
1368                         adapter->vfinfo[vf].pf_set_mac = true;
1369
1370                         if (test_bit(__IXGBE_DOWN, &adapter->state)) {
1371                                 dev_warn(&adapter->pdev->dev, "The VF MAC address has been set, but the PF device is not up.\n");
1372                                 dev_warn(&adapter->pdev->dev, "Bring the PF device up before attempting to use the VF device.\n");
1373                         }
1374                 } else {
1375                         dev_warn(&adapter->pdev->dev, "The VF MAC address was NOT set due to invalid or duplicate MAC address.\n");
1376                 }
1377         } else if (is_zero_ether_addr(mac)) {
1378                 unsigned char *vf_mac_addr =
1379                                            adapter->vfinfo[vf].vf_mac_addresses;
1380
1381                 /* nothing to do */
1382                 if (is_zero_ether_addr(vf_mac_addr))
1383                         return 0;
1384
1385                 dev_info(&adapter->pdev->dev, "removing MAC on VF %d\n", vf);
1386
1387                 retval = ixgbe_del_mac_filter(adapter, vf_mac_addr, vf);
1388                 if (retval >= 0) {
1389                         adapter->vfinfo[vf].pf_set_mac = false;
1390                         memcpy(vf_mac_addr, mac, ETH_ALEN);
1391                 } else {
1392                         dev_warn(&adapter->pdev->dev, "Could NOT remove the VF MAC address.\n");
1393                 }
1394         } else {
1395                 retval = -EINVAL;
1396         }
1397
1398         return retval;
1399 }
1400
1401 static int ixgbe_enable_port_vlan(struct ixgbe_adapter *adapter, int vf,
1402                                   u16 vlan, u8 qos)
1403 {
1404         struct ixgbe_hw *hw = &adapter->hw;
1405         int err;
1406
1407         err = ixgbe_set_vf_vlan(adapter, true, vlan, vf);
1408         if (err)
1409                 goto out;
1410
1411         /* Revoke tagless access via VLAN 0 */
1412         ixgbe_set_vf_vlan(adapter, false, 0, vf);
1413
1414         ixgbe_set_vmvir(adapter, vlan, qos, vf);
1415         ixgbe_set_vmolr(hw, vf, false);
1416
1417         /* enable hide vlan on X550 */
1418         if (hw->mac.type >= ixgbe_mac_X550)
1419                 ixgbe_write_qde(adapter, vf, IXGBE_QDE_ENABLE |
1420                                 IXGBE_QDE_HIDE_VLAN);
1421
1422         adapter->vfinfo[vf].pf_vlan = vlan;
1423         adapter->vfinfo[vf].pf_qos = qos;
1424         dev_info(&adapter->pdev->dev,
1425                  "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
1426         if (test_bit(__IXGBE_DOWN, &adapter->state)) {
1427                 dev_warn(&adapter->pdev->dev,
1428                          "The VF VLAN has been set, but the PF device is not up.\n");
1429                 dev_warn(&adapter->pdev->dev,
1430                          "Bring the PF device up before attempting to use the VF device.\n");
1431         }
1432
1433 out:
1434         return err;
1435 }
1436
1437 static int ixgbe_disable_port_vlan(struct ixgbe_adapter *adapter, int vf)
1438 {
1439         struct ixgbe_hw *hw = &adapter->hw;
1440         int err;
1441
1442         err = ixgbe_set_vf_vlan(adapter, false,
1443                                 adapter->vfinfo[vf].pf_vlan, vf);
1444         /* Restore tagless access via VLAN 0 */
1445         ixgbe_set_vf_vlan(adapter, true, 0, vf);
1446         ixgbe_clear_vmvir(adapter, vf);
1447         ixgbe_set_vmolr(hw, vf, true);
1448
1449         /* disable hide VLAN on X550 */
1450         if (hw->mac.type >= ixgbe_mac_X550)
1451                 ixgbe_write_qde(adapter, vf, IXGBE_QDE_ENABLE);
1452
1453         adapter->vfinfo[vf].pf_vlan = 0;
1454         adapter->vfinfo[vf].pf_qos = 0;
1455
1456         return err;
1457 }
1458
1459 int ixgbe_ndo_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan,
1460                           u8 qos, __be16 vlan_proto)
1461 {
1462         int err = 0;
1463         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1464
1465         if ((vf >= adapter->num_vfs) || (vlan > 4095) || (qos > 7))
1466                 return -EINVAL;
1467         if (vlan_proto != htons(ETH_P_8021Q))
1468                 return -EPROTONOSUPPORT;
1469         if (vlan || qos) {
1470                 /* Check if there is already a port VLAN set, if so
1471                  * we have to delete the old one first before we
1472                  * can set the new one.  The usage model had
1473                  * previously assumed the user would delete the
1474                  * old port VLAN before setting a new one but this
1475                  * is not necessarily the case.
1476                  */
1477                 if (adapter->vfinfo[vf].pf_vlan)
1478                         err = ixgbe_disable_port_vlan(adapter, vf);
1479                 if (err)
1480                         goto out;
1481                 err = ixgbe_enable_port_vlan(adapter, vf, vlan, qos);
1482         } else {
1483                 err = ixgbe_disable_port_vlan(adapter, vf);
1484         }
1485
1486 out:
1487         return err;
1488 }
1489
1490 int ixgbe_link_mbps(struct ixgbe_adapter *adapter)
1491 {
1492         switch (adapter->link_speed) {
1493         case IXGBE_LINK_SPEED_100_FULL:
1494                 return 100;
1495         case IXGBE_LINK_SPEED_1GB_FULL:
1496                 return 1000;
1497         case IXGBE_LINK_SPEED_10GB_FULL:
1498                 return 10000;
1499         default:
1500                 return 0;
1501         }
1502 }
1503
1504 static void ixgbe_set_vf_rate_limit(struct ixgbe_adapter *adapter, int vf)
1505 {
1506         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
1507         struct ixgbe_hw *hw = &adapter->hw;
1508         u32 bcnrc_val = 0;
1509         u16 queue, queues_per_pool;
1510         u16 tx_rate = adapter->vfinfo[vf].tx_rate;
1511
1512         if (tx_rate) {
1513                 /* start with base link speed value */
1514                 bcnrc_val = adapter->vf_rate_link_speed;
1515
1516                 /* Calculate the rate factor values to set */
1517                 bcnrc_val <<= IXGBE_RTTBCNRC_RF_INT_SHIFT;
1518                 bcnrc_val /= tx_rate;
1519
1520                 /* clear everything but the rate factor */
1521                 bcnrc_val &= IXGBE_RTTBCNRC_RF_INT_MASK |
1522                              IXGBE_RTTBCNRC_RF_DEC_MASK;
1523
1524                 /* enable the rate scheduler */
1525                 bcnrc_val |= IXGBE_RTTBCNRC_RS_ENA;
1526         }
1527
1528         /*
1529          * Set global transmit compensation time to the MMW_SIZE in RTTBCNRM
1530          * register. Typically MMW_SIZE=0x014 if 9728-byte jumbo is supported
1531          * and 0x004 otherwise.
1532          */
1533         switch (hw->mac.type) {
1534         case ixgbe_mac_82599EB:
1535                 IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x4);
1536                 break;
1537         case ixgbe_mac_X540:
1538                 IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x14);
1539                 break;
1540         default:
1541                 break;
1542         }
1543
1544         /* determine how many queues per pool based on VMDq mask */
1545         queues_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
1546
1547         /* write value for all Tx queues belonging to VF */
1548         for (queue = 0; queue < queues_per_pool; queue++) {
1549                 unsigned int reg_idx = (vf * queues_per_pool) + queue;
1550
1551                 IXGBE_WRITE_REG(hw, IXGBE_RTTDQSEL, reg_idx);
1552                 IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRC, bcnrc_val);
1553         }
1554 }
1555
1556 void ixgbe_check_vf_rate_limit(struct ixgbe_adapter *adapter)
1557 {
1558         int i;
1559
1560         /* VF Tx rate limit was not set */
1561         if (!adapter->vf_rate_link_speed)
1562                 return;
1563
1564         if (ixgbe_link_mbps(adapter) != adapter->vf_rate_link_speed) {
1565                 adapter->vf_rate_link_speed = 0;
1566                 dev_info(&adapter->pdev->dev,
1567                          "Link speed has been changed. VF Transmit rate is disabled\n");
1568         }
1569
1570         for (i = 0; i < adapter->num_vfs; i++) {
1571                 if (!adapter->vf_rate_link_speed)
1572                         adapter->vfinfo[i].tx_rate = 0;
1573
1574                 ixgbe_set_vf_rate_limit(adapter, i);
1575         }
1576 }
1577
1578 int ixgbe_ndo_set_vf_bw(struct net_device *netdev, int vf, int min_tx_rate,
1579                         int max_tx_rate)
1580 {
1581         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1582         int link_speed;
1583
1584         /* verify VF is active */
1585         if (vf >= adapter->num_vfs)
1586                 return -EINVAL;
1587
1588         /* verify link is up */
1589         if (!adapter->link_up)
1590                 return -EINVAL;
1591
1592         /* verify we are linked at 10Gbps */
1593         link_speed = ixgbe_link_mbps(adapter);
1594         if (link_speed != 10000)
1595                 return -EINVAL;
1596
1597         if (min_tx_rate)
1598                 return -EINVAL;
1599
1600         /* rate limit cannot be less than 10Mbs or greater than link speed */
1601         if (max_tx_rate && ((max_tx_rate <= 10) || (max_tx_rate > link_speed)))
1602                 return -EINVAL;
1603
1604         /* store values */
1605         adapter->vf_rate_link_speed = link_speed;
1606         adapter->vfinfo[vf].tx_rate = max_tx_rate;
1607
1608         /* update hardware configuration */
1609         ixgbe_set_vf_rate_limit(adapter, vf);
1610
1611         return 0;
1612 }
1613
1614 int ixgbe_ndo_set_vf_spoofchk(struct net_device *netdev, int vf, bool setting)
1615 {
1616         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1617         struct ixgbe_hw *hw = &adapter->hw;
1618
1619         if (vf >= adapter->num_vfs)
1620                 return -EINVAL;
1621
1622         adapter->vfinfo[vf].spoofchk_enabled = setting;
1623
1624         /* configure MAC spoofing */
1625         hw->mac.ops.set_mac_anti_spoofing(hw, setting, vf);
1626
1627         /* configure VLAN spoofing */
1628         hw->mac.ops.set_vlan_anti_spoofing(hw, setting, vf);
1629
1630         /* Ensure LLDP and FC is set for Ethertype Antispoofing if we will be
1631          * calling set_ethertype_anti_spoofing for each VF in loop below
1632          */
1633         if (hw->mac.ops.set_ethertype_anti_spoofing) {
1634                 IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_LLDP),
1635                                 (IXGBE_ETQF_FILTER_EN    |
1636                                  IXGBE_ETQF_TX_ANTISPOOF |
1637                                  IXGBE_ETH_P_LLDP));
1638
1639                 IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_FC),
1640                                 (IXGBE_ETQF_FILTER_EN |
1641                                  IXGBE_ETQF_TX_ANTISPOOF |
1642                                  ETH_P_PAUSE));
1643
1644                 hw->mac.ops.set_ethertype_anti_spoofing(hw, setting, vf);
1645         }
1646
1647         return 0;
1648 }
1649
1650 int ixgbe_ndo_set_vf_rss_query_en(struct net_device *netdev, int vf,
1651                                   bool setting)
1652 {
1653         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1654
1655         /* This operation is currently supported only for 82599 and x540
1656          * devices.
1657          */
1658         if (adapter->hw.mac.type < ixgbe_mac_82599EB ||
1659             adapter->hw.mac.type >= ixgbe_mac_X550)
1660                 return -EOPNOTSUPP;
1661
1662         if (vf >= adapter->num_vfs)
1663                 return -EINVAL;
1664
1665         adapter->vfinfo[vf].rss_query_enabled = setting;
1666
1667         return 0;
1668 }
1669
1670 int ixgbe_ndo_set_vf_trust(struct net_device *netdev, int vf, bool setting)
1671 {
1672         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1673
1674         if (vf >= adapter->num_vfs)
1675                 return -EINVAL;
1676
1677         /* nothing to do */
1678         if (adapter->vfinfo[vf].trusted == setting)
1679                 return 0;
1680
1681         adapter->vfinfo[vf].trusted = setting;
1682
1683         /* reset VF to reconfigure features */
1684         adapter->vfinfo[vf].clear_to_send = false;
1685         ixgbe_ping_vf(adapter, vf);
1686
1687         e_info(drv, "VF %u is %strusted\n", vf, setting ? "" : "not ");
1688
1689         return 0;
1690 }
1691
1692 int ixgbe_ndo_get_vf_config(struct net_device *netdev,
1693                             int vf, struct ifla_vf_info *ivi)
1694 {
1695         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1696         if (vf >= adapter->num_vfs)
1697                 return -EINVAL;
1698         ivi->vf = vf;
1699         memcpy(&ivi->mac, adapter->vfinfo[vf].vf_mac_addresses, ETH_ALEN);
1700         ivi->max_tx_rate = adapter->vfinfo[vf].tx_rate;
1701         ivi->min_tx_rate = 0;
1702         ivi->vlan = adapter->vfinfo[vf].pf_vlan;
1703         ivi->qos = adapter->vfinfo[vf].pf_qos;
1704         ivi->spoofchk = adapter->vfinfo[vf].spoofchk_enabled;
1705         ivi->rss_query_en = adapter->vfinfo[vf].rss_query_enabled;
1706         ivi->trusted = adapter->vfinfo[vf].trusted;
1707         return 0;
1708 }