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