• Home
  • History
  • Annotate
  • Line#
  • Navigate
  • Raw
  • Download
  • only in /asuswrt-rt-n18u-9.0.0.4.380.2695/release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/net/ixgbe/
1/*******************************************************************************
2
3  Intel 10 Gigabit PCI Express Linux driver
4  Copyright(c) 1999 - 2009 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
46int 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
85void 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
107int ixgbe_set_vf_vlan(struct ixgbe_adapter *adapter, int add, int vid, u32 vf)
108{
109	return adapter->hw.mac.ops.set_vfta(&adapter->hw, vid, vf, (bool)add);
110}
111
112
113void ixgbe_set_vmolr(struct ixgbe_hw *hw, u32 vf, bool aupe)
114{
115	u32 vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(vf));
116	vmolr |= (IXGBE_VMOLR_ROMPE |
117		  IXGBE_VMOLR_ROPE |
118		  IXGBE_VMOLR_BAM);
119	if (aupe)
120		vmolr |= IXGBE_VMOLR_AUPE;
121	else
122		vmolr &= ~IXGBE_VMOLR_AUPE;
123	IXGBE_WRITE_REG(hw, IXGBE_VMOLR(vf), vmolr);
124}
125
126static void ixgbe_set_vmvir(struct ixgbe_adapter *adapter, u32 vid, u32 vf)
127{
128	struct ixgbe_hw *hw = &adapter->hw;
129
130	if (vid)
131		IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf),
132				(vid | IXGBE_VMVIR_VLANA_DEFAULT));
133	else
134		IXGBE_WRITE_REG(hw, IXGBE_VMVIR(vf), 0);
135}
136
137inline void ixgbe_vf_reset_event(struct ixgbe_adapter *adapter, u32 vf)
138{
139	struct ixgbe_hw *hw = &adapter->hw;
140	int rar_entry = hw->mac.num_rar_entries - (vf + 1);
141
142	/* reset offloads to defaults */
143	if (adapter->vfinfo[vf].pf_vlan) {
144		ixgbe_set_vf_vlan(adapter, true,
145				  adapter->vfinfo[vf].pf_vlan, vf);
146		ixgbe_set_vmvir(adapter,
147				(adapter->vfinfo[vf].pf_vlan |
148				 (adapter->vfinfo[vf].pf_qos <<
149				  VLAN_PRIO_SHIFT)), vf);
150		ixgbe_set_vmolr(hw, vf, false);
151	} else {
152		ixgbe_set_vmvir(adapter, 0, vf);
153		ixgbe_set_vmolr(hw, vf, true);
154	}
155
156	/* reset multicast table array for vf */
157	adapter->vfinfo[vf].num_vf_mc_hashes = 0;
158
159	/* Flush and reset the mta with the new values */
160	ixgbe_set_rx_mode(adapter->netdev);
161
162	hw->mac.ops.clear_rar(hw, rar_entry);
163}
164
165int ixgbe_set_vf_mac(struct ixgbe_adapter *adapter,
166                          int vf, unsigned char *mac_addr)
167{
168	struct ixgbe_hw *hw = &adapter->hw;
169	int rar_entry = hw->mac.num_rar_entries - (vf + 1);
170
171	memcpy(adapter->vfinfo[vf].vf_mac_addresses, mac_addr, 6);
172	hw->mac.ops.set_rar(hw, rar_entry, mac_addr, vf, IXGBE_RAH_AV);
173
174	return 0;
175}
176
177int ixgbe_vf_configuration(struct pci_dev *pdev, unsigned int event_mask)
178{
179	unsigned char vf_mac_addr[6];
180	struct net_device *netdev = pci_get_drvdata(pdev);
181	struct ixgbe_adapter *adapter = netdev_priv(netdev);
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);
188		e_info(probe, "IOV: VF %d is enabled MAC %pM\n",
189		       vfn, vf_mac_addr);
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
200inline void ixgbe_vf_reset_msg(struct ixgbe_adapter *adapter, u32 vf)
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
221static 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)
234		pr_err("Error receiving message from VF\n");
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]);
248		e_info(probe, "VF Reset msg received from vf %d\n", vf);
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]));
276			if (is_valid_ether_addr(new_mac) &&
277			    !adapter->vfinfo[vf].pf_set_mac)
278				ixgbe_set_vf_mac(adapter, vf, new_mac);
279			else
280				ixgbe_set_vf_mac(adapter,
281				  vf, adapter->vfinfo[vf].vf_mac_addresses);
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:
301		e_err(drv, "Unhandled Msg %8.8x\n", msgbuf[0]);
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
319static 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
329void 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
349void 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
361void 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
375int 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
393int 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       }
426out:
427       return err;
428}
429
430int ixgbe_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate)
431{
432	return -EOPNOTSUPP;
433}
434
435int 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}
448