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