1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 1999 - 2018 Intel Corporation. */
3 
4 #include <linux/types.h>
5 #include <linux/module.h>
6 #include <linux/pci.h>
7 #include <linux/netdevice.h>
8 #include <linux/vmalloc.h>
9 #include <linux/string.h>
10 #include <linux/in.h>
11 #include <linux/ip.h>
12 #include <linux/tcp.h>
13 #include <linux/ipv6.h>
14 #include <linux/if_bridge.h>
15 #ifdef NETIF_F_HW_VLAN_CTAG_TX
16 #include <linux/if_vlan.h>
17 #endif
18 
19 #include "ixgbe.h"
20 #include "ixgbe_type.h"
21 #include "ixgbe_sriov.h"
22 
23 #ifdef CONFIG_PCI_IOV
24 static inline void ixgbe_alloc_vf_macvlans(struct ixgbe_adapter *adapter,
25 					   unsigned int num_vfs)
26 {
27 	struct ixgbe_hw *hw = &adapter->hw;
28 	struct vf_macvlans *mv_list;
29 	int num_vf_macvlans, i;
30 
31 	num_vf_macvlans = hw->mac.num_rar_entries -
32 			  (IXGBE_MAX_PF_MACVLANS + 1 + num_vfs);
33 	if (!num_vf_macvlans)
34 		return;
35 
36 	mv_list = kcalloc(num_vf_macvlans, sizeof(struct vf_macvlans),
37 			  GFP_KERNEL);
38 	if (mv_list) {
39 		/* Initialize list of VF macvlans */
40 		INIT_LIST_HEAD(&adapter->vf_mvs.l);
41 		for (i = 0; i < num_vf_macvlans; i++) {
42 			mv_list[i].vf = -1;
43 			mv_list[i].free = true;
44 			list_add(&mv_list[i].l, &adapter->vf_mvs.l);
45 		}
46 		adapter->mv_list = mv_list;
47 	}
48 }
49 
50 static int __ixgbe_enable_sriov(struct ixgbe_adapter *adapter,
51 				unsigned int num_vfs)
52 {
53 	struct ixgbe_hw *hw = &adapter->hw;
54 	int i;
55 
56 	/* Enable VMDq flag so device will be set in VM mode */
57 	adapter->flags |= IXGBE_FLAG_SRIOV_ENABLED |
58 			  IXGBE_FLAG_VMDQ_ENABLED;
59 
60 	/* Allocate memory for per VF control structures */
61 	adapter->vfinfo = kcalloc(num_vfs, sizeof(struct vf_data_storage),
62 				  GFP_KERNEL);
63 	if (!adapter->vfinfo)
64 		return -ENOMEM;
65 
66 	adapter->num_vfs = num_vfs;
67 
68 	ixgbe_alloc_vf_macvlans(adapter, num_vfs);
69 	adapter->ring_feature[RING_F_VMDQ].offset = num_vfs;
70 
71 	/* Initialize default switching mode VEB */
72 	IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);
73 	adapter->bridge_mode = BRIDGE_MODE_VEB;
74 
75 	/* limit trafffic classes based on VFs enabled */
76 	if ((adapter->hw.mac.type == ixgbe_mac_82599EB) && (num_vfs < 16)) {
77 		adapter->dcb_cfg.num_tcs.pg_tcs = MAX_TRAFFIC_CLASS;
78 		adapter->dcb_cfg.num_tcs.pfc_tcs = MAX_TRAFFIC_CLASS;
79 	} else if (num_vfs < 32) {
80 		adapter->dcb_cfg.num_tcs.pg_tcs = 4;
81 		adapter->dcb_cfg.num_tcs.pfc_tcs = 4;
82 	} else {
83 		adapter->dcb_cfg.num_tcs.pg_tcs = 1;
84 		adapter->dcb_cfg.num_tcs.pfc_tcs = 1;
85 	}
86 
87 	/* Disable RSC when in SR-IOV mode */
88 	adapter->flags2 &= ~(IXGBE_FLAG2_RSC_CAPABLE |
89 			     IXGBE_FLAG2_RSC_ENABLED);
90 
91 	for (i = 0; i < num_vfs; i++) {
92 		/* enable spoof checking for all VFs */
93 		adapter->vfinfo[i].spoofchk_enabled = true;
94 
95 		/* We support VF RSS querying only for 82599 and x540
96 		 * devices at the moment. These devices share RSS
97 		 * indirection table and RSS hash key with PF therefore
98 		 * we want to disable the querying by default.
99 		 */
100 		adapter->vfinfo[i].rss_query_enabled = 0;
101 
102 		/* Untrust all VFs */
103 		adapter->vfinfo[i].trusted = false;
104 
105 		/* set the default xcast mode */
106 		adapter->vfinfo[i].xcast_mode = IXGBEVF_XCAST_MODE_NONE;
107 	}
108 
109 	e_info(probe, "SR-IOV enabled with %d VFs\n", num_vfs);
110 	return 0;
111 }
112 
113 /**
114  * ixgbe_get_vfs - Find and take references to all vf devices
115  * @adapter: Pointer to adapter struct
116  */
117 static void ixgbe_get_vfs(struct ixgbe_adapter *adapter)
118 {
119 	struct pci_dev *pdev = adapter->pdev;
120 	u16 vendor = pdev->vendor;
121 	struct pci_dev *vfdev;
122 	int vf = 0;
123 	u16 vf_id;
124 	int pos;
125 
126 	pos = pci_find_ext_capability(pdev, PCI_EXT_CAP_ID_SRIOV);
127 	if (!pos)
128 		return;
129 	pci_read_config_word(pdev, pos + PCI_SRIOV_VF_DID, &vf_id);
130 
131 	vfdev = pci_get_device(vendor, vf_id, NULL);
132 	for (; vfdev; vfdev = pci_get_device(vendor, vf_id, vfdev)) {
133 		if (!vfdev->is_virtfn)
134 			continue;
135 		if (vfdev->physfn != pdev)
136 			continue;
137 		if (vf >= adapter->num_vfs)
138 			continue;
139 		pci_dev_get(vfdev);
140 		adapter->vfinfo[vf].vfdev = vfdev;
141 		++vf;
142 	}
143 }
144 
145 /* Note this function is called when the user wants to enable SR-IOV
146  * VFs using the now deprecated module parameter
147  */
148 void ixgbe_enable_sriov(struct ixgbe_adapter *adapter, unsigned int max_vfs)
149 {
150 	int pre_existing_vfs = 0;
151 	unsigned int num_vfs;
152 
153 	pre_existing_vfs = pci_num_vf(adapter->pdev);
154 	if (!pre_existing_vfs && !max_vfs)
155 		return;
156 
157 	/* If there are pre-existing VFs then we have to force
158 	 * use of that many - over ride any module parameter value.
159 	 * This may result from the user unloading the PF driver
160 	 * while VFs were assigned to guest VMs or because the VFs
161 	 * have been created via the new PCI SR-IOV sysfs interface.
162 	 */
163 	if (pre_existing_vfs) {
164 		num_vfs = pre_existing_vfs;
165 		dev_warn(&adapter->pdev->dev,
166 			 "Virtual Functions already enabled for this device - Please reload all VF drivers to avoid spoofed packet errors\n");
167 	} else {
168 		int err;
169 		/*
170 		 * The 82599 supports up to 64 VFs per physical function
171 		 * but this implementation limits allocation to 63 so that
172 		 * basic networking resources are still available to the
173 		 * physical function.  If the user requests greater than
174 		 * 63 VFs then it is an error - reset to default of zero.
175 		 */
176 		num_vfs = min_t(unsigned int, max_vfs, IXGBE_MAX_VFS_DRV_LIMIT);
177 
178 		err = pci_enable_sriov(adapter->pdev, num_vfs);
179 		if (err) {
180 			e_err(probe, "Failed to enable PCI sriov: %d\n", err);
181 			return;
182 		}
183 	}
184 
185 	if (!__ixgbe_enable_sriov(adapter, num_vfs)) {
186 		ixgbe_get_vfs(adapter);
187 		return;
188 	}
189 
190 	/* If we have gotten to this point then there is no memory available
191 	 * to manage the VF devices - print message and bail.
192 	 */
193 	e_err(probe, "Unable to allocate memory for VF Data Storage - "
194 	      "SRIOV disabled\n");
195 	ixgbe_disable_sriov(adapter);
196 }
197 
198 #endif /* #ifdef CONFIG_PCI_IOV */
199 int ixgbe_disable_sriov(struct ixgbe_adapter *adapter)
200 {
201 	unsigned int num_vfs = adapter->num_vfs, vf;
202 	int rss;
203 
204 	/* set num VFs to 0 to prevent access to vfinfo */
205 	adapter->num_vfs = 0;
206 
207 	/* put the reference to all of the vf devices */
208 	for (vf = 0; vf < num_vfs; ++vf) {
209 		struct pci_dev *vfdev = adapter->vfinfo[vf].vfdev;
210 
211 		if (!vfdev)
212 			continue;
213 		adapter->vfinfo[vf].vfdev = NULL;
214 		pci_dev_put(vfdev);
215 	}
216 
217 	/* free VF control structures */
218 	kfree(adapter->vfinfo);
219 	adapter->vfinfo = NULL;
220 
221 	/* free macvlan list */
222 	kfree(adapter->mv_list);
223 	adapter->mv_list = NULL;
224 
225 	/* if SR-IOV is already disabled then there is nothing to do */
226 	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
227 		return 0;
228 
229 #ifdef CONFIG_PCI_IOV
230 	/*
231 	 * If our VFs are assigned we cannot shut down SR-IOV
232 	 * without causing issues, so just leave the hardware
233 	 * available but disabled
234 	 */
235 	if (pci_vfs_assigned(adapter->pdev)) {
236 		e_dev_warn("Unloading driver while VFs are assigned - VFs will not be deallocated\n");
237 		return -EPERM;
238 	}
239 	/* disable iov and allow time for transactions to clear */
240 	pci_disable_sriov(adapter->pdev);
241 #endif
242 
243 	/* Disable VMDq flag so device will be set in VM mode */
244 	if (bitmap_weight(adapter->fwd_bitmask, adapter->num_rx_pools) == 1) {
245 		adapter->flags &= ~IXGBE_FLAG_VMDQ_ENABLED;
246 		adapter->flags &= ~IXGBE_FLAG_SRIOV_ENABLED;
247 		rss = min_t(int, ixgbe_max_rss_indices(adapter),
248 			    num_online_cpus());
249 	} else {
250 		rss = min_t(int, IXGBE_MAX_L2A_QUEUES, num_online_cpus());
251 	}
252 
253 	adapter->ring_feature[RING_F_VMDQ].offset = 0;
254 	adapter->ring_feature[RING_F_RSS].limit = rss;
255 
256 	/* take a breather then clean up driver data */
257 	msleep(100);
258 	return 0;
259 }
260 
261 static int ixgbe_pci_sriov_enable(struct pci_dev *dev, int num_vfs)
262 {
263 #ifdef CONFIG_PCI_IOV
264 	struct ixgbe_adapter *adapter = pci_get_drvdata(dev);
265 	int pre_existing_vfs = pci_num_vf(dev);
266 	int err = 0, num_rx_pools, i, limit;
267 	u8 num_tc;
268 
269 	if (pre_existing_vfs && pre_existing_vfs != num_vfs)
270 		err = ixgbe_disable_sriov(adapter);
271 	else if (pre_existing_vfs && pre_existing_vfs == num_vfs)
272 		return num_vfs;
273 
274 	if (err)
275 		return err;
276 
277 	/* While the SR-IOV capability structure reports total VFs to be 64,
278 	 * we limit the actual number allocated as below based on two factors.
279 	 *    Num_TCs	MAX_VFs
280 	 *	1	  63
281 	 *	<=4	  31
282 	 *	>4	  15
283 	 * First, we reserve some transmit/receive resources for the PF.
284 	 * Second, VMDQ also uses the same pools that SR-IOV does. We need to
285 	 * account for this, so that we don't accidentally allocate more VFs
286 	 * than we have available pools. The PCI bus driver already checks for
287 	 * other values out of range.
288 	 */
289 	num_tc = adapter->hw_tcs;
290 	num_rx_pools = bitmap_weight(adapter->fwd_bitmask,
291 				     adapter->num_rx_pools);
292 	limit = (num_tc > 4) ? IXGBE_MAX_VFS_8TC :
293 		(num_tc > 1) ? IXGBE_MAX_VFS_4TC : IXGBE_MAX_VFS_1TC;
294 
295 	if (num_vfs > (limit - num_rx_pools)) {
296 		e_dev_err("Currently configured with %d TCs, and %d offloaded macvlans. Creating more than %d VFs is not allowed\n",
297 			  num_tc, num_rx_pools - 1, limit - num_rx_pools);
298 		return -EPERM;
299 	}
300 
301 	err = __ixgbe_enable_sriov(adapter, num_vfs);
302 	if (err)
303 		return  err;
304 
305 	for (i = 0; i < num_vfs; i++)
306 		ixgbe_vf_configuration(dev, (i | 0x10000000));
307 
308 	/* reset before enabling SRIOV to avoid mailbox issues */
309 	ixgbe_sriov_reinit(adapter);
310 
311 	err = pci_enable_sriov(dev, num_vfs);
312 	if (err) {
313 		e_dev_warn("Failed to enable PCI sriov: %d\n", err);
314 		return err;
315 	}
316 	ixgbe_get_vfs(adapter);
317 
318 	return num_vfs;
319 #else
320 	return 0;
321 #endif
322 }
323 
324 static int ixgbe_pci_sriov_disable(struct pci_dev *dev)
325 {
326 	struct ixgbe_adapter *adapter = pci_get_drvdata(dev);
327 	int err;
328 #ifdef CONFIG_PCI_IOV
329 	u32 current_flags = adapter->flags;
330 	int prev_num_vf = pci_num_vf(dev);
331 #endif
332 
333 	err = ixgbe_disable_sriov(adapter);
334 
335 	/* Only reinit if no error and state changed */
336 #ifdef CONFIG_PCI_IOV
337 	if (!err && (current_flags != adapter->flags ||
338 		     prev_num_vf != pci_num_vf(dev)))
339 		ixgbe_sriov_reinit(adapter);
340 #endif
341 
342 	return err;
343 }
344 
345 int ixgbe_pci_sriov_configure(struct pci_dev *dev, int num_vfs)
346 {
347 	if (num_vfs == 0)
348 		return ixgbe_pci_sriov_disable(dev);
349 	else
350 		return ixgbe_pci_sriov_enable(dev, num_vfs);
351 }
352 
353 static int ixgbe_set_vf_multicasts(struct ixgbe_adapter *adapter,
354 				   u32 *msgbuf, u32 vf)
355 {
356 	int entries = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
357 		       >> IXGBE_VT_MSGINFO_SHIFT;
358 	u16 *hash_list = (u16 *)&msgbuf[1];
359 	struct vf_data_storage *vfinfo = &adapter->vfinfo[vf];
360 	struct ixgbe_hw *hw = &adapter->hw;
361 	int i;
362 	u32 vector_bit;
363 	u32 vector_reg;
364 	u32 mta_reg;
365 	u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
366 
367 	/* only so many hash values supported */
368 	entries = min(entries, IXGBE_MAX_VF_MC_ENTRIES);
369 
370 	/*
371 	 * salt away the number of multi cast addresses assigned
372 	 * to this VF for later use to restore when the PF multi cast
373 	 * list changes
374 	 */
375 	vfinfo->num_vf_mc_hashes = entries;
376 
377 	/*
378 	 * VFs are limited to using the MTA hash table for their multicast
379 	 * addresses
380 	 */
381 	for (i = 0; i < entries; i++) {
382 		vfinfo->vf_mc_hashes[i] = hash_list[i];
383 	}
384 
385 	for (i = 0; i < vfinfo->num_vf_mc_hashes; i++) {
386 		vector_reg = (vfinfo->vf_mc_hashes[i] >> 5) & 0x7F;
387 		vector_bit = vfinfo->vf_mc_hashes[i] & 0x1F;
388 		mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
389 		mta_reg |= BIT(vector_bit);
390 		IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
391 	}
392 	vmolr |= IXGBE_VMOLR_ROMPE;
393 	IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
394 
395 	return 0;
396 }
397 
398 #ifdef CONFIG_PCI_IOV
399 void ixgbe_restore_vf_multicasts(struct ixgbe_adapter *adapter)
400 {
401 	struct ixgbe_hw *hw = &adapter->hw;
402 	struct vf_data_storage *vfinfo;
403 	int i, j;
404 	u32 vector_bit;
405 	u32 vector_reg;
406 	u32 mta_reg;
407 
408 	for (i = 0; i < adapter->num_vfs; i++) {
409 		u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(i));
410 		vfinfo = &adapter->vfinfo[i];
411 		for (j = 0; j < vfinfo->num_vf_mc_hashes; j++) {
412 			hw->addr_ctrl.mta_in_use++;
413 			vector_reg = (vfinfo->vf_mc_hashes[j] >> 5) & 0x7F;
414 			vector_bit = vfinfo->vf_mc_hashes[j] & 0x1F;
415 			mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
416 			mta_reg |= BIT(vector_bit);
417 			IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
418 		}
419 
420 		if (vfinfo->num_vf_mc_hashes)
421 			vmolr |= IXGBE_VMOLR_ROMPE;
422 		else
423 			vmolr &= ~IXGBE_VMOLR_ROMPE;
424 		IXGBE_WRITE_REG(hw, IXGBE_VMOLR(i), vmolr);
425 	}
426 
427 	/* Restore any VF macvlans */
428 	ixgbe_full_sync_mac_table(adapter);
429 }
430 #endif
431 
432 static int ixgbe_set_vf_vlan(struct ixgbe_adapter *adapter, int add, int vid,
433 			     u32 vf)
434 {
435 	struct ixgbe_hw *hw = &adapter->hw;
436 	int err;
437 
438 	/* If VLAN overlaps with one the PF is currently monitoring make
439 	 * sure that we are able to allocate a VLVF entry.  This may be
440 	 * redundant but it guarantees PF will maintain visibility to
441 	 * the VLAN.
442 	 */
443 	if (add && test_bit(vid, adapter->active_vlans)) {
444 		err = hw->mac.ops.set_vfta(hw, vid, VMDQ_P(0), true, false);
445 		if (err)
446 			return err;
447 	}
448 
449 	err = hw->mac.ops.set_vfta(hw, vid, vf, !!add, false);
450 
451 	if (add && !err)
452 		return err;
453 
454 	/* If we failed to add the VF VLAN or we are removing the VF VLAN
455 	 * we may need to drop the PF pool bit in order to allow us to free
456 	 * up the VLVF resources.
457 	 */
458 	if (test_bit(vid, adapter->active_vlans) ||
459 	    (adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
460 		ixgbe_update_pf_promisc_vlvf(adapter, vid);
461 
462 	return err;
463 }
464 
465 static s32 ixgbe_set_vf_lpe(struct ixgbe_adapter *adapter, u32 *msgbuf, u32 vf)
466 {
467 	struct ixgbe_hw *hw = &adapter->hw;
468 	int max_frame = msgbuf[1];
469 	u32 max_frs;
470 
471 	/*
472 	 * For 82599EB we have to keep all PFs and VFs operating with
473 	 * the same max_frame value in order to avoid sending an oversize
474 	 * frame to a VF.  In order to guarantee this is handled correctly
475 	 * for all cases we have several special exceptions to take into
476 	 * account before we can enable the VF for receive
477 	 */
478 	if (adapter->hw.mac.type == ixgbe_mac_82599EB) {
479 		struct net_device *dev = adapter->netdev;
480 		int pf_max_frame = dev->mtu + ETH_HLEN;
481 		u32 reg_offset, vf_shift, vfre;
482 		s32 err = 0;
483 
484 #ifdef CONFIG_FCOE
485 		if (dev->features & NETIF_F_FCOE_MTU)
486 			pf_max_frame = max_t(int, pf_max_frame,
487 					     IXGBE_FCOE_JUMBO_FRAME_SIZE);
488 
489 #endif /* CONFIG_FCOE */
490 		switch (adapter->vfinfo[vf].vf_api) {
491 		case ixgbe_mbox_api_11:
492 		case ixgbe_mbox_api_12:
493 		case ixgbe_mbox_api_13:
494 			/* Version 1.1 supports jumbo frames on VFs if PF has
495 			 * jumbo frames enabled which means legacy VFs are
496 			 * disabled
497 			 */
498 			if (pf_max_frame > ETH_FRAME_LEN)
499 				break;
500 			/* fall through */
501 		default:
502 			/* If the PF or VF are running w/ jumbo frames enabled
503 			 * we need to shut down the VF Rx path as we cannot
504 			 * support jumbo frames on legacy VFs
505 			 */
506 			if ((pf_max_frame > ETH_FRAME_LEN) ||
507 			    (max_frame > (ETH_FRAME_LEN + ETH_FCS_LEN)))
508 				err = -EINVAL;
509 			break;
510 		}
511 
512 		/* determine VF receive enable location */
513 		vf_shift = vf % 32;
514 		reg_offset = vf / 32;
515 
516 		/* enable or disable receive depending on error */
517 		vfre = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
518 		if (err)
519 			vfre &= ~BIT(vf_shift);
520 		else
521 			vfre |= BIT(vf_shift);
522 		IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), vfre);
523 
524 		if (err) {
525 			e_err(drv, "VF max_frame %d out of range\n", max_frame);
526 			return err;
527 		}
528 	}
529 
530 	/* MTU < 68 is an error and causes problems on some kernels */
531 	if (max_frame > IXGBE_MAX_JUMBO_FRAME_SIZE) {
532 		e_err(drv, "VF max_frame %d out of range\n", max_frame);
533 		return -EINVAL;
534 	}
535 
536 	/* pull current max frame size from hardware */
537 	max_frs = IXGBE_READ_REG(hw, IXGBE_MAXFRS);
538 	max_frs &= IXGBE_MHADD_MFS_MASK;
539 	max_frs >>= IXGBE_MHADD_MFS_SHIFT;
540 
541 	if (max_frs < max_frame) {
542 		max_frs = max_frame << IXGBE_MHADD_MFS_SHIFT;
543 		IXGBE_WRITE_REG(hw, IXGBE_MAXFRS, max_frs);
544 	}
545 
546 	e_info(hw, "VF requests change max MTU to %d\n", max_frame);
547 
548 	return 0;
549 }
550 
551 static void ixgbe_set_vmolr(struct ixgbe_hw *hw, u32 vf, bool aupe)
552 {
553 	u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
554 	vmolr |= IXGBE_VMOLR_BAM;
555 	if (aupe)
556 		vmolr |= IXGBE_VMOLR_AUPE;
557 	else
558 		vmolr &= ~IXGBE_VMOLR_AUPE;
559 	IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
560 }
561 
562 static void ixgbe_clear_vmvir(struct ixgbe_adapter *adapter, u32 vf)
563 {
564 	struct ixgbe_hw *hw = &adapter->hw;
565 
566 	IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf), 0);
567 }
568 
569 static void ixgbe_clear_vf_vlans(struct ixgbe_adapter *adapter, u32 vf)
570 {
571 	struct ixgbe_hw *hw = &adapter->hw;
572 	u32 vlvfb_mask, pool_mask, i;
573 
574 	/* create mask for VF and other pools */
575 	pool_mask = ~BIT(VMDQ_P(0) % 32);
576 	vlvfb_mask = BIT(vf % 32);
577 
578 	/* post increment loop, covers VLVF_ENTRIES - 1 to 0 */
579 	for (i = IXGBE_VLVF_ENTRIES; i--;) {
580 		u32 bits[2], vlvfb, vid, vfta, vlvf;
581 		u32 word = i * 2 + vf / 32;
582 		u32 mask;
583 
584 		vlvfb = IXGBE_READ_REG(hw, IXGBE_VLVFB(word));
585 
586 		/* if our bit isn't set we can skip it */
587 		if (!(vlvfb & vlvfb_mask))
588 			continue;
589 
590 		/* clear our bit from vlvfb */
591 		vlvfb ^= vlvfb_mask;
592 
593 		/* create 64b mask to chedk to see if we should clear VLVF */
594 		bits[word % 2] = vlvfb;
595 		bits[~word % 2] = IXGBE_READ_REG(hw, IXGBE_VLVFB(word ^ 1));
596 
597 		/* if other pools are present, just remove ourselves */
598 		if (bits[(VMDQ_P(0) / 32) ^ 1] ||
599 		    (bits[VMDQ_P(0) / 32] & pool_mask))
600 			goto update_vlvfb;
601 
602 		/* if PF is present, leave VFTA */
603 		if (bits[0] || bits[1])
604 			goto update_vlvf;
605 
606 		/* if we cannot determine VLAN just remove ourselves */
607 		vlvf = IXGBE_READ_REG(hw, IXGBE_VLVF(i));
608 		if (!vlvf)
609 			goto update_vlvfb;
610 
611 		vid = vlvf & VLAN_VID_MASK;
612 		mask = BIT(vid % 32);
613 
614 		/* clear bit from VFTA */
615 		vfta = IXGBE_READ_REG(hw, IXGBE_VFTA(vid / 32));
616 		if (vfta & mask)
617 			IXGBE_WRITE_REG(hw, IXGBE_VFTA(vid / 32), vfta ^ mask);
618 update_vlvf:
619 		/* clear POOL selection enable */
620 		IXGBE_WRITE_REG(hw, IXGBE_VLVF(i), 0);
621 
622 		if (!(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
623 			vlvfb = 0;
624 update_vlvfb:
625 		/* clear pool bits */
626 		IXGBE_WRITE_REG(hw, IXGBE_VLVFB(word), vlvfb);
627 	}
628 }
629 
630 static int ixgbe_set_vf_macvlan(struct ixgbe_adapter *adapter,
631 				int vf, int index, unsigned char *mac_addr)
632 {
633 	struct vf_macvlans *entry;
634 	struct list_head *pos;
635 	int retval = 0;
636 
637 	if (index <= 1) {
638 		list_for_each(pos, &adapter->vf_mvs.l) {
639 			entry = list_entry(pos, struct vf_macvlans, l);
640 			if (entry->vf == vf) {
641 				entry->vf = -1;
642 				entry->free = true;
643 				entry->is_macvlan = false;
644 				ixgbe_del_mac_filter(adapter,
645 						     entry->vf_macvlan, vf);
646 			}
647 		}
648 	}
649 
650 	/*
651 	 * If index was zero then we were asked to clear the uc list
652 	 * for the VF.  We're done.
653 	 */
654 	if (!index)
655 		return 0;
656 
657 	entry = NULL;
658 
659 	list_for_each(pos, &adapter->vf_mvs.l) {
660 		entry = list_entry(pos, struct vf_macvlans, l);
661 		if (entry->free)
662 			break;
663 	}
664 
665 	/*
666 	 * If we traversed the entire list and didn't find a free entry
667 	 * then we're out of space on the RAR table.  Also entry may
668 	 * be NULL because the original memory allocation for the list
669 	 * failed, which is not fatal but does mean we can't support
670 	 * VF requests for MACVLAN because we couldn't allocate
671 	 * memory for the list management required.
672 	 */
673 	if (!entry || !entry->free)
674 		return -ENOSPC;
675 
676 	retval = ixgbe_add_mac_filter(adapter, mac_addr, vf);
677 	if (retval < 0)
678 		return retval;
679 
680 	entry->free = false;
681 	entry->is_macvlan = true;
682 	entry->vf = vf;
683 	memcpy(entry->vf_macvlan, mac_addr, ETH_ALEN);
684 
685 	return 0;
686 }
687 
688 static inline void ixgbe_vf_reset_event(struct ixgbe_adapter *adapter, u32 vf)
689 {
690 	struct ixgbe_hw *hw = &adapter->hw;
691 	struct vf_data_storage *vfinfo = &adapter->vfinfo[vf];
692 	u8 num_tcs = adapter->hw_tcs;
693 
694 	/* remove VLAN filters beloning to this VF */
695 	ixgbe_clear_vf_vlans(adapter, vf);
696 
697 	/* add back PF assigned VLAN or VLAN 0 */
698 	ixgbe_set_vf_vlan(adapter, true, vfinfo->pf_vlan, vf);
699 
700 	/* reset offloads to defaults */
701 	ixgbe_set_vmolr(hw, vf, !vfinfo->pf_vlan);
702 
703 	/* set outgoing tags for VFs */
704 	if (!vfinfo->pf_vlan && !vfinfo->pf_qos && !num_tcs) {
705 		ixgbe_clear_vmvir(adapter, vf);
706 	} else {
707 		if (vfinfo->pf_qos || !num_tcs)
708 			ixgbe_set_vmvir(adapter, vfinfo->pf_vlan,
709 					vfinfo->pf_qos, vf);
710 		else
711 			ixgbe_set_vmvir(adapter, vfinfo->pf_vlan,
712 					adapter->default_up, vf);
713 
714 		if (vfinfo->spoofchk_enabled)
715 			hw->mac.ops.set_vlan_anti_spoofing(hw, true, vf);
716 	}
717 
718 	/* reset multicast table array for vf */
719 	adapter->vfinfo[vf].num_vf_mc_hashes = 0;
720 
721 	/* Flush and reset the mta with the new values */
722 	ixgbe_set_rx_mode(adapter->netdev);
723 
724 	ixgbe_del_mac_filter(adapter, adapter->vfinfo[vf].vf_mac_addresses, vf);
725 	ixgbe_set_vf_macvlan(adapter, vf, 0, NULL);
726 
727 	/* reset VF api back to unknown */
728 	adapter->vfinfo[vf].vf_api = ixgbe_mbox_api_10;
729 }
730 
731 static int ixgbe_set_vf_mac(struct ixgbe_adapter *adapter,
732 			    int vf, unsigned char *mac_addr)
733 {
734 	s32 retval;
735 
736 	ixgbe_del_mac_filter(adapter, adapter->vfinfo[vf].vf_mac_addresses, vf);
737 	retval = ixgbe_add_mac_filter(adapter, mac_addr, vf);
738 	if (retval >= 0)
739 		memcpy(adapter->vfinfo[vf].vf_mac_addresses, mac_addr,
740 		       ETH_ALEN);
741 	else
742 		memset(adapter->vfinfo[vf].vf_mac_addresses, 0, ETH_ALEN);
743 
744 	return retval;
745 }
746 
747 int ixgbe_vf_configuration(struct pci_dev *pdev, unsigned int event_mask)
748 {
749 	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
750 	unsigned int vfn = (event_mask & 0x3f);
751 
752 	bool enable = ((event_mask & 0x10000000U) != 0);
753 
754 	if (enable)
755 		eth_zero_addr(adapter->vfinfo[vfn].vf_mac_addresses);
756 
757 	return 0;
758 }
759 
760 static inline void ixgbe_write_qde(struct ixgbe_adapter *adapter, u32 vf,
761 				   u32 qde)
762 {
763 	struct ixgbe_hw *hw = &adapter->hw;
764 	struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
765 	u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
766 	int i;
767 
768 	for (i = vf * q_per_pool; i < ((vf + 1) * q_per_pool); i++) {
769 		u32 reg;
770 
771 		/* flush previous write */
772 		IXGBE_WRITE_FLUSH(hw);
773 
774 		/* indicate to hardware that we want to set drop enable */
775 		reg = IXGBE_QDE_WRITE | qde;
776 		reg |= i <<  IXGBE_QDE_IDX_SHIFT;
777 		IXGBE_WRITE_REG(hw, IXGBE_QDE, reg);
778 	}
779 }
780 
781 static int ixgbe_vf_reset_msg(struct ixgbe_adapter *adapter, u32 vf)
782 {
783 	struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
784 	struct ixgbe_hw *hw = &adapter->hw;
785 	unsigned char *vf_mac = adapter->vfinfo[vf].vf_mac_addresses;
786 	u32 reg, reg_offset, vf_shift;
787 	u32 msgbuf[4] = {0, 0, 0, 0};
788 	u8 *addr = (u8 *)(&msgbuf[1]);
789 	u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
790 	int i;
791 
792 	e_info(probe, "VF Reset msg received from vf %d\n", vf);
793 
794 	/* reset the filters for the device */
795 	ixgbe_vf_reset_event(adapter, vf);
796 
797 	/* set vf mac address */
798 	if (!is_zero_ether_addr(vf_mac))
799 		ixgbe_set_vf_mac(adapter, vf, vf_mac);
800 
801 	vf_shift = vf % 32;
802 	reg_offset = vf / 32;
803 
804 	/* enable transmit for vf */
805 	reg = IXGBE_READ_REG(hw, IXGBE_VFTE(reg_offset));
806 	reg |= BIT(vf_shift);
807 	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), reg);
808 
809 	/* force drop enable for all VF Rx queues */
810 	reg = IXGBE_QDE_ENABLE;
811 	if (adapter->vfinfo[vf].pf_vlan)
812 		reg |= IXGBE_QDE_HIDE_VLAN;
813 
814 	ixgbe_write_qde(adapter, vf, reg);
815 
816 	/* enable receive for vf */
817 	reg = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
818 	reg |= BIT(vf_shift);
819 	/*
820 	 * The 82599 cannot support a mix of jumbo and non-jumbo PF/VFs.
821 	 * For more info take a look at ixgbe_set_vf_lpe
822 	 */
823 	if (adapter->hw.mac.type == ixgbe_mac_82599EB) {
824 		struct net_device *dev = adapter->netdev;
825 		int pf_max_frame = dev->mtu + ETH_HLEN;
826 
827 #ifdef CONFIG_FCOE
828 		if (dev->features & NETIF_F_FCOE_MTU)
829 			pf_max_frame = max_t(int, pf_max_frame,
830 					     IXGBE_FCOE_JUMBO_FRAME_SIZE);
831 
832 #endif /* CONFIG_FCOE */
833 		if (pf_max_frame > ETH_FRAME_LEN)
834 			reg &= ~BIT(vf_shift);
835 	}
836 	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), reg);
837 
838 	/* enable VF mailbox for further messages */
839 	adapter->vfinfo[vf].clear_to_send = true;
840 
841 	/* Enable counting of spoofed packets in the SSVPC register */
842 	reg = IXGBE_READ_REG(hw, IXGBE_VMECM(reg_offset));
843 	reg |= BIT(vf_shift);
844 	IXGBE_WRITE_REG(hw, IXGBE_VMECM(reg_offset), reg);
845 
846 	/*
847 	 * Reset the VFs TDWBAL and TDWBAH registers
848 	 * which are not cleared by an FLR
849 	 */
850 	for (i = 0; i < q_per_pool; i++) {
851 		IXGBE_WRITE_REG(hw, IXGBE_PVFTDWBAHn(q_per_pool, vf, i), 0);
852 		IXGBE_WRITE_REG(hw, IXGBE_PVFTDWBALn(q_per_pool, vf, i), 0);
853 	}
854 
855 	/* reply to reset with ack and vf mac address */
856 	msgbuf[0] = IXGBE_VF_RESET;
857 	if (!is_zero_ether_addr(vf_mac) && adapter->vfinfo[vf].pf_set_mac) {
858 		msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
859 		memcpy(addr, vf_mac, ETH_ALEN);
860 	} else {
861 		msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
862 	}
863 
864 	/*
865 	 * Piggyback the multicast filter type so VF can compute the
866 	 * correct vectors
867 	 */
868 	msgbuf[3] = hw->mac.mc_filter_type;
869 	ixgbe_write_mbx(hw, msgbuf, IXGBE_VF_PERMADDR_MSG_LEN, vf);
870 
871 	return 0;
872 }
873 
874 static int ixgbe_set_vf_mac_addr(struct ixgbe_adapter *adapter,
875 				 u32 *msgbuf, u32 vf)
876 {
877 	u8 *new_mac = ((u8 *)(&msgbuf[1]));
878 
879 	if (!is_valid_ether_addr(new_mac)) {
880 		e_warn(drv, "VF %d attempted to set invalid mac\n", vf);
881 		return -1;
882 	}
883 
884 	if (adapter->vfinfo[vf].pf_set_mac && !adapter->vfinfo[vf].trusted &&
885 	    !ether_addr_equal(adapter->vfinfo[vf].vf_mac_addresses, new_mac)) {
886 		e_warn(drv,
887 		       "VF %d attempted to override administratively set MAC address\n"
888 		       "Reload the VF driver to resume operations\n",
889 		       vf);
890 		return -1;
891 	}
892 
893 	return ixgbe_set_vf_mac(adapter, vf, new_mac) < 0;
894 }
895 
896 static int ixgbe_set_vf_vlan_msg(struct ixgbe_adapter *adapter,
897 				 u32 *msgbuf, u32 vf)
898 {
899 	u32 add = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >> IXGBE_VT_MSGINFO_SHIFT;
900 	u32 vid = (msgbuf[1] & IXGBE_VLVF_VLANID_MASK);
901 	u8 tcs = adapter->hw_tcs;
902 
903 	if (adapter->vfinfo[vf].pf_vlan || tcs) {
904 		e_warn(drv,
905 		       "VF %d attempted to override administratively set VLAN configuration\n"
906 		       "Reload the VF driver to resume operations\n",
907 		       vf);
908 		return -1;
909 	}
910 
911 	/* VLAN 0 is a special case, don't allow it to be removed */
912 	if (!vid && !add)
913 		return 0;
914 
915 	return ixgbe_set_vf_vlan(adapter, add, vid, vf);
916 }
917 
918 static int ixgbe_set_vf_macvlan_msg(struct ixgbe_adapter *adapter,
919 				    u32 *msgbuf, u32 vf)
920 {
921 	u8 *new_mac = ((u8 *)(&msgbuf[1]));
922 	int index = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >>
923 		    IXGBE_VT_MSGINFO_SHIFT;
924 	int err;
925 
926 	if (adapter->vfinfo[vf].pf_set_mac && !adapter->vfinfo[vf].trusted &&
927 	    index > 0) {
928 		e_warn(drv,
929 		       "VF %d requested MACVLAN filter but is administratively denied\n",
930 		       vf);
931 		return -1;
932 	}
933 
934 	/* An non-zero index indicates the VF is setting a filter */
935 	if (index) {
936 		if (!is_valid_ether_addr(new_mac)) {
937 			e_warn(drv, "VF %d attempted to set invalid mac\n", vf);
938 			return -1;
939 		}
940 
941 		/*
942 		 * If the VF is allowed to set MAC filters then turn off
943 		 * anti-spoofing to avoid false positives.
944 		 */
945 		if (adapter->vfinfo[vf].spoofchk_enabled) {
946 			struct ixgbe_hw *hw = &adapter->hw;
947 
948 			hw->mac.ops.set_mac_anti_spoofing(hw, false, vf);
949 			hw->mac.ops.set_vlan_anti_spoofing(hw, false, vf);
950 		}
951 	}
952 
953 	err = ixgbe_set_vf_macvlan(adapter, vf, index, new_mac);
954 	if (err == -ENOSPC)
955 		e_warn(drv,
956 		       "VF %d has requested a MACVLAN filter but there is no space for it\n",
957 		       vf);
958 
959 	return err < 0;
960 }
961 
962 static int ixgbe_negotiate_vf_api(struct ixgbe_adapter *adapter,
963 				  u32 *msgbuf, u32 vf)
964 {
965 	int api = msgbuf[1];
966 
967 	switch (api) {
968 	case ixgbe_mbox_api_10:
969 	case ixgbe_mbox_api_11:
970 	case ixgbe_mbox_api_12:
971 	case ixgbe_mbox_api_13:
972 		adapter->vfinfo[vf].vf_api = api;
973 		return 0;
974 	default:
975 		break;
976 	}
977 
978 	e_info(drv, "VF %d requested invalid api version %u\n", vf, api);
979 
980 	return -1;
981 }
982 
983 static int ixgbe_get_vf_queues(struct ixgbe_adapter *adapter,
984 			       u32 *msgbuf, u32 vf)
985 {
986 	struct net_device *dev = adapter->netdev;
987 	struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
988 	unsigned int default_tc = 0;
989 	u8 num_tcs = adapter->hw_tcs;
990 
991 	/* verify the PF is supporting the correct APIs */
992 	switch (adapter->vfinfo[vf].vf_api) {
993 	case ixgbe_mbox_api_20:
994 	case ixgbe_mbox_api_11:
995 	case ixgbe_mbox_api_12:
996 	case ixgbe_mbox_api_13:
997 		break;
998 	default:
999 		return -1;
1000 	}
1001 
1002 	/* only allow 1 Tx queue for bandwidth limiting */
1003 	msgbuf[IXGBE_VF_TX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
1004 	msgbuf[IXGBE_VF_RX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
1005 
1006 	/* if TCs > 1 determine which TC belongs to default user priority */
1007 	if (num_tcs > 1)
1008 		default_tc = netdev_get_prio_tc_map(dev, adapter->default_up);
1009 
1010 	/* notify VF of need for VLAN tag stripping, and correct queue */
1011 	if (num_tcs)
1012 		msgbuf[IXGBE_VF_TRANS_VLAN] = num_tcs;
1013 	else if (adapter->vfinfo[vf].pf_vlan || adapter->vfinfo[vf].pf_qos)
1014 		msgbuf[IXGBE_VF_TRANS_VLAN] = 1;
1015 	else
1016 		msgbuf[IXGBE_VF_TRANS_VLAN] = 0;
1017 
1018 	/* notify VF of default queue */
1019 	msgbuf[IXGBE_VF_DEF_QUEUE] = default_tc;
1020 
1021 	return 0;
1022 }
1023 
1024 static int ixgbe_get_vf_reta(struct ixgbe_adapter *adapter, u32 *msgbuf, u32 vf)
1025 {
1026 	u32 i, j;
1027 	u32 *out_buf = &msgbuf[1];
1028 	const u8 *reta = adapter->rss_indir_tbl;
1029 	u32 reta_size = ixgbe_rss_indir_tbl_entries(adapter);
1030 
1031 	/* Check if operation is permitted */
1032 	if (!adapter->vfinfo[vf].rss_query_enabled)
1033 		return -EPERM;
1034 
1035 	/* verify the PF is supporting the correct API */
1036 	switch (adapter->vfinfo[vf].vf_api) {
1037 	case ixgbe_mbox_api_13:
1038 	case ixgbe_mbox_api_12:
1039 		break;
1040 	default:
1041 		return -EOPNOTSUPP;
1042 	}
1043 
1044 	/* This mailbox command is supported (required) only for 82599 and x540
1045 	 * VFs which support up to 4 RSS queues. Therefore we will compress the
1046 	 * RETA by saving only 2 bits from each entry. This way we will be able
1047 	 * to transfer the whole RETA in a single mailbox operation.
1048 	 */
1049 	for (i = 0; i < reta_size / 16; i++) {
1050 		out_buf[i] = 0;
1051 		for (j = 0; j < 16; j++)
1052 			out_buf[i] |= (u32)(reta[16 * i + j] & 0x3) << (2 * j);
1053 	}
1054 
1055 	return 0;
1056 }
1057 
1058 static int ixgbe_get_vf_rss_key(struct ixgbe_adapter *adapter,
1059 				u32 *msgbuf, u32 vf)
1060 {
1061 	u32 *rss_key = &msgbuf[1];
1062 
1063 	/* Check if the operation is permitted */
1064 	if (!adapter->vfinfo[vf].rss_query_enabled)
1065 		return -EPERM;
1066 
1067 	/* verify the PF is supporting the correct API */
1068 	switch (adapter->vfinfo[vf].vf_api) {
1069 	case ixgbe_mbox_api_13:
1070 	case ixgbe_mbox_api_12:
1071 		break;
1072 	default:
1073 		return -EOPNOTSUPP;
1074 	}
1075 
1076 	memcpy(rss_key, adapter->rss_key, IXGBE_RSS_KEY_SIZE);
1077 
1078 	return 0;
1079 }
1080 
1081 static int ixgbe_update_vf_xcast_mode(struct ixgbe_adapter *adapter,
1082 				      u32 *msgbuf, u32 vf)
1083 {
1084 	struct ixgbe_hw *hw = &adapter->hw;
1085 	int xcast_mode = msgbuf[1];
1086 	u32 vmolr, fctrl, disable, enable;
1087 
1088 	/* verify the PF is supporting the correct APIs */
1089 	switch (adapter->vfinfo[vf].vf_api) {
1090 	case ixgbe_mbox_api_12:
1091 		/* promisc introduced in 1.3 version */
1092 		if (xcast_mode == IXGBEVF_XCAST_MODE_PROMISC)
1093 			return -EOPNOTSUPP;
1094 		/* Fall threw */
1095 	case ixgbe_mbox_api_13:
1096 		break;
1097 	default:
1098 		return -EOPNOTSUPP;
1099 	}
1100 
1101 	if (xcast_mode > IXGBEVF_XCAST_MODE_MULTI &&
1102 	    !adapter->vfinfo[vf].trusted) {
1103 		xcast_mode = IXGBEVF_XCAST_MODE_MULTI;
1104 	}
1105 
1106 	if (adapter->vfinfo[vf].xcast_mode == xcast_mode)
1107 		goto out;
1108 
1109 	switch (xcast_mode) {
1110 	case IXGBEVF_XCAST_MODE_NONE:
1111 		disable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE |
1112 			  IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1113 		enable = 0;
1114 		break;
1115 	case IXGBEVF_XCAST_MODE_MULTI:
1116 		disable = IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1117 		enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE;
1118 		break;
1119 	case IXGBEVF_XCAST_MODE_ALLMULTI:
1120 		disable = IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1121 		enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE | IXGBE_VMOLR_MPE;
1122 		break;
1123 	case IXGBEVF_XCAST_MODE_PROMISC:
1124 		if (hw->mac.type <= ixgbe_mac_82599EB)
1125 			return -EOPNOTSUPP;
1126 
1127 		fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
1128 		if (!(fctrl & IXGBE_FCTRL_UPE)) {
1129 			/* VF promisc requires PF in promisc */
1130 			e_warn(drv,
1131 			       "Enabling VF promisc requires PF in promisc\n");
1132 			return -EPERM;
1133 		}
1134 
1135 		disable = 0;
1136 		enable = IXGBE_VMOLR_BAM | IXGBE_VMOLR_ROMPE |
1137 			 IXGBE_VMOLR_MPE | IXGBE_VMOLR_UPE | IXGBE_VMOLR_VPE;
1138 		break;
1139 	default:
1140 		return -EOPNOTSUPP;
1141 	}
1142 
1143 	vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
1144 	vmolr &= ~disable;
1145 	vmolr |= enable;
1146 	IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
1147 
1148 	adapter->vfinfo[vf].xcast_mode = xcast_mode;
1149 
1150 out:
1151 	msgbuf[1] = xcast_mode;
1152 
1153 	return 0;
1154 }
1155 
1156 static int ixgbe_rcv_msg_from_vf(struct ixgbe_adapter *adapter, u32 vf)
1157 {
1158 	u32 mbx_size = IXGBE_VFMAILBOX_SIZE;
1159 	u32 msgbuf[IXGBE_VFMAILBOX_SIZE];
1160 	struct ixgbe_hw *hw = &adapter->hw;
1161 	s32 retval;
1162 
1163 	retval = ixgbe_read_mbx(hw, msgbuf, mbx_size, vf);
1164 
1165 	if (retval) {
1166 		pr_err("Error receiving message from VF\n");
1167 		return retval;
1168 	}
1169 
1170 	/* this is a message we already processed, do nothing */
1171 	if (msgbuf[0] & (IXGBE_VT_MSGTYPE_ACK | IXGBE_VT_MSGTYPE_NACK))
1172 		return 0;
1173 
1174 	/* flush the ack before we write any messages back */
1175 	IXGBE_WRITE_FLUSH(hw);
1176 
1177 	if (msgbuf[0] == IXGBE_VF_RESET)
1178 		return ixgbe_vf_reset_msg(adapter, vf);
1179 
1180 	/*
1181 	 * until the vf completes a virtual function reset it should not be
1182 	 * allowed to start any configuration.
1183 	 */
1184 	if (!adapter->vfinfo[vf].clear_to_send) {
1185 		msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
1186 		ixgbe_write_mbx(hw, msgbuf, 1, vf);
1187 		return 0;
1188 	}
1189 
1190 	switch ((msgbuf[0] & 0xFFFF)) {
1191 	case IXGBE_VF_SET_MAC_ADDR:
1192 		retval = ixgbe_set_vf_mac_addr(adapter, msgbuf, vf);
1193 		break;
1194 	case IXGBE_VF_SET_MULTICAST:
1195 		retval = ixgbe_set_vf_multicasts(adapter, msgbuf, vf);
1196 		break;
1197 	case IXGBE_VF_SET_VLAN:
1198 		retval = ixgbe_set_vf_vlan_msg(adapter, msgbuf, vf);
1199 		break;
1200 	case IXGBE_VF_SET_LPE:
1201 		retval = ixgbe_set_vf_lpe(adapter, msgbuf, vf);
1202 		break;
1203 	case IXGBE_VF_SET_MACVLAN:
1204 		retval = ixgbe_set_vf_macvlan_msg(adapter, msgbuf, vf);
1205 		break;
1206 	case IXGBE_VF_API_NEGOTIATE:
1207 		retval = ixgbe_negotiate_vf_api(adapter, msgbuf, vf);
1208 		break;
1209 	case IXGBE_VF_GET_QUEUES:
1210 		retval = ixgbe_get_vf_queues(adapter, msgbuf, vf);
1211 		break;
1212 	case IXGBE_VF_GET_RETA:
1213 		retval = ixgbe_get_vf_reta(adapter, msgbuf, vf);
1214 		break;
1215 	case IXGBE_VF_GET_RSS_KEY:
1216 		retval = ixgbe_get_vf_rss_key(adapter, msgbuf, vf);
1217 		break;
1218 	case IXGBE_VF_UPDATE_XCAST_MODE:
1219 		retval = ixgbe_update_vf_xcast_mode(adapter, msgbuf, vf);
1220 		break;
1221 	default:
1222 		e_err(drv, "Unhandled Msg %8.8x\n", msgbuf[0]);
1223 		retval = IXGBE_ERR_MBX;
1224 		break;
1225 	}
1226 
1227 	/* notify the VF of the results of what it sent us */
1228 	if (retval)
1229 		msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
1230 	else
1231 		msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
1232 
1233 	msgbuf[0] |= IXGBE_VT_MSGTYPE_CTS;
1234 
1235 	ixgbe_write_mbx(hw, msgbuf, mbx_size, vf);
1236 
1237 	return retval;
1238 }
1239 
1240 static void ixgbe_rcv_ack_from_vf(struct ixgbe_adapter *adapter, u32 vf)
1241 {
1242 	struct ixgbe_hw *hw = &adapter->hw;
1243 	u32 msg = IXGBE_VT_MSGTYPE_NACK;
1244 
1245 	/* if device isn't clear to send it shouldn't be reading either */
1246 	if (!adapter->vfinfo[vf].clear_to_send)
1247 		ixgbe_write_mbx(hw, &msg, 1, vf);
1248 }
1249 
1250 void ixgbe_msg_task(struct ixgbe_adapter *adapter)
1251 {
1252 	struct ixgbe_hw *hw = &adapter->hw;
1253 	u32 vf;
1254 
1255 	for (vf = 0; vf < adapter->num_vfs; vf++) {
1256 		/* process any reset requests */
1257 		if (!ixgbe_check_for_rst(hw, vf))
1258 			ixgbe_vf_reset_event(adapter, vf);
1259 
1260 		/* process any messages pending */
1261 		if (!ixgbe_check_for_msg(hw, vf))
1262 			ixgbe_rcv_msg_from_vf(adapter, vf);
1263 
1264 		/* process any acks */
1265 		if (!ixgbe_check_for_ack(hw, vf))
1266 			ixgbe_rcv_ack_from_vf(adapter, vf);
1267 	}
1268 }
1269 
1270 void ixgbe_disable_tx_rx(struct ixgbe_adapter *adapter)
1271 {
1272 	struct ixgbe_hw *hw = &adapter->hw;
1273 
1274 	/* disable transmit and receive for all vfs */
1275 	IXGBE_WRITE_REG(hw, IXGBE_VFTE(0), 0);
1276 	IXGBE_WRITE_REG(hw, IXGBE_VFTE(1), 0);
1277 
1278 	IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), 0);
1279 	IXGBE_WRITE_REG(hw, IXGBE_VFRE(1), 0);
1280 }
1281 
1282 static inline void ixgbe_ping_vf(struct ixgbe_adapter *adapter, int vf)
1283 {
1284 	struct ixgbe_hw *hw = &adapter->hw;
1285 	u32 ping;
1286 
1287 	ping = IXGBE_PF_CONTROL_MSG;
1288 	if (adapter->vfinfo[vf].clear_to_send)
1289 		ping |= IXGBE_VT_MSGTYPE_CTS;
1290 	ixgbe_write_mbx(hw, &ping, 1, vf);
1291 }
1292 
1293 void ixgbe_ping_all_vfs(struct ixgbe_adapter *adapter)
1294 {
1295 	struct ixgbe_hw *hw = &adapter->hw;
1296 	u32 ping;
1297 	int i;
1298 
1299 	for (i = 0 ; i < adapter->num_vfs; i++) {
1300 		ping = IXGBE_PF_CONTROL_MSG;
1301 		if (adapter->vfinfo[i].clear_to_send)
1302 			ping |= IXGBE_VT_MSGTYPE_CTS;
1303 		ixgbe_write_mbx(hw, &ping, 1, i);
1304 	}
1305 }
1306 
1307 int ixgbe_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
1308 {
1309 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1310 	s32 retval;
1311 
1312 	if (vf >= adapter->num_vfs)
1313 		return -EINVAL;
1314 
1315 	if (is_valid_ether_addr(mac)) {
1316 		dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n",
1317 			 mac, vf);
1318 		dev_info(&adapter->pdev->dev, "Reload the VF driver to make this change effective.");
1319 
1320 		retval = ixgbe_set_vf_mac(adapter, vf, mac);
1321 		if (retval >= 0) {
1322 			adapter->vfinfo[vf].pf_set_mac = true;
1323 
1324 			if (test_bit(__IXGBE_DOWN, &adapter->state)) {
1325 				dev_warn(&adapter->pdev->dev, "The VF MAC address has been set, but the PF device is not up.\n");
1326 				dev_warn(&adapter->pdev->dev, "Bring the PF device up before attempting to use the VF device.\n");
1327 			}
1328 		} else {
1329 			dev_warn(&adapter->pdev->dev, "The VF MAC address was NOT set due to invalid or duplicate MAC address.\n");
1330 		}
1331 	} else if (is_zero_ether_addr(mac)) {
1332 		unsigned char *vf_mac_addr =
1333 					   adapter->vfinfo[vf].vf_mac_addresses;
1334 
1335 		/* nothing to do */
1336 		if (is_zero_ether_addr(vf_mac_addr))
1337 			return 0;
1338 
1339 		dev_info(&adapter->pdev->dev, "removing MAC on VF %d\n", vf);
1340 
1341 		retval = ixgbe_del_mac_filter(adapter, vf_mac_addr, vf);
1342 		if (retval >= 0) {
1343 			adapter->vfinfo[vf].pf_set_mac = false;
1344 			memcpy(vf_mac_addr, mac, ETH_ALEN);
1345 		} else {
1346 			dev_warn(&adapter->pdev->dev, "Could NOT remove the VF MAC address.\n");
1347 		}
1348 	} else {
1349 		retval = -EINVAL;
1350 	}
1351 
1352 	return retval;
1353 }
1354 
1355 static int ixgbe_enable_port_vlan(struct ixgbe_adapter *adapter, int vf,
1356 				  u16 vlan, u8 qos)
1357 {
1358 	struct ixgbe_hw *hw = &adapter->hw;
1359 	int err;
1360 
1361 	err = ixgbe_set_vf_vlan(adapter, true, vlan, vf);
1362 	if (err)
1363 		goto out;
1364 
1365 	/* Revoke tagless access via VLAN 0 */
1366 	ixgbe_set_vf_vlan(adapter, false, 0, vf);
1367 
1368 	ixgbe_set_vmvir(adapter, vlan, qos, vf);
1369 	ixgbe_set_vmolr(hw, vf, false);
1370 
1371 	/* enable hide vlan on X550 */
1372 	if (hw->mac.type >= ixgbe_mac_X550)
1373 		ixgbe_write_qde(adapter, vf, IXGBE_QDE_ENABLE |
1374 				IXGBE_QDE_HIDE_VLAN);
1375 
1376 	adapter->vfinfo[vf].pf_vlan = vlan;
1377 	adapter->vfinfo[vf].pf_qos = qos;
1378 	dev_info(&adapter->pdev->dev,
1379 		 "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
1380 	if (test_bit(__IXGBE_DOWN, &adapter->state)) {
1381 		dev_warn(&adapter->pdev->dev,
1382 			 "The VF VLAN has been set, but the PF device is not up.\n");
1383 		dev_warn(&adapter->pdev->dev,
1384 			 "Bring the PF device up before attempting to use the VF device.\n");
1385 	}
1386 
1387 out:
1388 	return err;
1389 }
1390 
1391 static int ixgbe_disable_port_vlan(struct ixgbe_adapter *adapter, int vf)
1392 {
1393 	struct ixgbe_hw *hw = &adapter->hw;
1394 	int err;
1395 
1396 	err = ixgbe_set_vf_vlan(adapter, false,
1397 				adapter->vfinfo[vf].pf_vlan, vf);
1398 	/* Restore tagless access via VLAN 0 */
1399 	ixgbe_set_vf_vlan(adapter, true, 0, vf);
1400 	ixgbe_clear_vmvir(adapter, vf);
1401 	ixgbe_set_vmolr(hw, vf, true);
1402 
1403 	/* disable hide VLAN on X550 */
1404 	if (hw->mac.type >= ixgbe_mac_X550)
1405 		ixgbe_write_qde(adapter, vf, IXGBE_QDE_ENABLE);
1406 
1407 	adapter->vfinfo[vf].pf_vlan = 0;
1408 	adapter->vfinfo[vf].pf_qos = 0;
1409 
1410 	return err;
1411 }
1412 
1413 int ixgbe_ndo_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan,
1414 			  u8 qos, __be16 vlan_proto)
1415 {
1416 	int err = 0;
1417 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1418 
1419 	if ((vf >= adapter->num_vfs) || (vlan > 4095) || (qos > 7))
1420 		return -EINVAL;
1421 	if (vlan_proto != htons(ETH_P_8021Q))
1422 		return -EPROTONOSUPPORT;
1423 	if (vlan || qos) {
1424 		/* Check if there is already a port VLAN set, if so
1425 		 * we have to delete the old one first before we
1426 		 * can set the new one.  The usage model had
1427 		 * previously assumed the user would delete the
1428 		 * old port VLAN before setting a new one but this
1429 		 * is not necessarily the case.
1430 		 */
1431 		if (adapter->vfinfo[vf].pf_vlan)
1432 			err = ixgbe_disable_port_vlan(adapter, vf);
1433 		if (err)
1434 			goto out;
1435 		err = ixgbe_enable_port_vlan(adapter, vf, vlan, qos);
1436 	} else {
1437 		err = ixgbe_disable_port_vlan(adapter, vf);
1438 	}
1439 
1440 out:
1441 	return err;
1442 }
1443 
1444 int ixgbe_link_mbps(struct ixgbe_adapter *adapter)
1445 {
1446 	switch (adapter->link_speed) {
1447 	case IXGBE_LINK_SPEED_100_FULL:
1448 		return 100;
1449 	case IXGBE_LINK_SPEED_1GB_FULL:
1450 		return 1000;
1451 	case IXGBE_LINK_SPEED_10GB_FULL:
1452 		return 10000;
1453 	default:
1454 		return 0;
1455 	}
1456 }
1457 
1458 static void ixgbe_set_vf_rate_limit(struct ixgbe_adapter *adapter, int vf)
1459 {
1460 	struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
1461 	struct ixgbe_hw *hw = &adapter->hw;
1462 	u32 bcnrc_val = 0;
1463 	u16 queue, queues_per_pool;
1464 	u16 tx_rate = adapter->vfinfo[vf].tx_rate;
1465 
1466 	if (tx_rate) {
1467 		/* start with base link speed value */
1468 		bcnrc_val = adapter->vf_rate_link_speed;
1469 
1470 		/* Calculate the rate factor values to set */
1471 		bcnrc_val <<= IXGBE_RTTBCNRC_RF_INT_SHIFT;
1472 		bcnrc_val /= tx_rate;
1473 
1474 		/* clear everything but the rate factor */
1475 		bcnrc_val &= IXGBE_RTTBCNRC_RF_INT_MASK |
1476 			     IXGBE_RTTBCNRC_RF_DEC_MASK;
1477 
1478 		/* enable the rate scheduler */
1479 		bcnrc_val |= IXGBE_RTTBCNRC_RS_ENA;
1480 	}
1481 
1482 	/*
1483 	 * Set global transmit compensation time to the MMW_SIZE in RTTBCNRM
1484 	 * register. Typically MMW_SIZE=0x014 if 9728-byte jumbo is supported
1485 	 * and 0x004 otherwise.
1486 	 */
1487 	switch (hw->mac.type) {
1488 	case ixgbe_mac_82599EB:
1489 		IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x4);
1490 		break;
1491 	case ixgbe_mac_X540:
1492 		IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x14);
1493 		break;
1494 	default:
1495 		break;
1496 	}
1497 
1498 	/* determine how many queues per pool based on VMDq mask */
1499 	queues_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
1500 
1501 	/* write value for all Tx queues belonging to VF */
1502 	for (queue = 0; queue < queues_per_pool; queue++) {
1503 		unsigned int reg_idx = (vf * queues_per_pool) + queue;
1504 
1505 		IXGBE_WRITE_REG(hw, IXGBE_RTTDQSEL, reg_idx);
1506 		IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRC, bcnrc_val);
1507 	}
1508 }
1509 
1510 void ixgbe_check_vf_rate_limit(struct ixgbe_adapter *adapter)
1511 {
1512 	int i;
1513 
1514 	/* VF Tx rate limit was not set */
1515 	if (!adapter->vf_rate_link_speed)
1516 		return;
1517 
1518 	if (ixgbe_link_mbps(adapter) != adapter->vf_rate_link_speed) {
1519 		adapter->vf_rate_link_speed = 0;
1520 		dev_info(&adapter->pdev->dev,
1521 			 "Link speed has been changed. VF Transmit rate is disabled\n");
1522 	}
1523 
1524 	for (i = 0; i < adapter->num_vfs; i++) {
1525 		if (!adapter->vf_rate_link_speed)
1526 			adapter->vfinfo[i].tx_rate = 0;
1527 
1528 		ixgbe_set_vf_rate_limit(adapter, i);
1529 	}
1530 }
1531 
1532 int ixgbe_ndo_set_vf_bw(struct net_device *netdev, int vf, int min_tx_rate,
1533 			int max_tx_rate)
1534 {
1535 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1536 	int link_speed;
1537 
1538 	/* verify VF is active */
1539 	if (vf >= adapter->num_vfs)
1540 		return -EINVAL;
1541 
1542 	/* verify link is up */
1543 	if (!adapter->link_up)
1544 		return -EINVAL;
1545 
1546 	/* verify we are linked at 10Gbps */
1547 	link_speed = ixgbe_link_mbps(adapter);
1548 	if (link_speed != 10000)
1549 		return -EINVAL;
1550 
1551 	if (min_tx_rate)
1552 		return -EINVAL;
1553 
1554 	/* rate limit cannot be less than 10Mbs or greater than link speed */
1555 	if (max_tx_rate && ((max_tx_rate <= 10) || (max_tx_rate > link_speed)))
1556 		return -EINVAL;
1557 
1558 	/* store values */
1559 	adapter->vf_rate_link_speed = link_speed;
1560 	adapter->vfinfo[vf].tx_rate = max_tx_rate;
1561 
1562 	/* update hardware configuration */
1563 	ixgbe_set_vf_rate_limit(adapter, vf);
1564 
1565 	return 0;
1566 }
1567 
1568 int ixgbe_ndo_set_vf_spoofchk(struct net_device *netdev, int vf, bool setting)
1569 {
1570 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1571 	struct ixgbe_hw *hw = &adapter->hw;
1572 
1573 	if (vf >= adapter->num_vfs)
1574 		return -EINVAL;
1575 
1576 	adapter->vfinfo[vf].spoofchk_enabled = setting;
1577 
1578 	/* configure MAC spoofing */
1579 	hw->mac.ops.set_mac_anti_spoofing(hw, setting, vf);
1580 
1581 	/* configure VLAN spoofing */
1582 	hw->mac.ops.set_vlan_anti_spoofing(hw, setting, vf);
1583 
1584 	/* Ensure LLDP and FC is set for Ethertype Antispoofing if we will be
1585 	 * calling set_ethertype_anti_spoofing for each VF in loop below
1586 	 */
1587 	if (hw->mac.ops.set_ethertype_anti_spoofing) {
1588 		IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_LLDP),
1589 				(IXGBE_ETQF_FILTER_EN    |
1590 				 IXGBE_ETQF_TX_ANTISPOOF |
1591 				 IXGBE_ETH_P_LLDP));
1592 
1593 		IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_FC),
1594 				(IXGBE_ETQF_FILTER_EN |
1595 				 IXGBE_ETQF_TX_ANTISPOOF |
1596 				 ETH_P_PAUSE));
1597 
1598 		hw->mac.ops.set_ethertype_anti_spoofing(hw, setting, vf);
1599 	}
1600 
1601 	return 0;
1602 }
1603 
1604 int ixgbe_ndo_set_vf_rss_query_en(struct net_device *netdev, int vf,
1605 				  bool setting)
1606 {
1607 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1608 
1609 	/* This operation is currently supported only for 82599 and x540
1610 	 * devices.
1611 	 */
1612 	if (adapter->hw.mac.type < ixgbe_mac_82599EB ||
1613 	    adapter->hw.mac.type >= ixgbe_mac_X550)
1614 		return -EOPNOTSUPP;
1615 
1616 	if (vf >= adapter->num_vfs)
1617 		return -EINVAL;
1618 
1619 	adapter->vfinfo[vf].rss_query_enabled = setting;
1620 
1621 	return 0;
1622 }
1623 
1624 int ixgbe_ndo_set_vf_trust(struct net_device *netdev, int vf, bool setting)
1625 {
1626 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1627 
1628 	if (vf >= adapter->num_vfs)
1629 		return -EINVAL;
1630 
1631 	/* nothing to do */
1632 	if (adapter->vfinfo[vf].trusted == setting)
1633 		return 0;
1634 
1635 	adapter->vfinfo[vf].trusted = setting;
1636 
1637 	/* reset VF to reconfigure features */
1638 	adapter->vfinfo[vf].clear_to_send = false;
1639 	ixgbe_ping_vf(adapter, vf);
1640 
1641 	e_info(drv, "VF %u is %strusted\n", vf, setting ? "" : "not ");
1642 
1643 	return 0;
1644 }
1645 
1646 int ixgbe_ndo_get_vf_config(struct net_device *netdev,
1647 			    int vf, struct ifla_vf_info *ivi)
1648 {
1649 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1650 	if (vf >= adapter->num_vfs)
1651 		return -EINVAL;
1652 	ivi->vf = vf;
1653 	memcpy(&ivi->mac, adapter->vfinfo[vf].vf_mac_addresses, ETH_ALEN);
1654 	ivi->max_tx_rate = adapter->vfinfo[vf].tx_rate;
1655 	ivi->min_tx_rate = 0;
1656 	ivi->vlan = adapter->vfinfo[vf].pf_vlan;
1657 	ivi->qos = adapter->vfinfo[vf].pf_qos;
1658 	ivi->spoofchk = adapter->vfinfo[vf].spoofchk_enabled;
1659 	ivi->rss_query_en = adapter->vfinfo[vf].rss_query_enabled;
1660 	ivi->trusted = adapter->vfinfo[vf].trusted;
1661 	return 0;
1662 }
1663