[net-next-2.6.git] / drivers / net / ixgbe / ixgbe_sriov.c

/*******************************************************************************

  Intel 10 Gigabit PCI Express Linux driver
  Copyright(c) 1999 - 2010 Intel Corporation.

  This program is free software; you can redistribute it and/or modify it
  under the terms and conditions of the GNU General Public License,
  version 2, as published by the Free Software Foundation.

  This program is distributed in the hope it will be useful, but WITHOUT
  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  more details.

  You should have received a copy of the GNU General Public License along with
  this program; if not, write to the Free Software Foundation, Inc.,
  51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.

  The full GNU General Public License is included in this distribution in
  the file called "COPYING".

  Contact Information:
  e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
  Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497

*******************************************************************************/

#include <linux/types.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/netdevice.h>
#include <linux/vmalloc.h>
#include <linux/string.h>
#include <linux/in.h>
#include <linux/ip.h>
#include <linux/tcp.h>
#include <linux/ipv6.h>
#ifdef NETIF_F_HW_VLAN_TX
#include <linux/if_vlan.h>
#endif

#include "ixgbe.h"

#include "ixgbe_sriov.h"

static int ixgbe_set_vf_multicasts(struct ixgbe_adapter *adapter,
				   int entries, u16 *hash_list, u32 vf)
{
	struct vf_data_storage *vfinfo = &adapter->vfinfo[vf];
	struct ixgbe_hw *hw = &adapter->hw;
	int i;
	u32 vector_bit;
	u32 vector_reg;
	u32 mta_reg;

	/* only so many hash values supported */
	entries = min(entries, IXGBE_MAX_VF_MC_ENTRIES);

	/*
	 * salt away the number of multi cast addresses assigned
	 * to this VF for later use to restore when the PF multi cast
	 * list changes
	 */
	vfinfo->num_vf_mc_hashes = entries;

	/*
	 * VFs are limited to using the MTA hash table for their multicast
	 * addresses
	 */
	for (i = 0; i < entries; i++) {
		vfinfo->vf_mc_hashes[i] = hash_list[i];
	}

	for (i = 0; i < vfinfo->num_vf_mc_hashes; i++) {
		vector_reg = (vfinfo->vf_mc_hashes[i] >> 5) & 0x7F;
		vector_bit = vfinfo->vf_mc_hashes[i] & 0x1F;
		mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
		mta_reg |= (1 << vector_bit);
		IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
	}

	return 0;
}

void ixgbe_restore_vf_multicasts(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct vf_data_storage *vfinfo;
	int i, j;
	u32 vector_bit;
	u32 vector_reg;
	u32 mta_reg;

	for (i = 0; i < adapter->num_vfs; i++) {
		vfinfo = &adapter->vfinfo[i];
		for (j = 0; j < vfinfo->num_vf_mc_hashes; j++) {
			hw->addr_ctrl.mta_in_use++;
			vector_reg = (vfinfo->vf_mc_hashes[j] >> 5) & 0x7F;
			vector_bit = vfinfo->vf_mc_hashes[j] & 0x1F;
			mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
			mta_reg |= (1 << vector_bit);
			IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
		}
	}
}

static int ixgbe_set_vf_vlan(struct ixgbe_adapter *adapter, int add, int vid,
			     u32 vf)
{
	return adapter->hw.mac.ops.set_vfta(&adapter->hw, vid, vf, (bool)add);
}


static void ixgbe_set_vmolr(struct ixgbe_hw *hw, u32 vf, bool aupe)
{
	u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
	vmolr |= (IXGBE_VMOLR_ROMPE |
		  IXGBE_VMOLR_ROPE |
		  IXGBE_VMOLR_BAM);
	if (aupe)
		vmolr |= IXGBE_VMOLR_AUPE;
	else
		vmolr &= ~IXGBE_VMOLR_AUPE;
	IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
}

static void ixgbe_set_vmvir(struct ixgbe_adapter *adapter, u32 vid, u32 vf)
{
	struct ixgbe_hw *hw = &adapter->hw;

	if (vid)
		IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf),
				(vid | IXGBE_VMVIR_VLANA_DEFAULT));
	else
		IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf), 0);
}

static inline void ixgbe_vf_reset_event(struct ixgbe_adapter *adapter, u32 vf)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int rar_entry = hw->mac.num_rar_entries - (vf + 1);

	/* reset offloads to defaults */
	if (adapter->vfinfo[vf].pf_vlan) {
		ixgbe_set_vf_vlan(adapter, true,
				  adapter->vfinfo[vf].pf_vlan, vf);
		ixgbe_set_vmvir(adapter,
				(adapter->vfinfo[vf].pf_vlan |
				 (adapter->vfinfo[vf].pf_qos <<
				  VLAN_PRIO_SHIFT)), vf);
		ixgbe_set_vmolr(hw, vf, false);
	} else {
		ixgbe_set_vmvir(adapter, 0, vf);
		ixgbe_set_vmolr(hw, vf, true);
	}

	/* reset multicast table array for vf */
	adapter->vfinfo[vf].num_vf_mc_hashes = 0;

	/* Flush and reset the mta with the new values */
	ixgbe_set_rx_mode(adapter->netdev);

	hw->mac.ops.clear_rar(hw, rar_entry);
}

static int ixgbe_set_vf_mac(struct ixgbe_adapter *adapter,
			    int vf, unsigned char *mac_addr)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int rar_entry = hw->mac.num_rar_entries - (vf + 1);

	memcpy(adapter->vfinfo[vf].vf_mac_addresses, mac_addr, 6);
	hw->mac.ops.set_rar(hw, rar_entry, mac_addr, vf, IXGBE_RAH_AV);

	return 0;
}

int ixgbe_vf_configuration(struct pci_dev *pdev, unsigned int event_mask)
{
	unsigned char vf_mac_addr[6];
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	unsigned int vfn = (event_mask & 0x3f);

	bool enable = ((event_mask & 0x10000000U) != 0);

	if (enable) {
		random_ether_addr(vf_mac_addr);
		e_info(probe, "IOV: VF %d is enabled MAC %pM\n",
		       vfn, vf_mac_addr);
		/*
		 * Store away the VF "permananet" MAC address, it will ask
		 * for it later.
		 */
		memcpy(adapter->vfinfo[vfn].vf_mac_addresses, vf_mac_addr, 6);
	}

	return 0;
}

static inline void ixgbe_vf_reset_msg(struct ixgbe_adapter *adapter, u32 vf)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 reg;
	u32 reg_offset, vf_shift;

	vf_shift = vf % 32;
	reg_offset = vf / 32;

	/* enable transmit and receive for vf */
	reg = IXGBE_READ_REG(hw, IXGBE_VFTE(reg_offset));
	reg |= (reg | (1 << vf_shift));
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), reg);

	reg = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
	reg |= (reg | (1 << vf_shift));
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), reg);

	ixgbe_vf_reset_event(adapter, vf);
}

static int ixgbe_rcv_msg_from_vf(struct ixgbe_adapter *adapter, u32 vf)
{
	u32 mbx_size = IXGBE_VFMAILBOX_SIZE;
	u32 msgbuf[mbx_size];
	struct ixgbe_hw *hw = &adapter->hw;
	s32 retval;
	int entries;
	u16 *hash_list;
	int add, vid;

	retval = ixgbe_read_mbx(hw, msgbuf, mbx_size, vf);

	if (retval)
		pr_err("Error receiving message from VF\n");

	/* this is a message we already processed, do nothing */
	if (msgbuf[0] & (IXGBE_VT_MSGTYPE_ACK | IXGBE_VT_MSGTYPE_NACK))
		return retval;

	/*
	 * until the vf completes a virtual function reset it should not be
	 * allowed to start any configuration.
	 */

	if (msgbuf[0] == IXGBE_VF_RESET) {
		unsigned char *vf_mac = adapter->vfinfo[vf].vf_mac_addresses;
		u8 *addr = (u8 *)(&msgbuf[1]);
		e_info(probe, "VF Reset msg received from vf %d\n", vf);
		adapter->vfinfo[vf].clear_to_send = false;
		ixgbe_vf_reset_msg(adapter, vf);
		adapter->vfinfo[vf].clear_to_send = true;

		/* reply to reset with ack and vf mac address */
		msgbuf[0] = IXGBE_VF_RESET | IXGBE_VT_MSGTYPE_ACK;
		memcpy(addr, vf_mac, IXGBE_ETH_LENGTH_OF_ADDRESS);
		/*
		 * Piggyback the multicast filter type so VF can compute the
		 * correct vectors
		 */
		msgbuf[3] = hw->mac.mc_filter_type;
		ixgbe_write_mbx(hw, msgbuf, IXGBE_VF_PERMADDR_MSG_LEN, vf);

		return retval;
	}

	if (!adapter->vfinfo[vf].clear_to_send) {
		msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
		ixgbe_write_mbx(hw, msgbuf, 1, vf);
		return retval;
	}

	switch ((msgbuf[0] & 0xFFFF)) {
	case IXGBE_VF_SET_MAC_ADDR:
		{
			u8 *new_mac = ((u8 *)(&msgbuf[1]));
			if (is_valid_ether_addr(new_mac) &&
			    !adapter->vfinfo[vf].pf_set_mac)
				ixgbe_set_vf_mac(adapter, vf, new_mac);
			else
				ixgbe_set_vf_mac(adapter,
				  vf, adapter->vfinfo[vf].vf_mac_addresses);
		}
		break;
	case IXGBE_VF_SET_MULTICAST:
		entries = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
		          >> IXGBE_VT_MSGINFO_SHIFT;
		hash_list = (u16 *)&msgbuf[1];
		retval = ixgbe_set_vf_multicasts(adapter, entries,
		                                 hash_list, vf);
		break;
	case IXGBE_VF_SET_LPE:
		WARN_ON((msgbuf[0] & 0xFFFF) == IXGBE_VF_SET_LPE);
		break;
	case IXGBE_VF_SET_VLAN:
		add = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
		      >> IXGBE_VT_MSGINFO_SHIFT;
		vid = (msgbuf[1] & IXGBE_VLVF_VLANID_MASK);
		retval = ixgbe_set_vf_vlan(adapter, add, vid, vf);
		break;
	default:
		e_err(drv, "Unhandled Msg %8.8x\n", msgbuf[0]);
		retval = IXGBE_ERR_MBX;
		break;
	}

	/* notify the VF of the results of what it sent us */
	if (retval)
		msgbuf[0] |= IXGBE_VT_MSGTYPE_NACK;
	else
		msgbuf[0] |= IXGBE_VT_MSGTYPE_ACK;

	msgbuf[0] |= IXGBE_VT_MSGTYPE_CTS;

	ixgbe_write_mbx(hw, msgbuf, 1, vf);

	return retval;
}

static void ixgbe_rcv_ack_from_vf(struct ixgbe_adapter *adapter, u32 vf)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 msg = IXGBE_VT_MSGTYPE_NACK;

	/* if device isn't clear to send it shouldn't be reading either */
	if (!adapter->vfinfo[vf].clear_to_send)
		ixgbe_write_mbx(hw, &msg, 1, vf);
}

void ixgbe_msg_task(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vf;

	for (vf = 0; vf < adapter->num_vfs; vf++) {
		/* process any reset requests */
		if (!ixgbe_check_for_rst(hw, vf))
			ixgbe_vf_reset_event(adapter, vf);

		/* process any messages pending */
		if (!ixgbe_check_for_msg(hw, vf))
			ixgbe_rcv_msg_from_vf(adapter, vf);

		/* process any acks */
		if (!ixgbe_check_for_ack(hw, vf))
			ixgbe_rcv_ack_from_vf(adapter, vf);
	}
}

void ixgbe_disable_tx_rx(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;

	/* disable transmit and receive for all vfs */
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(0), 0);
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(1), 0);

	IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), 0);
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(1), 0);
}

void ixgbe_ping_all_vfs(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 ping;
	int i;

	for (i = 0 ; i < adapter->num_vfs; i++) {
		ping = IXGBE_PF_CONTROL_MSG;
		if (adapter->vfinfo[i].clear_to_send)
			ping |= IXGBE_VT_MSGTYPE_CTS;
		ixgbe_write_mbx(hw, &ping, 1, i);
	}
}

int ixgbe_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	if (!is_valid_ether_addr(mac) || (vf >= adapter->num_vfs))
		return -EINVAL;
	adapter->vfinfo[vf].pf_set_mac = true;
	dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n", mac, vf);
	dev_info(&adapter->pdev->dev, "Reload the VF driver to make this"
				      " change effective.");
	if (test_bit(__IXGBE_DOWN, &adapter->state)) {
		dev_warn(&adapter->pdev->dev, "The VF MAC address has been set,"
			 " but the PF device is not up.\n");
		dev_warn(&adapter->pdev->dev, "Bring the PF device up before"
			 " attempting to use the VF device.\n");
	}
	return ixgbe_set_vf_mac(adapter, vf, mac);
}

int ixgbe_ndo_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos)
{
	int err = 0;
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	if ((vf >= adapter->num_vfs) || (vlan > 4095) || (qos > 7))
		return -EINVAL;
	if (vlan || qos) {
		err = ixgbe_set_vf_vlan(adapter, true, vlan, vf);
		if (err)
			goto out;
		ixgbe_set_vmvir(adapter, vlan | (qos << VLAN_PRIO_SHIFT), vf);
		ixgbe_set_vmolr(&adapter->hw, vf, false);
		adapter->vfinfo[vf].pf_vlan = vlan;
		adapter->vfinfo[vf].pf_qos = qos;
		dev_info(&adapter->pdev->dev,
			 "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
		if (test_bit(__IXGBE_DOWN, &adapter->state)) {
			dev_warn(&adapter->pdev->dev,
				 "The VF VLAN has been set,"
				 " but the PF device is not up.\n");
			dev_warn(&adapter->pdev->dev,
				 "Bring the PF device up before"
				 " attempting to use the VF device.\n");
		}
	} else {
		err = ixgbe_set_vf_vlan(adapter, false,
					adapter->vfinfo[vf].pf_vlan, vf);
		ixgbe_set_vmvir(adapter, vlan, vf);
		ixgbe_set_vmolr(&adapter->hw, vf, true);
		adapter->vfinfo[vf].pf_vlan = 0;
		adapter->vfinfo[vf].pf_qos = 0;
       }
out:
       return err;
}

int ixgbe_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate)
{
	return -EOPNOTSUPP;
}

int ixgbe_ndo_get_vf_config(struct net_device *netdev,
			    int vf, struct ifla_vf_info *ivi)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	if (vf >= adapter->num_vfs)
		return -EINVAL;
	ivi->vf = vf;
	memcpy(&ivi->mac, adapter->vfinfo[vf].vf_mac_addresses, ETH_ALEN);
	ivi->tx_rate = 0;
	ivi->vlan = adapter->vfinfo[vf].pf_vlan;
	ivi->qos = adapter->vfinfo[vf].pf_qos;
	return 0;
}
Commit	Line	Data
17367270 GR	1	/*******************************************************************************
	2
	3	Intel 10 Gigabit PCI Express Linux driver
3a338cbb	4	Copyright(c) 1999 - 2010 Intel Corporation.
17367270 GR	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
17367270 GR	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
5d5b7c39 ET	46	static int ixgbe_set_vf_multicasts(struct ixgbe_adapter *adapter,
5d5b7c39 ET	47	int entries, u16 *hash_list, u32 vf)
17367270 GR	48	{
17367270 GR	49	struct vf_data_storage *vfinfo = &adapter->vfinfo[vf];
8a07a22d	50	struct ixgbe_hw *hw = &adapter->hw;
17367270	51	int i;
8a07a22d GR	52	u32 vector_bit;
	53	u32 vector_reg;
	54	u32 mta_reg;
17367270 GR	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++) {
e81a1ba8	71	vfinfo->vf_mc_hashes[i] = hash_list[i];
17367270 GR	72	}
17367270 GR	73
8a07a22d GR	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	}
17367270 GR	81
	82	return 0;
	83	}
	84
	85	void ixgbe_restore_vf_multicasts(struct ixgbe_adapter *adapter)
	86	{
	87	struct ixgbe_hw *hw = &adapter->hw;
	88	struct vf_data_storage *vfinfo;
	89	int i, j;
	90	u32 vector_bit;
	91	u32 vector_reg;
	92	u32 mta_reg;
	93
	94	for (i = 0; i < adapter->num_vfs; i++) {
	95	vfinfo = &adapter->vfinfo[i];
	96	for (j = 0; j < vfinfo->num_vf_mc_hashes; j++) {
	97	hw->addr_ctrl.mta_in_use++;
	98	vector_reg = (vfinfo->vf_mc_hashes[j] >> 5) & 0x7F;
	99	vector_bit = vfinfo->vf_mc_hashes[j] & 0x1F;
	100	mta_reg = IXGBE_READ_REG(hw, IXGBE_MTA(vector_reg));
	101	mta_reg \|= (1 << vector_bit);
	102	IXGBE_WRITE_REG(hw, IXGBE_MTA(vector_reg), mta_reg);
	103	}
	104	}
	105	}
	106
5d5b7c39 ET	107	static int ixgbe_set_vf_vlan(struct ixgbe_adapter *adapter, int add, int vid,
5d5b7c39 ET	108	u32 vf)
17367270	109	{
17367270 GR	110	return adapter->hw.mac.ops.set_vfta(&adapter->hw, vid, vf, (bool)add);
	111	}
	112
	113
5d5b7c39	114	static void ixgbe_set_vmolr(struct ixgbe_hw *hw, u32 vf, bool aupe)
17367270 GR	115	{
17367270 GR	116	u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
f0412776	117	vmolr \|= (IXGBE_VMOLR_ROMPE \|
17367270 GR	118	IXGBE_VMOLR_ROPE \|
17367270 GR	119	IXGBE_VMOLR_BAM);
f0412776 GR	120	if (aupe)
	121	vmolr \|= IXGBE_VMOLR_AUPE;
	122	else
	123	vmolr &= ~IXGBE_VMOLR_AUPE;
17367270 GR	124	IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
	125	}
	126
7f01648a GR	127	static void ixgbe_set_vmvir(struct ixgbe_adapter *adapter, u32 vid, u32 vf)
	128	{
	129	struct ixgbe_hw *hw = &adapter->hw;
	130
	131	if (vid)
	132	IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf),
	133	(vid \| IXGBE_VMVIR_VLANA_DEFAULT));
	134	else
	135	IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf), 0);
	136	}
	137
5d5b7c39	138	static inline void ixgbe_vf_reset_event(struct ixgbe_adapter *adapter, u32 vf)
17367270 GR	139	{
17367270 GR	140	struct ixgbe_hw *hw = &adapter->hw;
2850062a	141	int rar_entry = hw->mac.num_rar_entries - (vf + 1);
17367270 GR	142
17367270 GR	143	/* reset offloads to defaults */
7f01648a GR	144	if (adapter->vfinfo[vf].pf_vlan) {
	145	ixgbe_set_vf_vlan(adapter, true,
	146	adapter->vfinfo[vf].pf_vlan, vf);
	147	ixgbe_set_vmvir(adapter,
	148	(adapter->vfinfo[vf].pf_vlan \|
	149	(adapter->vfinfo[vf].pf_qos <<
	150	VLAN_PRIO_SHIFT)), vf);
	151	ixgbe_set_vmolr(hw, vf, false);
	152	} else {
	153	ixgbe_set_vmvir(adapter, 0, vf);
	154	ixgbe_set_vmolr(hw, vf, true);
	155	}
17367270 GR	156
	157	/* reset multicast table array for vf */
	158	adapter->vfinfo[vf].num_vf_mc_hashes = 0;
	159
	160	/* Flush and reset the mta with the new values */
	161	ixgbe_set_rx_mode(adapter->netdev);
	162
2850062a	163	hw->mac.ops.clear_rar(hw, rar_entry);
17367270 GR	164	}
17367270 GR	165
5d5b7c39 ET	166	static int ixgbe_set_vf_mac(struct ixgbe_adapter *adapter,
5d5b7c39 ET	167	int vf, unsigned char *mac_addr)
17367270 GR	168	{
17367270 GR	169	struct ixgbe_hw *hw = &adapter->hw;
2850062a	170	int rar_entry = hw->mac.num_rar_entries - (vf + 1);
17367270 GR	171
17367270 GR	172	memcpy(adapter->vfinfo[vf].vf_mac_addresses, mac_addr, 6);
2850062a	173	hw->mac.ops.set_rar(hw, rar_entry, mac_addr, vf, IXGBE_RAH_AV);
17367270 GR	174
	175	return 0;
	176	}
	177
	178	int ixgbe_vf_configuration(struct pci_dev *pdev, unsigned int event_mask)
	179	{
	180	unsigned char vf_mac_addr[6];
c60fbb00	181	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
17367270 GR	182	unsigned int vfn = (event_mask & 0x3f);
	183
	184	bool enable = ((event_mask & 0x10000000U) != 0);
	185
	186	if (enable) {
	187	random_ether_addr(vf_mac_addr);
396e799c ET	188	e_info(probe, "IOV: VF %d is enabled MAC %pM\n",
396e799c ET	189	vfn, vf_mac_addr);
17367270 GR	190	/*
	191	* Store away the VF "permananet" MAC address, it will ask
	192	* for it later.
	193	*/
	194	memcpy(adapter->vfinfo[vfn].vf_mac_addresses, vf_mac_addr, 6);
	195	}
	196
	197	return 0;
	198	}
	199
5d5b7c39	200	static inline void ixgbe_vf_reset_msg(struct ixgbe_adapter *adapter, u32 vf)
17367270 GR	201	{
	202	struct ixgbe_hw *hw = &adapter->hw;
	203	u32 reg;
	204	u32 reg_offset, vf_shift;
	205
	206	vf_shift = vf % 32;
	207	reg_offset = vf / 32;
	208
	209	/* enable transmit and receive for vf */
	210	reg = IXGBE_READ_REG(hw, IXGBE_VFTE(reg_offset));
	211	reg \|= (reg \| (1 << vf_shift));
	212	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), reg);
	213
	214	reg = IXGBE_READ_REG(hw, IXGBE_VFRE(reg_offset));
	215	reg \|= (reg \| (1 << vf_shift));
	216	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), reg);
	217
	218	ixgbe_vf_reset_event(adapter, vf);
	219	}
	220
	221	static int ixgbe_rcv_msg_from_vf(struct ixgbe_adapter *adapter, u32 vf)
	222	{
	223	u32 mbx_size = IXGBE_VFMAILBOX_SIZE;
	224	u32 msgbuf[mbx_size];
	225	struct ixgbe_hw *hw = &adapter->hw;
	226	s32 retval;
	227	int entries;
	228	u16 *hash_list;
	229	int add, vid;
	230
	231	retval = ixgbe_read_mbx(hw, msgbuf, mbx_size, vf);
	232
	233	if (retval)
849c4542	234	pr_err("Error receiving message from VF\n");
17367270 GR	235
	236	/* this is a message we already processed, do nothing */
	237	if (msgbuf[0] & (IXGBE_VT_MSGTYPE_ACK \| IXGBE_VT_MSGTYPE_NACK))
	238	return retval;
	239
	240	/*
	241	* until the vf completes a virtual function reset it should not be
	242	* allowed to start any configuration.
	243	*/
	244
	245	if (msgbuf[0] == IXGBE_VF_RESET) {
	246	unsigned char *vf_mac = adapter->vfinfo[vf].vf_mac_addresses;
	247	u8 addr = (u8 )(&msgbuf[1]);
396e799c	248	e_info(probe, "VF Reset msg received from vf %d\n", vf);
17367270 GR	249	adapter->vfinfo[vf].clear_to_send = false;
	250	ixgbe_vf_reset_msg(adapter, vf);
	251	adapter->vfinfo[vf].clear_to_send = true;
	252
	253	/* reply to reset with ack and vf mac address */
	254	msgbuf[0] = IXGBE_VF_RESET \| IXGBE_VT_MSGTYPE_ACK;
	255	memcpy(addr, vf_mac, IXGBE_ETH_LENGTH_OF_ADDRESS);
	256	/*
	257	* Piggyback the multicast filter type so VF can compute the
	258	* correct vectors
	259	*/
	260	msgbuf[3] = hw->mac.mc_filter_type;
	261	ixgbe_write_mbx(hw, msgbuf, IXGBE_VF_PERMADDR_MSG_LEN, vf);
	262
	263	return retval;
	264	}
	265
	266	if (!adapter->vfinfo[vf].clear_to_send) {
	267	msgbuf[0] \|= IXGBE_VT_MSGTYPE_NACK;
	268	ixgbe_write_mbx(hw, msgbuf, 1, vf);
	269	return retval;
	270	}
	271
	272	switch ((msgbuf[0] & 0xFFFF)) {
	273	case IXGBE_VF_SET_MAC_ADDR:
	274	{
	275	u8 new_mac = ((u8 )(&msgbuf[1]));
7f01648a GR	276	if (is_valid_ether_addr(new_mac) &&
7f01648a GR	277	!adapter->vfinfo[vf].pf_set_mac)
17367270 GR	278	ixgbe_set_vf_mac(adapter, vf, new_mac);
17367270 GR	279	else
7f01648a GR	280	ixgbe_set_vf_mac(adapter,
7f01648a GR	281	vf, adapter->vfinfo[vf].vf_mac_addresses);
17367270 GR	282	}
	283	break;
	284	case IXGBE_VF_SET_MULTICAST:
	285	entries = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
	286	>> IXGBE_VT_MSGINFO_SHIFT;
	287	hash_list = (u16 *)&msgbuf[1];
	288	retval = ixgbe_set_vf_multicasts(adapter, entries,
	289	hash_list, vf);
	290	break;
	291	case IXGBE_VF_SET_LPE:
	292	WARN_ON((msgbuf[0] & 0xFFFF) == IXGBE_VF_SET_LPE);
	293	break;
	294	case IXGBE_VF_SET_VLAN:
	295	add = (msgbuf[0] & IXGBE_VT_MSGINFO_MASK)
	296	>> IXGBE_VT_MSGINFO_SHIFT;
	297	vid = (msgbuf[1] & IXGBE_VLVF_VLANID_MASK);
	298	retval = ixgbe_set_vf_vlan(adapter, add, vid, vf);
	299	break;
	300	default:
396e799c	301	e_err(drv, "Unhandled Msg %8.8x\n", msgbuf[0]);
17367270 GR	302	retval = IXGBE_ERR_MBX;
	303	break;
	304	}
	305
	306	/* notify the VF of the results of what it sent us */
	307	if (retval)
	308	msgbuf[0] \|= IXGBE_VT_MSGTYPE_NACK;
	309	else
	310	msgbuf[0] \|= IXGBE_VT_MSGTYPE_ACK;
	311
	312	msgbuf[0] \|= IXGBE_VT_MSGTYPE_CTS;
	313
	314	ixgbe_write_mbx(hw, msgbuf, 1, vf);
	315
	316	return retval;
	317	}
	318
	319	static void ixgbe_rcv_ack_from_vf(struct ixgbe_adapter *adapter, u32 vf)
	320	{
	321	struct ixgbe_hw *hw = &adapter->hw;
	322	u32 msg = IXGBE_VT_MSGTYPE_NACK;
	323
	324	/* if device isn't clear to send it shouldn't be reading either */
	325	if (!adapter->vfinfo[vf].clear_to_send)
	326	ixgbe_write_mbx(hw, &msg, 1, vf);
	327	}
	328
	329	void ixgbe_msg_task(struct ixgbe_adapter *adapter)
	330	{
	331	struct ixgbe_hw *hw = &adapter->hw;
	332	u32 vf;
	333
	334	for (vf = 0; vf < adapter->num_vfs; vf++) {
	335	/* process any reset requests */
	336	if (!ixgbe_check_for_rst(hw, vf))
	337	ixgbe_vf_reset_event(adapter, vf);
	338
	339	/* process any messages pending */
	340	if (!ixgbe_check_for_msg(hw, vf))
	341	ixgbe_rcv_msg_from_vf(adapter, vf);
	342
	343	/* process any acks */
	344	if (!ixgbe_check_for_ack(hw, vf))
	345	ixgbe_rcv_ack_from_vf(adapter, vf);
	346	}
	347	}
	348
767081ad GR	349	void ixgbe_disable_tx_rx(struct ixgbe_adapter *adapter)
	350	{
	351	struct ixgbe_hw *hw = &adapter->hw;
	352
	353	/* disable transmit and receive for all vfs */
	354	IXGBE_WRITE_REG(hw, IXGBE_VFTE(0), 0);
	355	IXGBE_WRITE_REG(hw, IXGBE_VFTE(1), 0);
	356
	357	IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), 0);
	358	IXGBE_WRITE_REG(hw, IXGBE_VFRE(1), 0);
	359	}
	360
	361	void ixgbe_ping_all_vfs(struct ixgbe_adapter *adapter)
	362	{
	363	struct ixgbe_hw *hw = &adapter->hw;
	364	u32 ping;
	365	int i;
	366
	367	for (i = 0 ; i < adapter->num_vfs; i++) {
	368	ping = IXGBE_PF_CONTROL_MSG;
	369	if (adapter->vfinfo[i].clear_to_send)
	370	ping \|= IXGBE_VT_MSGTYPE_CTS;
	371	ixgbe_write_mbx(hw, &ping, 1, i);
	372	}
	373	}
	374
7f01648a GR	375	int ixgbe_ndo_set_vf_mac(struct net_device netdev, int vf, u8 mac)
	376	{
	377	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	378	if (!is_valid_ether_addr(mac) \|\| (vf >= adapter->num_vfs))
	379	return -EINVAL;
	380	adapter->vfinfo[vf].pf_set_mac = true;
	381	dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n", mac, vf);
	382	dev_info(&adapter->pdev->dev, "Reload the VF driver to make this"
	383	" change effective.");
	384	if (test_bit(__IXGBE_DOWN, &adapter->state)) {
	385	dev_warn(&adapter->pdev->dev, "The VF MAC address has been set,"
	386	" but the PF device is not up.\n");
	387	dev_warn(&adapter->pdev->dev, "Bring the PF device up before"
	388	" attempting to use the VF device.\n");
	389	}
	390	return ixgbe_set_vf_mac(adapter, vf, mac);
	391	}
	392
	393	int ixgbe_ndo_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos)
	394	{
	395	int err = 0;
	396	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	397
	398	if ((vf >= adapter->num_vfs) \|\| (vlan > 4095) \|\| (qos > 7))
	399	return -EINVAL;
	400	if (vlan \|\| qos) {
	401	err = ixgbe_set_vf_vlan(adapter, true, vlan, vf);
	402	if (err)
	403	goto out;
	404	ixgbe_set_vmvir(adapter, vlan \| (qos << VLAN_PRIO_SHIFT), vf);
	405	ixgbe_set_vmolr(&adapter->hw, vf, false);
	406	adapter->vfinfo[vf].pf_vlan = vlan;
	407	adapter->vfinfo[vf].pf_qos = qos;
	408	dev_info(&adapter->pdev->dev,
	409	"Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
	410	if (test_bit(__IXGBE_DOWN, &adapter->state)) {
	411	dev_warn(&adapter->pdev->dev,
	412	"The VF VLAN has been set,"
	413	" but the PF device is not up.\n");
	414	dev_warn(&adapter->pdev->dev,
	415	"Bring the PF device up before"
	416	" attempting to use the VF device.\n");
	417	}
	418	} else {
	419	err = ixgbe_set_vf_vlan(adapter, false,
	420	adapter->vfinfo[vf].pf_vlan, vf);
	421	ixgbe_set_vmvir(adapter, vlan, vf);
	422	ixgbe_set_vmolr(&adapter->hw, vf, true);
	423	adapter->vfinfo[vf].pf_vlan = 0;
	424	adapter->vfinfo[vf].pf_qos = 0;
	425	}
	426	out:
	427	return err;
	428	}
	429
	430	int ixgbe_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate)
	431	{
	432	return -EOPNOTSUPP;
	433	}
	434
	435	int ixgbe_ndo_get_vf_config(struct net_device *netdev,
	436	int vf, struct ifla_vf_info *ivi)
	437	{
	438	struct ixgbe_adapter *adapter = netdev_priv(netdev);
439	if (vf >= adapter->num_vfs)
440	return -EINVAL;
441	ivi->vf = vf;
442	memcpy(&ivi->mac, adapter->vfinfo[vf].vf_mac_addresses, ETH_ALEN);
443	ivi->tx_rate = 0;
444	ivi->vlan = adapter->vfinfo[vf].pf_vlan;
445	ivi->qos = adapter->vfinfo[vf].pf_qos;
446	return 0;
447	}