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