GNU Linux-libre 4.19.286-gnu1
[releases.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 int ixgbe_set_vf_lpe(struct ixgbe_adapter *adapter, u32 max_frame, u32 vf)
471 {
472         struct ixgbe_hw *hw = &adapter->hw;
473         u32 max_frs;
474
475         if (max_frame < ETH_MIN_MTU || max_frame > IXGBE_MAX_JUMBO_FRAME_SIZE) {
476                 e_err(drv, "VF max_frame %d out of range\n", max_frame);
477                 return -EINVAL;
478         }
479
480         /*
481          * For 82599EB we have to keep all PFs and VFs operating with
482          * the same max_frame value in order to avoid sending an oversize
483          * frame to a VF.  In order to guarantee this is handled correctly
484          * for all cases we have several special exceptions to take into
485          * account before we can enable the VF for receive
486          */
487         if (adapter->hw.mac.type == ixgbe_mac_82599EB) {
488                 struct net_device *dev = adapter->netdev;
489                 int pf_max_frame = dev->mtu + ETH_HLEN;
490                 u32 reg_offset, vf_shift, vfre;
491                 s32 err = 0;
492
493 #ifdef CONFIG_FCOE
494                 if (dev->features & NETIF_F_FCOE_MTU)
495                         pf_max_frame = max_t(int, pf_max_frame,
496                                              IXGBE_FCOE_JUMBO_FRAME_SIZE);
497
498 #endif /* CONFIG_FCOE */
499                 switch (adapter->vfinfo[vf].vf_api) {
500                 case ixgbe_mbox_api_11:
501                 case ixgbe_mbox_api_12:
502                 case ixgbe_mbox_api_13:
503                         /* Version 1.1 supports jumbo frames on VFs if PF has
504                          * jumbo frames enabled which means legacy VFs are
505                          * disabled
506                          */
507                         if (pf_max_frame > ETH_FRAME_LEN)
508                                 break;
509                         /* fall through */
510                 default:
511                         /* If the PF or VF are running w/ jumbo frames enabled
512                          * we need to shut down the VF Rx path as we cannot
513                          * support jumbo frames on legacy VFs
514                          */
515                         if ((pf_max_frame > ETH_FRAME_LEN) ||
516                             (max_frame > (ETH_FRAME_LEN + ETH_FCS_LEN)))
517                                 err = -EINVAL;
518                         break;
519                 }
520
521                 /* determine VF receive enable location */
522                 vf_shift = vf % 32;
523                 reg_offset = vf / 32;
524
525                 /* enable or disable receive depending on error */
526                 vfre = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
527                 if (err)
528                         vfre &= ~BIT(vf_shift);
529                 else
530                         vfre |= BIT(vf_shift);
531                 IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), vfre);
532
533                 if (err) {
534                         e_err(drv, "VF max_frame %d out of range\n", max_frame);
535                         return err;
536                 }
537         }
538
539         /* pull current max frame size from hardware */
540         max_frs = IXGBE_READ_REG(hw, IXGBE_MAXFRS);
541         max_frs &= IXGBE_MHADD_MFS_MASK;
542         max_frs >>= IXGBE_MHADD_MFS_SHIFT;
543
544         if (max_frs < max_frame) {
545                 max_frs = max_frame << IXGBE_MHADD_MFS_SHIFT;
546                 IXGBE_WRITE_REG(hw, IXGBE_MAXFRS, max_frs);
547         }
548
549         e_info(hw, "VF requests change max MTU to %d\n", max_frame);
550
551         return 0;
552 }
553
554 static void ixgbe_set_vmolr(struct ixgbe_hw *hw, u32 vf, bool aupe)
555 {
556         u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
557         vmolr |= IXGBE_VMOLR_BAM;
558         if (aupe)
559                 vmolr |= IXGBE_VMOLR_AUPE;
560         else
561                 vmolr &= ~IXGBE_VMOLR_AUPE;
562         IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
563 }
564
565 static void ixgbe_clear_vmvir(struct ixgbe_adapter *adapter, u32 vf)
566 {
567         struct ixgbe_hw *hw = &adapter->hw;
568
569         IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf), 0);
570 }
571
572 static void ixgbe_clear_vf_vlans(struct ixgbe_adapter *adapter, u32 vf)
573 {
574         struct ixgbe_hw *hw = &adapter->hw;
575         u32 vlvfb_mask, pool_mask, i;
576
577         /* create mask for VF and other pools */
578         pool_mask = ~BIT(VMDQ_P(0) % 32);
579         vlvfb_mask = BIT(vf % 32);
580
581         /* post increment loop, covers VLVF_ENTRIES - 1 to 0 */
582         for (i = IXGBE_VLVF_ENTRIES; i--;) {
583                 u32 bits[2], vlvfb, vid, vfta, vlvf;
584                 u32 word = i * 2 + vf / 32;
585                 u32 mask;
586
587                 vlvfb = IXGBE_READ_REG(hw, IXGBE_VLVFB(word));
588
589                 /* if our bit isn't set we can skip it */
590                 if (!(vlvfb & vlvfb_mask))
591                         continue;
592
593                 /* clear our bit from vlvfb */
594                 vlvfb ^= vlvfb_mask;
595
596                 /* create 64b mask to chedk to see if we should clear VLVF */
597                 bits[word % 2] = vlvfb;
598                 bits[~word % 2] = IXGBE_READ_REG(hw, IXGBE_VLVFB(word ^ 1));
599
600                 /* if other pools are present, just remove ourselves */
601                 if (bits[(VMDQ_P(0) / 32) ^ 1] ||
602                     (bits[VMDQ_P(0) / 32] & pool_mask))
603                         goto update_vlvfb;
604
605                 /* if PF is present, leave VFTA */
606                 if (bits[0] || bits[1])
607                         goto update_vlvf;
608
609                 /* if we cannot determine VLAN just remove ourselves */
610                 vlvf = IXGBE_READ_REG(hw, IXGBE_VLVF(i));
611                 if (!vlvf)
612                         goto update_vlvfb;
613
614                 vid = vlvf & VLAN_VID_MASK;
615                 mask = BIT(vid % 32);
616
617                 /* clear bit from VFTA */
618                 vfta = IXGBE_READ_REG(hw, IXGBE_VFTA(vid / 32));
619                 if (vfta & mask)
620                         IXGBE_WRITE_REG(hw, IXGBE_VFTA(vid / 32), vfta ^ mask);
621 update_vlvf:
622                 /* clear POOL selection enable */
623                 IXGBE_WRITE_REG(hw, IXGBE_VLVF(i), 0);
624
625                 if (!(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
626                         vlvfb = 0;
627 update_vlvfb:
628                 /* clear pool bits */
629                 IXGBE_WRITE_REG(hw, IXGBE_VLVFB(word), vlvfb);
630         }
631 }
632
633 static int ixgbe_set_vf_macvlan(struct ixgbe_adapter *adapter,
634                                 int vf, int index, unsigned char *mac_addr)
635 {
636         struct vf_macvlans *entry;
637         struct list_head *pos;
638         int retval = 0;
639
640         if (index <= 1) {
641                 list_for_each(pos, &adapter->vf_mvs.l) {
642                         entry = list_entry(pos, struct vf_macvlans, l);
643                         if (entry->vf == vf) {
644                                 entry->vf = -1;
645                                 entry->free = true;
646                                 entry->is_macvlan = false;
647                                 ixgbe_del_mac_filter(adapter,
648                                                      entry->vf_macvlan, vf);
649                         }
650                 }
651         }
652
653         /*
654          * If index was zero then we were asked to clear the uc list
655          * for the VF.  We're done.
656          */
657         if (!index)
658                 return 0;
659
660         entry = NULL;
661
662         list_for_each(pos, &adapter->vf_mvs.l) {
663                 entry = list_entry(pos, struct vf_macvlans, l);
664                 if (entry->free)
665                         break;
666         }
667
668         /*
669          * If we traversed the entire list and didn't find a free entry
670          * then we're out of space on the RAR table.  Also entry may
671          * be NULL because the original memory allocation for the list
672          * failed, which is not fatal but does mean we can't support
673          * VF requests for MACVLAN because we couldn't allocate
674          * memory for the list management required.
675          */
676         if (!entry || !entry->free)
677                 return -ENOSPC;
678
679         retval = ixgbe_add_mac_filter(adapter, mac_addr, vf);
680         if (retval < 0)
681                 return retval;
682
683         entry->free = false;
684         entry->is_macvlan = true;
685         entry->vf = vf;
686         memcpy(entry->vf_macvlan, mac_addr, ETH_ALEN);
687
688         return 0;
689 }
690
691 static inline void ixgbe_vf_reset_event(struct ixgbe_adapter *adapter, u32 vf)
692 {
693         struct ixgbe_hw *hw = &adapter->hw;
694         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
695         struct vf_data_storage *vfinfo = &adapter->vfinfo[vf];
696         u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
697         u8 num_tcs = adapter->hw_tcs;
698         u32 reg_val;
699         u32 queue;
700
701         /* remove VLAN filters beloning to this VF */
702         ixgbe_clear_vf_vlans(adapter, vf);
703
704         /* add back PF assigned VLAN or VLAN 0 */
705         ixgbe_set_vf_vlan(adapter, true, vfinfo->pf_vlan, vf);
706
707         /* reset offloads to defaults */
708         ixgbe_set_vmolr(hw, vf, !vfinfo->pf_vlan);
709
710         /* set outgoing tags for VFs */
711         if (!vfinfo->pf_vlan && !vfinfo->pf_qos && !num_tcs) {
712                 ixgbe_clear_vmvir(adapter, vf);
713         } else {
714                 if (vfinfo->pf_qos || !num_tcs)
715                         ixgbe_set_vmvir(adapter, vfinfo->pf_vlan,
716                                         vfinfo->pf_qos, vf);
717                 else
718                         ixgbe_set_vmvir(adapter, vfinfo->pf_vlan,
719                                         adapter->default_up, vf);
720
721                 if (vfinfo->spoofchk_enabled) {
722                         hw->mac.ops.set_vlan_anti_spoofing(hw, true, vf);
723                         hw->mac.ops.set_mac_anti_spoofing(hw, true, vf);
724                 }
725         }
726
727         /* reset multicast table array for vf */
728         adapter->vfinfo[vf].num_vf_mc_hashes = 0;
729
730         /* Flush and reset the mta with the new values */
731         ixgbe_set_rx_mode(adapter->netdev);
732
733         ixgbe_del_mac_filter(adapter, adapter->vfinfo[vf].vf_mac_addresses, vf);
734         ixgbe_set_vf_macvlan(adapter, vf, 0, NULL);
735
736         /* reset VF api back to unknown */
737         adapter->vfinfo[vf].vf_api = ixgbe_mbox_api_10;
738
739         /* Restart each queue for given VF */
740         for (queue = 0; queue < q_per_pool; queue++) {
741                 unsigned int reg_idx = (vf * q_per_pool) + queue;
742
743                 reg_val = IXGBE_READ_REG(hw, IXGBE_PVFTXDCTL(reg_idx));
744
745                 /* Re-enabling only configured queues */
746                 if (reg_val) {
747                         reg_val |= IXGBE_TXDCTL_ENABLE;
748                         IXGBE_WRITE_REG(hw, IXGBE_PVFTXDCTL(reg_idx), reg_val);
749                         reg_val &= ~IXGBE_TXDCTL_ENABLE;
750                         IXGBE_WRITE_REG(hw, IXGBE_PVFTXDCTL(reg_idx), reg_val);
751                 }
752         }
753
754         IXGBE_WRITE_FLUSH(hw);
755 }
756
757 static void ixgbe_vf_clear_mbx(struct ixgbe_adapter *adapter, u32 vf)
758 {
759         struct ixgbe_hw *hw = &adapter->hw;
760         u32 word;
761
762         /* Clear VF's mailbox memory */
763         for (word = 0; word < IXGBE_VFMAILBOX_SIZE; word++)
764                 IXGBE_WRITE_REG_ARRAY(hw, IXGBE_PFMBMEM(vf), word, 0);
765
766         IXGBE_WRITE_FLUSH(hw);
767 }
768
769 static int ixgbe_set_vf_mac(struct ixgbe_adapter *adapter,
770                             int vf, unsigned char *mac_addr)
771 {
772         s32 retval;
773
774         ixgbe_del_mac_filter(adapter, adapter->vfinfo[vf].vf_mac_addresses, vf);
775         retval = ixgbe_add_mac_filter(adapter, mac_addr, vf);
776         if (retval >= 0)
777                 memcpy(adapter->vfinfo[vf].vf_mac_addresses, mac_addr,
778                        ETH_ALEN);
779         else
780                 memset(adapter->vfinfo[vf].vf_mac_addresses, 0, ETH_ALEN);
781
782         return retval;
783 }
784
785 int ixgbe_vf_configuration(struct pci_dev *pdev, unsigned int event_mask)
786 {
787         struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
788         unsigned int vfn = (event_mask & 0x3f);
789
790         bool enable = ((event_mask & 0x10000000U) != 0);
791
792         if (enable)
793                 eth_zero_addr(adapter->vfinfo[vfn].vf_mac_addresses);
794
795         return 0;
796 }
797
798 static inline void ixgbe_write_qde(struct ixgbe_adapter *adapter, u32 vf,
799                                    u32 qde)
800 {
801         struct ixgbe_hw *hw = &adapter->hw;
802         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
803         u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
804         int i;
805
806         for (i = vf * q_per_pool; i < ((vf + 1) * q_per_pool); i++) {
807                 u32 reg;
808
809                 /* flush previous write */
810                 IXGBE_WRITE_FLUSH(hw);
811
812                 /* indicate to hardware that we want to set drop enable */
813                 reg = IXGBE_QDE_WRITE | qde;
814                 reg |= i <<  IXGBE_QDE_IDX_SHIFT;
815                 IXGBE_WRITE_REG(hw, IXGBE_QDE, reg);
816         }
817 }
818
819 static int ixgbe_vf_reset_msg(struct ixgbe_adapter *adapter, u32 vf)
820 {
821         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
822         struct ixgbe_hw *hw = &adapter->hw;
823         unsigned char *vf_mac = adapter->vfinfo[vf].vf_mac_addresses;
824         u32 reg, reg_offset, vf_shift;
825         u32 msgbuf[4] = {0, 0, 0, 0};
826         u8 *addr = (u8 *)(&msgbuf[1]);
827         u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
828         int i;
829
830         e_info(probe, "VF Reset msg received from vf %d\n", vf);
831
832         /* reset the filters for the device */
833         ixgbe_vf_reset_event(adapter, vf);
834
835         ixgbe_vf_clear_mbx(adapter, vf);
836
837         /* set vf mac address */
838         if (!is_zero_ether_addr(vf_mac))
839                 ixgbe_set_vf_mac(adapter, vf, vf_mac);
840
841         vf_shift = vf % 32;
842         reg_offset = vf / 32;
843
844         /* enable transmit for vf */
845         reg = IXGBE_READ_REG(hw, IXGBE_VFTE(reg_offset));
846         reg |= BIT(vf_shift);
847         IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), reg);
848
849         /* force drop enable for all VF Rx queues */
850         reg = IXGBE_QDE_ENABLE;
851         if (adapter->vfinfo[vf].pf_vlan)
852                 reg |= IXGBE_QDE_HIDE_VLAN;
853
854         ixgbe_write_qde(adapter, vf, reg);
855
856         /* enable receive for vf */
857         reg = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
858         reg |= BIT(vf_shift);
859         /*
860          * The 82599 cannot support a mix of jumbo and non-jumbo PF/VFs.
861          * For more info take a look at ixgbe_set_vf_lpe
862          */
863         if (adapter->hw.mac.type == ixgbe_mac_82599EB) {
864                 struct net_device *dev = adapter->netdev;
865                 int pf_max_frame = dev->mtu + ETH_HLEN;
866
867 #ifdef CONFIG_FCOE
868                 if (dev->features & NETIF_F_FCOE_MTU)
869                         pf_max_frame = max_t(int, pf_max_frame,
870                                              IXGBE_FCOE_JUMBO_FRAME_SIZE);
871
872 #endif /* CONFIG_FCOE */
873                 if (pf_max_frame > ETH_FRAME_LEN)
874                         reg &= ~BIT(vf_shift);
875         }
876         IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), reg);
877
878         /* enable VF mailbox for further messages */
879         adapter->vfinfo[vf].clear_to_send = true;
880
881         /* Enable counting of spoofed packets in the SSVPC register */
882         reg = IXGBE_READ_REG(hw, IXGBE_VMECM(reg_offset));
883         reg |= BIT(vf_shift);
884         IXGBE_WRITE_REG(hw, IXGBE_VMECM(reg_offset), reg);
885
886         /*
887          * Reset the VFs TDWBAL and TDWBAH registers
888          * which are not cleared by an FLR
889          */
890         for (i = 0; i < q_per_pool; i++) {
891                 IXGBE_WRITE_REG(hw, IXGBE_PVFTDWBAHn(q_per_pool, vf, i), 0);
892                 IXGBE_WRITE_REG(hw, IXGBE_PVFTDWBALn(q_per_pool, vf, i), 0);
893         }
894
895         /* reply to reset with ack and vf mac address */
896         msgbuf[0] = IXGBE_VF_RESET;
897         if (!is_zero_ether_addr(vf_mac) && adapter->vfinfo[vf].pf_set_mac) {
898                 msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
899                 memcpy(addr, vf_mac, ETH_ALEN);
900         } else {
901                 msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
902         }
903
904         /*
905          * Piggyback the multicast filter type so VF can compute the
906          * correct vectors
907          */
908         msgbuf[3] = hw->mac.mc_filter_type;
909         ixgbe_write_mbx(hw, msgbuf, IXGBE_VF_PERMADDR_MSG_LEN, vf);
910
911         return 0;
912 }
913
914 static int ixgbe_set_vf_mac_addr(struct ixgbe_adapter *adapter,
915                                  u32 *msgbuf, u32 vf)
916 {
917         u8 *new_mac = ((u8 *)(&msgbuf[1]));
918
919         if (!is_valid_ether_addr(new_mac)) {
920                 e_warn(drv, "VF %d attempted to set invalid mac\n", vf);
921                 return -1;
922         }
923
924         if (adapter->vfinfo[vf].pf_set_mac && !adapter->vfinfo[vf].trusted &&
925             !ether_addr_equal(adapter->vfinfo[vf].vf_mac_addresses, new_mac)) {
926                 e_warn(drv,
927                        "VF %d attempted to override administratively set MAC address\n"
928                        "Reload the VF driver to resume operations\n",
929                        vf);
930                 return -1;
931         }
932
933         return ixgbe_set_vf_mac(adapter, vf, new_mac) < 0;
934 }
935
936 static int ixgbe_set_vf_vlan_msg(struct ixgbe_adapter *adapter,
937                                  u32 *msgbuf, u32 vf)
938 {
939         u32 add = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >> IXGBE_VT_MSGINFO_SHIFT;
940         u32 vid = (msgbuf[1] & IXGBE_VLVF_VLANID_MASK);
941         u8 tcs = adapter->hw_tcs;
942
943         if (adapter->vfinfo[vf].pf_vlan || tcs) {
944                 e_warn(drv,
945                        "VF %d attempted to override administratively set VLAN configuration\n"
946                        "Reload the VF driver to resume operations\n",
947                        vf);
948                 return -1;
949         }
950
951         /* VLAN 0 is a special case, don't allow it to be removed */
952         if (!vid && !add)
953                 return 0;
954
955         return ixgbe_set_vf_vlan(adapter, add, vid, vf);
956 }
957
958 static int ixgbe_set_vf_macvlan_msg(struct ixgbe_adapter *adapter,
959                                     u32 *msgbuf, u32 vf)
960 {
961         u8 *new_mac = ((u8 *)(&msgbuf[1]));
962         int index = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >>
963                     IXGBE_VT_MSGINFO_SHIFT;
964         int err;
965
966         if (adapter->vfinfo[vf].pf_set_mac && !adapter->vfinfo[vf].trusted &&
967             index > 0) {
968                 e_warn(drv,
969                        "VF %d requested MACVLAN filter but is administratively denied\n",
970                        vf);
971                 return -1;
972         }
973
974         /* An non-zero index indicates the VF is setting a filter */
975         if (index) {
976                 if (!is_valid_ether_addr(new_mac)) {
977                         e_warn(drv, "VF %d attempted to set invalid mac\n", vf);
978                         return -1;
979                 }
980
981                 /*
982                  * If the VF is allowed to set MAC filters then turn off
983                  * anti-spoofing to avoid false positives.
984                  */
985                 if (adapter->vfinfo[vf].spoofchk_enabled) {
986                         struct ixgbe_hw *hw = &adapter->hw;
987
988                         hw->mac.ops.set_mac_anti_spoofing(hw, false, vf);
989                         hw->mac.ops.set_vlan_anti_spoofing(hw, false, vf);
990                 }
991         }
992
993         err = ixgbe_set_vf_macvlan(adapter, vf, index, new_mac);
994         if (err == -ENOSPC)
995                 e_warn(drv,
996                        "VF %d has requested a MACVLAN filter but there is no space for it\n",
997                        vf);
998
999         return err < 0;
1000 }
1001
1002 static int ixgbe_negotiate_vf_api(struct ixgbe_adapter *adapter,
1003                                   u32 *msgbuf, u32 vf)
1004 {
1005         int api = msgbuf[1];
1006
1007         switch (api) {
1008         case ixgbe_mbox_api_10:
1009         case ixgbe_mbox_api_11:
1010         case ixgbe_mbox_api_12:
1011         case ixgbe_mbox_api_13:
1012                 adapter->vfinfo[vf].vf_api = api;
1013                 return 0;
1014         default:
1015                 break;
1016         }
1017
1018         e_info(drv, "VF %d requested invalid api version %u\n", vf, api);
1019
1020         return -1;
1021 }
1022
1023 static int ixgbe_get_vf_queues(struct ixgbe_adapter *adapter,
1024                                u32 *msgbuf, u32 vf)
1025 {
1026         struct net_device *dev = adapter->netdev;
1027         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
1028         unsigned int default_tc = 0;
1029         u8 num_tcs = adapter->hw_tcs;
1030
1031         /* verify the PF is supporting the correct APIs */
1032         switch (adapter->vfinfo[vf].vf_api) {
1033         case ixgbe_mbox_api_20:
1034         case ixgbe_mbox_api_11:
1035         case ixgbe_mbox_api_12:
1036         case ixgbe_mbox_api_13:
1037                 break;
1038         default:
1039                 return -1;
1040         }
1041
1042         /* only allow 1 Tx queue for bandwidth limiting */
1043         msgbuf[IXGBE_VF_TX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
1044         msgbuf[IXGBE_VF_RX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
1045
1046         /* if TCs > 1 determine which TC belongs to default user priority */
1047         if (num_tcs > 1)
1048                 default_tc = netdev_get_prio_tc_map(dev, adapter->default_up);
1049
1050         /* notify VF of need for VLAN tag stripping, and correct queue */
1051         if (num_tcs)
1052                 msgbuf[IXGBE_VF_TRANS_VLAN] = num_tcs;
1053         else if (adapter->vfinfo[vf].pf_vlan || adapter->vfinfo[vf].pf_qos)
1054                 msgbuf[IXGBE_VF_TRANS_VLAN] = 1;
1055         else
1056                 msgbuf[IXGBE_VF_TRANS_VLAN] = 0;
1057
1058         /* notify VF of default queue */
1059         msgbuf[IXGBE_VF_DEF_QUEUE] = default_tc;
1060
1061         return 0;
1062 }
1063
1064 static int ixgbe_get_vf_reta(struct ixgbe_adapter *adapter, u32 *msgbuf, u32 vf)
1065 {
1066         u32 i, j;
1067         u32 *out_buf = &msgbuf[1];
1068         const u8 *reta = adapter->rss_indir_tbl;
1069         u32 reta_size = ixgbe_rss_indir_tbl_entries(adapter);
1070
1071         /* Check if operation is permitted */
1072         if (!adapter->vfinfo[vf].rss_query_enabled)
1073                 return -EPERM;
1074
1075         /* verify the PF is supporting the correct API */
1076         switch (adapter->vfinfo[vf].vf_api) {
1077         case ixgbe_mbox_api_13:
1078         case ixgbe_mbox_api_12:
1079                 break;
1080         default:
1081                 return -EOPNOTSUPP;
1082         }
1083
1084         /* This mailbox command is supported (required) only for 82599 and x540
1085          * VFs which support up to 4 RSS queues. Therefore we will compress the
1086          * RETA by saving only 2 bits from each entry. This way we will be able
1087          * to transfer the whole RETA in a single mailbox operation.
1088          */
1089         for (i = 0; i < reta_size / 16; i++) {
1090                 out_buf[i] = 0;
1091                 for (j = 0; j < 16; j++)
1092                         out_buf[i] |= (u32)(reta[16 * i + j] & 0x3) << (2 * j);
1093         }
1094
1095         return 0;
1096 }
1097
1098 static int ixgbe_get_vf_rss_key(struct ixgbe_adapter *adapter,
1099                                 u32 *msgbuf, u32 vf)
1100 {
1101         u32 *rss_key = &msgbuf[1];
1102
1103         /* Check if the operation is permitted */
1104         if (!adapter->vfinfo[vf].rss_query_enabled)
1105                 return -EPERM;
1106
1107         /* verify the PF is supporting the correct API */
1108         switch (adapter->vfinfo[vf].vf_api) {
1109         case ixgbe_mbox_api_13:
1110         case ixgbe_mbox_api_12:
1111                 break;
1112         default:
1113                 return -EOPNOTSUPP;
1114         }
1115
1116         memcpy(rss_key, adapter->rss_key, IXGBE_RSS_KEY_SIZE);
1117
1118         return 0;
1119 }
1120
1121 static int ixgbe_update_vf_xcast_mode(struct ixgbe_adapter *adapter,
1122                                       u32 *msgbuf, u32 vf)
1123 {
1124         struct ixgbe_hw *hw = &adapter->hw;
1125         int xcast_mode = msgbuf[1];
1126         u32 vmolr, fctrl, disable, enable;
1127
1128         /* verify the PF is supporting the correct APIs */
1129         switch (adapter->vfinfo[vf].vf_api) {
1130         case ixgbe_mbox_api_12:
1131                 /* promisc introduced in 1.3 version */
1132                 if (xcast_mode == IXGBEVF_XCAST_MODE_PROMISC)
1133                         return -EOPNOTSUPP;
1134                 /* Fall threw */
1135         case ixgbe_mbox_api_13:
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_ROMPE |
1152                           IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1153                 enable = IXGBE_VMOLR_BAM;
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 = IXGBE_VMOLR_VPE;
1176                 enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE |
1177                          IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE;
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[1], 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         default:
1262                 e_err(drv, "Unhandled Msg %8.8x\n", msgbuf[0]);
1263                 retval = IXGBE_ERR_MBX;
1264                 break;
1265         }
1266
1267         /* notify the VF of the results of what it sent us */
1268         if (retval)
1269                 msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
1270         else
1271                 msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
1272
1273         msgbuf[0] |= IXGBE_VT_MSGTYPE_CTS;
1274
1275         ixgbe_write_mbx(hw, msgbuf, mbx_size, vf);
1276
1277         return retval;
1278 }
1279
1280 static void ixgbe_rcv_ack_from_vf(struct ixgbe_adapter *adapter, u32 vf)
1281 {
1282         struct ixgbe_hw *hw = &adapter->hw;
1283         u32 msg = IXGBE_VT_MSGTYPE_NACK;
1284
1285         /* if device isn't clear to send it shouldn't be reading either */
1286         if (!adapter->vfinfo[vf].clear_to_send)
1287                 ixgbe_write_mbx(hw, &msg, 1, vf);
1288 }
1289
1290 void ixgbe_msg_task(struct ixgbe_adapter *adapter)
1291 {
1292         struct ixgbe_hw *hw = &adapter->hw;
1293         u32 vf;
1294
1295         for (vf = 0; vf < adapter->num_vfs; vf++) {
1296                 /* process any reset requests */
1297                 if (!ixgbe_check_for_rst(hw, vf))
1298                         ixgbe_vf_reset_event(adapter, vf);
1299
1300                 /* process any messages pending */
1301                 if (!ixgbe_check_for_msg(hw, vf))
1302                         ixgbe_rcv_msg_from_vf(adapter, vf);
1303
1304                 /* process any acks */
1305                 if (!ixgbe_check_for_ack(hw, vf))
1306                         ixgbe_rcv_ack_from_vf(adapter, vf);
1307         }
1308 }
1309
1310 void ixgbe_disable_tx_rx(struct ixgbe_adapter *adapter)
1311 {
1312         struct ixgbe_hw *hw = &adapter->hw;
1313
1314         /* disable transmit and receive for all vfs */
1315         IXGBE_WRITE_REG(hw, IXGBE_VFTE(0), 0);
1316         IXGBE_WRITE_REG(hw, IXGBE_VFTE(1), 0);
1317
1318         IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), 0);
1319         IXGBE_WRITE_REG(hw, IXGBE_VFRE(1), 0);
1320 }
1321
1322 static inline void ixgbe_ping_vf(struct ixgbe_adapter *adapter, int vf)
1323 {
1324         struct ixgbe_hw *hw = &adapter->hw;
1325         u32 ping;
1326
1327         ping = IXGBE_PF_CONTROL_MSG;
1328         if (adapter->vfinfo[vf].clear_to_send)
1329                 ping |= IXGBE_VT_MSGTYPE_CTS;
1330         ixgbe_write_mbx(hw, &ping, 1, vf);
1331 }
1332
1333 void ixgbe_ping_all_vfs(struct ixgbe_adapter *adapter)
1334 {
1335         struct ixgbe_hw *hw = &adapter->hw;
1336         u32 ping;
1337         int i;
1338
1339         for (i = 0 ; i < adapter->num_vfs; i++) {
1340                 ping = IXGBE_PF_CONTROL_MSG;
1341                 if (adapter->vfinfo[i].clear_to_send)
1342                         ping |= IXGBE_VT_MSGTYPE_CTS;
1343                 ixgbe_write_mbx(hw, &ping, 1, i);
1344         }
1345 }
1346
1347 int ixgbe_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
1348 {
1349         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1350         s32 retval;
1351
1352         if (vf >= adapter->num_vfs)
1353                 return -EINVAL;
1354
1355         if (is_valid_ether_addr(mac)) {
1356                 dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n",
1357                          mac, vf);
1358                 dev_info(&adapter->pdev->dev, "Reload the VF driver to make this change effective.");
1359
1360                 retval = ixgbe_set_vf_mac(adapter, vf, mac);
1361                 if (retval >= 0) {
1362                         adapter->vfinfo[vf].pf_set_mac = true;
1363
1364                         if (test_bit(__IXGBE_DOWN, &adapter->state)) {
1365                                 dev_warn(&adapter->pdev->dev, "The VF MAC address has been set, but the PF device is not up.\n");
1366                                 dev_warn(&adapter->pdev->dev, "Bring the PF device up before attempting to use the VF device.\n");
1367                         }
1368                 } else {
1369                         dev_warn(&adapter->pdev->dev, "The VF MAC address was NOT set due to invalid or duplicate MAC address.\n");
1370                 }
1371         } else if (is_zero_ether_addr(mac)) {
1372                 unsigned char *vf_mac_addr =
1373                                            adapter->vfinfo[vf].vf_mac_addresses;
1374
1375                 /* nothing to do */
1376                 if (is_zero_ether_addr(vf_mac_addr))
1377                         return 0;
1378
1379                 dev_info(&adapter->pdev->dev, "removing MAC on VF %d\n", vf);
1380
1381                 retval = ixgbe_del_mac_filter(adapter, vf_mac_addr, vf);
1382                 if (retval >= 0) {
1383                         adapter->vfinfo[vf].pf_set_mac = false;
1384                         memcpy(vf_mac_addr, mac, ETH_ALEN);
1385                 } else {
1386                         dev_warn(&adapter->pdev->dev, "Could NOT remove the VF MAC address.\n");
1387                 }
1388         } else {
1389                 retval = -EINVAL;
1390         }
1391
1392         return retval;
1393 }
1394
1395 static int ixgbe_enable_port_vlan(struct ixgbe_adapter *adapter, int vf,
1396                                   u16 vlan, u8 qos)
1397 {
1398         struct ixgbe_hw *hw = &adapter->hw;
1399         int err;
1400
1401         err = ixgbe_set_vf_vlan(adapter, true, vlan, vf);
1402         if (err)
1403                 goto out;
1404
1405         /* Revoke tagless access via VLAN 0 */
1406         ixgbe_set_vf_vlan(adapter, false, 0, vf);
1407
1408         ixgbe_set_vmvir(adapter, vlan, qos, vf);
1409         ixgbe_set_vmolr(hw, vf, false);
1410
1411         /* enable hide vlan on X550 */
1412         if (hw->mac.type >= ixgbe_mac_X550)
1413                 ixgbe_write_qde(adapter, vf, IXGBE_QDE_ENABLE |
1414                                 IXGBE_QDE_HIDE_VLAN);
1415
1416         adapter->vfinfo[vf].pf_vlan = vlan;
1417         adapter->vfinfo[vf].pf_qos = qos;
1418         dev_info(&adapter->pdev->dev,
1419                  "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
1420         if (test_bit(__IXGBE_DOWN, &adapter->state)) {
1421                 dev_warn(&adapter->pdev->dev,
1422                          "The VF VLAN has been set, but the PF device is not up.\n");
1423                 dev_warn(&adapter->pdev->dev,
1424                          "Bring the PF device up before attempting to use the VF device.\n");
1425         }
1426
1427 out:
1428         return err;
1429 }
1430
1431 static int ixgbe_disable_port_vlan(struct ixgbe_adapter *adapter, int vf)
1432 {
1433         struct ixgbe_hw *hw = &adapter->hw;
1434         int err;
1435
1436         err = ixgbe_set_vf_vlan(adapter, false,
1437                                 adapter->vfinfo[vf].pf_vlan, vf);
1438         /* Restore tagless access via VLAN 0 */
1439         ixgbe_set_vf_vlan(adapter, true, 0, vf);
1440         ixgbe_clear_vmvir(adapter, vf);
1441         ixgbe_set_vmolr(hw, vf, true);
1442
1443         /* disable hide VLAN on X550 */
1444         if (hw->mac.type >= ixgbe_mac_X550)
1445                 ixgbe_write_qde(adapter, vf, IXGBE_QDE_ENABLE);
1446
1447         adapter->vfinfo[vf].pf_vlan = 0;
1448         adapter->vfinfo[vf].pf_qos = 0;
1449
1450         return err;
1451 }
1452
1453 int ixgbe_ndo_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan,
1454                           u8 qos, __be16 vlan_proto)
1455 {
1456         int err = 0;
1457         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1458
1459         if ((vf >= adapter->num_vfs) || (vlan > 4095) || (qos > 7))
1460                 return -EINVAL;
1461         if (vlan_proto != htons(ETH_P_8021Q))
1462                 return -EPROTONOSUPPORT;
1463         if (vlan || qos) {
1464                 /* Check if there is already a port VLAN set, if so
1465                  * we have to delete the old one first before we
1466                  * can set the new one.  The usage model had
1467                  * previously assumed the user would delete the
1468                  * old port VLAN before setting a new one but this
1469                  * is not necessarily the case.
1470                  */
1471                 if (adapter->vfinfo[vf].pf_vlan)
1472                         err = ixgbe_disable_port_vlan(adapter, vf);
1473                 if (err)
1474                         goto out;
1475                 err = ixgbe_enable_port_vlan(adapter, vf, vlan, qos);
1476         } else {
1477                 err = ixgbe_disable_port_vlan(adapter, vf);
1478         }
1479
1480 out:
1481         return err;
1482 }
1483
1484 int ixgbe_link_mbps(struct ixgbe_adapter *adapter)
1485 {
1486         switch (adapter->link_speed) {
1487         case IXGBE_LINK_SPEED_100_FULL:
1488                 return 100;
1489         case IXGBE_LINK_SPEED_1GB_FULL:
1490                 return 1000;
1491         case IXGBE_LINK_SPEED_10GB_FULL:
1492                 return 10000;
1493         default:
1494                 return 0;
1495         }
1496 }
1497
1498 static void ixgbe_set_vf_rate_limit(struct ixgbe_adapter *adapter, int vf)
1499 {
1500         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
1501         struct ixgbe_hw *hw = &adapter->hw;
1502         u32 bcnrc_val = 0;
1503         u16 queue, queues_per_pool;
1504         u16 tx_rate = adapter->vfinfo[vf].tx_rate;
1505
1506         if (tx_rate) {
1507                 /* start with base link speed value */
1508                 bcnrc_val = adapter->vf_rate_link_speed;
1509
1510                 /* Calculate the rate factor values to set */
1511                 bcnrc_val <<= IXGBE_RTTBCNRC_RF_INT_SHIFT;
1512                 bcnrc_val /= tx_rate;
1513
1514                 /* clear everything but the rate factor */
1515                 bcnrc_val &= IXGBE_RTTBCNRC_RF_INT_MASK |
1516                              IXGBE_RTTBCNRC_RF_DEC_MASK;
1517
1518                 /* enable the rate scheduler */
1519                 bcnrc_val |= IXGBE_RTTBCNRC_RS_ENA;
1520         }
1521
1522         /*
1523          * Set global transmit compensation time to the MMW_SIZE in RTTBCNRM
1524          * register. Typically MMW_SIZE=0x014 if 9728-byte jumbo is supported
1525          * and 0x004 otherwise.
1526          */
1527         switch (hw->mac.type) {
1528         case ixgbe_mac_82599EB:
1529                 IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x4);
1530                 break;
1531         case ixgbe_mac_X540:
1532                 IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x14);
1533                 break;
1534         default:
1535                 break;
1536         }
1537
1538         /* determine how many queues per pool based on VMDq mask */
1539         queues_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
1540
1541         /* write value for all Tx queues belonging to VF */
1542         for (queue = 0; queue < queues_per_pool; queue++) {
1543                 unsigned int reg_idx = (vf * queues_per_pool) + queue;
1544
1545                 IXGBE_WRITE_REG(hw, IXGBE_RTTDQSEL, reg_idx);
1546                 IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRC, bcnrc_val);
1547         }
1548 }
1549
1550 void ixgbe_check_vf_rate_limit(struct ixgbe_adapter *adapter)
1551 {
1552         int i;
1553
1554         /* VF Tx rate limit was not set */
1555         if (!adapter->vf_rate_link_speed)
1556                 return;
1557
1558         if (ixgbe_link_mbps(adapter) != adapter->vf_rate_link_speed) {
1559                 adapter->vf_rate_link_speed = 0;
1560                 dev_info(&adapter->pdev->dev,
1561                          "Link speed has been changed. VF Transmit rate is disabled\n");
1562         }
1563
1564         for (i = 0; i < adapter->num_vfs; i++) {
1565                 if (!adapter->vf_rate_link_speed)
1566                         adapter->vfinfo[i].tx_rate = 0;
1567
1568                 ixgbe_set_vf_rate_limit(adapter, i);
1569         }
1570 }
1571
1572 int ixgbe_ndo_set_vf_bw(struct net_device *netdev, int vf, int min_tx_rate,
1573                         int max_tx_rate)
1574 {
1575         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1576         int link_speed;
1577
1578         /* verify VF is active */
1579         if (vf >= adapter->num_vfs)
1580                 return -EINVAL;
1581
1582         /* verify link is up */
1583         if (!adapter->link_up)
1584                 return -EINVAL;
1585
1586         /* verify we are linked at 10Gbps */
1587         link_speed = ixgbe_link_mbps(adapter);
1588         if (link_speed != 10000)
1589                 return -EINVAL;
1590
1591         if (min_tx_rate)
1592                 return -EINVAL;
1593
1594         /* rate limit cannot be less than 10Mbs or greater than link speed */
1595         if (max_tx_rate && ((max_tx_rate <= 10) || (max_tx_rate > link_speed)))
1596                 return -EINVAL;
1597
1598         /* store values */
1599         adapter->vf_rate_link_speed = link_speed;
1600         adapter->vfinfo[vf].tx_rate = max_tx_rate;
1601
1602         /* update hardware configuration */
1603         ixgbe_set_vf_rate_limit(adapter, vf);
1604
1605         return 0;
1606 }
1607
1608 int ixgbe_ndo_set_vf_spoofchk(struct net_device *netdev, int vf, bool setting)
1609 {
1610         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1611         struct ixgbe_hw *hw = &adapter->hw;
1612
1613         if (vf >= adapter->num_vfs)
1614                 return -EINVAL;
1615
1616         adapter->vfinfo[vf].spoofchk_enabled = setting;
1617
1618         /* configure MAC spoofing */
1619         hw->mac.ops.set_mac_anti_spoofing(hw, setting, vf);
1620
1621         /* configure VLAN spoofing */
1622         hw->mac.ops.set_vlan_anti_spoofing(hw, setting, vf);
1623
1624         /* Ensure LLDP and FC is set for Ethertype Antispoofing if we will be
1625          * calling set_ethertype_anti_spoofing for each VF in loop below
1626          */
1627         if (hw->mac.ops.set_ethertype_anti_spoofing) {
1628                 IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_LLDP),
1629                                 (IXGBE_ETQF_FILTER_EN    |
1630                                  IXGBE_ETQF_TX_ANTISPOOF |
1631                                  IXGBE_ETH_P_LLDP));
1632
1633                 IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_FC),
1634                                 (IXGBE_ETQF_FILTER_EN |
1635                                  IXGBE_ETQF_TX_ANTISPOOF |
1636                                  ETH_P_PAUSE));
1637
1638                 hw->mac.ops.set_ethertype_anti_spoofing(hw, setting, vf);
1639         }
1640
1641         return 0;
1642 }
1643
1644 int ixgbe_ndo_set_vf_rss_query_en(struct net_device *netdev, int vf,
1645                                   bool setting)
1646 {
1647         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1648
1649         /* This operation is currently supported only for 82599 and x540
1650          * devices.
1651          */
1652         if (adapter->hw.mac.type < ixgbe_mac_82599EB ||
1653             adapter->hw.mac.type >= ixgbe_mac_X550)
1654                 return -EOPNOTSUPP;
1655
1656         if (vf >= adapter->num_vfs)
1657                 return -EINVAL;
1658
1659         adapter->vfinfo[vf].rss_query_enabled = setting;
1660
1661         return 0;
1662 }
1663
1664 int ixgbe_ndo_set_vf_trust(struct net_device *netdev, int vf, bool setting)
1665 {
1666         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1667
1668         if (vf >= adapter->num_vfs)
1669                 return -EINVAL;
1670
1671         /* nothing to do */
1672         if (adapter->vfinfo[vf].trusted == setting)
1673                 return 0;
1674
1675         adapter->vfinfo[vf].trusted = setting;
1676
1677         /* reset VF to reconfigure features */
1678         adapter->vfinfo[vf].clear_to_send = false;
1679         ixgbe_ping_vf(adapter, vf);
1680
1681         e_info(drv, "VF %u is %strusted\n", vf, setting ? "" : "not ");
1682
1683         return 0;
1684 }
1685
1686 int ixgbe_ndo_get_vf_config(struct net_device *netdev,
1687                             int vf, struct ifla_vf_info *ivi)
1688 {
1689         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1690         if (vf >= adapter->num_vfs)
1691                 return -EINVAL;
1692         ivi->vf = vf;
1693         memcpy(&ivi->mac, adapter->vfinfo[vf].vf_mac_addresses, ETH_ALEN);
1694         ivi->max_tx_rate = adapter->vfinfo[vf].tx_rate;
1695         ivi->min_tx_rate = 0;
1696         ivi->vlan = adapter->vfinfo[vf].pf_vlan;
1697         ivi->qos = adapter->vfinfo[vf].pf_qos;
1698         ivi->spoofchk = adapter->vfinfo[vf].spoofchk_enabled;
1699         ivi->rss_query_en = adapter->vfinfo[vf].rss_query_enabled;
1700         ivi->trusted = adapter->vfinfo[vf].trusted;
1701         return 0;
1702 }