xref: /linux/drivers/net/ethernet/intel/ixgbe/ixgbe_sriov.c (revision a508da6cc0093171833efb8376b00473f24221b9)
1 /*******************************************************************************
2 
3   Intel 10 Gigabit PCI Express Linux driver
4   Copyright(c) 1999 - 2012 Intel Corporation.
5 
6   This program is free software; you can redistribute it and/or modify it
7   under the terms and conditions of the GNU General Public License,
8   version 2, as published by the Free Software Foundation.
9 
10   This program is distributed in the hope it will be useful, but WITHOUT
11   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
13   more details.
14 
15   You should have received a copy of the GNU General Public License along with
16   this program; if not, write to the Free Software Foundation, Inc.,
17   51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
18 
19   The full GNU General Public License is included in this distribution in
20   the file called "COPYING".
21 
22   Contact Information:
23   e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
24   Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
25 
26 *******************************************************************************/
27 
28 #include <linux/types.h>
29 #include <linux/module.h>
30 #include <linux/pci.h>
31 #include <linux/netdevice.h>
32 #include <linux/vmalloc.h>
33 #include <linux/string.h>
34 #include <linux/in.h>
35 #include <linux/ip.h>
36 #include <linux/tcp.h>
37 #include <linux/ipv6.h>
38 #ifdef NETIF_F_HW_VLAN_TX
39 #include <linux/if_vlan.h>
40 #endif
41 
42 #include "ixgbe.h"
43 #include "ixgbe_type.h"
44 #include "ixgbe_sriov.h"
45 
46 #ifdef CONFIG_PCI_IOV
47 static int ixgbe_find_enabled_vfs(struct ixgbe_adapter *adapter)
48 {
49 	struct pci_dev *pdev = adapter->pdev;
50 	struct pci_dev *pvfdev;
51 	u16 vf_devfn = 0;
52 	int device_id;
53 	int vfs_found = 0;
54 
55 	switch (adapter->hw.mac.type) {
56 	case ixgbe_mac_82599EB:
57 		device_id = IXGBE_DEV_ID_82599_VF;
58 		break;
59 	case ixgbe_mac_X540:
60 		device_id = IXGBE_DEV_ID_X540_VF;
61 		break;
62 	default:
63 		device_id = 0;
64 		break;
65 	}
66 
67 	vf_devfn = pdev->devfn + 0x80;
68 	pvfdev = pci_get_device(IXGBE_INTEL_VENDOR_ID, device_id, NULL);
69 	while (pvfdev) {
70 		if (pvfdev->devfn == vf_devfn &&
71 		    (pvfdev->bus->number >= pdev->bus->number))
72 			vfs_found++;
73 		vf_devfn += 2;
74 		pvfdev = pci_get_device(IXGBE_INTEL_VENDOR_ID,
75 					device_id, pvfdev);
76 	}
77 
78 	return vfs_found;
79 }
80 
81 void ixgbe_enable_sriov(struct ixgbe_adapter *adapter,
82 			 const struct ixgbe_info *ii)
83 {
84 	struct ixgbe_hw *hw = &adapter->hw;
85 	int err = 0;
86 	int num_vf_macvlans, i;
87 	struct vf_macvlans *mv_list;
88 	int pre_existing_vfs = 0;
89 
90 	pre_existing_vfs = ixgbe_find_enabled_vfs(adapter);
91 	if (!pre_existing_vfs && !adapter->num_vfs)
92 		return;
93 
94 	/* If there are pre-existing VFs then we have to force
95 	 * use of that many because they were not deleted the last
96 	 * time someone removed the PF driver.  That would have
97 	 * been because they were allocated to guest VMs and can't
98 	 * be removed.  Go ahead and just re-enable the old amount.
99 	 * If the user wants to change the number of VFs they can
100 	 * use ethtool while making sure no VFs are allocated to
101 	 * guest VMs... i.e. the right way.
102 	 */
103 	if (pre_existing_vfs) {
104 		adapter->num_vfs = pre_existing_vfs;
105 		dev_warn(&adapter->pdev->dev, "Virtual Functions already "
106 			 "enabled for this device - Please reload all "
107 			 "VF drivers to avoid spoofed packet errors\n");
108 	} else {
109 		err = pci_enable_sriov(adapter->pdev, adapter->num_vfs);
110 	}
111 	if (err) {
112 		e_err(probe, "Failed to enable PCI sriov: %d\n", err);
113 		goto err_novfs;
114 	}
115 	adapter->flags |= IXGBE_FLAG_SRIOV_ENABLED;
116 
117 	e_info(probe, "SR-IOV enabled with %d VFs\n", adapter->num_vfs);
118 
119 	num_vf_macvlans = hw->mac.num_rar_entries -
120 	(IXGBE_MAX_PF_MACVLANS + 1 + adapter->num_vfs);
121 
122 	adapter->mv_list = mv_list = kcalloc(num_vf_macvlans,
123 					     sizeof(struct vf_macvlans),
124 					     GFP_KERNEL);
125 	if (mv_list) {
126 		/* Initialize list of VF macvlans */
127 		INIT_LIST_HEAD(&adapter->vf_mvs.l);
128 		for (i = 0; i < num_vf_macvlans; i++) {
129 			mv_list->vf = -1;
130 			mv_list->free = true;
131 			mv_list->rar_entry = hw->mac.num_rar_entries -
132 				(i + adapter->num_vfs + 1);
133 			list_add(&mv_list->l, &adapter->vf_mvs.l);
134 			mv_list++;
135 		}
136 	}
137 
138 	/* If call to enable VFs succeeded then allocate memory
139 	 * for per VF control structures.
140 	 */
141 	adapter->vfinfo =
142 		kcalloc(adapter->num_vfs,
143 			sizeof(struct vf_data_storage), GFP_KERNEL);
144 	if (adapter->vfinfo) {
145 		/* Now that we're sure SR-IOV is enabled
146 		 * and memory allocated set up the mailbox parameters
147 		 */
148 		ixgbe_init_mbx_params_pf(hw);
149 		memcpy(&hw->mbx.ops, ii->mbx_ops,
150 		       sizeof(hw->mbx.ops));
151 
152 		/* Disable RSC when in SR-IOV mode */
153 		adapter->flags2 &= ~(IXGBE_FLAG2_RSC_CAPABLE |
154 				     IXGBE_FLAG2_RSC_ENABLED);
155 		for (i = 0; i < adapter->num_vfs; i++)
156 			adapter->vfinfo[i].spoofchk_enabled = true;
157 		return;
158 	}
159 
160 	/* Oh oh */
161 	e_err(probe, "Unable to allocate memory for VF Data Storage - "
162 	      "SRIOV disabled\n");
163 	pci_disable_sriov(adapter->pdev);
164 
165 err_novfs:
166 	adapter->flags &= ~IXGBE_FLAG_SRIOV_ENABLED;
167 	adapter->num_vfs = 0;
168 }
169 #endif /* #ifdef CONFIG_PCI_IOV */
170 
171 void ixgbe_disable_sriov(struct ixgbe_adapter *adapter)
172 {
173 	struct ixgbe_hw *hw = &adapter->hw;
174 	u32 gcr;
175 	u32 gpie;
176 	u32 vmdctl;
177 	int i;
178 
179 #ifdef CONFIG_PCI_IOV
180 	/* disable iov and allow time for transactions to clear */
181 	pci_disable_sriov(adapter->pdev);
182 #endif
183 
184 	/* turn off device IOV mode */
185 	gcr = IXGBE_READ_REG(hw, IXGBE_GCR_EXT);
186 	gcr &= ~(IXGBE_GCR_EXT_SRIOV);
187 	IXGBE_WRITE_REG(hw, IXGBE_GCR_EXT, gcr);
188 	gpie = IXGBE_READ_REG(hw, IXGBE_GPIE);
189 	gpie &= ~IXGBE_GPIE_VTMODE_MASK;
190 	IXGBE_WRITE_REG(hw, IXGBE_GPIE, gpie);
191 
192 	/* set default pool back to 0 */
193 	vmdctl = IXGBE_READ_REG(hw, IXGBE_VT_CTL);
194 	vmdctl &= ~IXGBE_VT_CTL_POOL_MASK;
195 	IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, vmdctl);
196 	IXGBE_WRITE_FLUSH(hw);
197 
198 	/* take a breather then clean up driver data */
199 	msleep(100);
200 
201 	/* Release reference to VF devices */
202 	for (i = 0; i < adapter->num_vfs; i++) {
203 		if (adapter->vfinfo[i].vfdev)
204 			pci_dev_put(adapter->vfinfo[i].vfdev);
205 	}
206 	kfree(adapter->vfinfo);
207 	kfree(adapter->mv_list);
208 	adapter->vfinfo = NULL;
209 
210 	adapter->num_vfs = 0;
211 	adapter->flags &= ~IXGBE_FLAG_SRIOV_ENABLED;
212 }
213 
214 static int ixgbe_set_vf_multicasts(struct ixgbe_adapter *adapter,
215 				   int entries, u16 *hash_list, u32 vf)
216 {
217 	struct vf_data_storage *vfinfo = &adapter->vfinfo[vf];
218 	struct ixgbe_hw *hw = &adapter->hw;
219 	int i;
220 	u32 vector_bit;
221 	u32 vector_reg;
222 	u32 mta_reg;
223 
224 	/* only so many hash values supported */
225 	entries = min(entries, IXGBE_MAX_VF_MC_ENTRIES);
226 
227 	/*
228 	 * salt away the number of multi cast addresses assigned
229 	 * to this VF for later use to restore when the PF multi cast
230 	 * list changes
231 	 */
232 	vfinfo->num_vf_mc_hashes = entries;
233 
234 	/*
235 	 * VFs are limited to using the MTA hash table for their multicast
236 	 * addresses
237 	 */
238 	for (i = 0; i < entries; i++) {
239 		vfinfo->vf_mc_hashes[i] = hash_list[i];
240 	}
241 
242 	for (i = 0; i < vfinfo->num_vf_mc_hashes; i++) {
243 		vector_reg = (vfinfo->vf_mc_hashes[i] >> 5) & 0x7F;
244 		vector_bit = vfinfo->vf_mc_hashes[i] & 0x1F;
245 		mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
246 		mta_reg |= (1 << vector_bit);
247 		IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
248 	}
249 
250 	return 0;
251 }
252 
253 static void ixgbe_restore_vf_macvlans(struct ixgbe_adapter *adapter)
254 {
255 	struct ixgbe_hw *hw = &adapter->hw;
256 	struct list_head *pos;
257 	struct vf_macvlans *entry;
258 
259 	list_for_each(pos, &adapter->vf_mvs.l) {
260 		entry = list_entry(pos, struct vf_macvlans, l);
261 		if (!entry->free)
262 			hw->mac.ops.set_rar(hw, entry->rar_entry,
263 					    entry->vf_macvlan,
264 					    entry->vf, IXGBE_RAH_AV);
265 	}
266 }
267 
268 void ixgbe_restore_vf_multicasts(struct ixgbe_adapter *adapter)
269 {
270 	struct ixgbe_hw *hw = &adapter->hw;
271 	struct vf_data_storage *vfinfo;
272 	int i, j;
273 	u32 vector_bit;
274 	u32 vector_reg;
275 	u32 mta_reg;
276 
277 	for (i = 0; i < adapter->num_vfs; i++) {
278 		vfinfo = &adapter->vfinfo[i];
279 		for (j = 0; j < vfinfo->num_vf_mc_hashes; j++) {
280 			hw->addr_ctrl.mta_in_use++;
281 			vector_reg = (vfinfo->vf_mc_hashes[j] >> 5) & 0x7F;
282 			vector_bit = vfinfo->vf_mc_hashes[j] & 0x1F;
283 			mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
284 			mta_reg |= (1 << vector_bit);
285 			IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
286 		}
287 	}
288 
289 	/* Restore any VF macvlans */
290 	ixgbe_restore_vf_macvlans(adapter);
291 }
292 
293 static int ixgbe_set_vf_vlan(struct ixgbe_adapter *adapter, int add, int vid,
294 			     u32 vf)
295 {
296 	return adapter->hw.mac.ops.set_vfta(&adapter->hw, vid, vf, (bool)add);
297 }
298 
299 static void ixgbe_set_vf_lpe(struct ixgbe_adapter *adapter, u32 *msgbuf)
300 {
301 	struct ixgbe_hw *hw = &adapter->hw;
302 	int new_mtu = msgbuf[1];
303 	u32 max_frs;
304 	int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;
305 
306 	/* Only X540 supports jumbo frames in IOV mode */
307 	if (adapter->hw.mac.type != ixgbe_mac_X540)
308 		return;
309 
310 	/* MTU < 68 is an error and causes problems on some kernels */
311 	if ((new_mtu < 68) || (max_frame > IXGBE_MAX_JUMBO_FRAME_SIZE)) {
312 		e_err(drv, "VF mtu %d out of range\n", new_mtu);
313 		return;
314 	}
315 
316 	max_frs = (IXGBE_READ_REG(hw, IXGBE_MAXFRS) &
317 		   IXGBE_MHADD_MFS_MASK) >> IXGBE_MHADD_MFS_SHIFT;
318 	if (max_frs < new_mtu) {
319 		max_frs = new_mtu << IXGBE_MHADD_MFS_SHIFT;
320 		IXGBE_WRITE_REG(hw, IXGBE_MAXFRS, max_frs);
321 	}
322 
323 	e_info(hw, "VF requests change max MTU to %d\n", new_mtu);
324 }
325 
326 static void ixgbe_set_vmolr(struct ixgbe_hw *hw, u32 vf, bool aupe)
327 {
328 	u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
329 	vmolr |= (IXGBE_VMOLR_ROMPE |
330 		  IXGBE_VMOLR_BAM);
331 	if (aupe)
332 		vmolr |= IXGBE_VMOLR_AUPE;
333 	else
334 		vmolr &= ~IXGBE_VMOLR_AUPE;
335 	IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
336 }
337 
338 static void ixgbe_set_vmvir(struct ixgbe_adapter *adapter, u32 vid, u32 vf)
339 {
340 	struct ixgbe_hw *hw = &adapter->hw;
341 
342 	if (vid)
343 		IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf),
344 				(vid | IXGBE_VMVIR_VLANA_DEFAULT));
345 	else
346 		IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf), 0);
347 }
348 
349 static inline void ixgbe_vf_reset_event(struct ixgbe_adapter *adapter, u32 vf)
350 {
351 	struct ixgbe_hw *hw = &adapter->hw;
352 	int rar_entry = hw->mac.num_rar_entries - (vf + 1);
353 
354 	/* reset offloads to defaults */
355 	if (adapter->vfinfo[vf].pf_vlan) {
356 		ixgbe_set_vf_vlan(adapter, true,
357 				  adapter->vfinfo[vf].pf_vlan, vf);
358 		ixgbe_set_vmvir(adapter,
359 				(adapter->vfinfo[vf].pf_vlan |
360 				 (adapter->vfinfo[vf].pf_qos <<
361 				  VLAN_PRIO_SHIFT)), vf);
362 		ixgbe_set_vmolr(hw, vf, false);
363 	} else {
364 		ixgbe_set_vmvir(adapter, 0, vf);
365 		ixgbe_set_vmolr(hw, vf, true);
366 	}
367 
368 	/* reset multicast table array for vf */
369 	adapter->vfinfo[vf].num_vf_mc_hashes = 0;
370 
371 	/* Flush and reset the mta with the new values */
372 	ixgbe_set_rx_mode(adapter->netdev);
373 
374 	hw->mac.ops.clear_rar(hw, rar_entry);
375 }
376 
377 static int ixgbe_set_vf_mac(struct ixgbe_adapter *adapter,
378 			    int vf, unsigned char *mac_addr)
379 {
380 	struct ixgbe_hw *hw = &adapter->hw;
381 	int rar_entry = hw->mac.num_rar_entries - (vf + 1);
382 
383 	memcpy(adapter->vfinfo[vf].vf_mac_addresses, mac_addr, 6);
384 	hw->mac.ops.set_rar(hw, rar_entry, mac_addr, vf, IXGBE_RAH_AV);
385 
386 	return 0;
387 }
388 
389 static int ixgbe_set_vf_macvlan(struct ixgbe_adapter *adapter,
390 				int vf, int index, unsigned char *mac_addr)
391 {
392 	struct ixgbe_hw *hw = &adapter->hw;
393 	struct list_head *pos;
394 	struct vf_macvlans *entry;
395 
396 	if (index <= 1) {
397 		list_for_each(pos, &adapter->vf_mvs.l) {
398 			entry = list_entry(pos, struct vf_macvlans, l);
399 			if (entry->vf == vf) {
400 				entry->vf = -1;
401 				entry->free = true;
402 				entry->is_macvlan = false;
403 				hw->mac.ops.clear_rar(hw, entry->rar_entry);
404 			}
405 		}
406 	}
407 
408 	/*
409 	 * If index was zero then we were asked to clear the uc list
410 	 * for the VF.  We're done.
411 	 */
412 	if (!index)
413 		return 0;
414 
415 	entry = NULL;
416 
417 	list_for_each(pos, &adapter->vf_mvs.l) {
418 		entry = list_entry(pos, struct vf_macvlans, l);
419 		if (entry->free)
420 			break;
421 	}
422 
423 	/*
424 	 * If we traversed the entire list and didn't find a free entry
425 	 * then we're out of space on the RAR table.  Also entry may
426 	 * be NULL because the original memory allocation for the list
427 	 * failed, which is not fatal but does mean we can't support
428 	 * VF requests for MACVLAN because we couldn't allocate
429 	 * memory for the list management required.
430 	 */
431 	if (!entry || !entry->free)
432 		return -ENOSPC;
433 
434 	entry->free = false;
435 	entry->is_macvlan = true;
436 	entry->vf = vf;
437 	memcpy(entry->vf_macvlan, mac_addr, ETH_ALEN);
438 
439 	hw->mac.ops.set_rar(hw, entry->rar_entry, mac_addr, vf, IXGBE_RAH_AV);
440 
441 	return 0;
442 }
443 
444 int ixgbe_check_vf_assignment(struct ixgbe_adapter *adapter)
445 {
446 #ifdef CONFIG_PCI_IOV
447 	int i;
448 	for (i = 0; i < adapter->num_vfs; i++) {
449 		if (adapter->vfinfo[i].vfdev->dev_flags &
450 				PCI_DEV_FLAGS_ASSIGNED)
451 			return true;
452 	}
453 #endif
454 	return false;
455 }
456 
457 int ixgbe_vf_configuration(struct pci_dev *pdev, unsigned int event_mask)
458 {
459 	unsigned char vf_mac_addr[6];
460 	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
461 	unsigned int vfn = (event_mask & 0x3f);
462 	struct pci_dev *pvfdev;
463 	unsigned int device_id;
464 	u16 thisvf_devfn = (pdev->devfn + 0x80 + (vfn << 1)) |
465 				(pdev->devfn & 1);
466 
467 	bool enable = ((event_mask & 0x10000000U) != 0);
468 
469 	if (enable) {
470 		random_ether_addr(vf_mac_addr);
471 		e_info(probe, "IOV: VF %d is enabled MAC %pM\n",
472 		       vfn, vf_mac_addr);
473 		/*
474 		 * Store away the VF "permananet" MAC address, it will ask
475 		 * for it later.
476 		 */
477 		memcpy(adapter->vfinfo[vfn].vf_mac_addresses, vf_mac_addr, 6);
478 
479 		switch (adapter->hw.mac.type) {
480 		case ixgbe_mac_82599EB:
481 			device_id = IXGBE_DEV_ID_82599_VF;
482 			break;
483 		case ixgbe_mac_X540:
484 			device_id = IXGBE_DEV_ID_X540_VF;
485 			break;
486 		default:
487 			device_id = 0;
488 			break;
489 		}
490 
491 		pvfdev = pci_get_device(IXGBE_INTEL_VENDOR_ID, device_id, NULL);
492 		while (pvfdev) {
493 			if (pvfdev->devfn == thisvf_devfn)
494 				break;
495 			pvfdev = pci_get_device(IXGBE_INTEL_VENDOR_ID,
496 						device_id, pvfdev);
497 		}
498 		if (pvfdev)
499 			adapter->vfinfo[vfn].vfdev = pvfdev;
500 		else
501 			e_err(drv, "Couldn't find pci dev ptr for VF %4.4x\n",
502 			      thisvf_devfn);
503 	}
504 
505 	return 0;
506 }
507 
508 static inline void ixgbe_vf_reset_msg(struct ixgbe_adapter *adapter, u32 vf)
509 {
510 	struct ixgbe_hw *hw = &adapter->hw;
511 	u32 reg;
512 	u32 reg_offset, vf_shift;
513 
514 	vf_shift = vf % 32;
515 	reg_offset = vf / 32;
516 
517 	/* enable transmit and receive for vf */
518 	reg = IXGBE_READ_REG(hw, IXGBE_VFTE(reg_offset));
519 	reg |= (reg | (1 << vf_shift));
520 	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), reg);
521 
522 	reg = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
523 	reg |= (reg | (1 << vf_shift));
524 	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), reg);
525 
526 	/* Enable counting of spoofed packets in the SSVPC register */
527 	reg = IXGBE_READ_REG(hw, IXGBE_VMECM(reg_offset));
528 	reg |= (1 << vf_shift);
529 	IXGBE_WRITE_REG(hw, IXGBE_VMECM(reg_offset), reg);
530 
531 	ixgbe_vf_reset_event(adapter, vf);
532 }
533 
534 static int ixgbe_rcv_msg_from_vf(struct ixgbe_adapter *adapter, u32 vf)
535 {
536 	u32 mbx_size = IXGBE_VFMAILBOX_SIZE;
537 	u32 msgbuf[IXGBE_VFMAILBOX_SIZE];
538 	struct ixgbe_hw *hw = &adapter->hw;
539 	s32 retval;
540 	int entries;
541 	u16 *hash_list;
542 	int add, vid, index;
543 	u8 *new_mac;
544 
545 	retval = ixgbe_read_mbx(hw, msgbuf, mbx_size, vf);
546 
547 	if (retval) {
548 		pr_err("Error receiving message from VF\n");
549 		return retval;
550 	}
551 
552 	/* this is a message we already processed, do nothing */
553 	if (msgbuf[0] & (IXGBE_VT_MSGTYPE_ACK | IXGBE_VT_MSGTYPE_NACK))
554 		return retval;
555 
556 	/* flush the ack before we write any messages back */
557 	IXGBE_WRITE_FLUSH(hw);
558 
559 	/*
560 	 * until the vf completes a virtual function reset it should not be
561 	 * allowed to start any configuration.
562 	 */
563 
564 	if (msgbuf[0] == IXGBE_VF_RESET) {
565 		unsigned char *vf_mac = adapter->vfinfo[vf].vf_mac_addresses;
566 		new_mac = (u8 *)(&msgbuf[1]);
567 		e_info(probe, "VF Reset msg received from vf %d\n", vf);
568 		adapter->vfinfo[vf].clear_to_send = false;
569 		ixgbe_vf_reset_msg(adapter, vf);
570 		adapter->vfinfo[vf].clear_to_send = true;
571 
572 		if (is_valid_ether_addr(new_mac) &&
573 		    !adapter->vfinfo[vf].pf_set_mac)
574 			ixgbe_set_vf_mac(adapter, vf, vf_mac);
575 		else
576 			ixgbe_set_vf_mac(adapter,
577 				 vf, adapter->vfinfo[vf].vf_mac_addresses);
578 
579 		/* reply to reset with ack and vf mac address */
580 		msgbuf[0] = IXGBE_VF_RESET | IXGBE_VT_MSGTYPE_ACK;
581 		memcpy(new_mac, vf_mac, ETH_ALEN);
582 		/*
583 		 * Piggyback the multicast filter type so VF can compute the
584 		 * correct vectors
585 		 */
586 		msgbuf[3] = hw->mac.mc_filter_type;
587 		ixgbe_write_mbx(hw, msgbuf, IXGBE_VF_PERMADDR_MSG_LEN, vf);
588 
589 		return retval;
590 	}
591 
592 	if (!adapter->vfinfo[vf].clear_to_send) {
593 		msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
594 		ixgbe_write_mbx(hw, msgbuf, 1, vf);
595 		return retval;
596 	}
597 
598 	switch ((msgbuf[0] & 0xFFFF)) {
599 	case IXGBE_VF_SET_MAC_ADDR:
600 		new_mac = ((u8 *)(&msgbuf[1]));
601 		if (is_valid_ether_addr(new_mac) &&
602 		    !adapter->vfinfo[vf].pf_set_mac) {
603 			ixgbe_set_vf_mac(adapter, vf, new_mac);
604 		} else if (memcmp(adapter->vfinfo[vf].vf_mac_addresses,
605 				  new_mac, ETH_ALEN)) {
606 			e_warn(drv, "VF %d attempted to override "
607 			       "administratively set MAC address\nReload "
608 			       "the VF driver to resume operations\n", vf);
609 			retval = -1;
610 		}
611 		break;
612 	case IXGBE_VF_SET_MULTICAST:
613 		entries = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
614 		          >> IXGBE_VT_MSGINFO_SHIFT;
615 		hash_list = (u16 *)&msgbuf[1];
616 		retval = ixgbe_set_vf_multicasts(adapter, entries,
617 		                                 hash_list, vf);
618 		break;
619 	case IXGBE_VF_SET_LPE:
620 		ixgbe_set_vf_lpe(adapter, msgbuf);
621 		break;
622 	case IXGBE_VF_SET_VLAN:
623 		add = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
624 		      >> IXGBE_VT_MSGINFO_SHIFT;
625 		vid = (msgbuf[1] & IXGBE_VLVF_VLANID_MASK);
626 		if (adapter->vfinfo[vf].pf_vlan) {
627 			e_warn(drv, "VF %d attempted to override "
628 			       "administratively set VLAN configuration\n"
629 			       "Reload the VF driver to resume operations\n",
630 			       vf);
631 			retval = -1;
632 		} else {
633 			if (add)
634 				adapter->vfinfo[vf].vlan_count++;
635 			else if (adapter->vfinfo[vf].vlan_count)
636 				adapter->vfinfo[vf].vlan_count--;
637 			retval = ixgbe_set_vf_vlan(adapter, add, vid, vf);
638 			if (!retval && adapter->vfinfo[vf].spoofchk_enabled)
639 				hw->mac.ops.set_vlan_anti_spoofing(hw, true, vf);
640 		}
641 		break;
642 	case IXGBE_VF_SET_MACVLAN:
643 		index = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >>
644 			IXGBE_VT_MSGINFO_SHIFT;
645 		if (adapter->vfinfo[vf].pf_set_mac && index > 0) {
646 			e_warn(drv, "VF %d requested MACVLAN filter but is "
647 				    "administratively denied\n", vf);
648 			retval = -1;
649 			break;
650 		}
651 		/*
652 		 * If the VF is allowed to set MAC filters then turn off
653 		 * anti-spoofing to avoid false positives.  An index
654 		 * greater than 0 will indicate the VF is setting a
655 		 * macvlan MAC filter.
656 		 */
657 		if (index > 0 && adapter->vfinfo[vf].spoofchk_enabled)
658 			ixgbe_ndo_set_vf_spoofchk(adapter->netdev, vf, false);
659 		retval = ixgbe_set_vf_macvlan(adapter, vf, index,
660 					      (unsigned char *)(&msgbuf[1]));
661 		if (retval == -ENOSPC)
662 			e_warn(drv, "VF %d has requested a MACVLAN filter "
663 				    "but there is no space for it\n", vf);
664 		break;
665 	default:
666 		e_err(drv, "Unhandled Msg %8.8x\n", msgbuf[0]);
667 		retval = IXGBE_ERR_MBX;
668 		break;
669 	}
670 
671 	/* notify the VF of the results of what it sent us */
672 	if (retval)
673 		msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
674 	else
675 		msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
676 
677 	msgbuf[0] |= IXGBE_VT_MSGTYPE_CTS;
678 
679 	ixgbe_write_mbx(hw, msgbuf, 1, vf);
680 
681 	return retval;
682 }
683 
684 static void ixgbe_rcv_ack_from_vf(struct ixgbe_adapter *adapter, u32 vf)
685 {
686 	struct ixgbe_hw *hw = &adapter->hw;
687 	u32 msg = IXGBE_VT_MSGTYPE_NACK;
688 
689 	/* if device isn't clear to send it shouldn't be reading either */
690 	if (!adapter->vfinfo[vf].clear_to_send)
691 		ixgbe_write_mbx(hw, &msg, 1, vf);
692 }
693 
694 void ixgbe_msg_task(struct ixgbe_adapter *adapter)
695 {
696 	struct ixgbe_hw *hw = &adapter->hw;
697 	u32 vf;
698 
699 	for (vf = 0; vf < adapter->num_vfs; vf++) {
700 		/* process any reset requests */
701 		if (!ixgbe_check_for_rst(hw, vf))
702 			ixgbe_vf_reset_event(adapter, vf);
703 
704 		/* process any messages pending */
705 		if (!ixgbe_check_for_msg(hw, vf))
706 			ixgbe_rcv_msg_from_vf(adapter, vf);
707 
708 		/* process any acks */
709 		if (!ixgbe_check_for_ack(hw, vf))
710 			ixgbe_rcv_ack_from_vf(adapter, vf);
711 	}
712 }
713 
714 void ixgbe_disable_tx_rx(struct ixgbe_adapter *adapter)
715 {
716 	struct ixgbe_hw *hw = &adapter->hw;
717 
718 	/* disable transmit and receive for all vfs */
719 	IXGBE_WRITE_REG(hw, IXGBE_VFTE(0), 0);
720 	IXGBE_WRITE_REG(hw, IXGBE_VFTE(1), 0);
721 
722 	IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), 0);
723 	IXGBE_WRITE_REG(hw, IXGBE_VFRE(1), 0);
724 }
725 
726 void ixgbe_ping_all_vfs(struct ixgbe_adapter *adapter)
727 {
728 	struct ixgbe_hw *hw = &adapter->hw;
729 	u32 ping;
730 	int i;
731 
732 	for (i = 0 ; i < adapter->num_vfs; i++) {
733 		ping = IXGBE_PF_CONTROL_MSG;
734 		if (adapter->vfinfo[i].clear_to_send)
735 			ping |= IXGBE_VT_MSGTYPE_CTS;
736 		ixgbe_write_mbx(hw, &ping, 1, i);
737 	}
738 }
739 
740 int ixgbe_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
741 {
742 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
743 	if (!is_valid_ether_addr(mac) || (vf >= adapter->num_vfs))
744 		return -EINVAL;
745 	adapter->vfinfo[vf].pf_set_mac = true;
746 	dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n", mac, vf);
747 	dev_info(&adapter->pdev->dev, "Reload the VF driver to make this"
748 				      " change effective.");
749 	if (test_bit(__IXGBE_DOWN, &adapter->state)) {
750 		dev_warn(&adapter->pdev->dev, "The VF MAC address has been set,"
751 			 " but the PF device is not up.\n");
752 		dev_warn(&adapter->pdev->dev, "Bring the PF device up before"
753 			 " attempting to use the VF device.\n");
754 	}
755 	return ixgbe_set_vf_mac(adapter, vf, mac);
756 }
757 
758 int ixgbe_ndo_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos)
759 {
760 	int err = 0;
761 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
762 	struct ixgbe_hw *hw = &adapter->hw;
763 
764 	if ((vf >= adapter->num_vfs) || (vlan > 4095) || (qos > 7))
765 		return -EINVAL;
766 	if (vlan || qos) {
767 		err = ixgbe_set_vf_vlan(adapter, true, vlan, vf);
768 		if (err)
769 			goto out;
770 		ixgbe_set_vmvir(adapter, vlan | (qos << VLAN_PRIO_SHIFT), vf);
771 		ixgbe_set_vmolr(hw, vf, false);
772 		if (adapter->vfinfo[vf].spoofchk_enabled)
773 			hw->mac.ops.set_vlan_anti_spoofing(hw, true, vf);
774 		adapter->vfinfo[vf].vlan_count++;
775 		adapter->vfinfo[vf].pf_vlan = vlan;
776 		adapter->vfinfo[vf].pf_qos = qos;
777 		dev_info(&adapter->pdev->dev,
778 			 "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
779 		if (test_bit(__IXGBE_DOWN, &adapter->state)) {
780 			dev_warn(&adapter->pdev->dev,
781 				 "The VF VLAN has been set,"
782 				 " but the PF device is not up.\n");
783 			dev_warn(&adapter->pdev->dev,
784 				 "Bring the PF device up before"
785 				 " attempting to use the VF device.\n");
786 		}
787 	} else {
788 		err = ixgbe_set_vf_vlan(adapter, false,
789 					adapter->vfinfo[vf].pf_vlan, vf);
790 		ixgbe_set_vmvir(adapter, vlan, vf);
791 		ixgbe_set_vmolr(hw, vf, true);
792 		hw->mac.ops.set_vlan_anti_spoofing(hw, false, vf);
793 		if (adapter->vfinfo[vf].vlan_count)
794 			adapter->vfinfo[vf].vlan_count--;
795 		adapter->vfinfo[vf].pf_vlan = 0;
796 		adapter->vfinfo[vf].pf_qos = 0;
797        }
798 out:
799        return err;
800 }
801 
802 static int ixgbe_link_mbps(int internal_link_speed)
803 {
804 	switch (internal_link_speed) {
805 	case IXGBE_LINK_SPEED_100_FULL:
806 		return 100;
807 	case IXGBE_LINK_SPEED_1GB_FULL:
808 		return 1000;
809 	case IXGBE_LINK_SPEED_10GB_FULL:
810 		return 10000;
811 	default:
812 		return 0;
813 	}
814 }
815 
816 static void ixgbe_set_vf_rate_limit(struct ixgbe_hw *hw, int vf, int tx_rate,
817 				    int link_speed)
818 {
819 	int rf_dec, rf_int;
820 	u32 bcnrc_val;
821 
822 	if (tx_rate != 0) {
823 		/* Calculate the rate factor values to set */
824 		rf_int = link_speed / tx_rate;
825 		rf_dec = (link_speed - (rf_int * tx_rate));
826 		rf_dec = (rf_dec * (1<<IXGBE_RTTBCNRC_RF_INT_SHIFT)) / tx_rate;
827 
828 		bcnrc_val = IXGBE_RTTBCNRC_RS_ENA;
829 		bcnrc_val |= ((rf_int<<IXGBE_RTTBCNRC_RF_INT_SHIFT) &
830 		               IXGBE_RTTBCNRC_RF_INT_MASK);
831 		bcnrc_val |= (rf_dec & IXGBE_RTTBCNRC_RF_DEC_MASK);
832 	} else {
833 		bcnrc_val = 0;
834 	}
835 
836 	IXGBE_WRITE_REG(hw, IXGBE_RTTDQSEL, 2*vf); /* vf Y uses queue 2*Y */
837 	/*
838 	 * Set global transmit compensation time to the MMW_SIZE in RTTBCNRM
839 	 * register. Typically MMW_SIZE=0x014 if 9728-byte jumbo is supported
840 	 * and 0x004 otherwise.
841 	 */
842 	switch (hw->mac.type) {
843 	case ixgbe_mac_82599EB:
844 		IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x4);
845 		break;
846 	case ixgbe_mac_X540:
847 		IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x14);
848 		break;
849 	default:
850 		break;
851 	}
852 
853 	IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRC, bcnrc_val);
854 }
855 
856 void ixgbe_check_vf_rate_limit(struct ixgbe_adapter *adapter)
857 {
858 	int actual_link_speed, i;
859 	bool reset_rate = false;
860 
861 	/* VF Tx rate limit was not set */
862 	if (adapter->vf_rate_link_speed == 0)
863 		return;
864 
865 	actual_link_speed = ixgbe_link_mbps(adapter->link_speed);
866 	if (actual_link_speed != adapter->vf_rate_link_speed) {
867 		reset_rate = true;
868 		adapter->vf_rate_link_speed = 0;
869 		dev_info(&adapter->pdev->dev,
870 		         "Link speed has been changed. VF Transmit rate "
871 		         "is disabled\n");
872 	}
873 
874 	for (i = 0; i < adapter->num_vfs; i++) {
875 		if (reset_rate)
876 			adapter->vfinfo[i].tx_rate = 0;
877 
878 		ixgbe_set_vf_rate_limit(&adapter->hw, i,
879 					adapter->vfinfo[i].tx_rate,
880 					actual_link_speed);
881 	}
882 }
883 
884 int ixgbe_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate)
885 {
886 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
887 	struct ixgbe_hw *hw = &adapter->hw;
888 	int actual_link_speed;
889 
890 	actual_link_speed = ixgbe_link_mbps(adapter->link_speed);
891 	if ((vf >= adapter->num_vfs) || (!adapter->link_up) ||
892 	    (tx_rate > actual_link_speed) || (actual_link_speed != 10000) ||
893 	    ((tx_rate != 0) && (tx_rate <= 10)))
894 	    /* rate limit cannot be set to 10Mb or less in 10Gb adapters */
895 		return -EINVAL;
896 
897 	adapter->vf_rate_link_speed = actual_link_speed;
898 	adapter->vfinfo[vf].tx_rate = (u16)tx_rate;
899 	ixgbe_set_vf_rate_limit(hw, vf, tx_rate, actual_link_speed);
900 
901 	return 0;
902 }
903 
904 int ixgbe_ndo_set_vf_spoofchk(struct net_device *netdev, int vf, bool setting)
905 {
906 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
907 	int vf_target_reg = vf >> 3;
908 	int vf_target_shift = vf % 8;
909 	struct ixgbe_hw *hw = &adapter->hw;
910 	u32 regval;
911 
912 	adapter->vfinfo[vf].spoofchk_enabled = setting;
913 
914 	regval = IXGBE_READ_REG(hw, IXGBE_PFVFSPOOF(vf_target_reg));
915 	regval &= ~(1 << vf_target_shift);
916 	regval |= (setting << vf_target_shift);
917 	IXGBE_WRITE_REG(hw, IXGBE_PFVFSPOOF(vf_target_reg), regval);
918 
919 	if (adapter->vfinfo[vf].vlan_count) {
920 		vf_target_shift += IXGBE_SPOOF_VLANAS_SHIFT;
921 		regval = IXGBE_READ_REG(hw, IXGBE_PFVFSPOOF(vf_target_reg));
922 		regval &= ~(1 << vf_target_shift);
923 		regval |= (setting << vf_target_shift);
924 		IXGBE_WRITE_REG(hw, IXGBE_PFVFSPOOF(vf_target_reg), regval);
925 	}
926 
927 	return 0;
928 }
929 
930 int ixgbe_ndo_get_vf_config(struct net_device *netdev,
931 			    int vf, struct ifla_vf_info *ivi)
932 {
933 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
934 	if (vf >= adapter->num_vfs)
935 		return -EINVAL;
936 	ivi->vf = vf;
937 	memcpy(&ivi->mac, adapter->vfinfo[vf].vf_mac_addresses, ETH_ALEN);
938 	ivi->tx_rate = adapter->vfinfo[vf].tx_rate;
939 	ivi->vlan = adapter->vfinfo[vf].pf_vlan;
940 	ivi->qos = adapter->vfinfo[vf].pf_qos;
941 	ivi->spoofchk = adapter->vfinfo[vf].spoofchk_enabled;
942 	return 0;
943 }
944