Linux Audio

Check our new training course

Loading...
Note: File does not exist in v4.17.
  1/*******************************************************************************
  2
  3  Intel 10 Gigabit PCI Express Linux driver
  4  Copyright(c) 1999 - 2011 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
 44#include "ixgbe_sriov.h"
 45
 46static int ixgbe_set_vf_multicasts(struct ixgbe_adapter *adapter,
 47				   int entries, u16 *hash_list, u32 vf)
 48{
 49	struct vf_data_storage *vfinfo = &adapter->vfinfo[vf];
 50	struct ixgbe_hw *hw = &adapter->hw;
 51	int i;
 52	u32 vector_bit;
 53	u32 vector_reg;
 54	u32 mta_reg;
 55
 56	/* only so many hash values supported */
 57	entries = min(entries, IXGBE_MAX_VF_MC_ENTRIES);
 58
 59	/*
 60	 * salt away the number of multi cast addresses assigned
 61	 * to this VF for later use to restore when the PF multi cast
 62	 * list changes
 63	 */
 64	vfinfo->num_vf_mc_hashes = entries;
 65
 66	/*
 67	 * VFs are limited to using the MTA hash table for their multicast
 68	 * addresses
 69	 */
 70	for (i = 0; i < entries; i++) {
 71		vfinfo->vf_mc_hashes[i] = hash_list[i];
 72	}
 73
 74	for (i = 0; i < vfinfo->num_vf_mc_hashes; i++) {
 75		vector_reg = (vfinfo->vf_mc_hashes[i] >> 5) & 0x7F;
 76		vector_bit = vfinfo->vf_mc_hashes[i] & 0x1F;
 77		mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
 78		mta_reg |= (1 << vector_bit);
 79		IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
 80	}
 81
 82	return 0;
 83}
 84
 85static void ixgbe_restore_vf_macvlans(struct ixgbe_adapter *adapter)
 86{
 87	struct ixgbe_hw *hw = &adapter->hw;
 88	struct list_head *pos;
 89	struct vf_macvlans *entry;
 90
 91	list_for_each(pos, &adapter->vf_mvs.l) {
 92		entry = list_entry(pos, struct vf_macvlans, l);
 93		if (entry->free == false)
 94			hw->mac.ops.set_rar(hw, entry->rar_entry,
 95					    entry->vf_macvlan,
 96					    entry->vf, IXGBE_RAH_AV);
 97	}
 98}
 99
100void ixgbe_restore_vf_multicasts(struct ixgbe_adapter *adapter)
101{
102	struct ixgbe_hw *hw = &adapter->hw;
103	struct vf_data_storage *vfinfo;
104	int i, j;
105	u32 vector_bit;
106	u32 vector_reg;
107	u32 mta_reg;
108
109	for (i = 0; i < adapter->num_vfs; i++) {
110		vfinfo = &adapter->vfinfo[i];
111		for (j = 0; j < vfinfo->num_vf_mc_hashes; j++) {
112			hw->addr_ctrl.mta_in_use++;
113			vector_reg = (vfinfo->vf_mc_hashes[j] >> 5) & 0x7F;
114			vector_bit = vfinfo->vf_mc_hashes[j] & 0x1F;
115			mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
116			mta_reg |= (1 << vector_bit);
117			IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
118		}
119	}
120
121	/* Restore any VF macvlans */
122	ixgbe_restore_vf_macvlans(adapter);
123}
124
125static int ixgbe_set_vf_vlan(struct ixgbe_adapter *adapter, int add, int vid,
126			     u32 vf)
127{
128	return adapter->hw.mac.ops.set_vfta(&adapter->hw, vid, vf, (bool)add);
129}
130
131static void ixgbe_set_vf_lpe(struct ixgbe_adapter *adapter, u32 *msgbuf)
132{
133	struct ixgbe_hw *hw = &adapter->hw;
134	int new_mtu = msgbuf[1];
135	u32 max_frs;
136	int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;
137
138	/* Only X540 supports jumbo frames in IOV mode */
139	if (adapter->hw.mac.type != ixgbe_mac_X540)
140		return;
141
142	/* MTU < 68 is an error and causes problems on some kernels */
143	if ((new_mtu < 68) || (max_frame > IXGBE_MAX_JUMBO_FRAME_SIZE)) {
144		e_err(drv, "VF mtu %d out of range\n", new_mtu);
145		return;
146	}
147
148	max_frs = (IXGBE_READ_REG(hw, IXGBE_MAXFRS) &
149		   IXGBE_MHADD_MFS_MASK) >> IXGBE_MHADD_MFS_SHIFT;
150	if (max_frs < new_mtu) {
151		max_frs = new_mtu << IXGBE_MHADD_MFS_SHIFT;
152		IXGBE_WRITE_REG(hw, IXGBE_MAXFRS, max_frs);
153	}
154
155	e_info(hw, "VF requests change max MTU to %d\n", new_mtu);
156}
157
158static void ixgbe_set_vmolr(struct ixgbe_hw *hw, u32 vf, bool aupe)
159{
160	u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
161	vmolr |= (IXGBE_VMOLR_ROMPE |
162		  IXGBE_VMOLR_BAM);
163	if (aupe)
164		vmolr |= IXGBE_VMOLR_AUPE;
165	else
166		vmolr &= ~IXGBE_VMOLR_AUPE;
167	IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
168}
169
170static void ixgbe_set_vmvir(struct ixgbe_adapter *adapter, u32 vid, u32 vf)
171{
172	struct ixgbe_hw *hw = &adapter->hw;
173
174	if (vid)
175		IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf),
176				(vid | IXGBE_VMVIR_VLANA_DEFAULT));
177	else
178		IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf), 0);
179}
180
181static inline void ixgbe_vf_reset_event(struct ixgbe_adapter *adapter, u32 vf)
182{
183	struct ixgbe_hw *hw = &adapter->hw;
184	int rar_entry = hw->mac.num_rar_entries - (vf + 1);
185
186	/* reset offloads to defaults */
187	if (adapter->vfinfo[vf].pf_vlan) {
188		ixgbe_set_vf_vlan(adapter, true,
189				  adapter->vfinfo[vf].pf_vlan, vf);
190		ixgbe_set_vmvir(adapter,
191				(adapter->vfinfo[vf].pf_vlan |
192				 (adapter->vfinfo[vf].pf_qos <<
193				  VLAN_PRIO_SHIFT)), vf);
194		ixgbe_set_vmolr(hw, vf, false);
195	} else {
196		ixgbe_set_vmvir(adapter, 0, vf);
197		ixgbe_set_vmolr(hw, vf, true);
198	}
199
200	/* reset multicast table array for vf */
201	adapter->vfinfo[vf].num_vf_mc_hashes = 0;
202
203	/* Flush and reset the mta with the new values */
204	ixgbe_set_rx_mode(adapter->netdev);
205
206	hw->mac.ops.clear_rar(hw, rar_entry);
207}
208
209static int ixgbe_set_vf_mac(struct ixgbe_adapter *adapter,
210			    int vf, unsigned char *mac_addr)
211{
212	struct ixgbe_hw *hw = &adapter->hw;
213	int rar_entry = hw->mac.num_rar_entries - (vf + 1);
214
215	memcpy(adapter->vfinfo[vf].vf_mac_addresses, mac_addr, 6);
216	hw->mac.ops.set_rar(hw, rar_entry, mac_addr, vf, IXGBE_RAH_AV);
217
218	return 0;
219}
220
221static int ixgbe_set_vf_macvlan(struct ixgbe_adapter *adapter,
222				int vf, int index, unsigned char *mac_addr)
223{
224	struct ixgbe_hw *hw = &adapter->hw;
225	struct list_head *pos;
226	struct vf_macvlans *entry;
227
228	if (index <= 1) {
229		list_for_each(pos, &adapter->vf_mvs.l) {
230			entry = list_entry(pos, struct vf_macvlans, l);
231			if (entry->vf == vf) {
232				entry->vf = -1;
233				entry->free = true;
234				entry->is_macvlan = false;
235				hw->mac.ops.clear_rar(hw, entry->rar_entry);
236			}
237		}
238	}
239
240	/*
241	 * If index was zero then we were asked to clear the uc list
242	 * for the VF.  We're done.
243	 */
244	if (!index)
245		return 0;
246
247	entry = NULL;
248
249	list_for_each(pos, &adapter->vf_mvs.l) {
250		entry = list_entry(pos, struct vf_macvlans, l);
251		if (entry->free)
252			break;
253	}
254
255	/*
256	 * If we traversed the entire list and didn't find a free entry
257	 * then we're out of space on the RAR table.  Also entry may
258	 * be NULL because the original memory allocation for the list
259	 * failed, which is not fatal but does mean we can't support
260	 * VF requests for MACVLAN because we couldn't allocate
261	 * memory for the list management required.
262	 */
263	if (!entry || !entry->free)
264		return -ENOSPC;
265
266	entry->free = false;
267	entry->is_macvlan = true;
268	entry->vf = vf;
269	memcpy(entry->vf_macvlan, mac_addr, ETH_ALEN);
270
271	hw->mac.ops.set_rar(hw, entry->rar_entry, mac_addr, vf, IXGBE_RAH_AV);
272
273	return 0;
274}
275
276int ixgbe_vf_configuration(struct pci_dev *pdev, unsigned int event_mask)
277{
278	unsigned char vf_mac_addr[6];
279	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
280	unsigned int vfn = (event_mask & 0x3f);
281
282	bool enable = ((event_mask & 0x10000000U) != 0);
283
284	if (enable) {
285		random_ether_addr(vf_mac_addr);
286		e_info(probe, "IOV: VF %d is enabled MAC %pM\n",
287		       vfn, vf_mac_addr);
288		/*
289		 * Store away the VF "permananet" MAC address, it will ask
290		 * for it later.
291		 */
292		memcpy(adapter->vfinfo[vfn].vf_mac_addresses, vf_mac_addr, 6);
293	}
294
295	return 0;
296}
297
298static inline void ixgbe_vf_reset_msg(struct ixgbe_adapter *adapter, u32 vf)
299{
300	struct ixgbe_hw *hw = &adapter->hw;
301	u32 reg;
302	u32 reg_offset, vf_shift;
303
304	vf_shift = vf % 32;
305	reg_offset = vf / 32;
306
307	/* enable transmit and receive for vf */
308	reg = IXGBE_READ_REG(hw, IXGBE_VFTE(reg_offset));
309	reg |= (reg | (1 << vf_shift));
310	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), reg);
311
312	reg = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
313	reg |= (reg | (1 << vf_shift));
314	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), reg);
315
316	/* Enable counting of spoofed packets in the SSVPC register */
317	reg = IXGBE_READ_REG(hw, IXGBE_VMECM(reg_offset));
318	reg |= (1 << vf_shift);
319	IXGBE_WRITE_REG(hw, IXGBE_VMECM(reg_offset), reg);
320
321	ixgbe_vf_reset_event(adapter, vf);
322}
323
324static int ixgbe_rcv_msg_from_vf(struct ixgbe_adapter *adapter, u32 vf)
325{
326	u32 mbx_size = IXGBE_VFMAILBOX_SIZE;
327	u32 msgbuf[IXGBE_VFMAILBOX_SIZE];
328	struct ixgbe_hw *hw = &adapter->hw;
329	s32 retval;
330	int entries;
331	u16 *hash_list;
332	int add, vid, index;
333	u8 *new_mac;
334
335	retval = ixgbe_read_mbx(hw, msgbuf, mbx_size, vf);
336
337	if (retval)
338		pr_err("Error receiving message from VF\n");
339
340	/* this is a message we already processed, do nothing */
341	if (msgbuf[0] & (IXGBE_VT_MSGTYPE_ACK | IXGBE_VT_MSGTYPE_NACK))
342		return retval;
343
344	/*
345	 * until the vf completes a virtual function reset it should not be
346	 * allowed to start any configuration.
347	 */
348
349	if (msgbuf[0] == IXGBE_VF_RESET) {
350		unsigned char *vf_mac = adapter->vfinfo[vf].vf_mac_addresses;
351		new_mac = (u8 *)(&msgbuf[1]);
352		e_info(probe, "VF Reset msg received from vf %d\n", vf);
353		adapter->vfinfo[vf].clear_to_send = false;
354		ixgbe_vf_reset_msg(adapter, vf);
355		adapter->vfinfo[vf].clear_to_send = true;
356
357		if (is_valid_ether_addr(new_mac) &&
358		    !adapter->vfinfo[vf].pf_set_mac)
359			ixgbe_set_vf_mac(adapter, vf, vf_mac);
360		else
361			ixgbe_set_vf_mac(adapter,
362				 vf, adapter->vfinfo[vf].vf_mac_addresses);
363
364		/* reply to reset with ack and vf mac address */
365		msgbuf[0] = IXGBE_VF_RESET | IXGBE_VT_MSGTYPE_ACK;
366		memcpy(new_mac, vf_mac, IXGBE_ETH_LENGTH_OF_ADDRESS);
367		/*
368		 * Piggyback the multicast filter type so VF can compute the
369		 * correct vectors
370		 */
371		msgbuf[3] = hw->mac.mc_filter_type;
372		ixgbe_write_mbx(hw, msgbuf, IXGBE_VF_PERMADDR_MSG_LEN, vf);
373
374		return retval;
375	}
376
377	if (!adapter->vfinfo[vf].clear_to_send) {
378		msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
379		ixgbe_write_mbx(hw, msgbuf, 1, vf);
380		return retval;
381	}
382
383	switch ((msgbuf[0] & 0xFFFF)) {
384	case IXGBE_VF_SET_MAC_ADDR:
385		new_mac = ((u8 *)(&msgbuf[1]));
386		if (is_valid_ether_addr(new_mac) &&
387		    !adapter->vfinfo[vf].pf_set_mac) {
388			ixgbe_set_vf_mac(adapter, vf, new_mac);
389		} else if (memcmp(adapter->vfinfo[vf].vf_mac_addresses,
390				  new_mac, ETH_ALEN)) {
391			e_warn(drv, "VF %d attempted to override "
392			       "administratively set MAC address\nReload "
393			       "the VF driver to resume operations\n", vf);
394			retval = -1;
395		}
396		break;
397	case IXGBE_VF_SET_MULTICAST:
398		entries = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
399		          >> IXGBE_VT_MSGINFO_SHIFT;
400		hash_list = (u16 *)&msgbuf[1];
401		retval = ixgbe_set_vf_multicasts(adapter, entries,
402		                                 hash_list, vf);
403		break;
404	case IXGBE_VF_SET_LPE:
405		ixgbe_set_vf_lpe(adapter, msgbuf);
406		break;
407	case IXGBE_VF_SET_VLAN:
408		add = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
409		      >> IXGBE_VT_MSGINFO_SHIFT;
410		vid = (msgbuf[1] & IXGBE_VLVF_VLANID_MASK);
411		if (adapter->vfinfo[vf].pf_vlan) {
412			e_warn(drv, "VF %d attempted to override "
413			       "administratively set VLAN configuration\n"
414			       "Reload the VF driver to resume operations\n",
415			       vf);
416			retval = -1;
417		} else {
418			retval = ixgbe_set_vf_vlan(adapter, add, vid, vf);
419		}
420		break;
421	case IXGBE_VF_SET_MACVLAN:
422		index = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK) >>
423			IXGBE_VT_MSGINFO_SHIFT;
424		/*
425		 * If the VF is allowed to set MAC filters then turn off
426		 * anti-spoofing to avoid false positives.  An index
427		 * greater than 0 will indicate the VF is setting a
428		 * macvlan MAC filter.
429		 */
430		if (index > 0 && adapter->antispoofing_enabled) {
431			hw->mac.ops.set_mac_anti_spoofing(hw, false,
432							  adapter->num_vfs);
433			hw->mac.ops.set_vlan_anti_spoofing(hw, false, vf);
434			adapter->antispoofing_enabled = false;
435		}
436		retval = ixgbe_set_vf_macvlan(adapter, vf, index,
437					      (unsigned char *)(&msgbuf[1]));
438		break;
439	default:
440		e_err(drv, "Unhandled Msg %8.8x\n", msgbuf[0]);
441		retval = IXGBE_ERR_MBX;
442		break;
443	}
444
445	/* notify the VF of the results of what it sent us */
446	if (retval)
447		msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
448	else
449		msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;
450
451	msgbuf[0] |= IXGBE_VT_MSGTYPE_CTS;
452
453	ixgbe_write_mbx(hw, msgbuf, 1, vf);
454
455	return retval;
456}
457
458static void ixgbe_rcv_ack_from_vf(struct ixgbe_adapter *adapter, u32 vf)
459{
460	struct ixgbe_hw *hw = &adapter->hw;
461	u32 msg = IXGBE_VT_MSGTYPE_NACK;
462
463	/* if device isn't clear to send it shouldn't be reading either */
464	if (!adapter->vfinfo[vf].clear_to_send)
465		ixgbe_write_mbx(hw, &msg, 1, vf);
466}
467
468void ixgbe_msg_task(struct ixgbe_adapter *adapter)
469{
470	struct ixgbe_hw *hw = &adapter->hw;
471	u32 vf;
472
473	for (vf = 0; vf < adapter->num_vfs; vf++) {
474		/* process any reset requests */
475		if (!ixgbe_check_for_rst(hw, vf))
476			ixgbe_vf_reset_event(adapter, vf);
477
478		/* process any messages pending */
479		if (!ixgbe_check_for_msg(hw, vf))
480			ixgbe_rcv_msg_from_vf(adapter, vf);
481
482		/* process any acks */
483		if (!ixgbe_check_for_ack(hw, vf))
484			ixgbe_rcv_ack_from_vf(adapter, vf);
485	}
486}
487
488void ixgbe_disable_tx_rx(struct ixgbe_adapter *adapter)
489{
490	struct ixgbe_hw *hw = &adapter->hw;
491
492	/* disable transmit and receive for all vfs */
493	IXGBE_WRITE_REG(hw, IXGBE_VFTE(0), 0);
494	IXGBE_WRITE_REG(hw, IXGBE_VFTE(1), 0);
495
496	IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), 0);
497	IXGBE_WRITE_REG(hw, IXGBE_VFRE(1), 0);
498}
499
500void ixgbe_ping_all_vfs(struct ixgbe_adapter *adapter)
501{
502	struct ixgbe_hw *hw = &adapter->hw;
503	u32 ping;
504	int i;
505
506	for (i = 0 ; i < adapter->num_vfs; i++) {
507		ping = IXGBE_PF_CONTROL_MSG;
508		if (adapter->vfinfo[i].clear_to_send)
509			ping |= IXGBE_VT_MSGTYPE_CTS;
510		ixgbe_write_mbx(hw, &ping, 1, i);
511	}
512}
513
514int ixgbe_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
515{
516	struct ixgbe_adapter *adapter = netdev_priv(netdev);
517	if (!is_valid_ether_addr(mac) || (vf >= adapter->num_vfs))
518		return -EINVAL;
519	adapter->vfinfo[vf].pf_set_mac = true;
520	dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n", mac, vf);
521	dev_info(&adapter->pdev->dev, "Reload the VF driver to make this"
522				      " change effective.");
523	if (test_bit(__IXGBE_DOWN, &adapter->state)) {
524		dev_warn(&adapter->pdev->dev, "The VF MAC address has been set,"
525			 " but the PF device is not up.\n");
526		dev_warn(&adapter->pdev->dev, "Bring the PF device up before"
527			 " attempting to use the VF device.\n");
528	}
529	return ixgbe_set_vf_mac(adapter, vf, mac);
530}
531
532int ixgbe_ndo_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos)
533{
534	int err = 0;
535	struct ixgbe_adapter *adapter = netdev_priv(netdev);
536	struct ixgbe_hw *hw = &adapter->hw;
537
538	if ((vf >= adapter->num_vfs) || (vlan > 4095) || (qos > 7))
539		return -EINVAL;
540	if (vlan || qos) {
541		err = ixgbe_set_vf_vlan(adapter, true, vlan, vf);
542		if (err)
543			goto out;
544		ixgbe_set_vmvir(adapter, vlan | (qos << VLAN_PRIO_SHIFT), vf);
545		ixgbe_set_vmolr(hw, vf, false);
546		if (adapter->antispoofing_enabled)
547			hw->mac.ops.set_vlan_anti_spoofing(hw, true, vf);
548		adapter->vfinfo[vf].pf_vlan = vlan;
549		adapter->vfinfo[vf].pf_qos = qos;
550		dev_info(&adapter->pdev->dev,
551			 "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
552		if (test_bit(__IXGBE_DOWN, &adapter->state)) {
553			dev_warn(&adapter->pdev->dev,
554				 "The VF VLAN has been set,"
555				 " but the PF device is not up.\n");
556			dev_warn(&adapter->pdev->dev,
557				 "Bring the PF device up before"
558				 " attempting to use the VF device.\n");
559		}
560	} else {
561		err = ixgbe_set_vf_vlan(adapter, false,
562					adapter->vfinfo[vf].pf_vlan, vf);
563		ixgbe_set_vmvir(adapter, vlan, vf);
564		ixgbe_set_vmolr(hw, vf, true);
565		hw->mac.ops.set_vlan_anti_spoofing(hw, false, vf);
566		adapter->vfinfo[vf].pf_vlan = 0;
567		adapter->vfinfo[vf].pf_qos = 0;
568       }
569out:
570       return err;
571}
572
573static int ixgbe_link_mbps(int internal_link_speed)
574{
575	switch (internal_link_speed) {
576	case IXGBE_LINK_SPEED_100_FULL:
577		return 100;
578	case IXGBE_LINK_SPEED_1GB_FULL:
579		return 1000;
580	case IXGBE_LINK_SPEED_10GB_FULL:
581		return 10000;
582	default:
583		return 0;
584	}
585}
586
587static void ixgbe_set_vf_rate_limit(struct ixgbe_hw *hw, int vf, int tx_rate,
588				    int link_speed)
589{
590	int rf_dec, rf_int;
591	u32 bcnrc_val;
592
593	if (tx_rate != 0) {
594		/* Calculate the rate factor values to set */
595		rf_int = link_speed / tx_rate;
596		rf_dec = (link_speed - (rf_int * tx_rate));
597		rf_dec = (rf_dec * (1<<IXGBE_RTTBCNRC_RF_INT_SHIFT)) / tx_rate;
598
599		bcnrc_val = IXGBE_RTTBCNRC_RS_ENA;
600		bcnrc_val |= ((rf_int<<IXGBE_RTTBCNRC_RF_INT_SHIFT) &
601		               IXGBE_RTTBCNRC_RF_INT_MASK);
602		bcnrc_val |= (rf_dec & IXGBE_RTTBCNRC_RF_DEC_MASK);
603	} else {
604		bcnrc_val = 0;
605	}
606
607	IXGBE_WRITE_REG(hw, IXGBE_RTTDQSEL, 2*vf); /* vf Y uses queue 2*Y */
608	/*
609	 * Set global transmit compensation time to the MMW_SIZE in RTTBCNRM
610	 * register. Typically MMW_SIZE=0x014 if 9728-byte jumbo is supported
611	 * and 0x004 otherwise.
612	 */
613	switch (hw->mac.type) {
614	case ixgbe_mac_82599EB:
615		IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x4);
616		break;
617	case ixgbe_mac_X540:
618		IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRM, 0x14);
619		break;
620	default:
621		break;
622	}
623
624	IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRC, bcnrc_val);
625}
626
627void ixgbe_check_vf_rate_limit(struct ixgbe_adapter *adapter)
628{
629	int actual_link_speed, i;
630	bool reset_rate = false;
631
632	/* VF Tx rate limit was not set */
633	if (adapter->vf_rate_link_speed == 0)
634		return;
635
636	actual_link_speed = ixgbe_link_mbps(adapter->link_speed);
637	if (actual_link_speed != adapter->vf_rate_link_speed) {
638		reset_rate = true;
639		adapter->vf_rate_link_speed = 0;
640		dev_info(&adapter->pdev->dev,
641		         "Link speed has been changed. VF Transmit rate "
642		         "is disabled\n");
643	}
644
645	for (i = 0; i < adapter->num_vfs; i++) {
646		if (reset_rate)
647			adapter->vfinfo[i].tx_rate = 0;
648
649		ixgbe_set_vf_rate_limit(&adapter->hw, i,
650					adapter->vfinfo[i].tx_rate,
651					actual_link_speed);
652	}
653}
654
655int ixgbe_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate)
656{
657	struct ixgbe_adapter *adapter = netdev_priv(netdev);
658	struct ixgbe_hw *hw = &adapter->hw;
659	int actual_link_speed;
660
661	actual_link_speed = ixgbe_link_mbps(adapter->link_speed);
662	if ((vf >= adapter->num_vfs) || (!adapter->link_up) ||
663	    (tx_rate > actual_link_speed) || (actual_link_speed != 10000) ||
664	    ((tx_rate != 0) && (tx_rate <= 10)))
665	    /* rate limit cannot be set to 10Mb or less in 10Gb adapters */
666		return -EINVAL;
667
668	adapter->vf_rate_link_speed = actual_link_speed;
669	adapter->vfinfo[vf].tx_rate = (u16)tx_rate;
670	ixgbe_set_vf_rate_limit(hw, vf, tx_rate, actual_link_speed);
671
672	return 0;
673}
674
675int ixgbe_ndo_get_vf_config(struct net_device *netdev,
676			    int vf, struct ifla_vf_info *ivi)
677{
678	struct ixgbe_adapter *adapter = netdev_priv(netdev);
679	if (vf >= adapter->num_vfs)
680		return -EINVAL;
681	ivi->vf = vf;
682	memcpy(&ivi->mac, adapter->vfinfo[vf].vf_mac_addresses, ETH_ALEN);
683	ivi->tx_rate = adapter->vfinfo[vf].tx_rate;
684	ivi->vlan = adapter->vfinfo[vf].pf_vlan;
685	ivi->qos = adapter->vfinfo[vf].pf_qos;
686	return 0;
687}