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