blob: 919e36386675feb8f2a4cad855d35a9d8eba3415 [file] [log] [blame]
Auke Kok9d5c8242008-01-24 02:22:38 -08001/*******************************************************************************
2
3 Intel(R) Gigabit Ethernet Linux driver
Alexander Duyck86d5d382009-02-06 23:23:12 +00004 Copyright(c) 2007-2009 Intel Corporation.
Auke Kok9d5c8242008-01-24 02:22:38 -08005
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/module.h>
29#include <linux/types.h>
30#include <linux/init.h>
31#include <linux/vmalloc.h>
32#include <linux/pagemap.h>
33#include <linux/netdevice.h>
Auke Kok9d5c8242008-01-24 02:22:38 -080034#include <linux/ipv6.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090035#include <linux/slab.h>
Auke Kok9d5c8242008-01-24 02:22:38 -080036#include <net/checksum.h>
37#include <net/ip6_checksum.h>
Patrick Ohlyc6cb0902009-02-12 05:03:42 +000038#include <linux/net_tstamp.h>
Auke Kok9d5c8242008-01-24 02:22:38 -080039#include <linux/mii.h>
40#include <linux/ethtool.h>
41#include <linux/if_vlan.h>
42#include <linux/pci.h>
Alexander Duyckc54106b2008-10-16 21:26:57 -070043#include <linux/pci-aspm.h>
Auke Kok9d5c8242008-01-24 02:22:38 -080044#include <linux/delay.h>
45#include <linux/interrupt.h>
46#include <linux/if_ether.h>
Alexander Duyck40a914f2008-11-27 00:24:37 -080047#include <linux/aer.h>
Jeff Kirsher421e02f2008-10-17 11:08:31 -070048#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -070049#include <linux/dca.h>
50#endif
Auke Kok9d5c8242008-01-24 02:22:38 -080051#include "igb.h"
52
Alexander Duyck55cac242009-11-19 12:42:21 +000053#define DRV_VERSION "2.1.0-k2"
Auke Kok9d5c8242008-01-24 02:22:38 -080054char igb_driver_name[] = "igb";
55char igb_driver_version[] = DRV_VERSION;
56static const char igb_driver_string[] =
57 "Intel(R) Gigabit Ethernet Network Driver";
Alexander Duyck86d5d382009-02-06 23:23:12 +000058static const char igb_copyright[] = "Copyright (c) 2007-2009 Intel Corporation.";
Auke Kok9d5c8242008-01-24 02:22:38 -080059
Auke Kok9d5c8242008-01-24 02:22:38 -080060static const struct e1000_info *igb_info_tbl[] = {
61 [board_82575] = &e1000_82575_info,
62};
63
Alexey Dobriyana3aa1882010-01-07 11:58:11 +000064static DEFINE_PCI_DEVICE_TABLE(igb_pci_tbl) = {
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +000065 { PCI_VDEVICE(INTEL, E1000_DEV_ID_I350_COPPER), board_82575 },
66 { PCI_VDEVICE(INTEL, E1000_DEV_ID_I350_FIBER), board_82575 },
67 { PCI_VDEVICE(INTEL, E1000_DEV_ID_I350_SERDES), board_82575 },
68 { PCI_VDEVICE(INTEL, E1000_DEV_ID_I350_SGMII), board_82575 },
Alexander Duyck55cac242009-11-19 12:42:21 +000069 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_COPPER), board_82575 },
70 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_FIBER), board_82575 },
71 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_SERDES), board_82575 },
72 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_SGMII), board_82575 },
73 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_COPPER_DUAL), board_82575 },
Alexander Duyck2d064c02008-07-08 15:10:12 -070074 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576), board_82575 },
Alexander Duyck9eb23412009-03-13 20:42:15 +000075 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_NS), board_82575 },
Alexander Duyck747d49b2009-10-05 06:33:27 +000076 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_NS_SERDES), board_82575 },
Alexander Duyck2d064c02008-07-08 15:10:12 -070077 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_FIBER), board_82575 },
78 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_SERDES), board_82575 },
Alexander Duyck4703bf72009-07-23 18:09:48 +000079 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_SERDES_QUAD), board_82575 },
Carolyn Wybornyb894fa22010-03-19 06:07:48 +000080 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_QUAD_COPPER_ET2), board_82575 },
Alexander Duyckc8ea5ea2009-03-13 20:42:35 +000081 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_QUAD_COPPER), board_82575 },
Auke Kok9d5c8242008-01-24 02:22:38 -080082 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82575EB_COPPER), board_82575 },
83 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82575EB_FIBER_SERDES), board_82575 },
84 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82575GB_QUAD_COPPER), board_82575 },
85 /* required last entry */
86 {0, }
87};
88
89MODULE_DEVICE_TABLE(pci, igb_pci_tbl);
90
91void igb_reset(struct igb_adapter *);
92static int igb_setup_all_tx_resources(struct igb_adapter *);
93static int igb_setup_all_rx_resources(struct igb_adapter *);
94static void igb_free_all_tx_resources(struct igb_adapter *);
95static void igb_free_all_rx_resources(struct igb_adapter *);
Alexander Duyck06cf2662009-10-27 15:53:25 +000096static void igb_setup_mrqc(struct igb_adapter *);
Auke Kok9d5c8242008-01-24 02:22:38 -080097void igb_update_stats(struct igb_adapter *);
98static int igb_probe(struct pci_dev *, const struct pci_device_id *);
99static void __devexit igb_remove(struct pci_dev *pdev);
100static int igb_sw_init(struct igb_adapter *);
101static int igb_open(struct net_device *);
102static int igb_close(struct net_device *);
103static void igb_configure_tx(struct igb_adapter *);
104static void igb_configure_rx(struct igb_adapter *);
Auke Kok9d5c8242008-01-24 02:22:38 -0800105static void igb_clean_all_tx_rings(struct igb_adapter *);
106static void igb_clean_all_rx_rings(struct igb_adapter *);
Mitch Williams3b644cf2008-06-27 10:59:48 -0700107static void igb_clean_tx_ring(struct igb_ring *);
108static void igb_clean_rx_ring(struct igb_ring *);
Alexander Duyckff41f8d2009-09-03 14:48:56 +0000109static void igb_set_rx_mode(struct net_device *);
Auke Kok9d5c8242008-01-24 02:22:38 -0800110static void igb_update_phy_info(unsigned long);
111static void igb_watchdog(unsigned long);
112static void igb_watchdog_task(struct work_struct *);
Alexander Duyckb1a436c2009-10-27 15:54:43 +0000113static netdev_tx_t igb_xmit_frame_adv(struct sk_buff *skb, struct net_device *);
Auke Kok9d5c8242008-01-24 02:22:38 -0800114static struct net_device_stats *igb_get_stats(struct net_device *);
115static int igb_change_mtu(struct net_device *, int);
116static int igb_set_mac(struct net_device *, void *);
Alexander Duyck68d480c2009-10-05 06:33:08 +0000117static void igb_set_uta(struct igb_adapter *adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800118static irqreturn_t igb_intr(int irq, void *);
119static irqreturn_t igb_intr_msi(int irq, void *);
120static irqreturn_t igb_msix_other(int irq, void *);
Alexander Duyck047e0032009-10-27 15:49:27 +0000121static irqreturn_t igb_msix_ring(int irq, void *);
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700122#ifdef CONFIG_IGB_DCA
Alexander Duyck047e0032009-10-27 15:49:27 +0000123static void igb_update_dca(struct igb_q_vector *);
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700124static void igb_setup_dca(struct igb_adapter *);
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700125#endif /* CONFIG_IGB_DCA */
Alexander Duyck047e0032009-10-27 15:49:27 +0000126static bool igb_clean_tx_irq(struct igb_q_vector *);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700127static int igb_poll(struct napi_struct *, int);
Alexander Duyck047e0032009-10-27 15:49:27 +0000128static bool igb_clean_rx_irq_adv(struct igb_q_vector *, int *, int);
Auke Kok9d5c8242008-01-24 02:22:38 -0800129static int igb_ioctl(struct net_device *, struct ifreq *, int cmd);
130static void igb_tx_timeout(struct net_device *);
131static void igb_reset_task(struct work_struct *);
132static void igb_vlan_rx_register(struct net_device *, struct vlan_group *);
133static void igb_vlan_rx_add_vid(struct net_device *, u16);
134static void igb_vlan_rx_kill_vid(struct net_device *, u16);
135static void igb_restore_vlan(struct igb_adapter *);
Alexander Duyck26ad9172009-10-05 06:32:49 +0000136static void igb_rar_set_qsel(struct igb_adapter *, u8 *, u32 , u8);
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800137static void igb_ping_all_vfs(struct igb_adapter *);
138static void igb_msg_task(struct igb_adapter *);
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800139static void igb_vmm_control(struct igb_adapter *);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +0000140static int igb_set_vf_mac(struct igb_adapter *, int, unsigned char *);
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800141static void igb_restore_vf_multicasts(struct igb_adapter *adapter);
Williams, Mitch A8151d292010-02-10 01:44:24 +0000142static int igb_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac);
143static int igb_ndo_set_vf_vlan(struct net_device *netdev,
144 int vf, u16 vlan, u8 qos);
145static int igb_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate);
146static int igb_ndo_get_vf_config(struct net_device *netdev, int vf,
147 struct ifla_vf_info *ivi);
Auke Kok9d5c8242008-01-24 02:22:38 -0800148
Auke Kok9d5c8242008-01-24 02:22:38 -0800149#ifdef CONFIG_PM
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +0000150static int igb_suspend(struct pci_dev *, pm_message_t);
Auke Kok9d5c8242008-01-24 02:22:38 -0800151static int igb_resume(struct pci_dev *);
152#endif
153static void igb_shutdown(struct pci_dev *);
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700154#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700155static int igb_notify_dca(struct notifier_block *, unsigned long, void *);
156static struct notifier_block dca_notifier = {
157 .notifier_call = igb_notify_dca,
158 .next = NULL,
159 .priority = 0
160};
161#endif
Auke Kok9d5c8242008-01-24 02:22:38 -0800162#ifdef CONFIG_NET_POLL_CONTROLLER
163/* for netdump / net console */
164static void igb_netpoll(struct net_device *);
165#endif
Alexander Duyck37680112009-02-19 20:40:30 -0800166#ifdef CONFIG_PCI_IOV
Alexander Duyck2a3abf62009-04-07 14:37:52 +0000167static unsigned int max_vfs = 0;
168module_param(max_vfs, uint, 0);
169MODULE_PARM_DESC(max_vfs, "Maximum number of virtual functions to allocate "
170 "per physical function");
171#endif /* CONFIG_PCI_IOV */
172
Auke Kok9d5c8242008-01-24 02:22:38 -0800173static pci_ers_result_t igb_io_error_detected(struct pci_dev *,
174 pci_channel_state_t);
175static pci_ers_result_t igb_io_slot_reset(struct pci_dev *);
176static void igb_io_resume(struct pci_dev *);
177
178static struct pci_error_handlers igb_err_handler = {
179 .error_detected = igb_io_error_detected,
180 .slot_reset = igb_io_slot_reset,
181 .resume = igb_io_resume,
182};
183
184
185static struct pci_driver igb_driver = {
186 .name = igb_driver_name,
187 .id_table = igb_pci_tbl,
188 .probe = igb_probe,
189 .remove = __devexit_p(igb_remove),
190#ifdef CONFIG_PM
191 /* Power Managment Hooks */
192 .suspend = igb_suspend,
193 .resume = igb_resume,
194#endif
195 .shutdown = igb_shutdown,
196 .err_handler = &igb_err_handler
197};
198
199MODULE_AUTHOR("Intel Corporation, <e1000-devel@lists.sourceforge.net>");
200MODULE_DESCRIPTION("Intel(R) Gigabit Ethernet Network Driver");
201MODULE_LICENSE("GPL");
202MODULE_VERSION(DRV_VERSION);
203
Patrick Ohly38c845c2009-02-12 05:03:41 +0000204/**
Patrick Ohly38c845c2009-02-12 05:03:41 +0000205 * igb_read_clock - read raw cycle counter (to be used by time counter)
206 */
207static cycle_t igb_read_clock(const struct cyclecounter *tc)
208{
209 struct igb_adapter *adapter =
210 container_of(tc, struct igb_adapter, cycles);
211 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +0000212 u64 stamp = 0;
213 int shift = 0;
Patrick Ohly38c845c2009-02-12 05:03:41 +0000214
Alexander Duyck55cac242009-11-19 12:42:21 +0000215 /*
216 * The timestamp latches on lowest register read. For the 82580
217 * the lowest register is SYSTIMR instead of SYSTIML. However we never
218 * adjusted TIMINCA so SYSTIMR will just read as all 0s so ignore it.
219 */
220 if (hw->mac.type == e1000_82580) {
221 stamp = rd32(E1000_SYSTIMR) >> 8;
222 shift = IGB_82580_TSYNC_SHIFT;
223 }
224
Alexander Duyckc5b9bd52009-10-27 23:46:01 +0000225 stamp |= (u64)rd32(E1000_SYSTIML) << shift;
226 stamp |= (u64)rd32(E1000_SYSTIMH) << (shift + 32);
Patrick Ohly38c845c2009-02-12 05:03:41 +0000227 return stamp;
228}
229
Auke Kok9d5c8242008-01-24 02:22:38 -0800230/**
Alexander Duyckc0410762010-03-25 13:10:08 +0000231 * igb_get_hw_dev - return device
Auke Kok9d5c8242008-01-24 02:22:38 -0800232 * used by hardware layer to print debugging information
233 **/
Alexander Duyckc0410762010-03-25 13:10:08 +0000234struct net_device *igb_get_hw_dev(struct e1000_hw *hw)
Auke Kok9d5c8242008-01-24 02:22:38 -0800235{
236 struct igb_adapter *adapter = hw->back;
Alexander Duyckc0410762010-03-25 13:10:08 +0000237 return adapter->netdev;
Auke Kok9d5c8242008-01-24 02:22:38 -0800238}
Patrick Ohly38c845c2009-02-12 05:03:41 +0000239
240/**
Auke Kok9d5c8242008-01-24 02:22:38 -0800241 * igb_init_module - Driver Registration Routine
242 *
243 * igb_init_module is the first routine called when the driver is
244 * loaded. All it does is register with the PCI subsystem.
245 **/
246static int __init igb_init_module(void)
247{
248 int ret;
249 printk(KERN_INFO "%s - version %s\n",
250 igb_driver_string, igb_driver_version);
251
252 printk(KERN_INFO "%s\n", igb_copyright);
253
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700254#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700255 dca_register_notify(&dca_notifier);
256#endif
Alexander Duyckbbd98fe2009-01-31 00:52:30 -0800257 ret = pci_register_driver(&igb_driver);
Auke Kok9d5c8242008-01-24 02:22:38 -0800258 return ret;
259}
260
261module_init(igb_init_module);
262
263/**
264 * igb_exit_module - Driver Exit Cleanup Routine
265 *
266 * igb_exit_module is called just before the driver is removed
267 * from memory.
268 **/
269static void __exit igb_exit_module(void)
270{
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700271#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700272 dca_unregister_notify(&dca_notifier);
273#endif
Auke Kok9d5c8242008-01-24 02:22:38 -0800274 pci_unregister_driver(&igb_driver);
275}
276
277module_exit(igb_exit_module);
278
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800279#define Q_IDX_82576(i) (((i & 0x1) << 3) + (i >> 1))
280/**
281 * igb_cache_ring_register - Descriptor ring to register mapping
282 * @adapter: board private structure to initialize
283 *
284 * Once we know the feature-set enabled for the device, we'll cache
285 * the register offset the descriptor ring is assigned to.
286 **/
287static void igb_cache_ring_register(struct igb_adapter *adapter)
288{
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000289 int i = 0, j = 0;
Alexander Duyck047e0032009-10-27 15:49:27 +0000290 u32 rbase_offset = adapter->vfs_allocated_count;
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800291
292 switch (adapter->hw.mac.type) {
293 case e1000_82576:
294 /* The queues are allocated for virtualization such that VF 0
295 * is allocated queues 0 and 8, VF 1 queues 1 and 9, etc.
296 * In order to avoid collision we start at the first free queue
297 * and continue consuming queues in the same sequence
298 */
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000299 if (adapter->vfs_allocated_count) {
Alexander Duycka99955f2009-11-12 18:37:19 +0000300 for (; i < adapter->rss_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000301 adapter->rx_ring[i]->reg_idx = rbase_offset +
302 Q_IDX_82576(i);
Alexander Duycka99955f2009-11-12 18:37:19 +0000303 for (; j < adapter->rss_queues; j++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000304 adapter->tx_ring[j]->reg_idx = rbase_offset +
305 Q_IDX_82576(j);
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000306 }
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800307 case e1000_82575:
Alexander Duyck55cac242009-11-19 12:42:21 +0000308 case e1000_82580:
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +0000309 case e1000_i350:
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800310 default:
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000311 for (; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000312 adapter->rx_ring[i]->reg_idx = rbase_offset + i;
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000313 for (; j < adapter->num_tx_queues; j++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000314 adapter->tx_ring[j]->reg_idx = rbase_offset + j;
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800315 break;
316 }
317}
318
Alexander Duyck047e0032009-10-27 15:49:27 +0000319static void igb_free_queues(struct igb_adapter *adapter)
320{
Alexander Duyck3025a442010-02-17 01:02:39 +0000321 int i;
Alexander Duyck047e0032009-10-27 15:49:27 +0000322
Alexander Duyck3025a442010-02-17 01:02:39 +0000323 for (i = 0; i < adapter->num_tx_queues; i++) {
324 kfree(adapter->tx_ring[i]);
325 adapter->tx_ring[i] = NULL;
326 }
327 for (i = 0; i < adapter->num_rx_queues; i++) {
328 kfree(adapter->rx_ring[i]);
329 adapter->rx_ring[i] = NULL;
330 }
Alexander Duyck047e0032009-10-27 15:49:27 +0000331 adapter->num_rx_queues = 0;
332 adapter->num_tx_queues = 0;
333}
334
Auke Kok9d5c8242008-01-24 02:22:38 -0800335/**
336 * igb_alloc_queues - Allocate memory for all rings
337 * @adapter: board private structure to initialize
338 *
339 * We allocate one ring per queue at run-time since we don't know the
340 * number of queues at compile-time.
341 **/
342static int igb_alloc_queues(struct igb_adapter *adapter)
343{
Alexander Duyck3025a442010-02-17 01:02:39 +0000344 struct igb_ring *ring;
Auke Kok9d5c8242008-01-24 02:22:38 -0800345 int i;
346
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700347 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +0000348 ring = kzalloc(sizeof(struct igb_ring), GFP_KERNEL);
349 if (!ring)
350 goto err;
Alexander Duyck68fd9912008-11-20 00:48:10 -0800351 ring->count = adapter->tx_ring_count;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700352 ring->queue_index = i;
Alexander Duyck80785292009-10-27 15:51:47 +0000353 ring->pdev = adapter->pdev;
Alexander Duycke694e962009-10-27 15:53:06 +0000354 ring->netdev = adapter->netdev;
Alexander Duyck85ad76b2009-10-27 15:52:46 +0000355 /* For 82575, context index must be unique per ring. */
356 if (adapter->hw.mac.type == e1000_82575)
357 ring->flags = IGB_RING_FLAG_TX_CTX_IDX;
Alexander Duyck3025a442010-02-17 01:02:39 +0000358 adapter->tx_ring[i] = ring;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700359 }
Alexander Duyck85ad76b2009-10-27 15:52:46 +0000360
Auke Kok9d5c8242008-01-24 02:22:38 -0800361 for (i = 0; i < adapter->num_rx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +0000362 ring = kzalloc(sizeof(struct igb_ring), GFP_KERNEL);
363 if (!ring)
364 goto err;
Alexander Duyck68fd9912008-11-20 00:48:10 -0800365 ring->count = adapter->rx_ring_count;
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700366 ring->queue_index = i;
Alexander Duyck80785292009-10-27 15:51:47 +0000367 ring->pdev = adapter->pdev;
Alexander Duycke694e962009-10-27 15:53:06 +0000368 ring->netdev = adapter->netdev;
Alexander Duyck4c844852009-10-27 15:52:07 +0000369 ring->rx_buffer_len = MAXIMUM_ETHERNET_VLAN_SIZE;
Alexander Duyck85ad76b2009-10-27 15:52:46 +0000370 ring->flags = IGB_RING_FLAG_RX_CSUM; /* enable rx checksum */
371 /* set flag indicating ring supports SCTP checksum offload */
372 if (adapter->hw.mac.type >= e1000_82576)
373 ring->flags |= IGB_RING_FLAG_RX_SCTP_CSUM;
Alexander Duyck3025a442010-02-17 01:02:39 +0000374 adapter->rx_ring[i] = ring;
Auke Kok9d5c8242008-01-24 02:22:38 -0800375 }
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800376
377 igb_cache_ring_register(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +0000378
Auke Kok9d5c8242008-01-24 02:22:38 -0800379 return 0;
Auke Kok9d5c8242008-01-24 02:22:38 -0800380
Alexander Duyck047e0032009-10-27 15:49:27 +0000381err:
382 igb_free_queues(adapter);
Alexander Duycka88f10e2008-07-08 15:13:38 -0700383
Alexander Duyck047e0032009-10-27 15:49:27 +0000384 return -ENOMEM;
Alexander Duycka88f10e2008-07-08 15:13:38 -0700385}
386
Auke Kok9d5c8242008-01-24 02:22:38 -0800387#define IGB_N0_QUEUE -1
Alexander Duyck047e0032009-10-27 15:49:27 +0000388static void igb_assign_vector(struct igb_q_vector *q_vector, int msix_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -0800389{
390 u32 msixbm = 0;
Alexander Duyck047e0032009-10-27 15:49:27 +0000391 struct igb_adapter *adapter = q_vector->adapter;
Auke Kok9d5c8242008-01-24 02:22:38 -0800392 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700393 u32 ivar, index;
Alexander Duyck047e0032009-10-27 15:49:27 +0000394 int rx_queue = IGB_N0_QUEUE;
395 int tx_queue = IGB_N0_QUEUE;
396
397 if (q_vector->rx_ring)
398 rx_queue = q_vector->rx_ring->reg_idx;
399 if (q_vector->tx_ring)
400 tx_queue = q_vector->tx_ring->reg_idx;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700401
402 switch (hw->mac.type) {
403 case e1000_82575:
Auke Kok9d5c8242008-01-24 02:22:38 -0800404 /* The 82575 assigns vectors using a bitmask, which matches the
405 bitmask for the EICR/EIMS/EIMC registers. To assign one
406 or more queues to a vector, we write the appropriate bits
407 into the MSIXBM register for that vector. */
Alexander Duyck047e0032009-10-27 15:49:27 +0000408 if (rx_queue > IGB_N0_QUEUE)
Auke Kok9d5c8242008-01-24 02:22:38 -0800409 msixbm = E1000_EICR_RX_QUEUE0 << rx_queue;
Alexander Duyck047e0032009-10-27 15:49:27 +0000410 if (tx_queue > IGB_N0_QUEUE)
Auke Kok9d5c8242008-01-24 02:22:38 -0800411 msixbm |= E1000_EICR_TX_QUEUE0 << tx_queue;
Alexander Duyckfeeb2722010-02-03 21:59:51 +0000412 if (!adapter->msix_entries && msix_vector == 0)
413 msixbm |= E1000_EIMS_OTHER;
Auke Kok9d5c8242008-01-24 02:22:38 -0800414 array_wr32(E1000_MSIXBM(0), msix_vector, msixbm);
Alexander Duyck047e0032009-10-27 15:49:27 +0000415 q_vector->eims_value = msixbm;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700416 break;
417 case e1000_82576:
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800418 /* 82576 uses a table-based method for assigning vectors.
Alexander Duyck2d064c02008-07-08 15:10:12 -0700419 Each queue has a single entry in the table to which we write
420 a vector number along with a "valid" bit. Sadly, the layout
421 of the table is somewhat counterintuitive. */
422 if (rx_queue > IGB_N0_QUEUE) {
Alexander Duyck047e0032009-10-27 15:49:27 +0000423 index = (rx_queue & 0x7);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700424 ivar = array_rd32(E1000_IVAR0, index);
Alexander Duyck047e0032009-10-27 15:49:27 +0000425 if (rx_queue < 8) {
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800426 /* vector goes into low byte of register */
427 ivar = ivar & 0xFFFFFF00;
428 ivar |= msix_vector | E1000_IVAR_VALID;
Alexander Duyck047e0032009-10-27 15:49:27 +0000429 } else {
430 /* vector goes into third byte of register */
431 ivar = ivar & 0xFF00FFFF;
432 ivar |= (msix_vector | E1000_IVAR_VALID) << 16;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700433 }
Alexander Duyck2d064c02008-07-08 15:10:12 -0700434 array_wr32(E1000_IVAR0, index, ivar);
435 }
436 if (tx_queue > IGB_N0_QUEUE) {
Alexander Duyck047e0032009-10-27 15:49:27 +0000437 index = (tx_queue & 0x7);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700438 ivar = array_rd32(E1000_IVAR0, index);
Alexander Duyck047e0032009-10-27 15:49:27 +0000439 if (tx_queue < 8) {
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800440 /* vector goes into second byte of register */
441 ivar = ivar & 0xFFFF00FF;
442 ivar |= (msix_vector | E1000_IVAR_VALID) << 8;
Alexander Duyck047e0032009-10-27 15:49:27 +0000443 } else {
444 /* vector goes into high byte of register */
445 ivar = ivar & 0x00FFFFFF;
446 ivar |= (msix_vector | E1000_IVAR_VALID) << 24;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700447 }
Alexander Duyck2d064c02008-07-08 15:10:12 -0700448 array_wr32(E1000_IVAR0, index, ivar);
449 }
Alexander Duyck047e0032009-10-27 15:49:27 +0000450 q_vector->eims_value = 1 << msix_vector;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700451 break;
Alexander Duyck55cac242009-11-19 12:42:21 +0000452 case e1000_82580:
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +0000453 case e1000_i350:
Alexander Duyck55cac242009-11-19 12:42:21 +0000454 /* 82580 uses the same table-based approach as 82576 but has fewer
455 entries as a result we carry over for queues greater than 4. */
456 if (rx_queue > IGB_N0_QUEUE) {
457 index = (rx_queue >> 1);
458 ivar = array_rd32(E1000_IVAR0, index);
459 if (rx_queue & 0x1) {
460 /* vector goes into third byte of register */
461 ivar = ivar & 0xFF00FFFF;
462 ivar |= (msix_vector | E1000_IVAR_VALID) << 16;
463 } else {
464 /* vector goes into low byte of register */
465 ivar = ivar & 0xFFFFFF00;
466 ivar |= msix_vector | E1000_IVAR_VALID;
467 }
468 array_wr32(E1000_IVAR0, index, ivar);
469 }
470 if (tx_queue > IGB_N0_QUEUE) {
471 index = (tx_queue >> 1);
472 ivar = array_rd32(E1000_IVAR0, index);
473 if (tx_queue & 0x1) {
474 /* vector goes into high byte of register */
475 ivar = ivar & 0x00FFFFFF;
476 ivar |= (msix_vector | E1000_IVAR_VALID) << 24;
477 } else {
478 /* vector goes into second byte of register */
479 ivar = ivar & 0xFFFF00FF;
480 ivar |= (msix_vector | E1000_IVAR_VALID) << 8;
481 }
482 array_wr32(E1000_IVAR0, index, ivar);
483 }
484 q_vector->eims_value = 1 << msix_vector;
485 break;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700486 default:
487 BUG();
488 break;
489 }
Alexander Duyck26b39272010-02-17 01:00:41 +0000490
491 /* add q_vector eims value to global eims_enable_mask */
492 adapter->eims_enable_mask |= q_vector->eims_value;
493
494 /* configure q_vector to set itr on first interrupt */
495 q_vector->set_itr = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -0800496}
497
498/**
499 * igb_configure_msix - Configure MSI-X hardware
500 *
501 * igb_configure_msix sets up the hardware to properly
502 * generate MSI-X interrupts.
503 **/
504static void igb_configure_msix(struct igb_adapter *adapter)
505{
506 u32 tmp;
507 int i, vector = 0;
508 struct e1000_hw *hw = &adapter->hw;
509
510 adapter->eims_enable_mask = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -0800511
512 /* set vector for other causes, i.e. link changes */
Alexander Duyck2d064c02008-07-08 15:10:12 -0700513 switch (hw->mac.type) {
514 case e1000_82575:
Auke Kok9d5c8242008-01-24 02:22:38 -0800515 tmp = rd32(E1000_CTRL_EXT);
516 /* enable MSI-X PBA support*/
517 tmp |= E1000_CTRL_EXT_PBA_CLR;
518
519 /* Auto-Mask interrupts upon ICR read. */
520 tmp |= E1000_CTRL_EXT_EIAME;
521 tmp |= E1000_CTRL_EXT_IRCA;
522
523 wr32(E1000_CTRL_EXT, tmp);
Alexander Duyck047e0032009-10-27 15:49:27 +0000524
525 /* enable msix_other interrupt */
526 array_wr32(E1000_MSIXBM(0), vector++,
527 E1000_EIMS_OTHER);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700528 adapter->eims_other = E1000_EIMS_OTHER;
Auke Kok9d5c8242008-01-24 02:22:38 -0800529
Alexander Duyck2d064c02008-07-08 15:10:12 -0700530 break;
531
532 case e1000_82576:
Alexander Duyck55cac242009-11-19 12:42:21 +0000533 case e1000_82580:
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +0000534 case e1000_i350:
Alexander Duyck047e0032009-10-27 15:49:27 +0000535 /* Turn on MSI-X capability first, or our settings
536 * won't stick. And it will take days to debug. */
537 wr32(E1000_GPIE, E1000_GPIE_MSIX_MODE |
538 E1000_GPIE_PBA | E1000_GPIE_EIAME |
539 E1000_GPIE_NSICR);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700540
Alexander Duyck047e0032009-10-27 15:49:27 +0000541 /* enable msix_other interrupt */
542 adapter->eims_other = 1 << vector;
543 tmp = (vector++ | E1000_IVAR_VALID) << 8;
544
545 wr32(E1000_IVAR_MISC, tmp);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700546 break;
547 default:
548 /* do nothing, since nothing else supports MSI-X */
549 break;
550 } /* switch (hw->mac.type) */
Alexander Duyck047e0032009-10-27 15:49:27 +0000551
552 adapter->eims_enable_mask |= adapter->eims_other;
553
Alexander Duyck26b39272010-02-17 01:00:41 +0000554 for (i = 0; i < adapter->num_q_vectors; i++)
555 igb_assign_vector(adapter->q_vector[i], vector++);
Alexander Duyck047e0032009-10-27 15:49:27 +0000556
Auke Kok9d5c8242008-01-24 02:22:38 -0800557 wrfl();
558}
559
560/**
561 * igb_request_msix - Initialize MSI-X interrupts
562 *
563 * igb_request_msix allocates MSI-X vectors and requests interrupts from the
564 * kernel.
565 **/
566static int igb_request_msix(struct igb_adapter *adapter)
567{
568 struct net_device *netdev = adapter->netdev;
Alexander Duyck047e0032009-10-27 15:49:27 +0000569 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -0800570 int i, err = 0, vector = 0;
571
Auke Kok9d5c8242008-01-24 02:22:38 -0800572 err = request_irq(adapter->msix_entries[vector].vector,
Joe Perchesa0607fd2009-11-18 23:29:17 -0800573 igb_msix_other, 0, netdev->name, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800574 if (err)
575 goto out;
Alexander Duyck047e0032009-10-27 15:49:27 +0000576 vector++;
577
578 for (i = 0; i < adapter->num_q_vectors; i++) {
579 struct igb_q_vector *q_vector = adapter->q_vector[i];
580
581 q_vector->itr_register = hw->hw_addr + E1000_EITR(vector);
582
583 if (q_vector->rx_ring && q_vector->tx_ring)
584 sprintf(q_vector->name, "%s-TxRx-%u", netdev->name,
585 q_vector->rx_ring->queue_index);
586 else if (q_vector->tx_ring)
587 sprintf(q_vector->name, "%s-tx-%u", netdev->name,
588 q_vector->tx_ring->queue_index);
589 else if (q_vector->rx_ring)
590 sprintf(q_vector->name, "%s-rx-%u", netdev->name,
591 q_vector->rx_ring->queue_index);
592 else
593 sprintf(q_vector->name, "%s-unused", netdev->name);
594
595 err = request_irq(adapter->msix_entries[vector].vector,
Joe Perchesa0607fd2009-11-18 23:29:17 -0800596 igb_msix_ring, 0, q_vector->name,
Alexander Duyck047e0032009-10-27 15:49:27 +0000597 q_vector);
598 if (err)
599 goto out;
600 vector++;
601 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800602
Auke Kok9d5c8242008-01-24 02:22:38 -0800603 igb_configure_msix(adapter);
604 return 0;
605out:
606 return err;
607}
608
609static void igb_reset_interrupt_capability(struct igb_adapter *adapter)
610{
611 if (adapter->msix_entries) {
612 pci_disable_msix(adapter->pdev);
613 kfree(adapter->msix_entries);
614 adapter->msix_entries = NULL;
Alexander Duyck047e0032009-10-27 15:49:27 +0000615 } else if (adapter->flags & IGB_FLAG_HAS_MSI) {
Auke Kok9d5c8242008-01-24 02:22:38 -0800616 pci_disable_msi(adapter->pdev);
Alexander Duyck047e0032009-10-27 15:49:27 +0000617 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800618}
619
Alexander Duyck047e0032009-10-27 15:49:27 +0000620/**
621 * igb_free_q_vectors - Free memory allocated for interrupt vectors
622 * @adapter: board private structure to initialize
623 *
624 * This function frees the memory allocated to the q_vectors. In addition if
625 * NAPI is enabled it will delete any references to the NAPI struct prior
626 * to freeing the q_vector.
627 **/
628static void igb_free_q_vectors(struct igb_adapter *adapter)
629{
630 int v_idx;
631
632 for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
633 struct igb_q_vector *q_vector = adapter->q_vector[v_idx];
634 adapter->q_vector[v_idx] = NULL;
Nick Nunleyfe0592b2010-02-17 01:05:35 +0000635 if (!q_vector)
636 continue;
Alexander Duyck047e0032009-10-27 15:49:27 +0000637 netif_napi_del(&q_vector->napi);
638 kfree(q_vector);
639 }
640 adapter->num_q_vectors = 0;
641}
642
643/**
644 * igb_clear_interrupt_scheme - reset the device to a state of no interrupts
645 *
646 * This function resets the device so that it has 0 rx queues, tx queues, and
647 * MSI-X interrupts allocated.
648 */
649static void igb_clear_interrupt_scheme(struct igb_adapter *adapter)
650{
651 igb_free_queues(adapter);
652 igb_free_q_vectors(adapter);
653 igb_reset_interrupt_capability(adapter);
654}
Auke Kok9d5c8242008-01-24 02:22:38 -0800655
656/**
657 * igb_set_interrupt_capability - set MSI or MSI-X if supported
658 *
659 * Attempt to configure interrupts using the best available
660 * capabilities of the hardware and kernel.
661 **/
662static void igb_set_interrupt_capability(struct igb_adapter *adapter)
663{
664 int err;
665 int numvecs, i;
666
Alexander Duyck83b71802009-02-06 23:15:45 +0000667 /* Number of supported queues. */
Alexander Duycka99955f2009-11-12 18:37:19 +0000668 adapter->num_rx_queues = adapter->rss_queues;
669 adapter->num_tx_queues = adapter->rss_queues;
Alexander Duyck83b71802009-02-06 23:15:45 +0000670
Alexander Duyck047e0032009-10-27 15:49:27 +0000671 /* start with one vector for every rx queue */
672 numvecs = adapter->num_rx_queues;
673
Daniel Mack3ad2f3f2010-02-03 08:01:28 +0800674 /* if tx handler is separate add 1 for every tx queue */
Alexander Duycka99955f2009-11-12 18:37:19 +0000675 if (!(adapter->flags & IGB_FLAG_QUEUE_PAIRS))
676 numvecs += adapter->num_tx_queues;
Alexander Duyck047e0032009-10-27 15:49:27 +0000677
678 /* store the number of vectors reserved for queues */
679 adapter->num_q_vectors = numvecs;
680
681 /* add 1 vector for link status interrupts */
682 numvecs++;
Auke Kok9d5c8242008-01-24 02:22:38 -0800683 adapter->msix_entries = kcalloc(numvecs, sizeof(struct msix_entry),
684 GFP_KERNEL);
685 if (!adapter->msix_entries)
686 goto msi_only;
687
688 for (i = 0; i < numvecs; i++)
689 adapter->msix_entries[i].entry = i;
690
691 err = pci_enable_msix(adapter->pdev,
692 adapter->msix_entries,
693 numvecs);
694 if (err == 0)
Alexander Duyck34a20e82008-08-26 04:25:13 -0700695 goto out;
Auke Kok9d5c8242008-01-24 02:22:38 -0800696
697 igb_reset_interrupt_capability(adapter);
698
699 /* If we can't do MSI-X, try MSI */
700msi_only:
Alexander Duyck2a3abf62009-04-07 14:37:52 +0000701#ifdef CONFIG_PCI_IOV
702 /* disable SR-IOV for non MSI-X configurations */
703 if (adapter->vf_data) {
704 struct e1000_hw *hw = &adapter->hw;
705 /* disable iov and allow time for transactions to clear */
706 pci_disable_sriov(adapter->pdev);
707 msleep(500);
708
709 kfree(adapter->vf_data);
710 adapter->vf_data = NULL;
711 wr32(E1000_IOVCTL, E1000_IOVCTL_REUSE_VFQ);
712 msleep(100);
713 dev_info(&adapter->pdev->dev, "IOV Disabled\n");
714 }
715#endif
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000716 adapter->vfs_allocated_count = 0;
Alexander Duycka99955f2009-11-12 18:37:19 +0000717 adapter->rss_queues = 1;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000718 adapter->flags |= IGB_FLAG_QUEUE_PAIRS;
Auke Kok9d5c8242008-01-24 02:22:38 -0800719 adapter->num_rx_queues = 1;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700720 adapter->num_tx_queues = 1;
Alexander Duyck047e0032009-10-27 15:49:27 +0000721 adapter->num_q_vectors = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -0800722 if (!pci_enable_msi(adapter->pdev))
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700723 adapter->flags |= IGB_FLAG_HAS_MSI;
Alexander Duyck34a20e82008-08-26 04:25:13 -0700724out:
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700725 /* Notify the stack of the (possibly) reduced Tx Queue count. */
David S. Millerfd2ea0a2008-07-17 01:56:23 -0700726 adapter->netdev->real_num_tx_queues = adapter->num_tx_queues;
Auke Kok9d5c8242008-01-24 02:22:38 -0800727 return;
728}
729
730/**
Alexander Duyck047e0032009-10-27 15:49:27 +0000731 * igb_alloc_q_vectors - Allocate memory for interrupt vectors
732 * @adapter: board private structure to initialize
733 *
734 * We allocate one q_vector per queue interrupt. If allocation fails we
735 * return -ENOMEM.
736 **/
737static int igb_alloc_q_vectors(struct igb_adapter *adapter)
738{
739 struct igb_q_vector *q_vector;
740 struct e1000_hw *hw = &adapter->hw;
741 int v_idx;
742
743 for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
744 q_vector = kzalloc(sizeof(struct igb_q_vector), GFP_KERNEL);
745 if (!q_vector)
746 goto err_out;
747 q_vector->adapter = adapter;
Alexander Duyck047e0032009-10-27 15:49:27 +0000748 q_vector->itr_register = hw->hw_addr + E1000_EITR(0);
749 q_vector->itr_val = IGB_START_ITR;
Alexander Duyck047e0032009-10-27 15:49:27 +0000750 netif_napi_add(adapter->netdev, &q_vector->napi, igb_poll, 64);
751 adapter->q_vector[v_idx] = q_vector;
752 }
753 return 0;
754
755err_out:
Nick Nunleyfe0592b2010-02-17 01:05:35 +0000756 igb_free_q_vectors(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +0000757 return -ENOMEM;
758}
759
760static void igb_map_rx_ring_to_vector(struct igb_adapter *adapter,
761 int ring_idx, int v_idx)
762{
Alexander Duyck3025a442010-02-17 01:02:39 +0000763 struct igb_q_vector *q_vector = adapter->q_vector[v_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000764
Alexander Duyck3025a442010-02-17 01:02:39 +0000765 q_vector->rx_ring = adapter->rx_ring[ring_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000766 q_vector->rx_ring->q_vector = q_vector;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000767 q_vector->itr_val = adapter->rx_itr_setting;
768 if (q_vector->itr_val && q_vector->itr_val <= 3)
769 q_vector->itr_val = IGB_START_ITR;
Alexander Duyck047e0032009-10-27 15:49:27 +0000770}
771
772static void igb_map_tx_ring_to_vector(struct igb_adapter *adapter,
773 int ring_idx, int v_idx)
774{
Alexander Duyck3025a442010-02-17 01:02:39 +0000775 struct igb_q_vector *q_vector = adapter->q_vector[v_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000776
Alexander Duyck3025a442010-02-17 01:02:39 +0000777 q_vector->tx_ring = adapter->tx_ring[ring_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000778 q_vector->tx_ring->q_vector = q_vector;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000779 q_vector->itr_val = adapter->tx_itr_setting;
780 if (q_vector->itr_val && q_vector->itr_val <= 3)
781 q_vector->itr_val = IGB_START_ITR;
Alexander Duyck047e0032009-10-27 15:49:27 +0000782}
783
784/**
785 * igb_map_ring_to_vector - maps allocated queues to vectors
786 *
787 * This function maps the recently allocated queues to vectors.
788 **/
789static int igb_map_ring_to_vector(struct igb_adapter *adapter)
790{
791 int i;
792 int v_idx = 0;
793
794 if ((adapter->num_q_vectors < adapter->num_rx_queues) ||
795 (adapter->num_q_vectors < adapter->num_tx_queues))
796 return -ENOMEM;
797
798 if (adapter->num_q_vectors >=
799 (adapter->num_rx_queues + adapter->num_tx_queues)) {
800 for (i = 0; i < adapter->num_rx_queues; i++)
801 igb_map_rx_ring_to_vector(adapter, i, v_idx++);
802 for (i = 0; i < adapter->num_tx_queues; i++)
803 igb_map_tx_ring_to_vector(adapter, i, v_idx++);
804 } else {
805 for (i = 0; i < adapter->num_rx_queues; i++) {
806 if (i < adapter->num_tx_queues)
807 igb_map_tx_ring_to_vector(adapter, i, v_idx);
808 igb_map_rx_ring_to_vector(adapter, i, v_idx++);
809 }
810 for (; i < adapter->num_tx_queues; i++)
811 igb_map_tx_ring_to_vector(adapter, i, v_idx++);
812 }
813 return 0;
814}
815
816/**
817 * igb_init_interrupt_scheme - initialize interrupts, allocate queues/vectors
818 *
819 * This function initializes the interrupts and allocates all of the queues.
820 **/
821static int igb_init_interrupt_scheme(struct igb_adapter *adapter)
822{
823 struct pci_dev *pdev = adapter->pdev;
824 int err;
825
826 igb_set_interrupt_capability(adapter);
827
828 err = igb_alloc_q_vectors(adapter);
829 if (err) {
830 dev_err(&pdev->dev, "Unable to allocate memory for vectors\n");
831 goto err_alloc_q_vectors;
832 }
833
834 err = igb_alloc_queues(adapter);
835 if (err) {
836 dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
837 goto err_alloc_queues;
838 }
839
840 err = igb_map_ring_to_vector(adapter);
841 if (err) {
842 dev_err(&pdev->dev, "Invalid q_vector to ring mapping\n");
843 goto err_map_queues;
844 }
845
846
847 return 0;
848err_map_queues:
849 igb_free_queues(adapter);
850err_alloc_queues:
851 igb_free_q_vectors(adapter);
852err_alloc_q_vectors:
853 igb_reset_interrupt_capability(adapter);
854 return err;
855}
856
857/**
Auke Kok9d5c8242008-01-24 02:22:38 -0800858 * igb_request_irq - initialize interrupts
859 *
860 * Attempts to configure interrupts using the best available
861 * capabilities of the hardware and kernel.
862 **/
863static int igb_request_irq(struct igb_adapter *adapter)
864{
865 struct net_device *netdev = adapter->netdev;
Alexander Duyck047e0032009-10-27 15:49:27 +0000866 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -0800867 int err = 0;
868
869 if (adapter->msix_entries) {
870 err = igb_request_msix(adapter);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700871 if (!err)
Auke Kok9d5c8242008-01-24 02:22:38 -0800872 goto request_done;
Auke Kok9d5c8242008-01-24 02:22:38 -0800873 /* fall back to MSI */
Alexander Duyck047e0032009-10-27 15:49:27 +0000874 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800875 if (!pci_enable_msi(adapter->pdev))
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700876 adapter->flags |= IGB_FLAG_HAS_MSI;
Auke Kok9d5c8242008-01-24 02:22:38 -0800877 igb_free_all_tx_resources(adapter);
878 igb_free_all_rx_resources(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +0000879 adapter->num_tx_queues = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -0800880 adapter->num_rx_queues = 1;
Alexander Duyck047e0032009-10-27 15:49:27 +0000881 adapter->num_q_vectors = 1;
882 err = igb_alloc_q_vectors(adapter);
883 if (err) {
884 dev_err(&pdev->dev,
885 "Unable to allocate memory for vectors\n");
886 goto request_done;
887 }
888 err = igb_alloc_queues(adapter);
889 if (err) {
890 dev_err(&pdev->dev,
891 "Unable to allocate memory for queues\n");
892 igb_free_q_vectors(adapter);
893 goto request_done;
894 }
895 igb_setup_all_tx_resources(adapter);
896 igb_setup_all_rx_resources(adapter);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700897 } else {
Alexander Duyckfeeb2722010-02-03 21:59:51 +0000898 igb_assign_vector(adapter->q_vector[0], 0);
Auke Kok9d5c8242008-01-24 02:22:38 -0800899 }
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700900
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700901 if (adapter->flags & IGB_FLAG_HAS_MSI) {
Joe Perchesa0607fd2009-11-18 23:29:17 -0800902 err = request_irq(adapter->pdev->irq, igb_intr_msi, 0,
Alexander Duyck047e0032009-10-27 15:49:27 +0000903 netdev->name, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800904 if (!err)
905 goto request_done;
Alexander Duyck047e0032009-10-27 15:49:27 +0000906
Auke Kok9d5c8242008-01-24 02:22:38 -0800907 /* fall back to legacy interrupts */
908 igb_reset_interrupt_capability(adapter);
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700909 adapter->flags &= ~IGB_FLAG_HAS_MSI;
Auke Kok9d5c8242008-01-24 02:22:38 -0800910 }
911
Joe Perchesa0607fd2009-11-18 23:29:17 -0800912 err = request_irq(adapter->pdev->irq, igb_intr, IRQF_SHARED,
Alexander Duyck047e0032009-10-27 15:49:27 +0000913 netdev->name, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800914
Andy Gospodarek6cb5e572008-02-15 14:05:25 -0800915 if (err)
Auke Kok9d5c8242008-01-24 02:22:38 -0800916 dev_err(&adapter->pdev->dev, "Error %d getting interrupt\n",
917 err);
Auke Kok9d5c8242008-01-24 02:22:38 -0800918
919request_done:
920 return err;
921}
922
923static void igb_free_irq(struct igb_adapter *adapter)
924{
Auke Kok9d5c8242008-01-24 02:22:38 -0800925 if (adapter->msix_entries) {
926 int vector = 0, i;
927
Alexander Duyck047e0032009-10-27 15:49:27 +0000928 free_irq(adapter->msix_entries[vector++].vector, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800929
Alexander Duyck047e0032009-10-27 15:49:27 +0000930 for (i = 0; i < adapter->num_q_vectors; i++) {
931 struct igb_q_vector *q_vector = adapter->q_vector[i];
932 free_irq(adapter->msix_entries[vector++].vector,
933 q_vector);
934 }
935 } else {
936 free_irq(adapter->pdev->irq, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800937 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800938}
939
940/**
941 * igb_irq_disable - Mask off interrupt generation on the NIC
942 * @adapter: board private structure
943 **/
944static void igb_irq_disable(struct igb_adapter *adapter)
945{
946 struct e1000_hw *hw = &adapter->hw;
947
Alexander Duyck25568a52009-10-27 23:49:59 +0000948 /*
949 * we need to be careful when disabling interrupts. The VFs are also
950 * mapped into these registers and so clearing the bits can cause
951 * issues on the VF drivers so we only need to clear what we set
952 */
Auke Kok9d5c8242008-01-24 02:22:38 -0800953 if (adapter->msix_entries) {
Alexander Duyck2dfd1212009-09-03 14:49:15 +0000954 u32 regval = rd32(E1000_EIAM);
955 wr32(E1000_EIAM, regval & ~adapter->eims_enable_mask);
956 wr32(E1000_EIMC, adapter->eims_enable_mask);
957 regval = rd32(E1000_EIAC);
958 wr32(E1000_EIAC, regval & ~adapter->eims_enable_mask);
Auke Kok9d5c8242008-01-24 02:22:38 -0800959 }
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700960
961 wr32(E1000_IAM, 0);
Auke Kok9d5c8242008-01-24 02:22:38 -0800962 wr32(E1000_IMC, ~0);
963 wrfl();
964 synchronize_irq(adapter->pdev->irq);
965}
966
967/**
968 * igb_irq_enable - Enable default interrupt generation settings
969 * @adapter: board private structure
970 **/
971static void igb_irq_enable(struct igb_adapter *adapter)
972{
973 struct e1000_hw *hw = &adapter->hw;
974
975 if (adapter->msix_entries) {
Alexander Duyck25568a52009-10-27 23:49:59 +0000976 u32 ims = E1000_IMS_LSC | E1000_IMS_DOUTSYNC;
Alexander Duyck2dfd1212009-09-03 14:49:15 +0000977 u32 regval = rd32(E1000_EIAC);
978 wr32(E1000_EIAC, regval | adapter->eims_enable_mask);
979 regval = rd32(E1000_EIAM);
980 wr32(E1000_EIAM, regval | adapter->eims_enable_mask);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700981 wr32(E1000_EIMS, adapter->eims_enable_mask);
Alexander Duyck25568a52009-10-27 23:49:59 +0000982 if (adapter->vfs_allocated_count) {
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800983 wr32(E1000_MBVFIMR, 0xFF);
Alexander Duyck25568a52009-10-27 23:49:59 +0000984 ims |= E1000_IMS_VMMB;
985 }
Alexander Duyck55cac242009-11-19 12:42:21 +0000986 if (adapter->hw.mac.type == e1000_82580)
987 ims |= E1000_IMS_DRSTA;
988
Alexander Duyck25568a52009-10-27 23:49:59 +0000989 wr32(E1000_IMS, ims);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700990 } else {
Alexander Duyck55cac242009-11-19 12:42:21 +0000991 wr32(E1000_IMS, IMS_ENABLE_MASK |
992 E1000_IMS_DRSTA);
993 wr32(E1000_IAM, IMS_ENABLE_MASK |
994 E1000_IMS_DRSTA);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700995 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800996}
997
998static void igb_update_mng_vlan(struct igb_adapter *adapter)
999{
Alexander Duyck51466232009-10-27 23:47:35 +00001000 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08001001 u16 vid = adapter->hw.mng_cookie.vlan_id;
1002 u16 old_vid = adapter->mng_vlan_id;
Auke Kok9d5c8242008-01-24 02:22:38 -08001003
Alexander Duyck51466232009-10-27 23:47:35 +00001004 if (hw->mng_cookie.status & E1000_MNG_DHCP_COOKIE_STATUS_VLAN) {
1005 /* add VID to filter table */
1006 igb_vfta_set(hw, vid, true);
1007 adapter->mng_vlan_id = vid;
1008 } else {
1009 adapter->mng_vlan_id = IGB_MNG_VLAN_NONE;
1010 }
1011
1012 if ((old_vid != (u16)IGB_MNG_VLAN_NONE) &&
1013 (vid != old_vid) &&
1014 !vlan_group_get_device(adapter->vlgrp, old_vid)) {
1015 /* remove VID from filter table */
1016 igb_vfta_set(hw, old_vid, false);
Auke Kok9d5c8242008-01-24 02:22:38 -08001017 }
1018}
1019
1020/**
1021 * igb_release_hw_control - release control of the h/w to f/w
1022 * @adapter: address of board private structure
1023 *
1024 * igb_release_hw_control resets CTRL_EXT:DRV_LOAD bit.
1025 * For ASF and Pass Through versions of f/w this means that the
1026 * driver is no longer loaded.
1027 *
1028 **/
1029static void igb_release_hw_control(struct igb_adapter *adapter)
1030{
1031 struct e1000_hw *hw = &adapter->hw;
1032 u32 ctrl_ext;
1033
1034 /* Let firmware take over control of h/w */
1035 ctrl_ext = rd32(E1000_CTRL_EXT);
1036 wr32(E1000_CTRL_EXT,
1037 ctrl_ext & ~E1000_CTRL_EXT_DRV_LOAD);
1038}
1039
Auke Kok9d5c8242008-01-24 02:22:38 -08001040/**
1041 * igb_get_hw_control - get control of the h/w from f/w
1042 * @adapter: address of board private structure
1043 *
1044 * igb_get_hw_control sets CTRL_EXT:DRV_LOAD bit.
1045 * For ASF and Pass Through versions of f/w this means that
1046 * the driver is loaded.
1047 *
1048 **/
1049static void igb_get_hw_control(struct igb_adapter *adapter)
1050{
1051 struct e1000_hw *hw = &adapter->hw;
1052 u32 ctrl_ext;
1053
1054 /* Let firmware know the driver has taken over */
1055 ctrl_ext = rd32(E1000_CTRL_EXT);
1056 wr32(E1000_CTRL_EXT,
1057 ctrl_ext | E1000_CTRL_EXT_DRV_LOAD);
1058}
1059
Auke Kok9d5c8242008-01-24 02:22:38 -08001060/**
1061 * igb_configure - configure the hardware for RX and TX
1062 * @adapter: private board structure
1063 **/
1064static void igb_configure(struct igb_adapter *adapter)
1065{
1066 struct net_device *netdev = adapter->netdev;
1067 int i;
1068
1069 igb_get_hw_control(adapter);
Alexander Duyckff41f8d2009-09-03 14:48:56 +00001070 igb_set_rx_mode(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001071
1072 igb_restore_vlan(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001073
Alexander Duyck85b430b2009-10-27 15:50:29 +00001074 igb_setup_tctl(adapter);
Alexander Duyck06cf2662009-10-27 15:53:25 +00001075 igb_setup_mrqc(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001076 igb_setup_rctl(adapter);
Alexander Duyck85b430b2009-10-27 15:50:29 +00001077
1078 igb_configure_tx(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001079 igb_configure_rx(adapter);
Alexander Duyck662d7202008-06-27 11:00:29 -07001080
1081 igb_rx_fifo_flush_82575(&adapter->hw);
1082
Alexander Duyckc493ea42009-03-20 00:16:50 +00001083 /* call igb_desc_unused which always leaves
Auke Kok9d5c8242008-01-24 02:22:38 -08001084 * at least 1 descriptor unused to make sure
1085 * next_to_use != next_to_clean */
1086 for (i = 0; i < adapter->num_rx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00001087 struct igb_ring *ring = adapter->rx_ring[i];
Alexander Duyckc493ea42009-03-20 00:16:50 +00001088 igb_alloc_rx_buffers_adv(ring, igb_desc_unused(ring));
Auke Kok9d5c8242008-01-24 02:22:38 -08001089 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001090}
1091
Nick Nunley88a268c2010-02-17 01:01:59 +00001092/**
1093 * igb_power_up_link - Power up the phy/serdes link
1094 * @adapter: address of board private structure
1095 **/
1096void igb_power_up_link(struct igb_adapter *adapter)
1097{
1098 if (adapter->hw.phy.media_type == e1000_media_type_copper)
1099 igb_power_up_phy_copper(&adapter->hw);
1100 else
1101 igb_power_up_serdes_link_82575(&adapter->hw);
1102}
1103
1104/**
1105 * igb_power_down_link - Power down the phy/serdes link
1106 * @adapter: address of board private structure
1107 */
1108static void igb_power_down_link(struct igb_adapter *adapter)
1109{
1110 if (adapter->hw.phy.media_type == e1000_media_type_copper)
1111 igb_power_down_phy_copper_82575(&adapter->hw);
1112 else
1113 igb_shutdown_serdes_link_82575(&adapter->hw);
1114}
Auke Kok9d5c8242008-01-24 02:22:38 -08001115
1116/**
1117 * igb_up - Open the interface and prepare it to handle traffic
1118 * @adapter: board private structure
1119 **/
Auke Kok9d5c8242008-01-24 02:22:38 -08001120int igb_up(struct igb_adapter *adapter)
1121{
1122 struct e1000_hw *hw = &adapter->hw;
1123 int i;
1124
1125 /* hardware has been reset, we need to reload some things */
1126 igb_configure(adapter);
1127
1128 clear_bit(__IGB_DOWN, &adapter->state);
1129
Alexander Duyck047e0032009-10-27 15:49:27 +00001130 for (i = 0; i < adapter->num_q_vectors; i++) {
1131 struct igb_q_vector *q_vector = adapter->q_vector[i];
1132 napi_enable(&q_vector->napi);
1133 }
PJ Waskiewicz844290e2008-06-27 11:00:39 -07001134 if (adapter->msix_entries)
Auke Kok9d5c8242008-01-24 02:22:38 -08001135 igb_configure_msix(adapter);
Alexander Duyckfeeb2722010-02-03 21:59:51 +00001136 else
1137 igb_assign_vector(adapter->q_vector[0], 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08001138
1139 /* Clear any pending interrupts. */
1140 rd32(E1000_ICR);
1141 igb_irq_enable(adapter);
1142
Alexander Duyckd4960302009-10-27 15:53:45 +00001143 /* notify VFs that reset has been completed */
1144 if (adapter->vfs_allocated_count) {
1145 u32 reg_data = rd32(E1000_CTRL_EXT);
1146 reg_data |= E1000_CTRL_EXT_PFRSTD;
1147 wr32(E1000_CTRL_EXT, reg_data);
1148 }
1149
Jesse Brandeburg4cb9be72009-04-21 18:42:05 +00001150 netif_tx_start_all_queues(adapter->netdev);
1151
Alexander Duyck25568a52009-10-27 23:49:59 +00001152 /* start the watchdog. */
1153 hw->mac.get_link_status = 1;
1154 schedule_work(&adapter->watchdog_task);
1155
Auke Kok9d5c8242008-01-24 02:22:38 -08001156 return 0;
1157}
1158
1159void igb_down(struct igb_adapter *adapter)
1160{
Auke Kok9d5c8242008-01-24 02:22:38 -08001161 struct net_device *netdev = adapter->netdev;
Alexander Duyck330a6d62009-10-27 23:51:35 +00001162 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08001163 u32 tctl, rctl;
1164 int i;
1165
1166 /* signal that we're down so the interrupt handler does not
1167 * reschedule our watchdog timer */
1168 set_bit(__IGB_DOWN, &adapter->state);
1169
1170 /* disable receives in the hardware */
1171 rctl = rd32(E1000_RCTL);
1172 wr32(E1000_RCTL, rctl & ~E1000_RCTL_EN);
1173 /* flush and sleep below */
1174
David S. Millerfd2ea0a2008-07-17 01:56:23 -07001175 netif_tx_stop_all_queues(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001176
1177 /* disable transmits in the hardware */
1178 tctl = rd32(E1000_TCTL);
1179 tctl &= ~E1000_TCTL_EN;
1180 wr32(E1000_TCTL, tctl);
1181 /* flush both disables and wait for them to finish */
1182 wrfl();
1183 msleep(10);
1184
Alexander Duyck047e0032009-10-27 15:49:27 +00001185 for (i = 0; i < adapter->num_q_vectors; i++) {
1186 struct igb_q_vector *q_vector = adapter->q_vector[i];
1187 napi_disable(&q_vector->napi);
1188 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001189
Auke Kok9d5c8242008-01-24 02:22:38 -08001190 igb_irq_disable(adapter);
1191
1192 del_timer_sync(&adapter->watchdog_timer);
1193 del_timer_sync(&adapter->phy_info_timer);
1194
Auke Kok9d5c8242008-01-24 02:22:38 -08001195 netif_carrier_off(netdev);
Alexander Duyck04fe6352009-02-06 23:22:32 +00001196
1197 /* record the stats before reset*/
1198 igb_update_stats(adapter);
1199
Auke Kok9d5c8242008-01-24 02:22:38 -08001200 adapter->link_speed = 0;
1201 adapter->link_duplex = 0;
1202
Jeff Kirsher30236822008-06-24 17:01:15 -07001203 if (!pci_channel_offline(adapter->pdev))
1204 igb_reset(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001205 igb_clean_all_tx_rings(adapter);
1206 igb_clean_all_rx_rings(adapter);
Alexander Duyck7e0e99e2009-05-21 13:06:56 +00001207#ifdef CONFIG_IGB_DCA
1208
1209 /* since we reset the hardware DCA settings were cleared */
1210 igb_setup_dca(adapter);
1211#endif
Auke Kok9d5c8242008-01-24 02:22:38 -08001212}
1213
1214void igb_reinit_locked(struct igb_adapter *adapter)
1215{
1216 WARN_ON(in_interrupt());
1217 while (test_and_set_bit(__IGB_RESETTING, &adapter->state))
1218 msleep(1);
1219 igb_down(adapter);
1220 igb_up(adapter);
1221 clear_bit(__IGB_RESETTING, &adapter->state);
1222}
1223
1224void igb_reset(struct igb_adapter *adapter)
1225{
Alexander Duyck090b1792009-10-27 23:51:55 +00001226 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08001227 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck2d064c02008-07-08 15:10:12 -07001228 struct e1000_mac_info *mac = &hw->mac;
1229 struct e1000_fc_info *fc = &hw->fc;
Auke Kok9d5c8242008-01-24 02:22:38 -08001230 u32 pba = 0, tx_space, min_tx_space, min_rx_space;
1231 u16 hwm;
1232
1233 /* Repartition Pba for greater than 9k mtu
1234 * To take effect CTRL.RST is required.
1235 */
Alexander Duyckfa4dfae2009-02-06 23:21:31 +00001236 switch (mac->type) {
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +00001237 case e1000_i350:
Alexander Duyck55cac242009-11-19 12:42:21 +00001238 case e1000_82580:
1239 pba = rd32(E1000_RXPBS);
1240 pba = igb_rxpbs_adjust_82580(pba);
1241 break;
Alexander Duyckfa4dfae2009-02-06 23:21:31 +00001242 case e1000_82576:
Alexander Duyckd249be52009-10-27 23:46:38 +00001243 pba = rd32(E1000_RXPBS);
1244 pba &= E1000_RXPBS_SIZE_MASK_82576;
Alexander Duyckfa4dfae2009-02-06 23:21:31 +00001245 break;
1246 case e1000_82575:
1247 default:
1248 pba = E1000_PBA_34K;
1249 break;
Alexander Duyck2d064c02008-07-08 15:10:12 -07001250 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001251
Alexander Duyck2d064c02008-07-08 15:10:12 -07001252 if ((adapter->max_frame_size > ETH_FRAME_LEN + ETH_FCS_LEN) &&
1253 (mac->type < e1000_82576)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08001254 /* adjust PBA for jumbo frames */
1255 wr32(E1000_PBA, pba);
1256
1257 /* To maintain wire speed transmits, the Tx FIFO should be
1258 * large enough to accommodate two full transmit packets,
1259 * rounded up to the next 1KB and expressed in KB. Likewise,
1260 * the Rx FIFO should be large enough to accommodate at least
1261 * one full receive packet and is similarly rounded up and
1262 * expressed in KB. */
1263 pba = rd32(E1000_PBA);
1264 /* upper 16 bits has Tx packet buffer allocation size in KB */
1265 tx_space = pba >> 16;
1266 /* lower 16 bits has Rx packet buffer allocation size in KB */
1267 pba &= 0xffff;
1268 /* the tx fifo also stores 16 bytes of information about the tx
1269 * but don't include ethernet FCS because hardware appends it */
1270 min_tx_space = (adapter->max_frame_size +
Alexander Duyck85e8d002009-02-16 00:00:20 -08001271 sizeof(union e1000_adv_tx_desc) -
Auke Kok9d5c8242008-01-24 02:22:38 -08001272 ETH_FCS_LEN) * 2;
1273 min_tx_space = ALIGN(min_tx_space, 1024);
1274 min_tx_space >>= 10;
1275 /* software strips receive CRC, so leave room for it */
1276 min_rx_space = adapter->max_frame_size;
1277 min_rx_space = ALIGN(min_rx_space, 1024);
1278 min_rx_space >>= 10;
1279
1280 /* If current Tx allocation is less than the min Tx FIFO size,
1281 * and the min Tx FIFO size is less than the current Rx FIFO
1282 * allocation, take space away from current Rx allocation */
1283 if (tx_space < min_tx_space &&
1284 ((min_tx_space - tx_space) < pba)) {
1285 pba = pba - (min_tx_space - tx_space);
1286
1287 /* if short on rx space, rx wins and must trump tx
1288 * adjustment */
1289 if (pba < min_rx_space)
1290 pba = min_rx_space;
1291 }
Alexander Duyck2d064c02008-07-08 15:10:12 -07001292 wr32(E1000_PBA, pba);
Auke Kok9d5c8242008-01-24 02:22:38 -08001293 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001294
1295 /* flow control settings */
1296 /* The high water mark must be low enough to fit one full frame
1297 * (or the size used for early receive) above it in the Rx FIFO.
1298 * Set it to the lower of:
1299 * - 90% of the Rx FIFO size, or
1300 * - the full Rx FIFO size minus one full frame */
1301 hwm = min(((pba << 10) * 9 / 10),
Alexander Duyck2d064c02008-07-08 15:10:12 -07001302 ((pba << 10) - 2 * adapter->max_frame_size));
Auke Kok9d5c8242008-01-24 02:22:38 -08001303
Alexander Duyckd405ea32009-12-23 13:21:27 +00001304 fc->high_water = hwm & 0xFFF0; /* 16-byte granularity */
1305 fc->low_water = fc->high_water - 16;
Auke Kok9d5c8242008-01-24 02:22:38 -08001306 fc->pause_time = 0xFFFF;
1307 fc->send_xon = 1;
Alexander Duyck0cce1192009-07-23 18:10:24 +00001308 fc->current_mode = fc->requested_mode;
Auke Kok9d5c8242008-01-24 02:22:38 -08001309
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001310 /* disable receive for all VFs and wait one second */
1311 if (adapter->vfs_allocated_count) {
1312 int i;
1313 for (i = 0 ; i < adapter->vfs_allocated_count; i++)
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00001314 adapter->vf_data[i].flags = 0;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001315
1316 /* ping all the active vfs to let them know we are going down */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00001317 igb_ping_all_vfs(adapter);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001318
1319 /* disable transmits and receives */
1320 wr32(E1000_VFRE, 0);
1321 wr32(E1000_VFTE, 0);
1322 }
1323
Auke Kok9d5c8242008-01-24 02:22:38 -08001324 /* Allow time for pending master requests to run */
Alexander Duyck330a6d62009-10-27 23:51:35 +00001325 hw->mac.ops.reset_hw(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001326 wr32(E1000_WUC, 0);
1327
Alexander Duyck330a6d62009-10-27 23:51:35 +00001328 if (hw->mac.ops.init_hw(hw))
Alexander Duyck090b1792009-10-27 23:51:55 +00001329 dev_err(&pdev->dev, "Hardware Error\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08001330
Alexander Duyck55cac242009-11-19 12:42:21 +00001331 if (hw->mac.type == e1000_82580) {
1332 u32 reg = rd32(E1000_PCIEMISC);
1333 wr32(E1000_PCIEMISC,
1334 reg & ~E1000_PCIEMISC_LX_DECISION);
1335 }
Nick Nunley88a268c2010-02-17 01:01:59 +00001336 if (!netif_running(adapter->netdev))
1337 igb_power_down_link(adapter);
1338
Auke Kok9d5c8242008-01-24 02:22:38 -08001339 igb_update_mng_vlan(adapter);
1340
1341 /* Enable h/w to recognize an 802.1Q VLAN Ethernet packet */
1342 wr32(E1000_VET, ETHERNET_IEEE_VLAN_TYPE);
1343
Alexander Duyck330a6d62009-10-27 23:51:35 +00001344 igb_get_phy_info(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001345}
1346
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001347static const struct net_device_ops igb_netdev_ops = {
Alexander Duyck559e9c42009-10-27 23:52:50 +00001348 .ndo_open = igb_open,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001349 .ndo_stop = igb_close,
Stephen Hemminger00829822008-11-20 20:14:53 -08001350 .ndo_start_xmit = igb_xmit_frame_adv,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001351 .ndo_get_stats = igb_get_stats,
Alexander Duyckff41f8d2009-09-03 14:48:56 +00001352 .ndo_set_rx_mode = igb_set_rx_mode,
1353 .ndo_set_multicast_list = igb_set_rx_mode,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001354 .ndo_set_mac_address = igb_set_mac,
1355 .ndo_change_mtu = igb_change_mtu,
1356 .ndo_do_ioctl = igb_ioctl,
1357 .ndo_tx_timeout = igb_tx_timeout,
1358 .ndo_validate_addr = eth_validate_addr,
1359 .ndo_vlan_rx_register = igb_vlan_rx_register,
1360 .ndo_vlan_rx_add_vid = igb_vlan_rx_add_vid,
1361 .ndo_vlan_rx_kill_vid = igb_vlan_rx_kill_vid,
Williams, Mitch A8151d292010-02-10 01:44:24 +00001362 .ndo_set_vf_mac = igb_ndo_set_vf_mac,
1363 .ndo_set_vf_vlan = igb_ndo_set_vf_vlan,
1364 .ndo_set_vf_tx_rate = igb_ndo_set_vf_bw,
1365 .ndo_get_vf_config = igb_ndo_get_vf_config,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001366#ifdef CONFIG_NET_POLL_CONTROLLER
1367 .ndo_poll_controller = igb_netpoll,
1368#endif
1369};
1370
Taku Izumi42bfd332008-06-20 12:10:30 +09001371/**
Auke Kok9d5c8242008-01-24 02:22:38 -08001372 * igb_probe - Device Initialization Routine
1373 * @pdev: PCI device information struct
1374 * @ent: entry in igb_pci_tbl
1375 *
1376 * Returns 0 on success, negative on failure
1377 *
1378 * igb_probe initializes an adapter identified by a pci_dev structure.
1379 * The OS initialization, configuring of the adapter private structure,
1380 * and a hardware reset occur.
1381 **/
1382static int __devinit igb_probe(struct pci_dev *pdev,
1383 const struct pci_device_id *ent)
1384{
1385 struct net_device *netdev;
1386 struct igb_adapter *adapter;
1387 struct e1000_hw *hw;
Alexander Duyck4337e992009-10-27 23:48:31 +00001388 u16 eeprom_data = 0;
1389 static int global_quad_port_a; /* global quad port a indication */
Auke Kok9d5c8242008-01-24 02:22:38 -08001390 const struct e1000_info *ei = igb_info_tbl[ent->driver_data];
1391 unsigned long mmio_start, mmio_len;
David S. Miller2d6a5e92009-03-17 15:01:30 -07001392 int err, pci_using_dac;
Auke Kok9d5c8242008-01-24 02:22:38 -08001393 u16 eeprom_apme_mask = IGB_EEPROM_APME;
1394 u32 part_num;
1395
Alexander Duyckaed5dec2009-02-06 23:16:04 +00001396 err = pci_enable_device_mem(pdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001397 if (err)
1398 return err;
1399
1400 pci_using_dac = 0;
Yang Hongyang6a355282009-04-06 19:01:13 -07001401 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
Auke Kok9d5c8242008-01-24 02:22:38 -08001402 if (!err) {
Yang Hongyang6a355282009-04-06 19:01:13 -07001403 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64));
Auke Kok9d5c8242008-01-24 02:22:38 -08001404 if (!err)
1405 pci_using_dac = 1;
1406 } else {
Yang Hongyang284901a2009-04-06 19:01:15 -07001407 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
Auke Kok9d5c8242008-01-24 02:22:38 -08001408 if (err) {
Yang Hongyang284901a2009-04-06 19:01:15 -07001409 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
Auke Kok9d5c8242008-01-24 02:22:38 -08001410 if (err) {
1411 dev_err(&pdev->dev, "No usable DMA "
1412 "configuration, aborting\n");
1413 goto err_dma;
1414 }
1415 }
1416 }
1417
Alexander Duyckaed5dec2009-02-06 23:16:04 +00001418 err = pci_request_selected_regions(pdev, pci_select_bars(pdev,
1419 IORESOURCE_MEM),
1420 igb_driver_name);
Auke Kok9d5c8242008-01-24 02:22:38 -08001421 if (err)
1422 goto err_pci_reg;
1423
Frans Pop19d5afd2009-10-02 10:04:12 -07001424 pci_enable_pcie_error_reporting(pdev);
Alexander Duyck40a914f2008-11-27 00:24:37 -08001425
Auke Kok9d5c8242008-01-24 02:22:38 -08001426 pci_set_master(pdev);
Auke Kokc682fc22008-04-23 11:09:34 -07001427 pci_save_state(pdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001428
1429 err = -ENOMEM;
Alexander Duyck1bfaf072009-02-19 20:39:23 -08001430 netdev = alloc_etherdev_mq(sizeof(struct igb_adapter),
1431 IGB_ABS_MAX_TX_QUEUES);
Auke Kok9d5c8242008-01-24 02:22:38 -08001432 if (!netdev)
1433 goto err_alloc_etherdev;
1434
1435 SET_NETDEV_DEV(netdev, &pdev->dev);
1436
1437 pci_set_drvdata(pdev, netdev);
1438 adapter = netdev_priv(netdev);
1439 adapter->netdev = netdev;
1440 adapter->pdev = pdev;
1441 hw = &adapter->hw;
1442 hw->back = adapter;
1443 adapter->msg_enable = NETIF_MSG_DRV | NETIF_MSG_PROBE;
1444
1445 mmio_start = pci_resource_start(pdev, 0);
1446 mmio_len = pci_resource_len(pdev, 0);
1447
1448 err = -EIO;
Alexander Duyck28b07592009-02-06 23:20:31 +00001449 hw->hw_addr = ioremap(mmio_start, mmio_len);
1450 if (!hw->hw_addr)
Auke Kok9d5c8242008-01-24 02:22:38 -08001451 goto err_ioremap;
1452
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001453 netdev->netdev_ops = &igb_netdev_ops;
Auke Kok9d5c8242008-01-24 02:22:38 -08001454 igb_set_ethtool_ops(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001455 netdev->watchdog_timeo = 5 * HZ;
Auke Kok9d5c8242008-01-24 02:22:38 -08001456
1457 strncpy(netdev->name, pci_name(pdev), sizeof(netdev->name) - 1);
1458
1459 netdev->mem_start = mmio_start;
1460 netdev->mem_end = mmio_start + mmio_len;
1461
Auke Kok9d5c8242008-01-24 02:22:38 -08001462 /* PCI config space info */
1463 hw->vendor_id = pdev->vendor;
1464 hw->device_id = pdev->device;
1465 hw->revision_id = pdev->revision;
1466 hw->subsystem_vendor_id = pdev->subsystem_vendor;
1467 hw->subsystem_device_id = pdev->subsystem_device;
1468
Auke Kok9d5c8242008-01-24 02:22:38 -08001469 /* Copy the default MAC, PHY and NVM function pointers */
1470 memcpy(&hw->mac.ops, ei->mac_ops, sizeof(hw->mac.ops));
1471 memcpy(&hw->phy.ops, ei->phy_ops, sizeof(hw->phy.ops));
1472 memcpy(&hw->nvm.ops, ei->nvm_ops, sizeof(hw->nvm.ops));
1473 /* Initialize skew-specific constants */
1474 err = ei->get_invariants(hw);
1475 if (err)
Alexander Duyck450c87c2009-02-06 23:22:11 +00001476 goto err_sw_init;
Auke Kok9d5c8242008-01-24 02:22:38 -08001477
Alexander Duyck450c87c2009-02-06 23:22:11 +00001478 /* setup the private structure */
Auke Kok9d5c8242008-01-24 02:22:38 -08001479 err = igb_sw_init(adapter);
1480 if (err)
1481 goto err_sw_init;
1482
1483 igb_get_bus_info_pcie(hw);
1484
1485 hw->phy.autoneg_wait_to_complete = false;
Auke Kok9d5c8242008-01-24 02:22:38 -08001486
1487 /* Copper options */
1488 if (hw->phy.media_type == e1000_media_type_copper) {
1489 hw->phy.mdix = AUTO_ALL_MODES;
1490 hw->phy.disable_polarity_correction = false;
1491 hw->phy.ms_type = e1000_ms_hw_default;
1492 }
1493
1494 if (igb_check_reset_block(hw))
1495 dev_info(&pdev->dev,
1496 "PHY reset is blocked due to SOL/IDER session.\n");
1497
1498 netdev->features = NETIF_F_SG |
Alexander Duyck7d8eb292009-02-06 23:18:27 +00001499 NETIF_F_IP_CSUM |
Auke Kok9d5c8242008-01-24 02:22:38 -08001500 NETIF_F_HW_VLAN_TX |
1501 NETIF_F_HW_VLAN_RX |
1502 NETIF_F_HW_VLAN_FILTER;
1503
Alexander Duyck7d8eb292009-02-06 23:18:27 +00001504 netdev->features |= NETIF_F_IPV6_CSUM;
Auke Kok9d5c8242008-01-24 02:22:38 -08001505 netdev->features |= NETIF_F_TSO;
Auke Kok9d5c8242008-01-24 02:22:38 -08001506 netdev->features |= NETIF_F_TSO6;
Herbert Xu5c0999b2009-01-19 15:20:57 -08001507 netdev->features |= NETIF_F_GRO;
Alexander Duyckd3352522008-07-08 15:12:13 -07001508
Jeff Kirsher48f29ff2008-06-05 04:06:27 -07001509 netdev->vlan_features |= NETIF_F_TSO;
1510 netdev->vlan_features |= NETIF_F_TSO6;
Alexander Duyck7d8eb292009-02-06 23:18:27 +00001511 netdev->vlan_features |= NETIF_F_IP_CSUM;
Alexander Duyckcd1da502009-08-25 04:47:50 +00001512 netdev->vlan_features |= NETIF_F_IPV6_CSUM;
Jeff Kirsher48f29ff2008-06-05 04:06:27 -07001513 netdev->vlan_features |= NETIF_F_SG;
1514
Auke Kok9d5c8242008-01-24 02:22:38 -08001515 if (pci_using_dac)
1516 netdev->features |= NETIF_F_HIGHDMA;
1517
Alexander Duyck5b043fb2009-10-27 23:52:31 +00001518 if (hw->mac.type >= e1000_82576)
Jesse Brandeburgb9473562009-04-27 22:36:13 +00001519 netdev->features |= NETIF_F_SCTP_CSUM;
1520
Alexander Duyck330a6d62009-10-27 23:51:35 +00001521 adapter->en_mng_pt = igb_enable_mng_pass_thru(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001522
1523 /* before reading the NVM, reset the controller to put the device in a
1524 * known good starting state */
1525 hw->mac.ops.reset_hw(hw);
1526
1527 /* make sure the NVM is good */
1528 if (igb_validate_nvm_checksum(hw) < 0) {
1529 dev_err(&pdev->dev, "The NVM Checksum Is Not Valid\n");
1530 err = -EIO;
1531 goto err_eeprom;
1532 }
1533
1534 /* copy the MAC address out of the NVM */
1535 if (hw->mac.ops.read_mac_addr(hw))
1536 dev_err(&pdev->dev, "NVM Read Error\n");
1537
1538 memcpy(netdev->dev_addr, hw->mac.addr, netdev->addr_len);
1539 memcpy(netdev->perm_addr, hw->mac.addr, netdev->addr_len);
1540
1541 if (!is_valid_ether_addr(netdev->perm_addr)) {
1542 dev_err(&pdev->dev, "Invalid MAC Address\n");
1543 err = -EIO;
1544 goto err_eeprom;
1545 }
1546
Alexander Duyck0e340482009-03-20 00:17:08 +00001547 setup_timer(&adapter->watchdog_timer, &igb_watchdog,
1548 (unsigned long) adapter);
1549 setup_timer(&adapter->phy_info_timer, &igb_update_phy_info,
1550 (unsigned long) adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001551
1552 INIT_WORK(&adapter->reset_task, igb_reset_task);
1553 INIT_WORK(&adapter->watchdog_task, igb_watchdog_task);
1554
Alexander Duyck450c87c2009-02-06 23:22:11 +00001555 /* Initialize link properties that are user-changeable */
Auke Kok9d5c8242008-01-24 02:22:38 -08001556 adapter->fc_autoneg = true;
1557 hw->mac.autoneg = true;
1558 hw->phy.autoneg_advertised = 0x2f;
1559
Alexander Duyck0cce1192009-07-23 18:10:24 +00001560 hw->fc.requested_mode = e1000_fc_default;
1561 hw->fc.current_mode = e1000_fc_default;
Auke Kok9d5c8242008-01-24 02:22:38 -08001562
Auke Kok9d5c8242008-01-24 02:22:38 -08001563 igb_validate_mdi_setting(hw);
1564
Auke Kok9d5c8242008-01-24 02:22:38 -08001565 /* Initial Wake on LAN setting If APM wake is enabled in the EEPROM,
1566 * enable the ACPI Magic Packet filter
1567 */
1568
Alexander Duycka2cf8b62009-03-13 20:41:17 +00001569 if (hw->bus.func == 0)
Alexander Duyck312c75a2009-02-06 23:17:47 +00001570 hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_A, 1, &eeprom_data);
Alexander Duyck55cac242009-11-19 12:42:21 +00001571 else if (hw->mac.type == e1000_82580)
1572 hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_A +
1573 NVM_82580_LAN_FUNC_OFFSET(hw->bus.func), 1,
1574 &eeprom_data);
Alexander Duycka2cf8b62009-03-13 20:41:17 +00001575 else if (hw->bus.func == 1)
1576 hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_B, 1, &eeprom_data);
Auke Kok9d5c8242008-01-24 02:22:38 -08001577
1578 if (eeprom_data & eeprom_apme_mask)
1579 adapter->eeprom_wol |= E1000_WUFC_MAG;
1580
1581 /* now that we have the eeprom settings, apply the special cases where
1582 * the eeprom may be wrong or the board simply won't support wake on
1583 * lan on a particular port */
1584 switch (pdev->device) {
1585 case E1000_DEV_ID_82575GB_QUAD_COPPER:
1586 adapter->eeprom_wol = 0;
1587 break;
1588 case E1000_DEV_ID_82575EB_FIBER_SERDES:
Alexander Duyck2d064c02008-07-08 15:10:12 -07001589 case E1000_DEV_ID_82576_FIBER:
1590 case E1000_DEV_ID_82576_SERDES:
Auke Kok9d5c8242008-01-24 02:22:38 -08001591 /* Wake events only supported on port A for dual fiber
1592 * regardless of eeprom setting */
1593 if (rd32(E1000_STATUS) & E1000_STATUS_FUNC_1)
1594 adapter->eeprom_wol = 0;
1595 break;
Alexander Duyckc8ea5ea2009-03-13 20:42:35 +00001596 case E1000_DEV_ID_82576_QUAD_COPPER:
Stefan Assmannd5aa2252010-04-09 09:51:34 +00001597 case E1000_DEV_ID_82576_QUAD_COPPER_ET2:
Alexander Duyckc8ea5ea2009-03-13 20:42:35 +00001598 /* if quad port adapter, disable WoL on all but port A */
1599 if (global_quad_port_a != 0)
1600 adapter->eeprom_wol = 0;
1601 else
1602 adapter->flags |= IGB_FLAG_QUAD_PORT_A;
1603 /* Reset for multiple quad port adapters */
1604 if (++global_quad_port_a == 4)
1605 global_quad_port_a = 0;
1606 break;
Auke Kok9d5c8242008-01-24 02:22:38 -08001607 }
1608
1609 /* initialize the wol settings based on the eeprom settings */
1610 adapter->wol = adapter->eeprom_wol;
\"Rafael J. Wysocki\e1b86d82008-11-07 20:30:37 +00001611 device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);
Auke Kok9d5c8242008-01-24 02:22:38 -08001612
1613 /* reset the hardware with the new settings */
1614 igb_reset(adapter);
1615
1616 /* let the f/w know that the h/w is now under the control of the
1617 * driver. */
1618 igb_get_hw_control(adapter);
1619
Auke Kok9d5c8242008-01-24 02:22:38 -08001620 strcpy(netdev->name, "eth%d");
1621 err = register_netdev(netdev);
1622 if (err)
1623 goto err_register;
1624
Jesse Brandeburgb168dfc2009-04-17 20:44:32 +00001625 /* carrier off reporting is important to ethtool even BEFORE open */
1626 netif_carrier_off(netdev);
1627
Jeff Kirsher421e02f2008-10-17 11:08:31 -07001628#ifdef CONFIG_IGB_DCA
Alexander Duyckbbd98fe2009-01-31 00:52:30 -08001629 if (dca_add_requester(&pdev->dev) == 0) {
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001630 adapter->flags |= IGB_FLAG_DCA_ENABLED;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001631 dev_info(&pdev->dev, "DCA enabled\n");
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001632 igb_setup_dca(adapter);
1633 }
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00001634
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001635#endif
Auke Kok9d5c8242008-01-24 02:22:38 -08001636 dev_info(&pdev->dev, "Intel(R) Gigabit Ethernet Network Connection\n");
1637 /* print bus type/speed/width info */
Johannes Berg7c510e42008-10-27 17:47:26 -07001638 dev_info(&pdev->dev, "%s: (PCIe:%s:%s) %pM\n",
Auke Kok9d5c8242008-01-24 02:22:38 -08001639 netdev->name,
Alexander Duyck559e9c42009-10-27 23:52:50 +00001640 ((hw->bus.speed == e1000_bus_speed_2500) ? "2.5Gb/s" :
Alexander Duyckff846f52010-04-27 01:02:40 +00001641 (hw->bus.speed == e1000_bus_speed_5000) ? "5.0Gb/s" :
Alexander Duyck559e9c42009-10-27 23:52:50 +00001642 "unknown"),
Alexander Duyck59c3de82009-03-31 20:38:00 +00001643 ((hw->bus.width == e1000_bus_width_pcie_x4) ? "Width x4" :
1644 (hw->bus.width == e1000_bus_width_pcie_x2) ? "Width x2" :
1645 (hw->bus.width == e1000_bus_width_pcie_x1) ? "Width x1" :
1646 "unknown"),
Johannes Berg7c510e42008-10-27 17:47:26 -07001647 netdev->dev_addr);
Auke Kok9d5c8242008-01-24 02:22:38 -08001648
1649 igb_read_part_num(hw, &part_num);
1650 dev_info(&pdev->dev, "%s: PBA No: %06x-%03x\n", netdev->name,
1651 (part_num >> 8), (part_num & 0xff));
1652
1653 dev_info(&pdev->dev,
1654 "Using %s interrupts. %d rx queue(s), %d tx queue(s)\n",
1655 adapter->msix_entries ? "MSI-X" :
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001656 (adapter->flags & IGB_FLAG_HAS_MSI) ? "MSI" : "legacy",
Auke Kok9d5c8242008-01-24 02:22:38 -08001657 adapter->num_rx_queues, adapter->num_tx_queues);
1658
Auke Kok9d5c8242008-01-24 02:22:38 -08001659 return 0;
1660
1661err_register:
1662 igb_release_hw_control(adapter);
1663err_eeprom:
1664 if (!igb_check_reset_block(hw))
Alexander Duyckf5f4cf02008-11-21 21:30:24 -08001665 igb_reset_phy(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001666
1667 if (hw->flash_address)
1668 iounmap(hw->flash_address);
Auke Kok9d5c8242008-01-24 02:22:38 -08001669err_sw_init:
Alexander Duyck047e0032009-10-27 15:49:27 +00001670 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001671 iounmap(hw->hw_addr);
1672err_ioremap:
1673 free_netdev(netdev);
1674err_alloc_etherdev:
Alexander Duyck559e9c42009-10-27 23:52:50 +00001675 pci_release_selected_regions(pdev,
1676 pci_select_bars(pdev, IORESOURCE_MEM));
Auke Kok9d5c8242008-01-24 02:22:38 -08001677err_pci_reg:
1678err_dma:
1679 pci_disable_device(pdev);
1680 return err;
1681}
1682
1683/**
1684 * igb_remove - Device Removal Routine
1685 * @pdev: PCI device information struct
1686 *
1687 * igb_remove is called by the PCI subsystem to alert the driver
1688 * that it should release a PCI device. The could be caused by a
1689 * Hot-Plug event, or because the driver is going to be removed from
1690 * memory.
1691 **/
1692static void __devexit igb_remove(struct pci_dev *pdev)
1693{
1694 struct net_device *netdev = pci_get_drvdata(pdev);
1695 struct igb_adapter *adapter = netdev_priv(netdev);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001696 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08001697
1698 /* flush_scheduled work may reschedule our watchdog task, so
1699 * explicitly disable watchdog tasks from being rescheduled */
1700 set_bit(__IGB_DOWN, &adapter->state);
1701 del_timer_sync(&adapter->watchdog_timer);
1702 del_timer_sync(&adapter->phy_info_timer);
1703
1704 flush_scheduled_work();
1705
Jeff Kirsher421e02f2008-10-17 11:08:31 -07001706#ifdef CONFIG_IGB_DCA
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001707 if (adapter->flags & IGB_FLAG_DCA_ENABLED) {
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001708 dev_info(&pdev->dev, "DCA disabled\n");
1709 dca_remove_requester(&pdev->dev);
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001710 adapter->flags &= ~IGB_FLAG_DCA_ENABLED;
Alexander Duyckcbd347a2009-02-15 23:59:44 -08001711 wr32(E1000_DCA_CTRL, E1000_DCA_CTRL_DCA_MODE_DISABLE);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001712 }
1713#endif
1714
Auke Kok9d5c8242008-01-24 02:22:38 -08001715 /* Release control of h/w to f/w. If f/w is AMT enabled, this
1716 * would have already happened in close and is redundant. */
1717 igb_release_hw_control(adapter);
1718
1719 unregister_netdev(netdev);
1720
Alexander Duyck047e0032009-10-27 15:49:27 +00001721 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001722
Alexander Duyck37680112009-02-19 20:40:30 -08001723#ifdef CONFIG_PCI_IOV
1724 /* reclaim resources allocated to VFs */
1725 if (adapter->vf_data) {
1726 /* disable iov and allow time for transactions to clear */
1727 pci_disable_sriov(pdev);
1728 msleep(500);
1729
1730 kfree(adapter->vf_data);
1731 adapter->vf_data = NULL;
1732 wr32(E1000_IOVCTL, E1000_IOVCTL_REUSE_VFQ);
1733 msleep(100);
1734 dev_info(&pdev->dev, "IOV Disabled\n");
1735 }
1736#endif
Alexander Duyck559e9c42009-10-27 23:52:50 +00001737
Alexander Duyck28b07592009-02-06 23:20:31 +00001738 iounmap(hw->hw_addr);
1739 if (hw->flash_address)
1740 iounmap(hw->flash_address);
Alexander Duyck559e9c42009-10-27 23:52:50 +00001741 pci_release_selected_regions(pdev,
1742 pci_select_bars(pdev, IORESOURCE_MEM));
Auke Kok9d5c8242008-01-24 02:22:38 -08001743
1744 free_netdev(netdev);
1745
Frans Pop19d5afd2009-10-02 10:04:12 -07001746 pci_disable_pcie_error_reporting(pdev);
Alexander Duyck40a914f2008-11-27 00:24:37 -08001747
Auke Kok9d5c8242008-01-24 02:22:38 -08001748 pci_disable_device(pdev);
1749}
1750
1751/**
Alexander Duycka6b623e2009-10-27 23:47:53 +00001752 * igb_probe_vfs - Initialize vf data storage and add VFs to pci config space
1753 * @adapter: board private structure to initialize
1754 *
1755 * This function initializes the vf specific data storage and then attempts to
1756 * allocate the VFs. The reason for ordering it this way is because it is much
1757 * mor expensive time wise to disable SR-IOV than it is to allocate and free
1758 * the memory for the VFs.
1759 **/
1760static void __devinit igb_probe_vfs(struct igb_adapter * adapter)
1761{
1762#ifdef CONFIG_PCI_IOV
1763 struct pci_dev *pdev = adapter->pdev;
1764
1765 if (adapter->vfs_allocated_count > 7)
1766 adapter->vfs_allocated_count = 7;
1767
1768 if (adapter->vfs_allocated_count) {
1769 adapter->vf_data = kcalloc(adapter->vfs_allocated_count,
1770 sizeof(struct vf_data_storage),
1771 GFP_KERNEL);
1772 /* if allocation failed then we do not support SR-IOV */
1773 if (!adapter->vf_data) {
1774 adapter->vfs_allocated_count = 0;
1775 dev_err(&pdev->dev, "Unable to allocate memory for VF "
1776 "Data Storage\n");
1777 }
1778 }
1779
1780 if (pci_enable_sriov(pdev, adapter->vfs_allocated_count)) {
1781 kfree(adapter->vf_data);
1782 adapter->vf_data = NULL;
1783#endif /* CONFIG_PCI_IOV */
1784 adapter->vfs_allocated_count = 0;
1785#ifdef CONFIG_PCI_IOV
1786 } else {
1787 unsigned char mac_addr[ETH_ALEN];
1788 int i;
1789 dev_info(&pdev->dev, "%d vfs allocated\n",
1790 adapter->vfs_allocated_count);
1791 for (i = 0; i < adapter->vfs_allocated_count; i++) {
1792 random_ether_addr(mac_addr);
1793 igb_set_vf_mac(adapter, i, mac_addr);
1794 }
1795 }
1796#endif /* CONFIG_PCI_IOV */
1797}
1798
Alexander Duyck115f4592009-11-12 18:37:00 +00001799
1800/**
1801 * igb_init_hw_timer - Initialize hardware timer used with IEEE 1588 timestamp
1802 * @adapter: board private structure to initialize
1803 *
1804 * igb_init_hw_timer initializes the function pointer and values for the hw
1805 * timer found in hardware.
1806 **/
1807static void igb_init_hw_timer(struct igb_adapter *adapter)
1808{
1809 struct e1000_hw *hw = &adapter->hw;
1810
1811 switch (hw->mac.type) {
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +00001812 case e1000_i350:
Alexander Duyck55cac242009-11-19 12:42:21 +00001813 case e1000_82580:
1814 memset(&adapter->cycles, 0, sizeof(adapter->cycles));
1815 adapter->cycles.read = igb_read_clock;
1816 adapter->cycles.mask = CLOCKSOURCE_MASK(64);
1817 adapter->cycles.mult = 1;
1818 /*
1819 * The 82580 timesync updates the system timer every 8ns by 8ns
1820 * and the value cannot be shifted. Instead we need to shift
1821 * the registers to generate a 64bit timer value. As a result
1822 * SYSTIMR/L/H, TXSTMPL/H, RXSTMPL/H all have to be shifted by
1823 * 24 in order to generate a larger value for synchronization.
1824 */
1825 adapter->cycles.shift = IGB_82580_TSYNC_SHIFT;
1826 /* disable system timer temporarily by setting bit 31 */
1827 wr32(E1000_TSAUXC, 0x80000000);
1828 wrfl();
1829
1830 /* Set registers so that rollover occurs soon to test this. */
1831 wr32(E1000_SYSTIMR, 0x00000000);
1832 wr32(E1000_SYSTIML, 0x80000000);
1833 wr32(E1000_SYSTIMH, 0x000000FF);
1834 wrfl();
1835
1836 /* enable system timer by clearing bit 31 */
1837 wr32(E1000_TSAUXC, 0x0);
1838 wrfl();
1839
1840 timecounter_init(&adapter->clock,
1841 &adapter->cycles,
1842 ktime_to_ns(ktime_get_real()));
1843 /*
1844 * Synchronize our NIC clock against system wall clock. NIC
1845 * time stamp reading requires ~3us per sample, each sample
1846 * was pretty stable even under load => only require 10
1847 * samples for each offset comparison.
1848 */
1849 memset(&adapter->compare, 0, sizeof(adapter->compare));
1850 adapter->compare.source = &adapter->clock;
1851 adapter->compare.target = ktime_get_real;
1852 adapter->compare.num_samples = 10;
1853 timecompare_update(&adapter->compare, 0);
1854 break;
Alexander Duyck115f4592009-11-12 18:37:00 +00001855 case e1000_82576:
1856 /*
1857 * Initialize hardware timer: we keep it running just in case
1858 * that some program needs it later on.
1859 */
1860 memset(&adapter->cycles, 0, sizeof(adapter->cycles));
1861 adapter->cycles.read = igb_read_clock;
1862 adapter->cycles.mask = CLOCKSOURCE_MASK(64);
1863 adapter->cycles.mult = 1;
1864 /**
1865 * Scale the NIC clock cycle by a large factor so that
1866 * relatively small clock corrections can be added or
1867 * substracted at each clock tick. The drawbacks of a large
1868 * factor are a) that the clock register overflows more quickly
1869 * (not such a big deal) and b) that the increment per tick has
1870 * to fit into 24 bits. As a result we need to use a shift of
1871 * 19 so we can fit a value of 16 into the TIMINCA register.
1872 */
1873 adapter->cycles.shift = IGB_82576_TSYNC_SHIFT;
1874 wr32(E1000_TIMINCA,
1875 (1 << E1000_TIMINCA_16NS_SHIFT) |
1876 (16 << IGB_82576_TSYNC_SHIFT));
1877
1878 /* Set registers so that rollover occurs soon to test this. */
1879 wr32(E1000_SYSTIML, 0x00000000);
1880 wr32(E1000_SYSTIMH, 0xFF800000);
1881 wrfl();
1882
1883 timecounter_init(&adapter->clock,
1884 &adapter->cycles,
1885 ktime_to_ns(ktime_get_real()));
1886 /*
1887 * Synchronize our NIC clock against system wall clock. NIC
1888 * time stamp reading requires ~3us per sample, each sample
1889 * was pretty stable even under load => only require 10
1890 * samples for each offset comparison.
1891 */
1892 memset(&adapter->compare, 0, sizeof(adapter->compare));
1893 adapter->compare.source = &adapter->clock;
1894 adapter->compare.target = ktime_get_real;
1895 adapter->compare.num_samples = 10;
1896 timecompare_update(&adapter->compare, 0);
1897 break;
1898 case e1000_82575:
1899 /* 82575 does not support timesync */
1900 default:
1901 break;
1902 }
1903
1904}
1905
Alexander Duycka6b623e2009-10-27 23:47:53 +00001906/**
Auke Kok9d5c8242008-01-24 02:22:38 -08001907 * igb_sw_init - Initialize general software structures (struct igb_adapter)
1908 * @adapter: board private structure to initialize
1909 *
1910 * igb_sw_init initializes the Adapter private data structure.
1911 * Fields are initialized based on PCI device information and
1912 * OS network device settings (MTU size).
1913 **/
1914static int __devinit igb_sw_init(struct igb_adapter *adapter)
1915{
1916 struct e1000_hw *hw = &adapter->hw;
1917 struct net_device *netdev = adapter->netdev;
1918 struct pci_dev *pdev = adapter->pdev;
1919
1920 pci_read_config_word(pdev, PCI_COMMAND, &hw->bus.pci_cmd_word);
1921
Alexander Duyck68fd9912008-11-20 00:48:10 -08001922 adapter->tx_ring_count = IGB_DEFAULT_TXD;
1923 adapter->rx_ring_count = IGB_DEFAULT_RXD;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +00001924 adapter->rx_itr_setting = IGB_DEFAULT_ITR;
1925 adapter->tx_itr_setting = IGB_DEFAULT_ITR;
1926
Auke Kok9d5c8242008-01-24 02:22:38 -08001927 adapter->max_frame_size = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
1928 adapter->min_frame_size = ETH_ZLEN + ETH_FCS_LEN;
1929
Alexander Duycka6b623e2009-10-27 23:47:53 +00001930#ifdef CONFIG_PCI_IOV
1931 if (hw->mac.type == e1000_82576)
1932 adapter->vfs_allocated_count = max_vfs;
1933
1934#endif /* CONFIG_PCI_IOV */
Alexander Duycka99955f2009-11-12 18:37:19 +00001935 adapter->rss_queues = min_t(u32, IGB_MAX_RX_QUEUES, num_online_cpus());
1936
1937 /*
1938 * if rss_queues > 4 or vfs are going to be allocated with rss_queues
1939 * then we should combine the queues into a queue pair in order to
1940 * conserve interrupts due to limited supply
1941 */
1942 if ((adapter->rss_queues > 4) ||
1943 ((adapter->rss_queues > 1) && (adapter->vfs_allocated_count > 6)))
1944 adapter->flags |= IGB_FLAG_QUEUE_PAIRS;
1945
Alexander Duycka6b623e2009-10-27 23:47:53 +00001946 /* This call may decrease the number of queues */
Alexander Duyck047e0032009-10-27 15:49:27 +00001947 if (igb_init_interrupt_scheme(adapter)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08001948 dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
1949 return -ENOMEM;
1950 }
1951
Alexander Duyck115f4592009-11-12 18:37:00 +00001952 igb_init_hw_timer(adapter);
Alexander Duycka6b623e2009-10-27 23:47:53 +00001953 igb_probe_vfs(adapter);
1954
Auke Kok9d5c8242008-01-24 02:22:38 -08001955 /* Explicitly disable IRQ since the NIC can be in any state. */
1956 igb_irq_disable(adapter);
1957
1958 set_bit(__IGB_DOWN, &adapter->state);
1959 return 0;
1960}
1961
1962/**
1963 * igb_open - Called when a network interface is made active
1964 * @netdev: network interface device structure
1965 *
1966 * Returns 0 on success, negative value on failure
1967 *
1968 * The open entry point is called when a network interface is made
1969 * active by the system (IFF_UP). At this point all resources needed
1970 * for transmit and receive operations are allocated, the interrupt
1971 * handler is registered with the OS, the watchdog timer is started,
1972 * and the stack is notified that the interface is ready.
1973 **/
1974static int igb_open(struct net_device *netdev)
1975{
1976 struct igb_adapter *adapter = netdev_priv(netdev);
1977 struct e1000_hw *hw = &adapter->hw;
1978 int err;
1979 int i;
1980
1981 /* disallow open during test */
1982 if (test_bit(__IGB_TESTING, &adapter->state))
1983 return -EBUSY;
1984
Jesse Brandeburgb168dfc2009-04-17 20:44:32 +00001985 netif_carrier_off(netdev);
1986
Auke Kok9d5c8242008-01-24 02:22:38 -08001987 /* allocate transmit descriptors */
1988 err = igb_setup_all_tx_resources(adapter);
1989 if (err)
1990 goto err_setup_tx;
1991
1992 /* allocate receive descriptors */
1993 err = igb_setup_all_rx_resources(adapter);
1994 if (err)
1995 goto err_setup_rx;
1996
Nick Nunley88a268c2010-02-17 01:01:59 +00001997 igb_power_up_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001998
Auke Kok9d5c8242008-01-24 02:22:38 -08001999 /* before we allocate an interrupt, we must be ready to handle it.
2000 * Setting DEBUG_SHIRQ in the kernel makes it fire an interrupt
2001 * as soon as we call pci_request_irq, so we have to setup our
2002 * clean_rx handler before we do so. */
2003 igb_configure(adapter);
2004
2005 err = igb_request_irq(adapter);
2006 if (err)
2007 goto err_req_irq;
2008
2009 /* From here on the code is the same as igb_up() */
2010 clear_bit(__IGB_DOWN, &adapter->state);
2011
Alexander Duyck047e0032009-10-27 15:49:27 +00002012 for (i = 0; i < adapter->num_q_vectors; i++) {
2013 struct igb_q_vector *q_vector = adapter->q_vector[i];
2014 napi_enable(&q_vector->napi);
2015 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002016
2017 /* Clear any pending interrupts. */
2018 rd32(E1000_ICR);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07002019
2020 igb_irq_enable(adapter);
2021
Alexander Duyckd4960302009-10-27 15:53:45 +00002022 /* notify VFs that reset has been completed */
2023 if (adapter->vfs_allocated_count) {
2024 u32 reg_data = rd32(E1000_CTRL_EXT);
2025 reg_data |= E1000_CTRL_EXT_PFRSTD;
2026 wr32(E1000_CTRL_EXT, reg_data);
2027 }
2028
Jeff Kirsherd55b53f2008-07-18 04:33:03 -07002029 netif_tx_start_all_queues(netdev);
2030
Alexander Duyck25568a52009-10-27 23:49:59 +00002031 /* start the watchdog. */
2032 hw->mac.get_link_status = 1;
2033 schedule_work(&adapter->watchdog_task);
Auke Kok9d5c8242008-01-24 02:22:38 -08002034
2035 return 0;
2036
2037err_req_irq:
2038 igb_release_hw_control(adapter);
Nick Nunley88a268c2010-02-17 01:01:59 +00002039 igb_power_down_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08002040 igb_free_all_rx_resources(adapter);
2041err_setup_rx:
2042 igb_free_all_tx_resources(adapter);
2043err_setup_tx:
2044 igb_reset(adapter);
2045
2046 return err;
2047}
2048
2049/**
2050 * igb_close - Disables a network interface
2051 * @netdev: network interface device structure
2052 *
2053 * Returns 0, this is not allowed to fail
2054 *
2055 * The close entry point is called when an interface is de-activated
2056 * by the OS. The hardware is still under the driver's control, but
2057 * needs to be disabled. A global MAC reset is issued to stop the
2058 * hardware, and all transmit and receive resources are freed.
2059 **/
2060static int igb_close(struct net_device *netdev)
2061{
2062 struct igb_adapter *adapter = netdev_priv(netdev);
2063
2064 WARN_ON(test_bit(__IGB_RESETTING, &adapter->state));
2065 igb_down(adapter);
2066
2067 igb_free_irq(adapter);
2068
2069 igb_free_all_tx_resources(adapter);
2070 igb_free_all_rx_resources(adapter);
2071
Auke Kok9d5c8242008-01-24 02:22:38 -08002072 return 0;
2073}
2074
2075/**
2076 * igb_setup_tx_resources - allocate Tx resources (Descriptors)
Auke Kok9d5c8242008-01-24 02:22:38 -08002077 * @tx_ring: tx descriptor ring (for a specific queue) to setup
2078 *
2079 * Return 0 on success, negative on failure
2080 **/
Alexander Duyck80785292009-10-27 15:51:47 +00002081int igb_setup_tx_resources(struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002082{
Alexander Duyck80785292009-10-27 15:51:47 +00002083 struct pci_dev *pdev = tx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002084 int size;
2085
2086 size = sizeof(struct igb_buffer) * tx_ring->count;
2087 tx_ring->buffer_info = vmalloc(size);
2088 if (!tx_ring->buffer_info)
2089 goto err;
2090 memset(tx_ring->buffer_info, 0, size);
2091
2092 /* round up to nearest 4K */
Alexander Duyck85e8d002009-02-16 00:00:20 -08002093 tx_ring->size = tx_ring->count * sizeof(union e1000_adv_tx_desc);
Auke Kok9d5c8242008-01-24 02:22:38 -08002094 tx_ring->size = ALIGN(tx_ring->size, 4096);
2095
Alexander Duyck439705e2009-10-27 23:49:20 +00002096 tx_ring->desc = pci_alloc_consistent(pdev,
2097 tx_ring->size,
Auke Kok9d5c8242008-01-24 02:22:38 -08002098 &tx_ring->dma);
2099
2100 if (!tx_ring->desc)
2101 goto err;
2102
Auke Kok9d5c8242008-01-24 02:22:38 -08002103 tx_ring->next_to_use = 0;
2104 tx_ring->next_to_clean = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002105 return 0;
2106
2107err:
2108 vfree(tx_ring->buffer_info);
Alexander Duyck047e0032009-10-27 15:49:27 +00002109 dev_err(&pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08002110 "Unable to allocate memory for the transmit descriptor ring\n");
2111 return -ENOMEM;
2112}
2113
2114/**
2115 * igb_setup_all_tx_resources - wrapper to allocate Tx resources
2116 * (Descriptors) for all queues
2117 * @adapter: board private structure
2118 *
2119 * Return 0 on success, negative on failure
2120 **/
2121static int igb_setup_all_tx_resources(struct igb_adapter *adapter)
2122{
Alexander Duyck439705e2009-10-27 23:49:20 +00002123 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002124 int i, err = 0;
2125
2126 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00002127 err = igb_setup_tx_resources(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002128 if (err) {
Alexander Duyck439705e2009-10-27 23:49:20 +00002129 dev_err(&pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08002130 "Allocation for Tx Queue %u failed\n", i);
2131 for (i--; i >= 0; i--)
Alexander Duyck3025a442010-02-17 01:02:39 +00002132 igb_free_tx_resources(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002133 break;
2134 }
2135 }
2136
Alexander Duycka99955f2009-11-12 18:37:19 +00002137 for (i = 0; i < IGB_ABS_MAX_TX_QUEUES; i++) {
Alexander Duyck439705e2009-10-27 23:49:20 +00002138 int r_idx = i % adapter->num_tx_queues;
Alexander Duyck3025a442010-02-17 01:02:39 +00002139 adapter->multi_tx_table[i] = adapter->tx_ring[r_idx];
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00002140 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002141 return err;
2142}
2143
2144/**
Alexander Duyck85b430b2009-10-27 15:50:29 +00002145 * igb_setup_tctl - configure the transmit control registers
2146 * @adapter: Board private structure
Auke Kok9d5c8242008-01-24 02:22:38 -08002147 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002148void igb_setup_tctl(struct igb_adapter *adapter)
Auke Kok9d5c8242008-01-24 02:22:38 -08002149{
Auke Kok9d5c8242008-01-24 02:22:38 -08002150 struct e1000_hw *hw = &adapter->hw;
2151 u32 tctl;
Auke Kok9d5c8242008-01-24 02:22:38 -08002152
Alexander Duyck85b430b2009-10-27 15:50:29 +00002153 /* disable queue 0 which is enabled by default on 82575 and 82576 */
2154 wr32(E1000_TXDCTL(0), 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08002155
2156 /* Program the Transmit Control Register */
Auke Kok9d5c8242008-01-24 02:22:38 -08002157 tctl = rd32(E1000_TCTL);
2158 tctl &= ~E1000_TCTL_CT;
2159 tctl |= E1000_TCTL_PSP | E1000_TCTL_RTLC |
2160 (E1000_COLLISION_THRESHOLD << E1000_CT_SHIFT);
2161
2162 igb_config_collision_dist(hw);
2163
Auke Kok9d5c8242008-01-24 02:22:38 -08002164 /* Enable transmits */
2165 tctl |= E1000_TCTL_EN;
2166
2167 wr32(E1000_TCTL, tctl);
2168}
2169
2170/**
Alexander Duyck85b430b2009-10-27 15:50:29 +00002171 * igb_configure_tx_ring - Configure transmit ring after Reset
2172 * @adapter: board private structure
2173 * @ring: tx ring to configure
2174 *
2175 * Configure a transmit ring after a reset.
2176 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002177void igb_configure_tx_ring(struct igb_adapter *adapter,
2178 struct igb_ring *ring)
Alexander Duyck85b430b2009-10-27 15:50:29 +00002179{
2180 struct e1000_hw *hw = &adapter->hw;
2181 u32 txdctl;
2182 u64 tdba = ring->dma;
2183 int reg_idx = ring->reg_idx;
2184
2185 /* disable the queue */
2186 txdctl = rd32(E1000_TXDCTL(reg_idx));
2187 wr32(E1000_TXDCTL(reg_idx),
2188 txdctl & ~E1000_TXDCTL_QUEUE_ENABLE);
2189 wrfl();
2190 mdelay(10);
2191
2192 wr32(E1000_TDLEN(reg_idx),
2193 ring->count * sizeof(union e1000_adv_tx_desc));
2194 wr32(E1000_TDBAL(reg_idx),
2195 tdba & 0x00000000ffffffffULL);
2196 wr32(E1000_TDBAH(reg_idx), tdba >> 32);
2197
Alexander Duyckfce99e32009-10-27 15:51:27 +00002198 ring->head = hw->hw_addr + E1000_TDH(reg_idx);
2199 ring->tail = hw->hw_addr + E1000_TDT(reg_idx);
2200 writel(0, ring->head);
2201 writel(0, ring->tail);
Alexander Duyck85b430b2009-10-27 15:50:29 +00002202
2203 txdctl |= IGB_TX_PTHRESH;
2204 txdctl |= IGB_TX_HTHRESH << 8;
2205 txdctl |= IGB_TX_WTHRESH << 16;
2206
2207 txdctl |= E1000_TXDCTL_QUEUE_ENABLE;
2208 wr32(E1000_TXDCTL(reg_idx), txdctl);
2209}
2210
2211/**
2212 * igb_configure_tx - Configure transmit Unit after Reset
2213 * @adapter: board private structure
2214 *
2215 * Configure the Tx unit of the MAC after a reset.
2216 **/
2217static void igb_configure_tx(struct igb_adapter *adapter)
2218{
2219 int i;
2220
2221 for (i = 0; i < adapter->num_tx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002222 igb_configure_tx_ring(adapter, adapter->tx_ring[i]);
Alexander Duyck85b430b2009-10-27 15:50:29 +00002223}
2224
2225/**
Auke Kok9d5c8242008-01-24 02:22:38 -08002226 * igb_setup_rx_resources - allocate Rx resources (Descriptors)
Auke Kok9d5c8242008-01-24 02:22:38 -08002227 * @rx_ring: rx descriptor ring (for a specific queue) to setup
2228 *
2229 * Returns 0 on success, negative on failure
2230 **/
Alexander Duyck80785292009-10-27 15:51:47 +00002231int igb_setup_rx_resources(struct igb_ring *rx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002232{
Alexander Duyck80785292009-10-27 15:51:47 +00002233 struct pci_dev *pdev = rx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002234 int size, desc_len;
2235
2236 size = sizeof(struct igb_buffer) * rx_ring->count;
2237 rx_ring->buffer_info = vmalloc(size);
2238 if (!rx_ring->buffer_info)
2239 goto err;
2240 memset(rx_ring->buffer_info, 0, size);
2241
2242 desc_len = sizeof(union e1000_adv_rx_desc);
2243
2244 /* Round up to nearest 4K */
2245 rx_ring->size = rx_ring->count * desc_len;
2246 rx_ring->size = ALIGN(rx_ring->size, 4096);
2247
2248 rx_ring->desc = pci_alloc_consistent(pdev, rx_ring->size,
2249 &rx_ring->dma);
2250
2251 if (!rx_ring->desc)
2252 goto err;
2253
2254 rx_ring->next_to_clean = 0;
2255 rx_ring->next_to_use = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002256
Auke Kok9d5c8242008-01-24 02:22:38 -08002257 return 0;
2258
2259err:
2260 vfree(rx_ring->buffer_info);
Alexander Duyck439705e2009-10-27 23:49:20 +00002261 rx_ring->buffer_info = NULL;
Alexander Duyck80785292009-10-27 15:51:47 +00002262 dev_err(&pdev->dev, "Unable to allocate memory for "
Auke Kok9d5c8242008-01-24 02:22:38 -08002263 "the receive descriptor ring\n");
2264 return -ENOMEM;
2265}
2266
2267/**
2268 * igb_setup_all_rx_resources - wrapper to allocate Rx resources
2269 * (Descriptors) for all queues
2270 * @adapter: board private structure
2271 *
2272 * Return 0 on success, negative on failure
2273 **/
2274static int igb_setup_all_rx_resources(struct igb_adapter *adapter)
2275{
Alexander Duyck439705e2009-10-27 23:49:20 +00002276 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002277 int i, err = 0;
2278
2279 for (i = 0; i < adapter->num_rx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00002280 err = igb_setup_rx_resources(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002281 if (err) {
Alexander Duyck439705e2009-10-27 23:49:20 +00002282 dev_err(&pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08002283 "Allocation for Rx Queue %u failed\n", i);
2284 for (i--; i >= 0; i--)
Alexander Duyck3025a442010-02-17 01:02:39 +00002285 igb_free_rx_resources(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002286 break;
2287 }
2288 }
2289
2290 return err;
2291}
2292
2293/**
Alexander Duyck06cf2662009-10-27 15:53:25 +00002294 * igb_setup_mrqc - configure the multiple receive queue control registers
2295 * @adapter: Board private structure
2296 **/
2297static void igb_setup_mrqc(struct igb_adapter *adapter)
2298{
2299 struct e1000_hw *hw = &adapter->hw;
2300 u32 mrqc, rxcsum;
2301 u32 j, num_rx_queues, shift = 0, shift2 = 0;
2302 union e1000_reta {
2303 u32 dword;
2304 u8 bytes[4];
2305 } reta;
2306 static const u8 rsshash[40] = {
2307 0x6d, 0x5a, 0x56, 0xda, 0x25, 0x5b, 0x0e, 0xc2, 0x41, 0x67,
2308 0x25, 0x3d, 0x43, 0xa3, 0x8f, 0xb0, 0xd0, 0xca, 0x2b, 0xcb,
2309 0xae, 0x7b, 0x30, 0xb4, 0x77, 0xcb, 0x2d, 0xa3, 0x80, 0x30,
2310 0xf2, 0x0c, 0x6a, 0x42, 0xb7, 0x3b, 0xbe, 0xac, 0x01, 0xfa };
2311
2312 /* Fill out hash function seeds */
2313 for (j = 0; j < 10; j++) {
2314 u32 rsskey = rsshash[(j * 4)];
2315 rsskey |= rsshash[(j * 4) + 1] << 8;
2316 rsskey |= rsshash[(j * 4) + 2] << 16;
2317 rsskey |= rsshash[(j * 4) + 3] << 24;
2318 array_wr32(E1000_RSSRK(0), j, rsskey);
2319 }
2320
Alexander Duycka99955f2009-11-12 18:37:19 +00002321 num_rx_queues = adapter->rss_queues;
Alexander Duyck06cf2662009-10-27 15:53:25 +00002322
2323 if (adapter->vfs_allocated_count) {
2324 /* 82575 and 82576 supports 2 RSS queues for VMDq */
2325 switch (hw->mac.type) {
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +00002326 case e1000_i350:
Alexander Duyck55cac242009-11-19 12:42:21 +00002327 case e1000_82580:
2328 num_rx_queues = 1;
2329 shift = 0;
2330 break;
Alexander Duyck06cf2662009-10-27 15:53:25 +00002331 case e1000_82576:
2332 shift = 3;
2333 num_rx_queues = 2;
2334 break;
2335 case e1000_82575:
2336 shift = 2;
2337 shift2 = 6;
2338 default:
2339 break;
2340 }
2341 } else {
2342 if (hw->mac.type == e1000_82575)
2343 shift = 6;
2344 }
2345
2346 for (j = 0; j < (32 * 4); j++) {
2347 reta.bytes[j & 3] = (j % num_rx_queues) << shift;
2348 if (shift2)
2349 reta.bytes[j & 3] |= num_rx_queues << shift2;
2350 if ((j & 3) == 3)
2351 wr32(E1000_RETA(j >> 2), reta.dword);
2352 }
2353
2354 /*
2355 * Disable raw packet checksumming so that RSS hash is placed in
2356 * descriptor on writeback. No need to enable TCP/UDP/IP checksum
2357 * offloads as they are enabled by default
2358 */
2359 rxcsum = rd32(E1000_RXCSUM);
2360 rxcsum |= E1000_RXCSUM_PCSD;
2361
2362 if (adapter->hw.mac.type >= e1000_82576)
2363 /* Enable Receive Checksum Offload for SCTP */
2364 rxcsum |= E1000_RXCSUM_CRCOFL;
2365
2366 /* Don't need to set TUOFL or IPOFL, they default to 1 */
2367 wr32(E1000_RXCSUM, rxcsum);
2368
2369 /* If VMDq is enabled then we set the appropriate mode for that, else
2370 * we default to RSS so that an RSS hash is calculated per packet even
2371 * if we are only using one queue */
2372 if (adapter->vfs_allocated_count) {
2373 if (hw->mac.type > e1000_82575) {
2374 /* Set the default pool for the PF's first queue */
2375 u32 vtctl = rd32(E1000_VT_CTL);
2376 vtctl &= ~(E1000_VT_CTL_DEFAULT_POOL_MASK |
2377 E1000_VT_CTL_DISABLE_DEF_POOL);
2378 vtctl |= adapter->vfs_allocated_count <<
2379 E1000_VT_CTL_DEFAULT_POOL_SHIFT;
2380 wr32(E1000_VT_CTL, vtctl);
2381 }
Alexander Duycka99955f2009-11-12 18:37:19 +00002382 if (adapter->rss_queues > 1)
Alexander Duyck06cf2662009-10-27 15:53:25 +00002383 mrqc = E1000_MRQC_ENABLE_VMDQ_RSS_2Q;
2384 else
2385 mrqc = E1000_MRQC_ENABLE_VMDQ;
2386 } else {
2387 mrqc = E1000_MRQC_ENABLE_RSS_4Q;
2388 }
2389 igb_vmm_control(adapter);
2390
2391 mrqc |= (E1000_MRQC_RSS_FIELD_IPV4 |
2392 E1000_MRQC_RSS_FIELD_IPV4_TCP);
2393 mrqc |= (E1000_MRQC_RSS_FIELD_IPV6 |
2394 E1000_MRQC_RSS_FIELD_IPV6_TCP);
2395 mrqc |= (E1000_MRQC_RSS_FIELD_IPV4_UDP |
2396 E1000_MRQC_RSS_FIELD_IPV6_UDP);
2397 mrqc |= (E1000_MRQC_RSS_FIELD_IPV6_UDP_EX |
2398 E1000_MRQC_RSS_FIELD_IPV6_TCP_EX);
2399
2400 wr32(E1000_MRQC, mrqc);
2401}
2402
2403/**
Auke Kok9d5c8242008-01-24 02:22:38 -08002404 * igb_setup_rctl - configure the receive control registers
2405 * @adapter: Board private structure
2406 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002407void igb_setup_rctl(struct igb_adapter *adapter)
Auke Kok9d5c8242008-01-24 02:22:38 -08002408{
2409 struct e1000_hw *hw = &adapter->hw;
2410 u32 rctl;
Auke Kok9d5c8242008-01-24 02:22:38 -08002411
2412 rctl = rd32(E1000_RCTL);
2413
2414 rctl &= ~(3 << E1000_RCTL_MO_SHIFT);
Alexander Duyck69d728b2008-11-25 01:04:03 -08002415 rctl &= ~(E1000_RCTL_LBM_TCVR | E1000_RCTL_LBM_MAC);
Auke Kok9d5c8242008-01-24 02:22:38 -08002416
Alexander Duyck69d728b2008-11-25 01:04:03 -08002417 rctl |= E1000_RCTL_EN | E1000_RCTL_BAM | E1000_RCTL_RDMTS_HALF |
Alexander Duyck28b07592009-02-06 23:20:31 +00002418 (hw->mac.mc_filter_type << E1000_RCTL_MO_SHIFT);
Auke Kok9d5c8242008-01-24 02:22:38 -08002419
Auke Kok87cb7e82008-07-08 15:08:29 -07002420 /*
2421 * enable stripping of CRC. It's unlikely this will break BMC
2422 * redirection as it did with e1000. Newer features require
2423 * that the HW strips the CRC.
Alexander Duyck73cd78f2009-02-12 18:16:59 +00002424 */
Auke Kok87cb7e82008-07-08 15:08:29 -07002425 rctl |= E1000_RCTL_SECRC;
Auke Kok9d5c8242008-01-24 02:22:38 -08002426
Alexander Duyck559e9c42009-10-27 23:52:50 +00002427 /* disable store bad packets and clear size bits. */
Alexander Duyckec54d7d2009-01-31 00:52:57 -08002428 rctl &= ~(E1000_RCTL_SBP | E1000_RCTL_SZ_256);
Auke Kok9d5c8242008-01-24 02:22:38 -08002429
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002430 /* enable LPE to prevent packets larger than max_frame_size */
2431 rctl |= E1000_RCTL_LPE;
Auke Kok9d5c8242008-01-24 02:22:38 -08002432
Alexander Duyck952f72a2009-10-27 15:51:07 +00002433 /* disable queue 0 to prevent tail write w/o re-config */
2434 wr32(E1000_RXDCTL(0), 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08002435
Alexander Duycke1739522009-02-19 20:39:44 -08002436 /* Attention!!! For SR-IOV PF driver operations you must enable
2437 * queue drop for all VF and PF queues to prevent head of line blocking
2438 * if an un-trusted VF does not provide descriptors to hardware.
2439 */
2440 if (adapter->vfs_allocated_count) {
Alexander Duycke1739522009-02-19 20:39:44 -08002441 /* set all queue drop enable bits */
2442 wr32(E1000_QDE, ALL_QUEUES);
Alexander Duycke1739522009-02-19 20:39:44 -08002443 }
2444
Auke Kok9d5c8242008-01-24 02:22:38 -08002445 wr32(E1000_RCTL, rctl);
2446}
2447
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002448static inline int igb_set_vf_rlpml(struct igb_adapter *adapter, int size,
2449 int vfn)
2450{
2451 struct e1000_hw *hw = &adapter->hw;
2452 u32 vmolr;
2453
2454 /* if it isn't the PF check to see if VFs are enabled and
2455 * increase the size to support vlan tags */
2456 if (vfn < adapter->vfs_allocated_count &&
2457 adapter->vf_data[vfn].vlans_enabled)
2458 size += VLAN_TAG_SIZE;
2459
2460 vmolr = rd32(E1000_VMOLR(vfn));
2461 vmolr &= ~E1000_VMOLR_RLPML_MASK;
2462 vmolr |= size | E1000_VMOLR_LPE;
2463 wr32(E1000_VMOLR(vfn), vmolr);
2464
2465 return 0;
2466}
2467
Auke Kok9d5c8242008-01-24 02:22:38 -08002468/**
Alexander Duycke1739522009-02-19 20:39:44 -08002469 * igb_rlpml_set - set maximum receive packet size
2470 * @adapter: board private structure
2471 *
2472 * Configure maximum receivable packet size.
2473 **/
2474static void igb_rlpml_set(struct igb_adapter *adapter)
2475{
2476 u32 max_frame_size = adapter->max_frame_size;
2477 struct e1000_hw *hw = &adapter->hw;
2478 u16 pf_id = adapter->vfs_allocated_count;
2479
2480 if (adapter->vlgrp)
2481 max_frame_size += VLAN_TAG_SIZE;
2482
2483 /* if vfs are enabled we set RLPML to the largest possible request
2484 * size and set the VMOLR RLPML to the size we need */
2485 if (pf_id) {
2486 igb_set_vf_rlpml(adapter, max_frame_size, pf_id);
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002487 max_frame_size = MAX_JUMBO_FRAME_SIZE;
Alexander Duycke1739522009-02-19 20:39:44 -08002488 }
2489
2490 wr32(E1000_RLPML, max_frame_size);
2491}
2492
Williams, Mitch A8151d292010-02-10 01:44:24 +00002493static inline void igb_set_vmolr(struct igb_adapter *adapter,
2494 int vfn, bool aupe)
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002495{
2496 struct e1000_hw *hw = &adapter->hw;
2497 u32 vmolr;
2498
2499 /*
2500 * This register exists only on 82576 and newer so if we are older then
2501 * we should exit and do nothing
2502 */
2503 if (hw->mac.type < e1000_82576)
2504 return;
2505
2506 vmolr = rd32(E1000_VMOLR(vfn));
Williams, Mitch A8151d292010-02-10 01:44:24 +00002507 vmolr |= E1000_VMOLR_STRVLAN; /* Strip vlan tags */
2508 if (aupe)
2509 vmolr |= E1000_VMOLR_AUPE; /* Accept untagged packets */
2510 else
2511 vmolr &= ~(E1000_VMOLR_AUPE); /* Tagged packets ONLY */
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002512
2513 /* clear all bits that might not be set */
2514 vmolr &= ~(E1000_VMOLR_BAM | E1000_VMOLR_RSSE);
2515
Alexander Duycka99955f2009-11-12 18:37:19 +00002516 if (adapter->rss_queues > 1 && vfn == adapter->vfs_allocated_count)
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002517 vmolr |= E1000_VMOLR_RSSE; /* enable RSS */
2518 /*
2519 * for VMDq only allow the VFs and pool 0 to accept broadcast and
2520 * multicast packets
2521 */
2522 if (vfn <= adapter->vfs_allocated_count)
2523 vmolr |= E1000_VMOLR_BAM; /* Accept broadcast */
2524
2525 wr32(E1000_VMOLR(vfn), vmolr);
2526}
2527
Alexander Duycke1739522009-02-19 20:39:44 -08002528/**
Alexander Duyck85b430b2009-10-27 15:50:29 +00002529 * igb_configure_rx_ring - Configure a receive ring after Reset
2530 * @adapter: board private structure
2531 * @ring: receive ring to be configured
2532 *
2533 * Configure the Rx unit of the MAC after a reset.
2534 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002535void igb_configure_rx_ring(struct igb_adapter *adapter,
2536 struct igb_ring *ring)
Alexander Duyck85b430b2009-10-27 15:50:29 +00002537{
2538 struct e1000_hw *hw = &adapter->hw;
2539 u64 rdba = ring->dma;
2540 int reg_idx = ring->reg_idx;
Alexander Duyck952f72a2009-10-27 15:51:07 +00002541 u32 srrctl, rxdctl;
Alexander Duyck85b430b2009-10-27 15:50:29 +00002542
2543 /* disable the queue */
2544 rxdctl = rd32(E1000_RXDCTL(reg_idx));
2545 wr32(E1000_RXDCTL(reg_idx),
2546 rxdctl & ~E1000_RXDCTL_QUEUE_ENABLE);
2547
2548 /* Set DMA base address registers */
2549 wr32(E1000_RDBAL(reg_idx),
2550 rdba & 0x00000000ffffffffULL);
2551 wr32(E1000_RDBAH(reg_idx), rdba >> 32);
2552 wr32(E1000_RDLEN(reg_idx),
2553 ring->count * sizeof(union e1000_adv_rx_desc));
2554
2555 /* initialize head and tail */
Alexander Duyckfce99e32009-10-27 15:51:27 +00002556 ring->head = hw->hw_addr + E1000_RDH(reg_idx);
2557 ring->tail = hw->hw_addr + E1000_RDT(reg_idx);
2558 writel(0, ring->head);
2559 writel(0, ring->tail);
Alexander Duyck85b430b2009-10-27 15:50:29 +00002560
Alexander Duyck952f72a2009-10-27 15:51:07 +00002561 /* set descriptor configuration */
Alexander Duyck4c844852009-10-27 15:52:07 +00002562 if (ring->rx_buffer_len < IGB_RXBUFFER_1024) {
2563 srrctl = ALIGN(ring->rx_buffer_len, 64) <<
Alexander Duyck952f72a2009-10-27 15:51:07 +00002564 E1000_SRRCTL_BSIZEHDRSIZE_SHIFT;
2565#if (PAGE_SIZE / 2) > IGB_RXBUFFER_16384
2566 srrctl |= IGB_RXBUFFER_16384 >>
2567 E1000_SRRCTL_BSIZEPKT_SHIFT;
2568#else
2569 srrctl |= (PAGE_SIZE / 2) >>
2570 E1000_SRRCTL_BSIZEPKT_SHIFT;
2571#endif
2572 srrctl |= E1000_SRRCTL_DESCTYPE_HDR_SPLIT_ALWAYS;
2573 } else {
Alexander Duyck4c844852009-10-27 15:52:07 +00002574 srrctl = ALIGN(ring->rx_buffer_len, 1024) >>
Alexander Duyck952f72a2009-10-27 15:51:07 +00002575 E1000_SRRCTL_BSIZEPKT_SHIFT;
2576 srrctl |= E1000_SRRCTL_DESCTYPE_ADV_ONEBUF;
2577 }
Nick Nunley757b77e2010-03-26 11:36:47 +00002578 if (hw->mac.type == e1000_82580)
2579 srrctl |= E1000_SRRCTL_TIMESTAMP;
Nick Nunleye6bdb6f2010-02-17 01:03:38 +00002580 /* Only set Drop Enable if we are supporting multiple queues */
2581 if (adapter->vfs_allocated_count || adapter->num_rx_queues > 1)
2582 srrctl |= E1000_SRRCTL_DROP_EN;
Alexander Duyck952f72a2009-10-27 15:51:07 +00002583
2584 wr32(E1000_SRRCTL(reg_idx), srrctl);
2585
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002586 /* set filtering for VMDQ pools */
Williams, Mitch A8151d292010-02-10 01:44:24 +00002587 igb_set_vmolr(adapter, reg_idx & 0x7, true);
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002588
Alexander Duyck85b430b2009-10-27 15:50:29 +00002589 /* enable receive descriptor fetching */
2590 rxdctl = rd32(E1000_RXDCTL(reg_idx));
2591 rxdctl |= E1000_RXDCTL_QUEUE_ENABLE;
2592 rxdctl &= 0xFFF00000;
2593 rxdctl |= IGB_RX_PTHRESH;
2594 rxdctl |= IGB_RX_HTHRESH << 8;
2595 rxdctl |= IGB_RX_WTHRESH << 16;
2596 wr32(E1000_RXDCTL(reg_idx), rxdctl);
2597}
2598
2599/**
Auke Kok9d5c8242008-01-24 02:22:38 -08002600 * igb_configure_rx - Configure receive Unit after Reset
2601 * @adapter: board private structure
2602 *
2603 * Configure the Rx unit of the MAC after a reset.
2604 **/
2605static void igb_configure_rx(struct igb_adapter *adapter)
2606{
Hannes Eder91075842009-02-18 19:36:04 -08002607 int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08002608
Alexander Duyck68d480c2009-10-05 06:33:08 +00002609 /* set UTA to appropriate mode */
2610 igb_set_uta(adapter);
2611
Alexander Duyck26ad9172009-10-05 06:32:49 +00002612 /* set the correct pool for the PF default MAC address in entry 0 */
2613 igb_rar_set_qsel(adapter, adapter->hw.mac.addr, 0,
2614 adapter->vfs_allocated_count);
2615
Alexander Duyck06cf2662009-10-27 15:53:25 +00002616 /* Setup the HW Rx Head and Tail Descriptor Pointers and
2617 * the Base and Length of the Rx Descriptor Ring */
2618 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002619 igb_configure_rx_ring(adapter, adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002620}
2621
2622/**
2623 * igb_free_tx_resources - Free Tx Resources per Queue
Auke Kok9d5c8242008-01-24 02:22:38 -08002624 * @tx_ring: Tx descriptor ring for a specific queue
2625 *
2626 * Free all transmit software resources
2627 **/
Alexander Duyck68fd9912008-11-20 00:48:10 -08002628void igb_free_tx_resources(struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002629{
Mitch Williams3b644cf2008-06-27 10:59:48 -07002630 igb_clean_tx_ring(tx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08002631
2632 vfree(tx_ring->buffer_info);
2633 tx_ring->buffer_info = NULL;
2634
Alexander Duyck439705e2009-10-27 23:49:20 +00002635 /* if not set, then don't free */
2636 if (!tx_ring->desc)
2637 return;
2638
Alexander Duyck80785292009-10-27 15:51:47 +00002639 pci_free_consistent(tx_ring->pdev, tx_ring->size,
2640 tx_ring->desc, tx_ring->dma);
Auke Kok9d5c8242008-01-24 02:22:38 -08002641
2642 tx_ring->desc = NULL;
2643}
2644
2645/**
2646 * igb_free_all_tx_resources - Free Tx Resources for All Queues
2647 * @adapter: board private structure
2648 *
2649 * Free all transmit software resources
2650 **/
2651static void igb_free_all_tx_resources(struct igb_adapter *adapter)
2652{
2653 int i;
2654
2655 for (i = 0; i < adapter->num_tx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002656 igb_free_tx_resources(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002657}
2658
Alexander Duyckb1a436c2009-10-27 15:54:43 +00002659void igb_unmap_and_free_tx_resource(struct igb_ring *tx_ring,
2660 struct igb_buffer *buffer_info)
Auke Kok9d5c8242008-01-24 02:22:38 -08002661{
Alexander Duyck6366ad32009-12-02 16:47:18 +00002662 if (buffer_info->dma) {
2663 if (buffer_info->mapped_as_page)
2664 pci_unmap_page(tx_ring->pdev,
2665 buffer_info->dma,
2666 buffer_info->length,
2667 PCI_DMA_TODEVICE);
2668 else
2669 pci_unmap_single(tx_ring->pdev,
2670 buffer_info->dma,
2671 buffer_info->length,
2672 PCI_DMA_TODEVICE);
2673 buffer_info->dma = 0;
2674 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002675 if (buffer_info->skb) {
2676 dev_kfree_skb_any(buffer_info->skb);
2677 buffer_info->skb = NULL;
2678 }
2679 buffer_info->time_stamp = 0;
Alexander Duyck6366ad32009-12-02 16:47:18 +00002680 buffer_info->length = 0;
2681 buffer_info->next_to_watch = 0;
2682 buffer_info->mapped_as_page = false;
Auke Kok9d5c8242008-01-24 02:22:38 -08002683}
2684
2685/**
2686 * igb_clean_tx_ring - Free Tx Buffers
Auke Kok9d5c8242008-01-24 02:22:38 -08002687 * @tx_ring: ring to be cleaned
2688 **/
Mitch Williams3b644cf2008-06-27 10:59:48 -07002689static void igb_clean_tx_ring(struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002690{
2691 struct igb_buffer *buffer_info;
2692 unsigned long size;
2693 unsigned int i;
2694
2695 if (!tx_ring->buffer_info)
2696 return;
2697 /* Free all the Tx ring sk_buffs */
2698
2699 for (i = 0; i < tx_ring->count; i++) {
2700 buffer_info = &tx_ring->buffer_info[i];
Alexander Duyck80785292009-10-27 15:51:47 +00002701 igb_unmap_and_free_tx_resource(tx_ring, buffer_info);
Auke Kok9d5c8242008-01-24 02:22:38 -08002702 }
2703
2704 size = sizeof(struct igb_buffer) * tx_ring->count;
2705 memset(tx_ring->buffer_info, 0, size);
2706
2707 /* Zero out the descriptor ring */
Auke Kok9d5c8242008-01-24 02:22:38 -08002708 memset(tx_ring->desc, 0, tx_ring->size);
2709
2710 tx_ring->next_to_use = 0;
2711 tx_ring->next_to_clean = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002712}
2713
2714/**
2715 * igb_clean_all_tx_rings - Free Tx Buffers for all queues
2716 * @adapter: board private structure
2717 **/
2718static void igb_clean_all_tx_rings(struct igb_adapter *adapter)
2719{
2720 int i;
2721
2722 for (i = 0; i < adapter->num_tx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002723 igb_clean_tx_ring(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002724}
2725
2726/**
2727 * igb_free_rx_resources - Free Rx Resources
Auke Kok9d5c8242008-01-24 02:22:38 -08002728 * @rx_ring: ring to clean the resources from
2729 *
2730 * Free all receive software resources
2731 **/
Alexander Duyck68fd9912008-11-20 00:48:10 -08002732void igb_free_rx_resources(struct igb_ring *rx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002733{
Mitch Williams3b644cf2008-06-27 10:59:48 -07002734 igb_clean_rx_ring(rx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08002735
2736 vfree(rx_ring->buffer_info);
2737 rx_ring->buffer_info = NULL;
2738
Alexander Duyck439705e2009-10-27 23:49:20 +00002739 /* if not set, then don't free */
2740 if (!rx_ring->desc)
2741 return;
2742
Alexander Duyck80785292009-10-27 15:51:47 +00002743 pci_free_consistent(rx_ring->pdev, rx_ring->size,
2744 rx_ring->desc, rx_ring->dma);
Auke Kok9d5c8242008-01-24 02:22:38 -08002745
2746 rx_ring->desc = NULL;
2747}
2748
2749/**
2750 * igb_free_all_rx_resources - Free Rx Resources for All Queues
2751 * @adapter: board private structure
2752 *
2753 * Free all receive software resources
2754 **/
2755static void igb_free_all_rx_resources(struct igb_adapter *adapter)
2756{
2757 int i;
2758
2759 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002760 igb_free_rx_resources(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002761}
2762
2763/**
2764 * igb_clean_rx_ring - Free Rx Buffers per Queue
Auke Kok9d5c8242008-01-24 02:22:38 -08002765 * @rx_ring: ring to free buffers from
2766 **/
Mitch Williams3b644cf2008-06-27 10:59:48 -07002767static void igb_clean_rx_ring(struct igb_ring *rx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002768{
2769 struct igb_buffer *buffer_info;
Auke Kok9d5c8242008-01-24 02:22:38 -08002770 unsigned long size;
2771 unsigned int i;
2772
2773 if (!rx_ring->buffer_info)
2774 return;
Alexander Duyck439705e2009-10-27 23:49:20 +00002775
Auke Kok9d5c8242008-01-24 02:22:38 -08002776 /* Free all the Rx ring sk_buffs */
2777 for (i = 0; i < rx_ring->count; i++) {
2778 buffer_info = &rx_ring->buffer_info[i];
2779 if (buffer_info->dma) {
Alexander Duyck80785292009-10-27 15:51:47 +00002780 pci_unmap_single(rx_ring->pdev,
2781 buffer_info->dma,
Alexander Duyck4c844852009-10-27 15:52:07 +00002782 rx_ring->rx_buffer_len,
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002783 PCI_DMA_FROMDEVICE);
Auke Kok9d5c8242008-01-24 02:22:38 -08002784 buffer_info->dma = 0;
2785 }
2786
2787 if (buffer_info->skb) {
2788 dev_kfree_skb(buffer_info->skb);
2789 buffer_info->skb = NULL;
2790 }
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002791 if (buffer_info->page_dma) {
Alexander Duyck80785292009-10-27 15:51:47 +00002792 pci_unmap_page(rx_ring->pdev,
2793 buffer_info->page_dma,
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002794 PAGE_SIZE / 2,
2795 PCI_DMA_FROMDEVICE);
2796 buffer_info->page_dma = 0;
2797 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002798 if (buffer_info->page) {
Auke Kok9d5c8242008-01-24 02:22:38 -08002799 put_page(buffer_info->page);
2800 buffer_info->page = NULL;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07002801 buffer_info->page_offset = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002802 }
2803 }
2804
Auke Kok9d5c8242008-01-24 02:22:38 -08002805 size = sizeof(struct igb_buffer) * rx_ring->count;
2806 memset(rx_ring->buffer_info, 0, size);
2807
2808 /* Zero out the descriptor ring */
2809 memset(rx_ring->desc, 0, rx_ring->size);
2810
2811 rx_ring->next_to_clean = 0;
2812 rx_ring->next_to_use = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002813}
2814
2815/**
2816 * igb_clean_all_rx_rings - Free Rx Buffers for all queues
2817 * @adapter: board private structure
2818 **/
2819static void igb_clean_all_rx_rings(struct igb_adapter *adapter)
2820{
2821 int i;
2822
2823 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002824 igb_clean_rx_ring(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002825}
2826
2827/**
2828 * igb_set_mac - Change the Ethernet Address of the NIC
2829 * @netdev: network interface device structure
2830 * @p: pointer to an address structure
2831 *
2832 * Returns 0 on success, negative on failure
2833 **/
2834static int igb_set_mac(struct net_device *netdev, void *p)
2835{
2836 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyck28b07592009-02-06 23:20:31 +00002837 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08002838 struct sockaddr *addr = p;
2839
2840 if (!is_valid_ether_addr(addr->sa_data))
2841 return -EADDRNOTAVAIL;
2842
2843 memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
Alexander Duyck28b07592009-02-06 23:20:31 +00002844 memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
Auke Kok9d5c8242008-01-24 02:22:38 -08002845
Alexander Duyck26ad9172009-10-05 06:32:49 +00002846 /* set the correct pool for the new PF MAC address in entry 0 */
2847 igb_rar_set_qsel(adapter, hw->mac.addr, 0,
2848 adapter->vfs_allocated_count);
Alexander Duycke1739522009-02-19 20:39:44 -08002849
Auke Kok9d5c8242008-01-24 02:22:38 -08002850 return 0;
2851}
2852
2853/**
Alexander Duyck68d480c2009-10-05 06:33:08 +00002854 * igb_write_mc_addr_list - write multicast addresses to MTA
2855 * @netdev: network interface device structure
2856 *
2857 * Writes multicast address list to the MTA hash table.
2858 * Returns: -ENOMEM on failure
2859 * 0 on no addresses written
2860 * X on writing X addresses to MTA
2861 **/
2862static int igb_write_mc_addr_list(struct net_device *netdev)
2863{
2864 struct igb_adapter *adapter = netdev_priv(netdev);
2865 struct e1000_hw *hw = &adapter->hw;
Jiri Pirko22bedad2010-04-01 21:22:57 +00002866 struct netdev_hw_addr *ha;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002867 u8 *mta_list;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002868 int i;
2869
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00002870 if (netdev_mc_empty(netdev)) {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002871 /* nothing to program, so clear mc list */
2872 igb_update_mc_addr_list(hw, NULL, 0);
2873 igb_restore_vf_multicasts(adapter);
2874 return 0;
2875 }
2876
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00002877 mta_list = kzalloc(netdev_mc_count(netdev) * 6, GFP_ATOMIC);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002878 if (!mta_list)
2879 return -ENOMEM;
2880
Alexander Duyck68d480c2009-10-05 06:33:08 +00002881 /* The shared function expects a packed array of only addresses. */
Jiri Pirko48e2f182010-02-22 09:22:26 +00002882 i = 0;
Jiri Pirko22bedad2010-04-01 21:22:57 +00002883 netdev_for_each_mc_addr(ha, netdev)
2884 memcpy(mta_list + (i++ * ETH_ALEN), ha->addr, ETH_ALEN);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002885
Alexander Duyck68d480c2009-10-05 06:33:08 +00002886 igb_update_mc_addr_list(hw, mta_list, i);
2887 kfree(mta_list);
2888
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00002889 return netdev_mc_count(netdev);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002890}
2891
2892/**
2893 * igb_write_uc_addr_list - write unicast addresses to RAR table
2894 * @netdev: network interface device structure
2895 *
2896 * Writes unicast address list to the RAR table.
2897 * Returns: -ENOMEM on failure/insufficient address space
2898 * 0 on no addresses written
2899 * X on writing X addresses to the RAR table
2900 **/
2901static int igb_write_uc_addr_list(struct net_device *netdev)
2902{
2903 struct igb_adapter *adapter = netdev_priv(netdev);
2904 struct e1000_hw *hw = &adapter->hw;
2905 unsigned int vfn = adapter->vfs_allocated_count;
2906 unsigned int rar_entries = hw->mac.rar_entry_count - (vfn + 1);
2907 int count = 0;
2908
2909 /* return ENOMEM indicating insufficient memory for addresses */
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08002910 if (netdev_uc_count(netdev) > rar_entries)
Alexander Duyck68d480c2009-10-05 06:33:08 +00002911 return -ENOMEM;
2912
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08002913 if (!netdev_uc_empty(netdev) && rar_entries) {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002914 struct netdev_hw_addr *ha;
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08002915
2916 netdev_for_each_uc_addr(ha, netdev) {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002917 if (!rar_entries)
2918 break;
2919 igb_rar_set_qsel(adapter, ha->addr,
2920 rar_entries--,
2921 vfn);
2922 count++;
2923 }
2924 }
2925 /* write the addresses in reverse order to avoid write combining */
2926 for (; rar_entries > 0 ; rar_entries--) {
2927 wr32(E1000_RAH(rar_entries), 0);
2928 wr32(E1000_RAL(rar_entries), 0);
2929 }
2930 wrfl();
2931
2932 return count;
2933}
2934
2935/**
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002936 * igb_set_rx_mode - Secondary Unicast, Multicast and Promiscuous mode set
Auke Kok9d5c8242008-01-24 02:22:38 -08002937 * @netdev: network interface device structure
2938 *
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002939 * The set_rx_mode entry point is called whenever the unicast or multicast
2940 * address lists or the network interface flags are updated. This routine is
2941 * responsible for configuring the hardware for proper unicast, multicast,
Auke Kok9d5c8242008-01-24 02:22:38 -08002942 * promiscuous mode, and all-multi behavior.
2943 **/
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002944static void igb_set_rx_mode(struct net_device *netdev)
Auke Kok9d5c8242008-01-24 02:22:38 -08002945{
2946 struct igb_adapter *adapter = netdev_priv(netdev);
2947 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002948 unsigned int vfn = adapter->vfs_allocated_count;
2949 u32 rctl, vmolr = 0;
2950 int count;
Auke Kok9d5c8242008-01-24 02:22:38 -08002951
2952 /* Check for Promiscuous and All Multicast modes */
Auke Kok9d5c8242008-01-24 02:22:38 -08002953 rctl = rd32(E1000_RCTL);
2954
Alexander Duyck68d480c2009-10-05 06:33:08 +00002955 /* clear the effected bits */
2956 rctl &= ~(E1000_RCTL_UPE | E1000_RCTL_MPE | E1000_RCTL_VFE);
2957
Patrick McHardy746b9f02008-07-16 20:15:45 -07002958 if (netdev->flags & IFF_PROMISC) {
Auke Kok9d5c8242008-01-24 02:22:38 -08002959 rctl |= (E1000_RCTL_UPE | E1000_RCTL_MPE);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002960 vmolr |= (E1000_VMOLR_ROPE | E1000_VMOLR_MPME);
Patrick McHardy746b9f02008-07-16 20:15:45 -07002961 } else {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002962 if (netdev->flags & IFF_ALLMULTI) {
Patrick McHardy746b9f02008-07-16 20:15:45 -07002963 rctl |= E1000_RCTL_MPE;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002964 vmolr |= E1000_VMOLR_MPME;
2965 } else {
2966 /*
2967 * Write addresses to the MTA, if the attempt fails
2968 * then we should just turn on promiscous mode so
2969 * that we can at least receive multicast traffic
2970 */
2971 count = igb_write_mc_addr_list(netdev);
2972 if (count < 0) {
2973 rctl |= E1000_RCTL_MPE;
2974 vmolr |= E1000_VMOLR_MPME;
2975 } else if (count) {
2976 vmolr |= E1000_VMOLR_ROMPE;
2977 }
2978 }
2979 /*
2980 * Write addresses to available RAR registers, if there is not
2981 * sufficient space to store all the addresses then enable
2982 * unicast promiscous mode
2983 */
2984 count = igb_write_uc_addr_list(netdev);
2985 if (count < 0) {
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002986 rctl |= E1000_RCTL_UPE;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002987 vmolr |= E1000_VMOLR_ROPE;
2988 }
Patrick McHardy78ed11a2008-07-16 20:16:14 -07002989 rctl |= E1000_RCTL_VFE;
Patrick McHardy746b9f02008-07-16 20:15:45 -07002990 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002991 wr32(E1000_RCTL, rctl);
2992
Alexander Duyck68d480c2009-10-05 06:33:08 +00002993 /*
2994 * In order to support SR-IOV and eventually VMDq it is necessary to set
2995 * the VMOLR to enable the appropriate modes. Without this workaround
2996 * we will have issues with VLAN tag stripping not being done for frames
2997 * that are only arriving because we are the default pool
2998 */
2999 if (hw->mac.type < e1000_82576)
Alexander Duyck28fc06f2009-07-23 18:08:54 +00003000 return;
Alexander Duyck28fc06f2009-07-23 18:08:54 +00003001
Alexander Duyck68d480c2009-10-05 06:33:08 +00003002 vmolr |= rd32(E1000_VMOLR(vfn)) &
3003 ~(E1000_VMOLR_ROPE | E1000_VMOLR_MPME | E1000_VMOLR_ROMPE);
3004 wr32(E1000_VMOLR(vfn), vmolr);
Alexander Duyck28fc06f2009-07-23 18:08:54 +00003005 igb_restore_vf_multicasts(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003006}
3007
3008/* Need to wait a few seconds after link up to get diagnostic information from
3009 * the phy */
3010static void igb_update_phy_info(unsigned long data)
3011{
3012 struct igb_adapter *adapter = (struct igb_adapter *) data;
Alexander Duyckf5f4cf02008-11-21 21:30:24 -08003013 igb_get_phy_info(&adapter->hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08003014}
3015
3016/**
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003017 * igb_has_link - check shared code for link and determine up/down
3018 * @adapter: pointer to driver private info
3019 **/
Nick Nunley31455352010-02-17 01:01:21 +00003020bool igb_has_link(struct igb_adapter *adapter)
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003021{
3022 struct e1000_hw *hw = &adapter->hw;
3023 bool link_active = false;
3024 s32 ret_val = 0;
3025
3026 /* get_link_status is set on LSC (link status) interrupt or
3027 * rx sequence error interrupt. get_link_status will stay
3028 * false until the e1000_check_for_link establishes link
3029 * for copper adapters ONLY
3030 */
3031 switch (hw->phy.media_type) {
3032 case e1000_media_type_copper:
3033 if (hw->mac.get_link_status) {
3034 ret_val = hw->mac.ops.check_for_link(hw);
3035 link_active = !hw->mac.get_link_status;
3036 } else {
3037 link_active = true;
3038 }
3039 break;
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003040 case e1000_media_type_internal_serdes:
3041 ret_val = hw->mac.ops.check_for_link(hw);
3042 link_active = hw->mac.serdes_has_link;
3043 break;
3044 default:
3045 case e1000_media_type_unknown:
3046 break;
3047 }
3048
3049 return link_active;
3050}
3051
3052/**
Auke Kok9d5c8242008-01-24 02:22:38 -08003053 * igb_watchdog - Timer Call-back
3054 * @data: pointer to adapter cast into an unsigned long
3055 **/
3056static void igb_watchdog(unsigned long data)
3057{
3058 struct igb_adapter *adapter = (struct igb_adapter *)data;
3059 /* Do the rest outside of interrupt context */
3060 schedule_work(&adapter->watchdog_task);
3061}
3062
3063static void igb_watchdog_task(struct work_struct *work)
3064{
3065 struct igb_adapter *adapter = container_of(work,
Alexander Duyck559e9c42009-10-27 23:52:50 +00003066 struct igb_adapter,
3067 watchdog_task);
Auke Kok9d5c8242008-01-24 02:22:38 -08003068 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08003069 struct net_device *netdev = adapter->netdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003070 u32 link;
Alexander Duyck7a6ea552008-08-26 04:25:03 -07003071 int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003072
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003073 link = igb_has_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003074 if (link) {
3075 if (!netif_carrier_ok(netdev)) {
3076 u32 ctrl;
Alexander Duyck330a6d62009-10-27 23:51:35 +00003077 hw->mac.ops.get_speed_and_duplex(hw,
3078 &adapter->link_speed,
3079 &adapter->link_duplex);
Auke Kok9d5c8242008-01-24 02:22:38 -08003080
3081 ctrl = rd32(E1000_CTRL);
Alexander Duyck527d47c2008-11-27 00:21:39 -08003082 /* Links status message must follow this format */
3083 printk(KERN_INFO "igb: %s NIC Link is Up %d Mbps %s, "
Auke Kok9d5c8242008-01-24 02:22:38 -08003084 "Flow Control: %s\n",
Alexander Duyck559e9c42009-10-27 23:52:50 +00003085 netdev->name,
3086 adapter->link_speed,
3087 adapter->link_duplex == FULL_DUPLEX ?
Auke Kok9d5c8242008-01-24 02:22:38 -08003088 "Full Duplex" : "Half Duplex",
Alexander Duyck559e9c42009-10-27 23:52:50 +00003089 ((ctrl & E1000_CTRL_TFCE) &&
3090 (ctrl & E1000_CTRL_RFCE)) ? "RX/TX" :
3091 ((ctrl & E1000_CTRL_RFCE) ? "RX" :
3092 ((ctrl & E1000_CTRL_TFCE) ? "TX" : "None")));
Auke Kok9d5c8242008-01-24 02:22:38 -08003093
Emil Tantilovd07f3e32010-03-23 18:34:57 +00003094 /* adjust timeout factor according to speed/duplex */
Auke Kok9d5c8242008-01-24 02:22:38 -08003095 adapter->tx_timeout_factor = 1;
3096 switch (adapter->link_speed) {
3097 case SPEED_10:
Auke Kok9d5c8242008-01-24 02:22:38 -08003098 adapter->tx_timeout_factor = 14;
3099 break;
3100 case SPEED_100:
Auke Kok9d5c8242008-01-24 02:22:38 -08003101 /* maybe add some timeout factor ? */
3102 break;
3103 }
3104
3105 netif_carrier_on(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08003106
Alexander Duyck4ae196d2009-02-19 20:40:07 -08003107 igb_ping_all_vfs(adapter);
3108
Alexander Duyck4b1a9872009-02-06 23:19:50 +00003109 /* link state has changed, schedule phy info update */
Auke Kok9d5c8242008-01-24 02:22:38 -08003110 if (!test_bit(__IGB_DOWN, &adapter->state))
3111 mod_timer(&adapter->phy_info_timer,
3112 round_jiffies(jiffies + 2 * HZ));
3113 }
3114 } else {
3115 if (netif_carrier_ok(netdev)) {
3116 adapter->link_speed = 0;
3117 adapter->link_duplex = 0;
Alexander Duyck527d47c2008-11-27 00:21:39 -08003118 /* Links status message must follow this format */
3119 printk(KERN_INFO "igb: %s NIC Link is Down\n",
3120 netdev->name);
Auke Kok9d5c8242008-01-24 02:22:38 -08003121 netif_carrier_off(netdev);
Alexander Duyck4b1a9872009-02-06 23:19:50 +00003122
Alexander Duyck4ae196d2009-02-19 20:40:07 -08003123 igb_ping_all_vfs(adapter);
3124
Alexander Duyck4b1a9872009-02-06 23:19:50 +00003125 /* link state has changed, schedule phy info update */
Auke Kok9d5c8242008-01-24 02:22:38 -08003126 if (!test_bit(__IGB_DOWN, &adapter->state))
3127 mod_timer(&adapter->phy_info_timer,
3128 round_jiffies(jiffies + 2 * HZ));
3129 }
3130 }
3131
Auke Kok9d5c8242008-01-24 02:22:38 -08003132 igb_update_stats(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003133
Alexander Duyckdbabb062009-11-12 18:38:16 +00003134 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00003135 struct igb_ring *tx_ring = adapter->tx_ring[i];
Alexander Duyckdbabb062009-11-12 18:38:16 +00003136 if (!netif_carrier_ok(netdev)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003137 /* We've lost link, so the controller stops DMA,
3138 * but we've got queued Tx work that's never going
3139 * to get done, so reset controller to flush Tx.
3140 * (Do the reset outside of interrupt context). */
Alexander Duyckdbabb062009-11-12 18:38:16 +00003141 if (igb_desc_unused(tx_ring) + 1 < tx_ring->count) {
3142 adapter->tx_timeout_count++;
3143 schedule_work(&adapter->reset_task);
3144 /* return immediately since reset is imminent */
3145 return;
3146 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003147 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003148
Alexander Duyckdbabb062009-11-12 18:38:16 +00003149 /* Force detection of hung controller every watchdog period */
3150 tx_ring->detect_tx_hung = true;
3151 }
Alexander Duyckf7ba2052009-10-27 23:48:51 +00003152
Auke Kok9d5c8242008-01-24 02:22:38 -08003153 /* Cause software interrupt to ensure rx ring is cleaned */
Alexander Duyck7a6ea552008-08-26 04:25:03 -07003154 if (adapter->msix_entries) {
Alexander Duyck047e0032009-10-27 15:49:27 +00003155 u32 eics = 0;
3156 for (i = 0; i < adapter->num_q_vectors; i++) {
3157 struct igb_q_vector *q_vector = adapter->q_vector[i];
3158 eics |= q_vector->eims_value;
3159 }
Alexander Duyck7a6ea552008-08-26 04:25:03 -07003160 wr32(E1000_EICS, eics);
3161 } else {
3162 wr32(E1000_ICS, E1000_ICS_RXDMT0);
3163 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003164
Auke Kok9d5c8242008-01-24 02:22:38 -08003165 /* Reset the timer */
3166 if (!test_bit(__IGB_DOWN, &adapter->state))
3167 mod_timer(&adapter->watchdog_timer,
3168 round_jiffies(jiffies + 2 * HZ));
3169}
3170
3171enum latency_range {
3172 lowest_latency = 0,
3173 low_latency = 1,
3174 bulk_latency = 2,
3175 latency_invalid = 255
3176};
3177
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003178/**
3179 * igb_update_ring_itr - update the dynamic ITR value based on packet size
3180 *
3181 * Stores a new ITR value based on strictly on packet size. This
3182 * algorithm is less sophisticated than that used in igb_update_itr,
3183 * due to the difficulty of synchronizing statistics across multiple
3184 * receive rings. The divisors and thresholds used by this fuction
3185 * were determined based on theoretical maximum wire speed and testing
3186 * data, in order to minimize response time while increasing bulk
3187 * throughput.
3188 * This functionality is controlled by the InterruptThrottleRate module
3189 * parameter (see igb_param.c)
3190 * NOTE: This function is called only when operating in a multiqueue
3191 * receive environment.
Alexander Duyck047e0032009-10-27 15:49:27 +00003192 * @q_vector: pointer to q_vector
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003193 **/
Alexander Duyck047e0032009-10-27 15:49:27 +00003194static void igb_update_ring_itr(struct igb_q_vector *q_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -08003195{
Alexander Duyck047e0032009-10-27 15:49:27 +00003196 int new_val = q_vector->itr_val;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003197 int avg_wire_size = 0;
Alexander Duyck047e0032009-10-27 15:49:27 +00003198 struct igb_adapter *adapter = q_vector->adapter;
Auke Kok9d5c8242008-01-24 02:22:38 -08003199
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003200 /* For non-gigabit speeds, just fix the interrupt rate at 4000
3201 * ints/sec - ITR timer value of 120 ticks.
3202 */
3203 if (adapter->link_speed != SPEED_1000) {
Alexander Duyck047e0032009-10-27 15:49:27 +00003204 new_val = 976;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003205 goto set_itr_val;
3206 }
Alexander Duyck047e0032009-10-27 15:49:27 +00003207
3208 if (q_vector->rx_ring && q_vector->rx_ring->total_packets) {
3209 struct igb_ring *ring = q_vector->rx_ring;
3210 avg_wire_size = ring->total_bytes / ring->total_packets;
3211 }
3212
3213 if (q_vector->tx_ring && q_vector->tx_ring->total_packets) {
3214 struct igb_ring *ring = q_vector->tx_ring;
3215 avg_wire_size = max_t(u32, avg_wire_size,
3216 (ring->total_bytes /
3217 ring->total_packets));
3218 }
3219
3220 /* if avg_wire_size isn't set no work was done */
3221 if (!avg_wire_size)
3222 goto clear_counts;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003223
3224 /* Add 24 bytes to size to account for CRC, preamble, and gap */
3225 avg_wire_size += 24;
3226
3227 /* Don't starve jumbo frames */
3228 avg_wire_size = min(avg_wire_size, 3000);
3229
3230 /* Give a little boost to mid-size frames */
3231 if ((avg_wire_size > 300) && (avg_wire_size < 1200))
3232 new_val = avg_wire_size / 3;
3233 else
3234 new_val = avg_wire_size / 2;
3235
Nick Nunleyabe1c362010-02-17 01:03:19 +00003236 /* when in itr mode 3 do not exceed 20K ints/sec */
3237 if (adapter->rx_itr_setting == 3 && new_val < 196)
3238 new_val = 196;
3239
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003240set_itr_val:
Alexander Duyck047e0032009-10-27 15:49:27 +00003241 if (new_val != q_vector->itr_val) {
3242 q_vector->itr_val = new_val;
3243 q_vector->set_itr = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -08003244 }
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003245clear_counts:
Alexander Duyck047e0032009-10-27 15:49:27 +00003246 if (q_vector->rx_ring) {
3247 q_vector->rx_ring->total_bytes = 0;
3248 q_vector->rx_ring->total_packets = 0;
3249 }
3250 if (q_vector->tx_ring) {
3251 q_vector->tx_ring->total_bytes = 0;
3252 q_vector->tx_ring->total_packets = 0;
3253 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003254}
3255
3256/**
3257 * igb_update_itr - update the dynamic ITR value based on statistics
3258 * Stores a new ITR value based on packets and byte
3259 * counts during the last interrupt. The advantage of per interrupt
3260 * computation is faster updates and more accurate ITR for the current
3261 * traffic pattern. Constants in this function were computed
3262 * based on theoretical maximum wire speed and thresholds were set based
3263 * on testing data as well as attempting to minimize response time
3264 * while increasing bulk throughput.
3265 * this functionality is controlled by the InterruptThrottleRate module
3266 * parameter (see igb_param.c)
3267 * NOTE: These calculations are only valid when operating in a single-
3268 * queue environment.
3269 * @adapter: pointer to adapter
Alexander Duyck047e0032009-10-27 15:49:27 +00003270 * @itr_setting: current q_vector->itr_val
Auke Kok9d5c8242008-01-24 02:22:38 -08003271 * @packets: the number of packets during this measurement interval
3272 * @bytes: the number of bytes during this measurement interval
3273 **/
3274static unsigned int igb_update_itr(struct igb_adapter *adapter, u16 itr_setting,
3275 int packets, int bytes)
3276{
3277 unsigned int retval = itr_setting;
3278
3279 if (packets == 0)
3280 goto update_itr_done;
3281
3282 switch (itr_setting) {
3283 case lowest_latency:
3284 /* handle TSO and jumbo frames */
3285 if (bytes/packets > 8000)
3286 retval = bulk_latency;
3287 else if ((packets < 5) && (bytes > 512))
3288 retval = low_latency;
3289 break;
3290 case low_latency: /* 50 usec aka 20000 ints/s */
3291 if (bytes > 10000) {
3292 /* this if handles the TSO accounting */
3293 if (bytes/packets > 8000) {
3294 retval = bulk_latency;
3295 } else if ((packets < 10) || ((bytes/packets) > 1200)) {
3296 retval = bulk_latency;
3297 } else if ((packets > 35)) {
3298 retval = lowest_latency;
3299 }
3300 } else if (bytes/packets > 2000) {
3301 retval = bulk_latency;
3302 } else if (packets <= 2 && bytes < 512) {
3303 retval = lowest_latency;
3304 }
3305 break;
3306 case bulk_latency: /* 250 usec aka 4000 ints/s */
3307 if (bytes > 25000) {
3308 if (packets > 35)
3309 retval = low_latency;
Alexander Duyck1e5c3d22009-02-12 18:17:21 +00003310 } else if (bytes < 1500) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003311 retval = low_latency;
3312 }
3313 break;
3314 }
3315
3316update_itr_done:
3317 return retval;
3318}
3319
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003320static void igb_set_itr(struct igb_adapter *adapter)
Auke Kok9d5c8242008-01-24 02:22:38 -08003321{
Alexander Duyck047e0032009-10-27 15:49:27 +00003322 struct igb_q_vector *q_vector = adapter->q_vector[0];
Auke Kok9d5c8242008-01-24 02:22:38 -08003323 u16 current_itr;
Alexander Duyck047e0032009-10-27 15:49:27 +00003324 u32 new_itr = q_vector->itr_val;
Auke Kok9d5c8242008-01-24 02:22:38 -08003325
3326 /* for non-gigabit speeds, just fix the interrupt rate at 4000 */
3327 if (adapter->link_speed != SPEED_1000) {
3328 current_itr = 0;
3329 new_itr = 4000;
3330 goto set_itr_now;
3331 }
3332
3333 adapter->rx_itr = igb_update_itr(adapter,
3334 adapter->rx_itr,
Alexander Duyck3025a442010-02-17 01:02:39 +00003335 q_vector->rx_ring->total_packets,
3336 q_vector->rx_ring->total_bytes);
Auke Kok9d5c8242008-01-24 02:22:38 -08003337
Alexander Duyck047e0032009-10-27 15:49:27 +00003338 adapter->tx_itr = igb_update_itr(adapter,
3339 adapter->tx_itr,
Alexander Duyck3025a442010-02-17 01:02:39 +00003340 q_vector->tx_ring->total_packets,
3341 q_vector->tx_ring->total_bytes);
Alexander Duyck047e0032009-10-27 15:49:27 +00003342 current_itr = max(adapter->rx_itr, adapter->tx_itr);
Auke Kok9d5c8242008-01-24 02:22:38 -08003343
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003344 /* conservative mode (itr 3) eliminates the lowest_latency setting */
Alexander Duyck4fc82ad2009-10-27 23:45:42 +00003345 if (adapter->rx_itr_setting == 3 && current_itr == lowest_latency)
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003346 current_itr = low_latency;
3347
Auke Kok9d5c8242008-01-24 02:22:38 -08003348 switch (current_itr) {
3349 /* counts and packets in update_itr are dependent on these numbers */
3350 case lowest_latency:
Alexander Duyck78b1f602009-04-23 11:20:29 +00003351 new_itr = 56; /* aka 70,000 ints/sec */
Auke Kok9d5c8242008-01-24 02:22:38 -08003352 break;
3353 case low_latency:
Alexander Duyck78b1f602009-04-23 11:20:29 +00003354 new_itr = 196; /* aka 20,000 ints/sec */
Auke Kok9d5c8242008-01-24 02:22:38 -08003355 break;
3356 case bulk_latency:
Alexander Duyck78b1f602009-04-23 11:20:29 +00003357 new_itr = 980; /* aka 4,000 ints/sec */
Auke Kok9d5c8242008-01-24 02:22:38 -08003358 break;
3359 default:
3360 break;
3361 }
3362
3363set_itr_now:
Alexander Duyck3025a442010-02-17 01:02:39 +00003364 q_vector->rx_ring->total_bytes = 0;
3365 q_vector->rx_ring->total_packets = 0;
3366 q_vector->tx_ring->total_bytes = 0;
3367 q_vector->tx_ring->total_packets = 0;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003368
Alexander Duyck047e0032009-10-27 15:49:27 +00003369 if (new_itr != q_vector->itr_val) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003370 /* this attempts to bias the interrupt rate towards Bulk
3371 * by adding intermediate steps when interrupt rate is
3372 * increasing */
Alexander Duyck047e0032009-10-27 15:49:27 +00003373 new_itr = new_itr > q_vector->itr_val ?
3374 max((new_itr * q_vector->itr_val) /
3375 (new_itr + (q_vector->itr_val >> 2)),
3376 new_itr) :
Auke Kok9d5c8242008-01-24 02:22:38 -08003377 new_itr;
3378 /* Don't write the value here; it resets the adapter's
3379 * internal timer, and causes us to delay far longer than
3380 * we should between interrupts. Instead, we write the ITR
3381 * value at the beginning of the next interrupt so the timing
3382 * ends up being correct.
3383 */
Alexander Duyck047e0032009-10-27 15:49:27 +00003384 q_vector->itr_val = new_itr;
3385 q_vector->set_itr = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -08003386 }
3387
3388 return;
3389}
3390
Auke Kok9d5c8242008-01-24 02:22:38 -08003391#define IGB_TX_FLAGS_CSUM 0x00000001
3392#define IGB_TX_FLAGS_VLAN 0x00000002
3393#define IGB_TX_FLAGS_TSO 0x00000004
3394#define IGB_TX_FLAGS_IPV4 0x00000008
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003395#define IGB_TX_FLAGS_TSTAMP 0x00000010
3396#define IGB_TX_FLAGS_VLAN_MASK 0xffff0000
3397#define IGB_TX_FLAGS_VLAN_SHIFT 16
Auke Kok9d5c8242008-01-24 02:22:38 -08003398
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003399static inline int igb_tso_adv(struct igb_ring *tx_ring,
Auke Kok9d5c8242008-01-24 02:22:38 -08003400 struct sk_buff *skb, u32 tx_flags, u8 *hdr_len)
3401{
3402 struct e1000_adv_tx_context_desc *context_desc;
3403 unsigned int i;
3404 int err;
3405 struct igb_buffer *buffer_info;
3406 u32 info = 0, tu_cmd = 0;
Nick Nunley91d4ee32010-02-17 01:04:56 +00003407 u32 mss_l4len_idx;
3408 u8 l4len;
Auke Kok9d5c8242008-01-24 02:22:38 -08003409
3410 if (skb_header_cloned(skb)) {
3411 err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
3412 if (err)
3413 return err;
3414 }
3415
3416 l4len = tcp_hdrlen(skb);
3417 *hdr_len += l4len;
3418
3419 if (skb->protocol == htons(ETH_P_IP)) {
3420 struct iphdr *iph = ip_hdr(skb);
3421 iph->tot_len = 0;
3422 iph->check = 0;
3423 tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
3424 iph->daddr, 0,
3425 IPPROTO_TCP,
3426 0);
Sridhar Samudrala8e1e8a42010-01-23 02:02:21 -08003427 } else if (skb_is_gso_v6(skb)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003428 ipv6_hdr(skb)->payload_len = 0;
3429 tcp_hdr(skb)->check = ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
3430 &ipv6_hdr(skb)->daddr,
3431 0, IPPROTO_TCP, 0);
3432 }
3433
3434 i = tx_ring->next_to_use;
3435
3436 buffer_info = &tx_ring->buffer_info[i];
3437 context_desc = E1000_TX_CTXTDESC_ADV(*tx_ring, i);
3438 /* VLAN MACLEN IPLEN */
3439 if (tx_flags & IGB_TX_FLAGS_VLAN)
3440 info |= (tx_flags & IGB_TX_FLAGS_VLAN_MASK);
3441 info |= (skb_network_offset(skb) << E1000_ADVTXD_MACLEN_SHIFT);
3442 *hdr_len += skb_network_offset(skb);
3443 info |= skb_network_header_len(skb);
3444 *hdr_len += skb_network_header_len(skb);
3445 context_desc->vlan_macip_lens = cpu_to_le32(info);
3446
3447 /* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
3448 tu_cmd |= (E1000_TXD_CMD_DEXT | E1000_ADVTXD_DTYP_CTXT);
3449
3450 if (skb->protocol == htons(ETH_P_IP))
3451 tu_cmd |= E1000_ADVTXD_TUCMD_IPV4;
3452 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_TCP;
3453
3454 context_desc->type_tucmd_mlhl = cpu_to_le32(tu_cmd);
3455
3456 /* MSS L4LEN IDX */
3457 mss_l4len_idx = (skb_shinfo(skb)->gso_size << E1000_ADVTXD_MSS_SHIFT);
3458 mss_l4len_idx |= (l4len << E1000_ADVTXD_L4LEN_SHIFT);
3459
Alexander Duyck73cd78f2009-02-12 18:16:59 +00003460 /* For 82575, context index must be unique per ring. */
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003461 if (tx_ring->flags & IGB_RING_FLAG_TX_CTX_IDX)
3462 mss_l4len_idx |= tx_ring->reg_idx << 4;
Auke Kok9d5c8242008-01-24 02:22:38 -08003463
3464 context_desc->mss_l4len_idx = cpu_to_le32(mss_l4len_idx);
3465 context_desc->seqnum_seed = 0;
3466
3467 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003468 buffer_info->next_to_watch = i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003469 buffer_info->dma = 0;
3470 i++;
3471 if (i == tx_ring->count)
3472 i = 0;
3473
3474 tx_ring->next_to_use = i;
3475
3476 return true;
3477}
3478
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003479static inline bool igb_tx_csum_adv(struct igb_ring *tx_ring,
3480 struct sk_buff *skb, u32 tx_flags)
Auke Kok9d5c8242008-01-24 02:22:38 -08003481{
3482 struct e1000_adv_tx_context_desc *context_desc;
Alexander Duyck80785292009-10-27 15:51:47 +00003483 struct pci_dev *pdev = tx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003484 struct igb_buffer *buffer_info;
3485 u32 info = 0, tu_cmd = 0;
Alexander Duyck80785292009-10-27 15:51:47 +00003486 unsigned int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003487
3488 if ((skb->ip_summed == CHECKSUM_PARTIAL) ||
3489 (tx_flags & IGB_TX_FLAGS_VLAN)) {
3490 i = tx_ring->next_to_use;
3491 buffer_info = &tx_ring->buffer_info[i];
3492 context_desc = E1000_TX_CTXTDESC_ADV(*tx_ring, i);
3493
3494 if (tx_flags & IGB_TX_FLAGS_VLAN)
3495 info |= (tx_flags & IGB_TX_FLAGS_VLAN_MASK);
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003496
Auke Kok9d5c8242008-01-24 02:22:38 -08003497 info |= (skb_network_offset(skb) << E1000_ADVTXD_MACLEN_SHIFT);
3498 if (skb->ip_summed == CHECKSUM_PARTIAL)
3499 info |= skb_network_header_len(skb);
3500
3501 context_desc->vlan_macip_lens = cpu_to_le32(info);
3502
3503 tu_cmd |= (E1000_TXD_CMD_DEXT | E1000_ADVTXD_DTYP_CTXT);
3504
3505 if (skb->ip_summed == CHECKSUM_PARTIAL) {
Arthur Jonesfa4a7ef2009-03-21 16:55:07 -07003506 __be16 protocol;
3507
3508 if (skb->protocol == cpu_to_be16(ETH_P_8021Q)) {
3509 const struct vlan_ethhdr *vhdr =
3510 (const struct vlan_ethhdr*)skb->data;
3511
3512 protocol = vhdr->h_vlan_encapsulated_proto;
3513 } else {
3514 protocol = skb->protocol;
3515 }
3516
3517 switch (protocol) {
Harvey Harrison09640e62009-02-01 00:45:17 -08003518 case cpu_to_be16(ETH_P_IP):
Auke Kok9d5c8242008-01-24 02:22:38 -08003519 tu_cmd |= E1000_ADVTXD_TUCMD_IPV4;
Mitch Williams44b0cda2008-03-07 10:32:13 -08003520 if (ip_hdr(skb)->protocol == IPPROTO_TCP)
3521 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_TCP;
Jesse Brandeburgb9473562009-04-27 22:36:13 +00003522 else if (ip_hdr(skb)->protocol == IPPROTO_SCTP)
3523 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_SCTP;
Mitch Williams44b0cda2008-03-07 10:32:13 -08003524 break;
Harvey Harrison09640e62009-02-01 00:45:17 -08003525 case cpu_to_be16(ETH_P_IPV6):
Mitch Williams44b0cda2008-03-07 10:32:13 -08003526 /* XXX what about other V6 headers?? */
3527 if (ipv6_hdr(skb)->nexthdr == IPPROTO_TCP)
3528 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_TCP;
Jesse Brandeburgb9473562009-04-27 22:36:13 +00003529 else if (ipv6_hdr(skb)->nexthdr == IPPROTO_SCTP)
3530 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_SCTP;
Mitch Williams44b0cda2008-03-07 10:32:13 -08003531 break;
3532 default:
3533 if (unlikely(net_ratelimit()))
Alexander Duyck80785292009-10-27 15:51:47 +00003534 dev_warn(&pdev->dev,
Mitch Williams44b0cda2008-03-07 10:32:13 -08003535 "partial checksum but proto=%x!\n",
3536 skb->protocol);
3537 break;
3538 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003539 }
3540
3541 context_desc->type_tucmd_mlhl = cpu_to_le32(tu_cmd);
3542 context_desc->seqnum_seed = 0;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003543 if (tx_ring->flags & IGB_RING_FLAG_TX_CTX_IDX)
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07003544 context_desc->mss_l4len_idx =
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003545 cpu_to_le32(tx_ring->reg_idx << 4);
Auke Kok9d5c8242008-01-24 02:22:38 -08003546
3547 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003548 buffer_info->next_to_watch = i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003549 buffer_info->dma = 0;
3550
3551 i++;
3552 if (i == tx_ring->count)
3553 i = 0;
3554 tx_ring->next_to_use = i;
3555
3556 return true;
3557 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003558 return false;
3559}
3560
3561#define IGB_MAX_TXD_PWR 16
3562#define IGB_MAX_DATA_PER_TXD (1<<IGB_MAX_TXD_PWR)
3563
Alexander Duyck80785292009-10-27 15:51:47 +00003564static inline int igb_tx_map_adv(struct igb_ring *tx_ring, struct sk_buff *skb,
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003565 unsigned int first)
Auke Kok9d5c8242008-01-24 02:22:38 -08003566{
3567 struct igb_buffer *buffer_info;
Alexander Duyck80785292009-10-27 15:51:47 +00003568 struct pci_dev *pdev = tx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003569 unsigned int len = skb_headlen(skb);
3570 unsigned int count = 0, i;
3571 unsigned int f;
3572
3573 i = tx_ring->next_to_use;
3574
3575 buffer_info = &tx_ring->buffer_info[i];
3576 BUG_ON(len >= IGB_MAX_DATA_PER_TXD);
3577 buffer_info->length = len;
3578 /* set time_stamp *before* dma to help avoid a possible race */
3579 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003580 buffer_info->next_to_watch = i;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003581 buffer_info->dma = pci_map_single(pdev, skb->data, len,
3582 PCI_DMA_TODEVICE);
3583 if (pci_dma_mapping_error(pdev, buffer_info->dma))
3584 goto dma_error;
Auke Kok9d5c8242008-01-24 02:22:38 -08003585
3586 for (f = 0; f < skb_shinfo(skb)->nr_frags; f++) {
3587 struct skb_frag_struct *frag;
3588
Alexander Duyck85811452010-01-23 01:35:00 -08003589 count++;
Alexander Duyck65689fe2009-03-20 00:17:43 +00003590 i++;
3591 if (i == tx_ring->count)
3592 i = 0;
3593
Auke Kok9d5c8242008-01-24 02:22:38 -08003594 frag = &skb_shinfo(skb)->frags[f];
3595 len = frag->size;
3596
3597 buffer_info = &tx_ring->buffer_info[i];
3598 BUG_ON(len >= IGB_MAX_DATA_PER_TXD);
3599 buffer_info->length = len;
3600 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003601 buffer_info->next_to_watch = i;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003602 buffer_info->mapped_as_page = true;
3603 buffer_info->dma = pci_map_page(pdev,
3604 frag->page,
3605 frag->page_offset,
3606 len,
3607 PCI_DMA_TODEVICE);
3608 if (pci_dma_mapping_error(pdev, buffer_info->dma))
3609 goto dma_error;
3610
Auke Kok9d5c8242008-01-24 02:22:38 -08003611 }
3612
Auke Kok9d5c8242008-01-24 02:22:38 -08003613 tx_ring->buffer_info[i].skb = skb;
Nick Nunley40e90c22010-02-17 01:04:37 +00003614 tx_ring->buffer_info[i].gso_segs = skb_shinfo(skb)->gso_segs ?: 1;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003615 tx_ring->buffer_info[first].next_to_watch = i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003616
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003617 return ++count;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003618
3619dma_error:
3620 dev_err(&pdev->dev, "TX DMA map failed\n");
3621
3622 /* clear timestamp and dma mappings for failed buffer_info mapping */
3623 buffer_info->dma = 0;
3624 buffer_info->time_stamp = 0;
3625 buffer_info->length = 0;
3626 buffer_info->next_to_watch = 0;
3627 buffer_info->mapped_as_page = false;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003628
3629 /* clear timestamp and dma mappings for remaining portion of packet */
Nick Nunleya77ff702010-02-17 01:06:16 +00003630 while (count--) {
3631 if (i == 0)
3632 i = tx_ring->count;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003633 i--;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003634 buffer_info = &tx_ring->buffer_info[i];
3635 igb_unmap_and_free_tx_resource(tx_ring, buffer_info);
3636 }
3637
3638 return 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08003639}
3640
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003641static inline void igb_tx_queue_adv(struct igb_ring *tx_ring,
Nick Nunley91d4ee32010-02-17 01:04:56 +00003642 u32 tx_flags, int count, u32 paylen,
Auke Kok9d5c8242008-01-24 02:22:38 -08003643 u8 hdr_len)
3644{
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003645 union e1000_adv_tx_desc *tx_desc;
Auke Kok9d5c8242008-01-24 02:22:38 -08003646 struct igb_buffer *buffer_info;
3647 u32 olinfo_status = 0, cmd_type_len;
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003648 unsigned int i = tx_ring->next_to_use;
Auke Kok9d5c8242008-01-24 02:22:38 -08003649
3650 cmd_type_len = (E1000_ADVTXD_DTYP_DATA | E1000_ADVTXD_DCMD_IFCS |
3651 E1000_ADVTXD_DCMD_DEXT);
3652
3653 if (tx_flags & IGB_TX_FLAGS_VLAN)
3654 cmd_type_len |= E1000_ADVTXD_DCMD_VLE;
3655
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003656 if (tx_flags & IGB_TX_FLAGS_TSTAMP)
3657 cmd_type_len |= E1000_ADVTXD_MAC_TSTAMP;
3658
Auke Kok9d5c8242008-01-24 02:22:38 -08003659 if (tx_flags & IGB_TX_FLAGS_TSO) {
3660 cmd_type_len |= E1000_ADVTXD_DCMD_TSE;
3661
3662 /* insert tcp checksum */
3663 olinfo_status |= E1000_TXD_POPTS_TXSM << 8;
3664
3665 /* insert ip checksum */
3666 if (tx_flags & IGB_TX_FLAGS_IPV4)
3667 olinfo_status |= E1000_TXD_POPTS_IXSM << 8;
3668
3669 } else if (tx_flags & IGB_TX_FLAGS_CSUM) {
3670 olinfo_status |= E1000_TXD_POPTS_TXSM << 8;
3671 }
3672
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003673 if ((tx_ring->flags & IGB_RING_FLAG_TX_CTX_IDX) &&
3674 (tx_flags & (IGB_TX_FLAGS_CSUM |
3675 IGB_TX_FLAGS_TSO |
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07003676 IGB_TX_FLAGS_VLAN)))
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003677 olinfo_status |= tx_ring->reg_idx << 4;
Auke Kok9d5c8242008-01-24 02:22:38 -08003678
3679 olinfo_status |= ((paylen - hdr_len) << E1000_ADVTXD_PAYLEN_SHIFT);
3680
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003681 do {
Auke Kok9d5c8242008-01-24 02:22:38 -08003682 buffer_info = &tx_ring->buffer_info[i];
3683 tx_desc = E1000_TX_DESC_ADV(*tx_ring, i);
3684 tx_desc->read.buffer_addr = cpu_to_le64(buffer_info->dma);
3685 tx_desc->read.cmd_type_len =
3686 cpu_to_le32(cmd_type_len | buffer_info->length);
3687 tx_desc->read.olinfo_status = cpu_to_le32(olinfo_status);
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003688 count--;
Auke Kok9d5c8242008-01-24 02:22:38 -08003689 i++;
3690 if (i == tx_ring->count)
3691 i = 0;
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003692 } while (count > 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08003693
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003694 tx_desc->read.cmd_type_len |= cpu_to_le32(IGB_ADVTXD_DCMD);
Auke Kok9d5c8242008-01-24 02:22:38 -08003695 /* Force memory writes to complete before letting h/w
3696 * know there are new descriptors to fetch. (Only
3697 * applicable for weak-ordered memory model archs,
3698 * such as IA-64). */
3699 wmb();
3700
3701 tx_ring->next_to_use = i;
Alexander Duyckfce99e32009-10-27 15:51:27 +00003702 writel(i, tx_ring->tail);
Auke Kok9d5c8242008-01-24 02:22:38 -08003703 /* we need this if more than one processor can write to our tail
3704 * at a time, it syncronizes IO on IA64/Altix systems */
3705 mmiowb();
3706}
3707
Alexander Duycke694e962009-10-27 15:53:06 +00003708static int __igb_maybe_stop_tx(struct igb_ring *tx_ring, int size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003709{
Alexander Duycke694e962009-10-27 15:53:06 +00003710 struct net_device *netdev = tx_ring->netdev;
3711
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003712 netif_stop_subqueue(netdev, tx_ring->queue_index);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003713
Auke Kok9d5c8242008-01-24 02:22:38 -08003714 /* Herbert's original patch had:
3715 * smp_mb__after_netif_stop_queue();
3716 * but since that doesn't exist yet, just open code it. */
3717 smp_mb();
3718
3719 /* We need to check again in a case another CPU has just
3720 * made room available. */
Alexander Duyckc493ea42009-03-20 00:16:50 +00003721 if (igb_desc_unused(tx_ring) < size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003722 return -EBUSY;
3723
3724 /* A reprieve! */
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003725 netif_wake_subqueue(netdev, tx_ring->queue_index);
Alexander Duyck04a5fca2009-10-27 15:52:27 +00003726 tx_ring->tx_stats.restart_queue++;
Auke Kok9d5c8242008-01-24 02:22:38 -08003727 return 0;
3728}
3729
Nick Nunley717ba082010-02-17 01:04:18 +00003730static inline int igb_maybe_stop_tx(struct igb_ring *tx_ring, int size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003731{
Alexander Duyckc493ea42009-03-20 00:16:50 +00003732 if (igb_desc_unused(tx_ring) >= size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003733 return 0;
Alexander Duycke694e962009-10-27 15:53:06 +00003734 return __igb_maybe_stop_tx(tx_ring, size);
Auke Kok9d5c8242008-01-24 02:22:38 -08003735}
3736
Alexander Duyckb1a436c2009-10-27 15:54:43 +00003737netdev_tx_t igb_xmit_frame_ring_adv(struct sk_buff *skb,
3738 struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08003739{
Alexander Duycke694e962009-10-27 15:53:06 +00003740 struct igb_adapter *adapter = netdev_priv(tx_ring->netdev);
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003741 int tso = 0, count;
Nick Nunley91d4ee32010-02-17 01:04:56 +00003742 u32 tx_flags = 0;
3743 u16 first;
3744 u8 hdr_len = 0;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00003745 union skb_shared_tx *shtx = skb_tx(skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08003746
Auke Kok9d5c8242008-01-24 02:22:38 -08003747 /* need: 1 descriptor per page,
3748 * + 2 desc gap to keep tail from touching head,
3749 * + 1 desc for skb->data,
3750 * + 1 desc for context descriptor,
3751 * otherwise try next time */
Alexander Duycke694e962009-10-27 15:53:06 +00003752 if (igb_maybe_stop_tx(tx_ring, skb_shinfo(skb)->nr_frags + 4)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003753 /* this is a hard error */
Auke Kok9d5c8242008-01-24 02:22:38 -08003754 return NETDEV_TX_BUSY;
3755 }
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003756
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003757 if (unlikely(shtx->hardware)) {
3758 shtx->in_progress = 1;
3759 tx_flags |= IGB_TX_FLAGS_TSTAMP;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003760 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003761
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003762 if (vlan_tx_tag_present(skb) && adapter->vlgrp) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003763 tx_flags |= IGB_TX_FLAGS_VLAN;
3764 tx_flags |= (vlan_tx_tag_get(skb) << IGB_TX_FLAGS_VLAN_SHIFT);
3765 }
3766
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003767 if (skb->protocol == htons(ETH_P_IP))
3768 tx_flags |= IGB_TX_FLAGS_IPV4;
3769
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003770 first = tx_ring->next_to_use;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003771 if (skb_is_gso(skb)) {
3772 tso = igb_tso_adv(tx_ring, skb, tx_flags, &hdr_len);
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003773
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003774 if (tso < 0) {
3775 dev_kfree_skb_any(skb);
3776 return NETDEV_TX_OK;
3777 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003778 }
3779
3780 if (tso)
3781 tx_flags |= IGB_TX_FLAGS_TSO;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003782 else if (igb_tx_csum_adv(tx_ring, skb, tx_flags) &&
Alexander Duyckbc1cbd32009-02-13 14:45:17 +00003783 (skb->ip_summed == CHECKSUM_PARTIAL))
3784 tx_flags |= IGB_TX_FLAGS_CSUM;
Auke Kok9d5c8242008-01-24 02:22:38 -08003785
Alexander Duyck65689fe2009-03-20 00:17:43 +00003786 /*
Alexander Duyckcdfd01f2009-10-27 23:50:57 +00003787 * count reflects descriptors mapped, if 0 or less then mapping error
Alexander Duyck65689fe2009-03-20 00:17:43 +00003788 * has occured and we need to rewind the descriptor queue
3789 */
Alexander Duyck80785292009-10-27 15:51:47 +00003790 count = igb_tx_map_adv(tx_ring, skb, first);
Alexander Duyck6366ad32009-12-02 16:47:18 +00003791 if (!count) {
Alexander Duyck65689fe2009-03-20 00:17:43 +00003792 dev_kfree_skb_any(skb);
3793 tx_ring->buffer_info[first].time_stamp = 0;
3794 tx_ring->next_to_use = first;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003795 return NETDEV_TX_OK;
Alexander Duyck65689fe2009-03-20 00:17:43 +00003796 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003797
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003798 igb_tx_queue_adv(tx_ring, tx_flags, count, skb->len, hdr_len);
3799
3800 /* Make sure there is space in the ring for the next send. */
Alexander Duycke694e962009-10-27 15:53:06 +00003801 igb_maybe_stop_tx(tx_ring, MAX_SKB_FRAGS + 4);
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003802
Auke Kok9d5c8242008-01-24 02:22:38 -08003803 return NETDEV_TX_OK;
3804}
3805
Stephen Hemminger3b29a562009-08-31 19:50:55 +00003806static netdev_tx_t igb_xmit_frame_adv(struct sk_buff *skb,
3807 struct net_device *netdev)
Auke Kok9d5c8242008-01-24 02:22:38 -08003808{
3809 struct igb_adapter *adapter = netdev_priv(netdev);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003810 struct igb_ring *tx_ring;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003811 int r_idx = 0;
Alexander Duyckb1a436c2009-10-27 15:54:43 +00003812
3813 if (test_bit(__IGB_DOWN, &adapter->state)) {
3814 dev_kfree_skb_any(skb);
3815 return NETDEV_TX_OK;
3816 }
3817
3818 if (skb->len <= 0) {
3819 dev_kfree_skb_any(skb);
3820 return NETDEV_TX_OK;
3821 }
3822
Alexander Duyck1bfaf072009-02-19 20:39:23 -08003823 r_idx = skb->queue_mapping & (IGB_ABS_MAX_TX_QUEUES - 1);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003824 tx_ring = adapter->multi_tx_table[r_idx];
Auke Kok9d5c8242008-01-24 02:22:38 -08003825
3826 /* This goes back to the question of how to logically map a tx queue
3827 * to a flow. Right now, performance is impacted slightly negatively
3828 * if using multiple tx queues. If the stack breaks away from a
3829 * single qdisc implementation, we can look at this again. */
Alexander Duycke694e962009-10-27 15:53:06 +00003830 return igb_xmit_frame_ring_adv(skb, tx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08003831}
3832
3833/**
3834 * igb_tx_timeout - Respond to a Tx Hang
3835 * @netdev: network interface device structure
3836 **/
3837static void igb_tx_timeout(struct net_device *netdev)
3838{
3839 struct igb_adapter *adapter = netdev_priv(netdev);
3840 struct e1000_hw *hw = &adapter->hw;
3841
3842 /* Do the reset outside of interrupt context */
3843 adapter->tx_timeout_count++;
Alexander Duyckf7ba2052009-10-27 23:48:51 +00003844
Alexander Duyck55cac242009-11-19 12:42:21 +00003845 if (hw->mac.type == e1000_82580)
3846 hw->dev_spec._82575.global_device_reset = true;
3847
Auke Kok9d5c8242008-01-24 02:22:38 -08003848 schedule_work(&adapter->reset_task);
Alexander Duyck265de402009-02-06 23:22:52 +00003849 wr32(E1000_EICS,
3850 (adapter->eims_enable_mask & ~adapter->eims_other));
Auke Kok9d5c8242008-01-24 02:22:38 -08003851}
3852
3853static void igb_reset_task(struct work_struct *work)
3854{
3855 struct igb_adapter *adapter;
3856 adapter = container_of(work, struct igb_adapter, reset_task);
3857
3858 igb_reinit_locked(adapter);
3859}
3860
3861/**
3862 * igb_get_stats - Get System Network Statistics
3863 * @netdev: network interface device structure
3864 *
3865 * Returns the address of the device statistics structure.
3866 * The statistics are actually updated from the timer callback.
3867 **/
Alexander Duyck73cd78f2009-02-12 18:16:59 +00003868static struct net_device_stats *igb_get_stats(struct net_device *netdev)
Auke Kok9d5c8242008-01-24 02:22:38 -08003869{
Auke Kok9d5c8242008-01-24 02:22:38 -08003870 /* only return the current stats */
Ajit Khaparde8d24e932009-10-07 02:42:56 +00003871 return &netdev->stats;
Auke Kok9d5c8242008-01-24 02:22:38 -08003872}
3873
3874/**
3875 * igb_change_mtu - Change the Maximum Transfer Unit
3876 * @netdev: network interface device structure
3877 * @new_mtu: new value for maximum frame size
3878 *
3879 * Returns 0 on success, negative on failure
3880 **/
3881static int igb_change_mtu(struct net_device *netdev, int new_mtu)
3882{
3883 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyck090b1792009-10-27 23:51:55 +00003884 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003885 int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;
Alexander Duyck4c844852009-10-27 15:52:07 +00003886 u32 rx_buffer_len, i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003887
Alexander Duyckc809d222009-10-27 23:52:13 +00003888 if ((new_mtu < 68) || (max_frame > MAX_JUMBO_FRAME_SIZE)) {
Alexander Duyck090b1792009-10-27 23:51:55 +00003889 dev_err(&pdev->dev, "Invalid MTU setting\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08003890 return -EINVAL;
3891 }
3892
Auke Kok9d5c8242008-01-24 02:22:38 -08003893 if (max_frame > MAX_STD_JUMBO_FRAME_SIZE) {
Alexander Duyck090b1792009-10-27 23:51:55 +00003894 dev_err(&pdev->dev, "MTU > 9216 not supported.\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08003895 return -EINVAL;
3896 }
3897
3898 while (test_and_set_bit(__IGB_RESETTING, &adapter->state))
3899 msleep(1);
Alexander Duyck73cd78f2009-02-12 18:16:59 +00003900
Auke Kok9d5c8242008-01-24 02:22:38 -08003901 /* igb_down has a dependency on max_frame_size */
3902 adapter->max_frame_size = max_frame;
Alexander Duyck559e9c42009-10-27 23:52:50 +00003903
Auke Kok9d5c8242008-01-24 02:22:38 -08003904 /* NOTE: netdev_alloc_skb reserves 16 bytes, and typically NET_IP_ALIGN
3905 * means we reserve 2 more, this pushes us to allocate from the next
3906 * larger slab size.
3907 * i.e. RXBUFFER_2048 --> size-4096 slab
3908 */
3909
Nick Nunley757b77e2010-03-26 11:36:47 +00003910 if (adapter->hw.mac.type == e1000_82580)
3911 max_frame += IGB_TS_HDR_LEN;
3912
Alexander Duyck7d95b712009-10-27 15:50:08 +00003913 if (max_frame <= IGB_RXBUFFER_1024)
Alexander Duyck4c844852009-10-27 15:52:07 +00003914 rx_buffer_len = IGB_RXBUFFER_1024;
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00003915 else if (max_frame <= MAXIMUM_ETHERNET_VLAN_SIZE)
Alexander Duyck4c844852009-10-27 15:52:07 +00003916 rx_buffer_len = MAXIMUM_ETHERNET_VLAN_SIZE;
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00003917 else
Alexander Duyck4c844852009-10-27 15:52:07 +00003918 rx_buffer_len = IGB_RXBUFFER_128;
3919
Nick Nunley757b77e2010-03-26 11:36:47 +00003920 if ((max_frame == ETH_FRAME_LEN + ETH_FCS_LEN + IGB_TS_HDR_LEN) ||
3921 (max_frame == MAXIMUM_ETHERNET_VLAN_SIZE + IGB_TS_HDR_LEN))
3922 rx_buffer_len = MAXIMUM_ETHERNET_VLAN_SIZE + IGB_TS_HDR_LEN;
3923
3924 if ((adapter->hw.mac.type == e1000_82580) &&
3925 (rx_buffer_len == IGB_RXBUFFER_128))
3926 rx_buffer_len += IGB_RXBUFFER_64;
3927
Alexander Duyck4c844852009-10-27 15:52:07 +00003928 if (netif_running(netdev))
3929 igb_down(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003930
Alexander Duyck090b1792009-10-27 23:51:55 +00003931 dev_info(&pdev->dev, "changing MTU from %d to %d\n",
Auke Kok9d5c8242008-01-24 02:22:38 -08003932 netdev->mtu, new_mtu);
3933 netdev->mtu = new_mtu;
3934
Alexander Duyck4c844852009-10-27 15:52:07 +00003935 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00003936 adapter->rx_ring[i]->rx_buffer_len = rx_buffer_len;
Alexander Duyck4c844852009-10-27 15:52:07 +00003937
Auke Kok9d5c8242008-01-24 02:22:38 -08003938 if (netif_running(netdev))
3939 igb_up(adapter);
3940 else
3941 igb_reset(adapter);
3942
3943 clear_bit(__IGB_RESETTING, &adapter->state);
3944
3945 return 0;
3946}
3947
3948/**
3949 * igb_update_stats - Update the board statistics counters
3950 * @adapter: board private structure
3951 **/
3952
3953void igb_update_stats(struct igb_adapter *adapter)
3954{
Alexander Duyck128e45e2009-11-12 18:37:38 +00003955 struct net_device_stats *net_stats = igb_get_stats(adapter->netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08003956 struct e1000_hw *hw = &adapter->hw;
3957 struct pci_dev *pdev = adapter->pdev;
Mitch Williamsfa3d9a62010-03-23 18:34:38 +00003958 u32 reg, mpc;
Auke Kok9d5c8242008-01-24 02:22:38 -08003959 u16 phy_tmp;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003960 int i;
3961 u64 bytes, packets;
Auke Kok9d5c8242008-01-24 02:22:38 -08003962
3963#define PHY_IDLE_ERROR_COUNT_MASK 0x00FF
3964
3965 /*
3966 * Prevent stats update while adapter is being reset, or if the pci
3967 * connection is down.
3968 */
3969 if (adapter->link_speed == 0)
3970 return;
3971 if (pci_channel_offline(pdev))
3972 return;
3973
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003974 bytes = 0;
3975 packets = 0;
3976 for (i = 0; i < adapter->num_rx_queues; i++) {
3977 u32 rqdpc_tmp = rd32(E1000_RQDPC(i)) & 0x0FFF;
Alexander Duyck3025a442010-02-17 01:02:39 +00003978 struct igb_ring *ring = adapter->rx_ring[i];
3979 ring->rx_stats.drops += rqdpc_tmp;
Alexander Duyck128e45e2009-11-12 18:37:38 +00003980 net_stats->rx_fifo_errors += rqdpc_tmp;
Alexander Duyck3025a442010-02-17 01:02:39 +00003981 bytes += ring->rx_stats.bytes;
3982 packets += ring->rx_stats.packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003983 }
3984
Alexander Duyck128e45e2009-11-12 18:37:38 +00003985 net_stats->rx_bytes = bytes;
3986 net_stats->rx_packets = packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003987
3988 bytes = 0;
3989 packets = 0;
3990 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00003991 struct igb_ring *ring = adapter->tx_ring[i];
3992 bytes += ring->tx_stats.bytes;
3993 packets += ring->tx_stats.packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003994 }
Alexander Duyck128e45e2009-11-12 18:37:38 +00003995 net_stats->tx_bytes = bytes;
3996 net_stats->tx_packets = packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003997
3998 /* read stats registers */
Auke Kok9d5c8242008-01-24 02:22:38 -08003999 adapter->stats.crcerrs += rd32(E1000_CRCERRS);
4000 adapter->stats.gprc += rd32(E1000_GPRC);
4001 adapter->stats.gorc += rd32(E1000_GORCL);
4002 rd32(E1000_GORCH); /* clear GORCL */
4003 adapter->stats.bprc += rd32(E1000_BPRC);
4004 adapter->stats.mprc += rd32(E1000_MPRC);
4005 adapter->stats.roc += rd32(E1000_ROC);
4006
4007 adapter->stats.prc64 += rd32(E1000_PRC64);
4008 adapter->stats.prc127 += rd32(E1000_PRC127);
4009 adapter->stats.prc255 += rd32(E1000_PRC255);
4010 adapter->stats.prc511 += rd32(E1000_PRC511);
4011 adapter->stats.prc1023 += rd32(E1000_PRC1023);
4012 adapter->stats.prc1522 += rd32(E1000_PRC1522);
4013 adapter->stats.symerrs += rd32(E1000_SYMERRS);
4014 adapter->stats.sec += rd32(E1000_SEC);
4015
Mitch Williamsfa3d9a62010-03-23 18:34:38 +00004016 mpc = rd32(E1000_MPC);
4017 adapter->stats.mpc += mpc;
4018 net_stats->rx_fifo_errors += mpc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004019 adapter->stats.scc += rd32(E1000_SCC);
4020 adapter->stats.ecol += rd32(E1000_ECOL);
4021 adapter->stats.mcc += rd32(E1000_MCC);
4022 adapter->stats.latecol += rd32(E1000_LATECOL);
4023 adapter->stats.dc += rd32(E1000_DC);
4024 adapter->stats.rlec += rd32(E1000_RLEC);
4025 adapter->stats.xonrxc += rd32(E1000_XONRXC);
4026 adapter->stats.xontxc += rd32(E1000_XONTXC);
4027 adapter->stats.xoffrxc += rd32(E1000_XOFFRXC);
4028 adapter->stats.xofftxc += rd32(E1000_XOFFTXC);
4029 adapter->stats.fcruc += rd32(E1000_FCRUC);
4030 adapter->stats.gptc += rd32(E1000_GPTC);
4031 adapter->stats.gotc += rd32(E1000_GOTCL);
4032 rd32(E1000_GOTCH); /* clear GOTCL */
Mitch Williamsfa3d9a62010-03-23 18:34:38 +00004033 adapter->stats.rnbc += rd32(E1000_RNBC);
Auke Kok9d5c8242008-01-24 02:22:38 -08004034 adapter->stats.ruc += rd32(E1000_RUC);
4035 adapter->stats.rfc += rd32(E1000_RFC);
4036 adapter->stats.rjc += rd32(E1000_RJC);
4037 adapter->stats.tor += rd32(E1000_TORH);
4038 adapter->stats.tot += rd32(E1000_TOTH);
4039 adapter->stats.tpr += rd32(E1000_TPR);
4040
4041 adapter->stats.ptc64 += rd32(E1000_PTC64);
4042 adapter->stats.ptc127 += rd32(E1000_PTC127);
4043 adapter->stats.ptc255 += rd32(E1000_PTC255);
4044 adapter->stats.ptc511 += rd32(E1000_PTC511);
4045 adapter->stats.ptc1023 += rd32(E1000_PTC1023);
4046 adapter->stats.ptc1522 += rd32(E1000_PTC1522);
4047
4048 adapter->stats.mptc += rd32(E1000_MPTC);
4049 adapter->stats.bptc += rd32(E1000_BPTC);
4050
Nick Nunley2d0b0f62010-02-17 01:02:59 +00004051 adapter->stats.tpt += rd32(E1000_TPT);
4052 adapter->stats.colc += rd32(E1000_COLC);
Auke Kok9d5c8242008-01-24 02:22:38 -08004053
4054 adapter->stats.algnerrc += rd32(E1000_ALGNERRC);
Nick Nunley43915c7c2010-02-17 01:03:58 +00004055 /* read internal phy specific stats */
4056 reg = rd32(E1000_CTRL_EXT);
4057 if (!(reg & E1000_CTRL_EXT_LINK_MODE_MASK)) {
4058 adapter->stats.rxerrc += rd32(E1000_RXERRC);
4059 adapter->stats.tncrs += rd32(E1000_TNCRS);
4060 }
4061
Auke Kok9d5c8242008-01-24 02:22:38 -08004062 adapter->stats.tsctc += rd32(E1000_TSCTC);
4063 adapter->stats.tsctfc += rd32(E1000_TSCTFC);
4064
4065 adapter->stats.iac += rd32(E1000_IAC);
4066 adapter->stats.icrxoc += rd32(E1000_ICRXOC);
4067 adapter->stats.icrxptc += rd32(E1000_ICRXPTC);
4068 adapter->stats.icrxatc += rd32(E1000_ICRXATC);
4069 adapter->stats.ictxptc += rd32(E1000_ICTXPTC);
4070 adapter->stats.ictxatc += rd32(E1000_ICTXATC);
4071 adapter->stats.ictxqec += rd32(E1000_ICTXQEC);
4072 adapter->stats.ictxqmtc += rd32(E1000_ICTXQMTC);
4073 adapter->stats.icrxdmtc += rd32(E1000_ICRXDMTC);
4074
4075 /* Fill out the OS statistics structure */
Alexander Duyck128e45e2009-11-12 18:37:38 +00004076 net_stats->multicast = adapter->stats.mprc;
4077 net_stats->collisions = adapter->stats.colc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004078
4079 /* Rx Errors */
4080
4081 /* RLEC on some newer hardware can be incorrect so build
Jesper Dangaard Brouer8c0ab702009-05-26 13:50:31 +00004082 * our own version based on RUC and ROC */
Alexander Duyck128e45e2009-11-12 18:37:38 +00004083 net_stats->rx_errors = adapter->stats.rxerrc +
Auke Kok9d5c8242008-01-24 02:22:38 -08004084 adapter->stats.crcerrs + adapter->stats.algnerrc +
4085 adapter->stats.ruc + adapter->stats.roc +
4086 adapter->stats.cexterr;
Alexander Duyck128e45e2009-11-12 18:37:38 +00004087 net_stats->rx_length_errors = adapter->stats.ruc +
4088 adapter->stats.roc;
4089 net_stats->rx_crc_errors = adapter->stats.crcerrs;
4090 net_stats->rx_frame_errors = adapter->stats.algnerrc;
4091 net_stats->rx_missed_errors = adapter->stats.mpc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004092
4093 /* Tx Errors */
Alexander Duyck128e45e2009-11-12 18:37:38 +00004094 net_stats->tx_errors = adapter->stats.ecol +
4095 adapter->stats.latecol;
4096 net_stats->tx_aborted_errors = adapter->stats.ecol;
4097 net_stats->tx_window_errors = adapter->stats.latecol;
4098 net_stats->tx_carrier_errors = adapter->stats.tncrs;
Auke Kok9d5c8242008-01-24 02:22:38 -08004099
4100 /* Tx Dropped needs to be maintained elsewhere */
4101
4102 /* Phy Stats */
4103 if (hw->phy.media_type == e1000_media_type_copper) {
4104 if ((adapter->link_speed == SPEED_1000) &&
Alexander Duyck73cd78f2009-02-12 18:16:59 +00004105 (!igb_read_phy_reg(hw, PHY_1000T_STATUS, &phy_tmp))) {
Auke Kok9d5c8242008-01-24 02:22:38 -08004106 phy_tmp &= PHY_IDLE_ERROR_COUNT_MASK;
4107 adapter->phy_stats.idle_errors += phy_tmp;
4108 }
4109 }
4110
4111 /* Management Stats */
4112 adapter->stats.mgptc += rd32(E1000_MGTPTC);
4113 adapter->stats.mgprc += rd32(E1000_MGTPRC);
4114 adapter->stats.mgpdc += rd32(E1000_MGTPDC);
4115}
4116
Auke Kok9d5c8242008-01-24 02:22:38 -08004117static irqreturn_t igb_msix_other(int irq, void *data)
4118{
Alexander Duyck047e0032009-10-27 15:49:27 +00004119 struct igb_adapter *adapter = data;
Auke Kok9d5c8242008-01-24 02:22:38 -08004120 struct e1000_hw *hw = &adapter->hw;
PJ Waskiewicz844290e2008-06-27 11:00:39 -07004121 u32 icr = rd32(E1000_ICR);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07004122 /* reading ICR causes bit 31 of EICR to be cleared */
Alexander Duyckdda0e082009-02-06 23:19:08 +00004123
Alexander Duyck7f081d42010-01-07 17:41:00 +00004124 if (icr & E1000_ICR_DRSTA)
4125 schedule_work(&adapter->reset_task);
4126
Alexander Duyck047e0032009-10-27 15:49:27 +00004127 if (icr & E1000_ICR_DOUTSYNC) {
Alexander Duyckdda0e082009-02-06 23:19:08 +00004128 /* HW is reporting DMA is out of sync */
4129 adapter->stats.doosync++;
4130 }
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00004131
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004132 /* Check for a mailbox event */
4133 if (icr & E1000_ICR_VMMB)
4134 igb_msg_task(adapter);
4135
4136 if (icr & E1000_ICR_LSC) {
4137 hw->mac.get_link_status = 1;
4138 /* guard against interrupt when we're going down */
4139 if (!test_bit(__IGB_DOWN, &adapter->state))
4140 mod_timer(&adapter->watchdog_timer, jiffies + 1);
4141 }
4142
Alexander Duyck25568a52009-10-27 23:49:59 +00004143 if (adapter->vfs_allocated_count)
4144 wr32(E1000_IMS, E1000_IMS_LSC |
4145 E1000_IMS_VMMB |
4146 E1000_IMS_DOUTSYNC);
4147 else
4148 wr32(E1000_IMS, E1000_IMS_LSC | E1000_IMS_DOUTSYNC);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07004149 wr32(E1000_EIMS, adapter->eims_other);
Auke Kok9d5c8242008-01-24 02:22:38 -08004150
4151 return IRQ_HANDLED;
4152}
4153
Alexander Duyck047e0032009-10-27 15:49:27 +00004154static void igb_write_itr(struct igb_q_vector *q_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -08004155{
Alexander Duyck26b39272010-02-17 01:00:41 +00004156 struct igb_adapter *adapter = q_vector->adapter;
Alexander Duyck047e0032009-10-27 15:49:27 +00004157 u32 itr_val = q_vector->itr_val & 0x7FFC;
Auke Kok9d5c8242008-01-24 02:22:38 -08004158
Alexander Duyck047e0032009-10-27 15:49:27 +00004159 if (!q_vector->set_itr)
4160 return;
Alexander Duyck73cd78f2009-02-12 18:16:59 +00004161
Alexander Duyck047e0032009-10-27 15:49:27 +00004162 if (!itr_val)
4163 itr_val = 0x4;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004164
Alexander Duyck26b39272010-02-17 01:00:41 +00004165 if (adapter->hw.mac.type == e1000_82575)
4166 itr_val |= itr_val << 16;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004167 else
Alexander Duyck047e0032009-10-27 15:49:27 +00004168 itr_val |= 0x8000000;
4169
4170 writel(itr_val, q_vector->itr_register);
4171 q_vector->set_itr = 0;
4172}
4173
4174static irqreturn_t igb_msix_ring(int irq, void *data)
4175{
4176 struct igb_q_vector *q_vector = data;
4177
4178 /* Write the ITR value calculated from the previous interrupt. */
4179 igb_write_itr(q_vector);
4180
4181 napi_schedule(&q_vector->napi);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004182
Auke Kok9d5c8242008-01-24 02:22:38 -08004183 return IRQ_HANDLED;
4184}
4185
Jeff Kirsher421e02f2008-10-17 11:08:31 -07004186#ifdef CONFIG_IGB_DCA
Alexander Duyck047e0032009-10-27 15:49:27 +00004187static void igb_update_dca(struct igb_q_vector *q_vector)
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004188{
Alexander Duyck047e0032009-10-27 15:49:27 +00004189 struct igb_adapter *adapter = q_vector->adapter;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004190 struct e1000_hw *hw = &adapter->hw;
4191 int cpu = get_cpu();
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004192
Alexander Duyck047e0032009-10-27 15:49:27 +00004193 if (q_vector->cpu == cpu)
4194 goto out_no_update;
4195
4196 if (q_vector->tx_ring) {
4197 int q = q_vector->tx_ring->reg_idx;
4198 u32 dca_txctrl = rd32(E1000_DCA_TXCTRL(q));
4199 if (hw->mac.type == e1000_82575) {
4200 dca_txctrl &= ~E1000_DCA_TXCTRL_CPUID_MASK;
4201 dca_txctrl |= dca3_get_tag(&adapter->pdev->dev, cpu);
4202 } else {
4203 dca_txctrl &= ~E1000_DCA_TXCTRL_CPUID_MASK_82576;
4204 dca_txctrl |= dca3_get_tag(&adapter->pdev->dev, cpu) <<
4205 E1000_DCA_TXCTRL_CPUID_SHIFT;
4206 }
4207 dca_txctrl |= E1000_DCA_TXCTRL_DESC_DCA_EN;
4208 wr32(E1000_DCA_TXCTRL(q), dca_txctrl);
4209 }
4210 if (q_vector->rx_ring) {
4211 int q = q_vector->rx_ring->reg_idx;
4212 u32 dca_rxctrl = rd32(E1000_DCA_RXCTRL(q));
4213 if (hw->mac.type == e1000_82575) {
4214 dca_rxctrl &= ~E1000_DCA_RXCTRL_CPUID_MASK;
4215 dca_rxctrl |= dca3_get_tag(&adapter->pdev->dev, cpu);
4216 } else {
Alexander Duyck2d064c02008-07-08 15:10:12 -07004217 dca_rxctrl &= ~E1000_DCA_RXCTRL_CPUID_MASK_82576;
Maciej Sosnowski92be7912009-03-13 20:40:21 +00004218 dca_rxctrl |= dca3_get_tag(&adapter->pdev->dev, cpu) <<
Alexander Duyck2d064c02008-07-08 15:10:12 -07004219 E1000_DCA_RXCTRL_CPUID_SHIFT;
Alexander Duyck2d064c02008-07-08 15:10:12 -07004220 }
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004221 dca_rxctrl |= E1000_DCA_RXCTRL_DESC_DCA_EN;
4222 dca_rxctrl |= E1000_DCA_RXCTRL_HEAD_DCA_EN;
4223 dca_rxctrl |= E1000_DCA_RXCTRL_DATA_DCA_EN;
4224 wr32(E1000_DCA_RXCTRL(q), dca_rxctrl);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004225 }
Alexander Duyck047e0032009-10-27 15:49:27 +00004226 q_vector->cpu = cpu;
4227out_no_update:
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004228 put_cpu();
4229}
4230
4231static void igb_setup_dca(struct igb_adapter *adapter)
4232{
Alexander Duyck7e0e99e2009-05-21 13:06:56 +00004233 struct e1000_hw *hw = &adapter->hw;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004234 int i;
4235
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004236 if (!(adapter->flags & IGB_FLAG_DCA_ENABLED))
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004237 return;
4238
Alexander Duyck7e0e99e2009-05-21 13:06:56 +00004239 /* Always use CB2 mode, difference is masked in the CB driver. */
4240 wr32(E1000_DCA_CTRL, E1000_DCA_CTRL_DCA_MODE_CB2);
4241
Alexander Duyck047e0032009-10-27 15:49:27 +00004242 for (i = 0; i < adapter->num_q_vectors; i++) {
Alexander Duyck26b39272010-02-17 01:00:41 +00004243 adapter->q_vector[i]->cpu = -1;
4244 igb_update_dca(adapter->q_vector[i]);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004245 }
4246}
4247
4248static int __igb_notify_dca(struct device *dev, void *data)
4249{
4250 struct net_device *netdev = dev_get_drvdata(dev);
4251 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyck090b1792009-10-27 23:51:55 +00004252 struct pci_dev *pdev = adapter->pdev;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004253 struct e1000_hw *hw = &adapter->hw;
4254 unsigned long event = *(unsigned long *)data;
4255
4256 switch (event) {
4257 case DCA_PROVIDER_ADD:
4258 /* if already enabled, don't do it again */
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004259 if (adapter->flags & IGB_FLAG_DCA_ENABLED)
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004260 break;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004261 if (dca_add_requester(dev) == 0) {
Alexander Duyckbbd98fe2009-01-31 00:52:30 -08004262 adapter->flags |= IGB_FLAG_DCA_ENABLED;
Alexander Duyck090b1792009-10-27 23:51:55 +00004263 dev_info(&pdev->dev, "DCA enabled\n");
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004264 igb_setup_dca(adapter);
4265 break;
4266 }
4267 /* Fall Through since DCA is disabled. */
4268 case DCA_PROVIDER_REMOVE:
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004269 if (adapter->flags & IGB_FLAG_DCA_ENABLED) {
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004270 /* without this a class_device is left
Alexander Duyck047e0032009-10-27 15:49:27 +00004271 * hanging around in the sysfs model */
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004272 dca_remove_requester(dev);
Alexander Duyck090b1792009-10-27 23:51:55 +00004273 dev_info(&pdev->dev, "DCA disabled\n");
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004274 adapter->flags &= ~IGB_FLAG_DCA_ENABLED;
Alexander Duyckcbd347a2009-02-15 23:59:44 -08004275 wr32(E1000_DCA_CTRL, E1000_DCA_CTRL_DCA_MODE_DISABLE);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004276 }
4277 break;
4278 }
Alexander Duyckbbd98fe2009-01-31 00:52:30 -08004279
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004280 return 0;
4281}
4282
4283static int igb_notify_dca(struct notifier_block *nb, unsigned long event,
4284 void *p)
4285{
4286 int ret_val;
4287
4288 ret_val = driver_for_each_device(&igb_driver.driver, NULL, &event,
4289 __igb_notify_dca);
4290
4291 return ret_val ? NOTIFY_BAD : NOTIFY_DONE;
4292}
Jeff Kirsher421e02f2008-10-17 11:08:31 -07004293#endif /* CONFIG_IGB_DCA */
Auke Kok9d5c8242008-01-24 02:22:38 -08004294
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004295static void igb_ping_all_vfs(struct igb_adapter *adapter)
4296{
4297 struct e1000_hw *hw = &adapter->hw;
4298 u32 ping;
4299 int i;
4300
4301 for (i = 0 ; i < adapter->vfs_allocated_count; i++) {
4302 ping = E1000_PF_CONTROL_MSG;
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004303 if (adapter->vf_data[i].flags & IGB_VF_FLAG_CTS)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004304 ping |= E1000_VT_MSGTYPE_CTS;
4305 igb_write_mbx(hw, &ping, 1, i);
4306 }
4307}
4308
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004309static int igb_set_vf_promisc(struct igb_adapter *adapter, u32 *msgbuf, u32 vf)
4310{
4311 struct e1000_hw *hw = &adapter->hw;
4312 u32 vmolr = rd32(E1000_VMOLR(vf));
4313 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
4314
4315 vf_data->flags |= ~(IGB_VF_FLAG_UNI_PROMISC |
4316 IGB_VF_FLAG_MULTI_PROMISC);
4317 vmolr &= ~(E1000_VMOLR_ROPE | E1000_VMOLR_ROMPE | E1000_VMOLR_MPME);
4318
4319 if (*msgbuf & E1000_VF_SET_PROMISC_MULTICAST) {
4320 vmolr |= E1000_VMOLR_MPME;
4321 *msgbuf &= ~E1000_VF_SET_PROMISC_MULTICAST;
4322 } else {
4323 /*
4324 * if we have hashes and we are clearing a multicast promisc
4325 * flag we need to write the hashes to the MTA as this step
4326 * was previously skipped
4327 */
4328 if (vf_data->num_vf_mc_hashes > 30) {
4329 vmolr |= E1000_VMOLR_MPME;
4330 } else if (vf_data->num_vf_mc_hashes) {
4331 int j;
4332 vmolr |= E1000_VMOLR_ROMPE;
4333 for (j = 0; j < vf_data->num_vf_mc_hashes; j++)
4334 igb_mta_set(hw, vf_data->vf_mc_hashes[j]);
4335 }
4336 }
4337
4338 wr32(E1000_VMOLR(vf), vmolr);
4339
4340 /* there are flags left unprocessed, likely not supported */
4341 if (*msgbuf & E1000_VT_MSGINFO_MASK)
4342 return -EINVAL;
4343
4344 return 0;
4345
4346}
4347
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004348static int igb_set_vf_multicasts(struct igb_adapter *adapter,
4349 u32 *msgbuf, u32 vf)
4350{
4351 int n = (msgbuf[0] & E1000_VT_MSGINFO_MASK) >> E1000_VT_MSGINFO_SHIFT;
4352 u16 *hash_list = (u16 *)&msgbuf[1];
4353 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
4354 int i;
4355
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004356 /* salt away the number of multicast addresses assigned
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004357 * to this VF for later use to restore when the PF multi cast
4358 * list changes
4359 */
4360 vf_data->num_vf_mc_hashes = n;
4361
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004362 /* only up to 30 hash values supported */
4363 if (n > 30)
4364 n = 30;
4365
4366 /* store the hashes for later use */
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004367 for (i = 0; i < n; i++)
Joe Perchesa419aef2009-08-18 11:18:35 -07004368 vf_data->vf_mc_hashes[i] = hash_list[i];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004369
4370 /* Flush and reset the mta with the new values */
Alexander Duyckff41f8d2009-09-03 14:48:56 +00004371 igb_set_rx_mode(adapter->netdev);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004372
4373 return 0;
4374}
4375
4376static void igb_restore_vf_multicasts(struct igb_adapter *adapter)
4377{
4378 struct e1000_hw *hw = &adapter->hw;
4379 struct vf_data_storage *vf_data;
4380 int i, j;
4381
4382 for (i = 0; i < adapter->vfs_allocated_count; i++) {
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004383 u32 vmolr = rd32(E1000_VMOLR(i));
4384 vmolr &= ~(E1000_VMOLR_ROMPE | E1000_VMOLR_MPME);
4385
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004386 vf_data = &adapter->vf_data[i];
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004387
4388 if ((vf_data->num_vf_mc_hashes > 30) ||
4389 (vf_data->flags & IGB_VF_FLAG_MULTI_PROMISC)) {
4390 vmolr |= E1000_VMOLR_MPME;
4391 } else if (vf_data->num_vf_mc_hashes) {
4392 vmolr |= E1000_VMOLR_ROMPE;
4393 for (j = 0; j < vf_data->num_vf_mc_hashes; j++)
4394 igb_mta_set(hw, vf_data->vf_mc_hashes[j]);
4395 }
4396 wr32(E1000_VMOLR(i), vmolr);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004397 }
4398}
4399
4400static void igb_clear_vf_vfta(struct igb_adapter *adapter, u32 vf)
4401{
4402 struct e1000_hw *hw = &adapter->hw;
4403 u32 pool_mask, reg, vid;
4404 int i;
4405
4406 pool_mask = 1 << (E1000_VLVF_POOLSEL_SHIFT + vf);
4407
4408 /* Find the vlan filter for this id */
4409 for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
4410 reg = rd32(E1000_VLVF(i));
4411
4412 /* remove the vf from the pool */
4413 reg &= ~pool_mask;
4414
4415 /* if pool is empty then remove entry from vfta */
4416 if (!(reg & E1000_VLVF_POOLSEL_MASK) &&
4417 (reg & E1000_VLVF_VLANID_ENABLE)) {
4418 reg = 0;
4419 vid = reg & E1000_VLVF_VLANID_MASK;
4420 igb_vfta_set(hw, vid, false);
4421 }
4422
4423 wr32(E1000_VLVF(i), reg);
4424 }
Alexander Duyckae641bd2009-09-03 14:49:33 +00004425
4426 adapter->vf_data[vf].vlans_enabled = 0;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004427}
4428
4429static s32 igb_vlvf_set(struct igb_adapter *adapter, u32 vid, bool add, u32 vf)
4430{
4431 struct e1000_hw *hw = &adapter->hw;
4432 u32 reg, i;
4433
Alexander Duyck51466232009-10-27 23:47:35 +00004434 /* The vlvf table only exists on 82576 hardware and newer */
4435 if (hw->mac.type < e1000_82576)
4436 return -1;
4437
4438 /* we only need to do this if VMDq is enabled */
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004439 if (!adapter->vfs_allocated_count)
4440 return -1;
4441
4442 /* Find the vlan filter for this id */
4443 for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
4444 reg = rd32(E1000_VLVF(i));
4445 if ((reg & E1000_VLVF_VLANID_ENABLE) &&
4446 vid == (reg & E1000_VLVF_VLANID_MASK))
4447 break;
4448 }
4449
4450 if (add) {
4451 if (i == E1000_VLVF_ARRAY_SIZE) {
4452 /* Did not find a matching VLAN ID entry that was
4453 * enabled. Search for a free filter entry, i.e.
4454 * one without the enable bit set
4455 */
4456 for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
4457 reg = rd32(E1000_VLVF(i));
4458 if (!(reg & E1000_VLVF_VLANID_ENABLE))
4459 break;
4460 }
4461 }
4462 if (i < E1000_VLVF_ARRAY_SIZE) {
4463 /* Found an enabled/available entry */
4464 reg |= 1 << (E1000_VLVF_POOLSEL_SHIFT + vf);
4465
4466 /* if !enabled we need to set this up in vfta */
4467 if (!(reg & E1000_VLVF_VLANID_ENABLE)) {
Alexander Duyck51466232009-10-27 23:47:35 +00004468 /* add VID to filter table */
4469 igb_vfta_set(hw, vid, true);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004470 reg |= E1000_VLVF_VLANID_ENABLE;
4471 }
Alexander Duyckcad6d052009-03-13 20:41:37 +00004472 reg &= ~E1000_VLVF_VLANID_MASK;
4473 reg |= vid;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004474 wr32(E1000_VLVF(i), reg);
Alexander Duyckae641bd2009-09-03 14:49:33 +00004475
4476 /* do not modify RLPML for PF devices */
4477 if (vf >= adapter->vfs_allocated_count)
4478 return 0;
4479
4480 if (!adapter->vf_data[vf].vlans_enabled) {
4481 u32 size;
4482 reg = rd32(E1000_VMOLR(vf));
4483 size = reg & E1000_VMOLR_RLPML_MASK;
4484 size += 4;
4485 reg &= ~E1000_VMOLR_RLPML_MASK;
4486 reg |= size;
4487 wr32(E1000_VMOLR(vf), reg);
4488 }
Alexander Duyckae641bd2009-09-03 14:49:33 +00004489
Alexander Duyck51466232009-10-27 23:47:35 +00004490 adapter->vf_data[vf].vlans_enabled++;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004491 return 0;
4492 }
4493 } else {
4494 if (i < E1000_VLVF_ARRAY_SIZE) {
4495 /* remove vf from the pool */
4496 reg &= ~(1 << (E1000_VLVF_POOLSEL_SHIFT + vf));
4497 /* if pool is empty then remove entry from vfta */
4498 if (!(reg & E1000_VLVF_POOLSEL_MASK)) {
4499 reg = 0;
4500 igb_vfta_set(hw, vid, false);
4501 }
4502 wr32(E1000_VLVF(i), reg);
Alexander Duyckae641bd2009-09-03 14:49:33 +00004503
4504 /* do not modify RLPML for PF devices */
4505 if (vf >= adapter->vfs_allocated_count)
4506 return 0;
4507
4508 adapter->vf_data[vf].vlans_enabled--;
4509 if (!adapter->vf_data[vf].vlans_enabled) {
4510 u32 size;
4511 reg = rd32(E1000_VMOLR(vf));
4512 size = reg & E1000_VMOLR_RLPML_MASK;
4513 size -= 4;
4514 reg &= ~E1000_VMOLR_RLPML_MASK;
4515 reg |= size;
4516 wr32(E1000_VMOLR(vf), reg);
4517 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004518 }
4519 }
Williams, Mitch A8151d292010-02-10 01:44:24 +00004520 return 0;
4521}
4522
4523static void igb_set_vmvir(struct igb_adapter *adapter, u32 vid, u32 vf)
4524{
4525 struct e1000_hw *hw = &adapter->hw;
4526
4527 if (vid)
4528 wr32(E1000_VMVIR(vf), (vid | E1000_VMVIR_VLANA_DEFAULT));
4529 else
4530 wr32(E1000_VMVIR(vf), 0);
4531}
4532
4533static int igb_ndo_set_vf_vlan(struct net_device *netdev,
4534 int vf, u16 vlan, u8 qos)
4535{
4536 int err = 0;
4537 struct igb_adapter *adapter = netdev_priv(netdev);
4538
4539 if ((vf >= adapter->vfs_allocated_count) || (vlan > 4095) || (qos > 7))
4540 return -EINVAL;
4541 if (vlan || qos) {
4542 err = igb_vlvf_set(adapter, vlan, !!vlan, vf);
4543 if (err)
4544 goto out;
4545 igb_set_vmvir(adapter, vlan | (qos << VLAN_PRIO_SHIFT), vf);
4546 igb_set_vmolr(adapter, vf, !vlan);
4547 adapter->vf_data[vf].pf_vlan = vlan;
4548 adapter->vf_data[vf].pf_qos = qos;
4549 dev_info(&adapter->pdev->dev,
4550 "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
4551 if (test_bit(__IGB_DOWN, &adapter->state)) {
4552 dev_warn(&adapter->pdev->dev,
4553 "The VF VLAN has been set,"
4554 " but the PF device is not up.\n");
4555 dev_warn(&adapter->pdev->dev,
4556 "Bring the PF device up before"
4557 " attempting to use the VF device.\n");
4558 }
4559 } else {
4560 igb_vlvf_set(adapter, adapter->vf_data[vf].pf_vlan,
4561 false, vf);
4562 igb_set_vmvir(adapter, vlan, vf);
4563 igb_set_vmolr(adapter, vf, true);
4564 adapter->vf_data[vf].pf_vlan = 0;
4565 adapter->vf_data[vf].pf_qos = 0;
4566 }
4567out:
4568 return err;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004569}
4570
4571static int igb_set_vf_vlan(struct igb_adapter *adapter, u32 *msgbuf, u32 vf)
4572{
4573 int add = (msgbuf[0] & E1000_VT_MSGINFO_MASK) >> E1000_VT_MSGINFO_SHIFT;
4574 int vid = (msgbuf[1] & E1000_VLVF_VLANID_MASK);
4575
4576 return igb_vlvf_set(adapter, vid, add, vf);
4577}
4578
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004579static inline void igb_vf_reset(struct igb_adapter *adapter, u32 vf)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004580{
Williams, Mitch A8151d292010-02-10 01:44:24 +00004581 /* clear flags */
4582 adapter->vf_data[vf].flags &= ~(IGB_VF_FLAG_PF_SET_MAC);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004583 adapter->vf_data[vf].last_nack = jiffies;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004584
4585 /* reset offloads to defaults */
Williams, Mitch A8151d292010-02-10 01:44:24 +00004586 igb_set_vmolr(adapter, vf, true);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004587
4588 /* reset vlans for device */
4589 igb_clear_vf_vfta(adapter, vf);
Williams, Mitch A8151d292010-02-10 01:44:24 +00004590 if (adapter->vf_data[vf].pf_vlan)
4591 igb_ndo_set_vf_vlan(adapter->netdev, vf,
4592 adapter->vf_data[vf].pf_vlan,
4593 adapter->vf_data[vf].pf_qos);
4594 else
4595 igb_clear_vf_vfta(adapter, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004596
4597 /* reset multicast table array for vf */
4598 adapter->vf_data[vf].num_vf_mc_hashes = 0;
4599
4600 /* Flush and reset the mta with the new values */
Alexander Duyckff41f8d2009-09-03 14:48:56 +00004601 igb_set_rx_mode(adapter->netdev);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004602}
4603
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004604static void igb_vf_reset_event(struct igb_adapter *adapter, u32 vf)
4605{
4606 unsigned char *vf_mac = adapter->vf_data[vf].vf_mac_addresses;
4607
4608 /* generate a new mac address as we were hotplug removed/added */
Williams, Mitch A8151d292010-02-10 01:44:24 +00004609 if (!(adapter->vf_data[vf].flags & IGB_VF_FLAG_PF_SET_MAC))
4610 random_ether_addr(vf_mac);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004611
4612 /* process remaining reset events */
4613 igb_vf_reset(adapter, vf);
4614}
4615
4616static void igb_vf_reset_msg(struct igb_adapter *adapter, u32 vf)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004617{
4618 struct e1000_hw *hw = &adapter->hw;
4619 unsigned char *vf_mac = adapter->vf_data[vf].vf_mac_addresses;
Alexander Duyckff41f8d2009-09-03 14:48:56 +00004620 int rar_entry = hw->mac.rar_entry_count - (vf + 1);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004621 u32 reg, msgbuf[3];
4622 u8 *addr = (u8 *)(&msgbuf[1]);
4623
4624 /* process all the same items cleared in a function level reset */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004625 igb_vf_reset(adapter, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004626
4627 /* set vf mac address */
Alexander Duyck26ad9172009-10-05 06:32:49 +00004628 igb_rar_set_qsel(adapter, vf_mac, rar_entry, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004629
4630 /* enable transmit and receive for vf */
4631 reg = rd32(E1000_VFTE);
4632 wr32(E1000_VFTE, reg | (1 << vf));
4633 reg = rd32(E1000_VFRE);
4634 wr32(E1000_VFRE, reg | (1 << vf));
4635
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004636 adapter->vf_data[vf].flags = IGB_VF_FLAG_CTS;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004637
4638 /* reply to reset with ack and vf mac address */
4639 msgbuf[0] = E1000_VF_RESET | E1000_VT_MSGTYPE_ACK;
4640 memcpy(addr, vf_mac, 6);
4641 igb_write_mbx(hw, msgbuf, 3, vf);
4642}
4643
4644static int igb_set_vf_mac_addr(struct igb_adapter *adapter, u32 *msg, int vf)
4645{
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004646 unsigned char *addr = (char *)&msg[1];
4647 int err = -1;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004648
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004649 if (is_valid_ether_addr(addr))
4650 err = igb_set_vf_mac(adapter, vf, addr);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004651
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004652 return err;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004653}
4654
4655static void igb_rcv_ack_from_vf(struct igb_adapter *adapter, u32 vf)
4656{
4657 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004658 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004659 u32 msg = E1000_VT_MSGTYPE_NACK;
4660
4661 /* if device isn't clear to send it shouldn't be reading either */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004662 if (!(vf_data->flags & IGB_VF_FLAG_CTS) &&
4663 time_after(jiffies, vf_data->last_nack + (2 * HZ))) {
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004664 igb_write_mbx(hw, &msg, 1, vf);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004665 vf_data->last_nack = jiffies;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004666 }
4667}
4668
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004669static void igb_rcv_msg_from_vf(struct igb_adapter *adapter, u32 vf)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004670{
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004671 struct pci_dev *pdev = adapter->pdev;
4672 u32 msgbuf[E1000_VFMAILBOX_SIZE];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004673 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004674 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004675 s32 retval;
4676
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004677 retval = igb_read_mbx(hw, msgbuf, E1000_VFMAILBOX_SIZE, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004678
Alexander Duyckfef45f42009-12-11 22:57:34 -08004679 if (retval) {
4680 /* if receive failed revoke VF CTS stats and restart init */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004681 dev_err(&pdev->dev, "Error receiving message from VF\n");
Alexander Duyckfef45f42009-12-11 22:57:34 -08004682 vf_data->flags &= ~IGB_VF_FLAG_CTS;
4683 if (!time_after(jiffies, vf_data->last_nack + (2 * HZ)))
4684 return;
4685 goto out;
4686 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004687
4688 /* this is a message we already processed, do nothing */
4689 if (msgbuf[0] & (E1000_VT_MSGTYPE_ACK | E1000_VT_MSGTYPE_NACK))
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004690 return;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004691
4692 /*
4693 * until the vf completes a reset it should not be
4694 * allowed to start any configuration.
4695 */
4696
4697 if (msgbuf[0] == E1000_VF_RESET) {
4698 igb_vf_reset_msg(adapter, vf);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004699 return;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004700 }
4701
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004702 if (!(vf_data->flags & IGB_VF_FLAG_CTS)) {
Alexander Duyckfef45f42009-12-11 22:57:34 -08004703 if (!time_after(jiffies, vf_data->last_nack + (2 * HZ)))
4704 return;
4705 retval = -1;
4706 goto out;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004707 }
4708
4709 switch ((msgbuf[0] & 0xFFFF)) {
4710 case E1000_VF_SET_MAC_ADDR:
4711 retval = igb_set_vf_mac_addr(adapter, msgbuf, vf);
4712 break;
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004713 case E1000_VF_SET_PROMISC:
4714 retval = igb_set_vf_promisc(adapter, msgbuf, vf);
4715 break;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004716 case E1000_VF_SET_MULTICAST:
4717 retval = igb_set_vf_multicasts(adapter, msgbuf, vf);
4718 break;
4719 case E1000_VF_SET_LPE:
4720 retval = igb_set_vf_rlpml(adapter, msgbuf[1], vf);
4721 break;
4722 case E1000_VF_SET_VLAN:
Williams, Mitch A8151d292010-02-10 01:44:24 +00004723 if (adapter->vf_data[vf].pf_vlan)
4724 retval = -1;
4725 else
4726 retval = igb_set_vf_vlan(adapter, msgbuf, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004727 break;
4728 default:
Alexander Duyck090b1792009-10-27 23:51:55 +00004729 dev_err(&pdev->dev, "Unhandled Msg %08x\n", msgbuf[0]);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004730 retval = -1;
4731 break;
4732 }
4733
Alexander Duyckfef45f42009-12-11 22:57:34 -08004734 msgbuf[0] |= E1000_VT_MSGTYPE_CTS;
4735out:
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004736 /* notify the VF of the results of what it sent us */
4737 if (retval)
4738 msgbuf[0] |= E1000_VT_MSGTYPE_NACK;
4739 else
4740 msgbuf[0] |= E1000_VT_MSGTYPE_ACK;
4741
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004742 igb_write_mbx(hw, msgbuf, 1, vf);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004743}
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004744
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004745static void igb_msg_task(struct igb_adapter *adapter)
4746{
4747 struct e1000_hw *hw = &adapter->hw;
4748 u32 vf;
4749
4750 for (vf = 0; vf < adapter->vfs_allocated_count; vf++) {
4751 /* process any reset requests */
4752 if (!igb_check_for_rst(hw, vf))
4753 igb_vf_reset_event(adapter, vf);
4754
4755 /* process any messages pending */
4756 if (!igb_check_for_msg(hw, vf))
4757 igb_rcv_msg_from_vf(adapter, vf);
4758
4759 /* process any acks */
4760 if (!igb_check_for_ack(hw, vf))
4761 igb_rcv_ack_from_vf(adapter, vf);
4762 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004763}
4764
Auke Kok9d5c8242008-01-24 02:22:38 -08004765/**
Alexander Duyck68d480c2009-10-05 06:33:08 +00004766 * igb_set_uta - Set unicast filter table address
4767 * @adapter: board private structure
4768 *
4769 * The unicast table address is a register array of 32-bit registers.
4770 * The table is meant to be used in a way similar to how the MTA is used
4771 * however due to certain limitations in the hardware it is necessary to
4772 * set all the hash bits to 1 and use the VMOLR ROPE bit as a promiscous
4773 * enable bit to allow vlan tag stripping when promiscous mode is enabled
4774 **/
4775static void igb_set_uta(struct igb_adapter *adapter)
4776{
4777 struct e1000_hw *hw = &adapter->hw;
4778 int i;
4779
4780 /* The UTA table only exists on 82576 hardware and newer */
4781 if (hw->mac.type < e1000_82576)
4782 return;
4783
4784 /* we only need to do this if VMDq is enabled */
4785 if (!adapter->vfs_allocated_count)
4786 return;
4787
4788 for (i = 0; i < hw->mac.uta_reg_count; i++)
4789 array_wr32(E1000_UTA, i, ~0);
4790}
4791
4792/**
Auke Kok9d5c8242008-01-24 02:22:38 -08004793 * igb_intr_msi - Interrupt Handler
4794 * @irq: interrupt number
4795 * @data: pointer to a network interface device structure
4796 **/
4797static irqreturn_t igb_intr_msi(int irq, void *data)
4798{
Alexander Duyck047e0032009-10-27 15:49:27 +00004799 struct igb_adapter *adapter = data;
4800 struct igb_q_vector *q_vector = adapter->q_vector[0];
Auke Kok9d5c8242008-01-24 02:22:38 -08004801 struct e1000_hw *hw = &adapter->hw;
4802 /* read ICR disables interrupts using IAM */
4803 u32 icr = rd32(E1000_ICR);
4804
Alexander Duyck047e0032009-10-27 15:49:27 +00004805 igb_write_itr(q_vector);
Auke Kok9d5c8242008-01-24 02:22:38 -08004806
Alexander Duyck7f081d42010-01-07 17:41:00 +00004807 if (icr & E1000_ICR_DRSTA)
4808 schedule_work(&adapter->reset_task);
4809
Alexander Duyck047e0032009-10-27 15:49:27 +00004810 if (icr & E1000_ICR_DOUTSYNC) {
Alexander Duyckdda0e082009-02-06 23:19:08 +00004811 /* HW is reporting DMA is out of sync */
4812 adapter->stats.doosync++;
4813 }
4814
Auke Kok9d5c8242008-01-24 02:22:38 -08004815 if (icr & (E1000_ICR_RXSEQ | E1000_ICR_LSC)) {
4816 hw->mac.get_link_status = 1;
4817 if (!test_bit(__IGB_DOWN, &adapter->state))
4818 mod_timer(&adapter->watchdog_timer, jiffies + 1);
4819 }
4820
Alexander Duyck047e0032009-10-27 15:49:27 +00004821 napi_schedule(&q_vector->napi);
Auke Kok9d5c8242008-01-24 02:22:38 -08004822
4823 return IRQ_HANDLED;
4824}
4825
4826/**
Alexander Duyck4a3c6432009-02-06 23:20:49 +00004827 * igb_intr - Legacy Interrupt Handler
Auke Kok9d5c8242008-01-24 02:22:38 -08004828 * @irq: interrupt number
4829 * @data: pointer to a network interface device structure
4830 **/
4831static irqreturn_t igb_intr(int irq, void *data)
4832{
Alexander Duyck047e0032009-10-27 15:49:27 +00004833 struct igb_adapter *adapter = data;
4834 struct igb_q_vector *q_vector = adapter->q_vector[0];
Auke Kok9d5c8242008-01-24 02:22:38 -08004835 struct e1000_hw *hw = &adapter->hw;
4836 /* Interrupt Auto-Mask...upon reading ICR, interrupts are masked. No
4837 * need for the IMC write */
4838 u32 icr = rd32(E1000_ICR);
Auke Kok9d5c8242008-01-24 02:22:38 -08004839 if (!icr)
4840 return IRQ_NONE; /* Not our interrupt */
4841
Alexander Duyck047e0032009-10-27 15:49:27 +00004842 igb_write_itr(q_vector);
Auke Kok9d5c8242008-01-24 02:22:38 -08004843
4844 /* IMS will not auto-mask if INT_ASSERTED is not set, and if it is
4845 * not set, then the adapter didn't send an interrupt */
4846 if (!(icr & E1000_ICR_INT_ASSERTED))
4847 return IRQ_NONE;
4848
Alexander Duyck7f081d42010-01-07 17:41:00 +00004849 if (icr & E1000_ICR_DRSTA)
4850 schedule_work(&adapter->reset_task);
4851
Alexander Duyck047e0032009-10-27 15:49:27 +00004852 if (icr & E1000_ICR_DOUTSYNC) {
Alexander Duyckdda0e082009-02-06 23:19:08 +00004853 /* HW is reporting DMA is out of sync */
4854 adapter->stats.doosync++;
4855 }
4856
Auke Kok9d5c8242008-01-24 02:22:38 -08004857 if (icr & (E1000_ICR_RXSEQ | E1000_ICR_LSC)) {
4858 hw->mac.get_link_status = 1;
4859 /* guard against interrupt when we're going down */
4860 if (!test_bit(__IGB_DOWN, &adapter->state))
4861 mod_timer(&adapter->watchdog_timer, jiffies + 1);
4862 }
4863
Alexander Duyck047e0032009-10-27 15:49:27 +00004864 napi_schedule(&q_vector->napi);
Auke Kok9d5c8242008-01-24 02:22:38 -08004865
4866 return IRQ_HANDLED;
4867}
4868
Alexander Duyck047e0032009-10-27 15:49:27 +00004869static inline void igb_ring_irq_enable(struct igb_q_vector *q_vector)
Alexander Duyck46544252009-02-19 20:39:04 -08004870{
Alexander Duyck047e0032009-10-27 15:49:27 +00004871 struct igb_adapter *adapter = q_vector->adapter;
Alexander Duyck46544252009-02-19 20:39:04 -08004872 struct e1000_hw *hw = &adapter->hw;
4873
Alexander Duyck4fc82ad2009-10-27 23:45:42 +00004874 if ((q_vector->rx_ring && (adapter->rx_itr_setting & 3)) ||
4875 (!q_vector->rx_ring && (adapter->tx_itr_setting & 3))) {
Alexander Duyck047e0032009-10-27 15:49:27 +00004876 if (!adapter->msix_entries)
Alexander Duyck46544252009-02-19 20:39:04 -08004877 igb_set_itr(adapter);
4878 else
Alexander Duyck047e0032009-10-27 15:49:27 +00004879 igb_update_ring_itr(q_vector);
Alexander Duyck46544252009-02-19 20:39:04 -08004880 }
4881
4882 if (!test_bit(__IGB_DOWN, &adapter->state)) {
4883 if (adapter->msix_entries)
Alexander Duyck047e0032009-10-27 15:49:27 +00004884 wr32(E1000_EIMS, q_vector->eims_value);
Alexander Duyck46544252009-02-19 20:39:04 -08004885 else
4886 igb_irq_enable(adapter);
4887 }
4888}
4889
Auke Kok9d5c8242008-01-24 02:22:38 -08004890/**
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004891 * igb_poll - NAPI Rx polling callback
4892 * @napi: napi polling structure
4893 * @budget: count of how many packets we should handle
Auke Kok9d5c8242008-01-24 02:22:38 -08004894 **/
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004895static int igb_poll(struct napi_struct *napi, int budget)
Auke Kok9d5c8242008-01-24 02:22:38 -08004896{
Alexander Duyck047e0032009-10-27 15:49:27 +00004897 struct igb_q_vector *q_vector = container_of(napi,
4898 struct igb_q_vector,
4899 napi);
4900 int tx_clean_complete = 1, work_done = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08004901
Jeff Kirsher421e02f2008-10-17 11:08:31 -07004902#ifdef CONFIG_IGB_DCA
Alexander Duyck047e0032009-10-27 15:49:27 +00004903 if (q_vector->adapter->flags & IGB_FLAG_DCA_ENABLED)
4904 igb_update_dca(q_vector);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004905#endif
Alexander Duyck047e0032009-10-27 15:49:27 +00004906 if (q_vector->tx_ring)
4907 tx_clean_complete = igb_clean_tx_irq(q_vector);
Auke Kok9d5c8242008-01-24 02:22:38 -08004908
Alexander Duyck047e0032009-10-27 15:49:27 +00004909 if (q_vector->rx_ring)
4910 igb_clean_rx_irq_adv(q_vector, &work_done, budget);
4911
4912 if (!tx_clean_complete)
4913 work_done = budget;
Auke Kok9d5c8242008-01-24 02:22:38 -08004914
Alexander Duyck46544252009-02-19 20:39:04 -08004915 /* If not enough Rx work done, exit the polling mode */
Alexander Duyck5e6d5b12009-03-13 20:40:38 +00004916 if (work_done < budget) {
Alexander Duyck46544252009-02-19 20:39:04 -08004917 napi_complete(napi);
Alexander Duyck047e0032009-10-27 15:49:27 +00004918 igb_ring_irq_enable(q_vector);
Alexander Duyck46544252009-02-19 20:39:04 -08004919 }
4920
4921 return work_done;
Auke Kok9d5c8242008-01-24 02:22:38 -08004922}
Al Viro6d8126f2008-03-16 22:23:24 +00004923
Auke Kok9d5c8242008-01-24 02:22:38 -08004924/**
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004925 * igb_systim_to_hwtstamp - convert system time value to hw timestamp
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004926 * @adapter: board private structure
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004927 * @shhwtstamps: timestamp structure to update
4928 * @regval: unsigned 64bit system time value.
4929 *
4930 * We need to convert the system time value stored in the RX/TXSTMP registers
4931 * into a hwtstamp which can be used by the upper level timestamping functions
4932 */
4933static void igb_systim_to_hwtstamp(struct igb_adapter *adapter,
4934 struct skb_shared_hwtstamps *shhwtstamps,
4935 u64 regval)
4936{
4937 u64 ns;
4938
Alexander Duyck55cac242009-11-19 12:42:21 +00004939 /*
4940 * The 82580 starts with 1ns at bit 0 in RX/TXSTMPL, shift this up to
4941 * 24 to match clock shift we setup earlier.
4942 */
4943 if (adapter->hw.mac.type == e1000_82580)
4944 regval <<= IGB_82580_TSYNC_SHIFT;
4945
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004946 ns = timecounter_cyc2time(&adapter->clock, regval);
4947 timecompare_update(&adapter->compare, ns);
4948 memset(shhwtstamps, 0, sizeof(struct skb_shared_hwtstamps));
4949 shhwtstamps->hwtstamp = ns_to_ktime(ns);
4950 shhwtstamps->syststamp = timecompare_transform(&adapter->compare, ns);
4951}
4952
4953/**
4954 * igb_tx_hwtstamp - utility function which checks for TX time stamp
4955 * @q_vector: pointer to q_vector containing needed info
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004956 * @skb: packet that was just sent
4957 *
4958 * If we were asked to do hardware stamping and such a time stamp is
4959 * available, then it must have been for this skb here because we only
4960 * allow only one such packet into the queue.
4961 */
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004962static void igb_tx_hwtstamp(struct igb_q_vector *q_vector, struct sk_buff *skb)
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004963{
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004964 struct igb_adapter *adapter = q_vector->adapter;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004965 union skb_shared_tx *shtx = skb_tx(skb);
4966 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004967 struct skb_shared_hwtstamps shhwtstamps;
4968 u64 regval;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004969
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004970 /* if skb does not support hw timestamp or TX stamp not valid exit */
4971 if (likely(!shtx->hardware) ||
4972 !(rd32(E1000_TSYNCTXCTL) & E1000_TSYNCTXCTL_VALID))
4973 return;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004974
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004975 regval = rd32(E1000_TXSTMPL);
4976 regval |= (u64)rd32(E1000_TXSTMPH) << 32;
4977
4978 igb_systim_to_hwtstamp(adapter, &shhwtstamps, regval);
4979 skb_tstamp_tx(skb, &shhwtstamps);
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004980}
4981
4982/**
Auke Kok9d5c8242008-01-24 02:22:38 -08004983 * igb_clean_tx_irq - Reclaim resources after transmit completes
Alexander Duyck047e0032009-10-27 15:49:27 +00004984 * @q_vector: pointer to q_vector containing needed info
Auke Kok9d5c8242008-01-24 02:22:38 -08004985 * returns true if ring is completely cleaned
4986 **/
Alexander Duyck047e0032009-10-27 15:49:27 +00004987static bool igb_clean_tx_irq(struct igb_q_vector *q_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -08004988{
Alexander Duyck047e0032009-10-27 15:49:27 +00004989 struct igb_adapter *adapter = q_vector->adapter;
4990 struct igb_ring *tx_ring = q_vector->tx_ring;
Alexander Duycke694e962009-10-27 15:53:06 +00004991 struct net_device *netdev = tx_ring->netdev;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08004992 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08004993 struct igb_buffer *buffer_info;
4994 struct sk_buff *skb;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08004995 union e1000_adv_tx_desc *tx_desc, *eop_desc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004996 unsigned int total_bytes = 0, total_packets = 0;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08004997 unsigned int i, eop, count = 0;
4998 bool cleaned = false;
Auke Kok9d5c8242008-01-24 02:22:38 -08004999
Auke Kok9d5c8242008-01-24 02:22:38 -08005000 i = tx_ring->next_to_clean;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005001 eop = tx_ring->buffer_info[i].next_to_watch;
5002 eop_desc = E1000_TX_DESC_ADV(*tx_ring, eop);
5003
5004 while ((eop_desc->wb.status & cpu_to_le32(E1000_TXD_STAT_DD)) &&
5005 (count < tx_ring->count)) {
5006 for (cleaned = false; !cleaned; count++) {
5007 tx_desc = E1000_TX_DESC_ADV(*tx_ring, i);
Auke Kok9d5c8242008-01-24 02:22:38 -08005008 buffer_info = &tx_ring->buffer_info[i];
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005009 cleaned = (i == eop);
Auke Kok9d5c8242008-01-24 02:22:38 -08005010 skb = buffer_info->skb;
5011
5012 if (skb) {
5013 unsigned int segs, bytecount;
5014 /* gso_segs is currently only valid for tcp */
Nick Nunley40e90c22010-02-17 01:04:37 +00005015 segs = buffer_info->gso_segs;
Auke Kok9d5c8242008-01-24 02:22:38 -08005016 /* multiply data chunks by size of headers */
5017 bytecount = ((segs - 1) * skb_headlen(skb)) +
5018 skb->len;
5019 total_packets += segs;
5020 total_bytes += bytecount;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005021
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005022 igb_tx_hwtstamp(q_vector, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005023 }
5024
Alexander Duyck80785292009-10-27 15:51:47 +00005025 igb_unmap_and_free_tx_resource(tx_ring, buffer_info);
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005026 tx_desc->wb.status = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08005027
5028 i++;
5029 if (i == tx_ring->count)
5030 i = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08005031 }
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005032 eop = tx_ring->buffer_info[i].next_to_watch;
5033 eop_desc = E1000_TX_DESC_ADV(*tx_ring, eop);
5034 }
5035
Auke Kok9d5c8242008-01-24 02:22:38 -08005036 tx_ring->next_to_clean = i;
5037
Alexander Duyckfc7d3452008-08-26 04:25:08 -07005038 if (unlikely(count &&
Auke Kok9d5c8242008-01-24 02:22:38 -08005039 netif_carrier_ok(netdev) &&
Alexander Duyckc493ea42009-03-20 00:16:50 +00005040 igb_desc_unused(tx_ring) >= IGB_TX_QUEUE_WAKE)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005041 /* Make sure that anybody stopping the queue after this
5042 * sees the new next_to_clean.
5043 */
5044 smp_mb();
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07005045 if (__netif_subqueue_stopped(netdev, tx_ring->queue_index) &&
5046 !(test_bit(__IGB_DOWN, &adapter->state))) {
5047 netif_wake_subqueue(netdev, tx_ring->queue_index);
Alexander Duyck04a5fca2009-10-27 15:52:27 +00005048 tx_ring->tx_stats.restart_queue++;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07005049 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005050 }
5051
5052 if (tx_ring->detect_tx_hung) {
5053 /* Detect a transmit hang in hardware, this serializes the
5054 * check with the clearing of time_stamp and movement of i */
5055 tx_ring->detect_tx_hung = false;
5056 if (tx_ring->buffer_info[i].time_stamp &&
5057 time_after(jiffies, tx_ring->buffer_info[i].time_stamp +
Joe Perches8e95a202009-12-03 07:58:21 +00005058 (adapter->tx_timeout_factor * HZ)) &&
5059 !(rd32(E1000_STATUS) & E1000_STATUS_TXOFF)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005060
Auke Kok9d5c8242008-01-24 02:22:38 -08005061 /* detected Tx unit hang */
Alexander Duyck80785292009-10-27 15:51:47 +00005062 dev_err(&tx_ring->pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08005063 "Detected Tx Unit Hang\n"
Alexander Duyck2d064c02008-07-08 15:10:12 -07005064 " Tx Queue <%d>\n"
Auke Kok9d5c8242008-01-24 02:22:38 -08005065 " TDH <%x>\n"
5066 " TDT <%x>\n"
5067 " next_to_use <%x>\n"
5068 " next_to_clean <%x>\n"
Auke Kok9d5c8242008-01-24 02:22:38 -08005069 "buffer_info[next_to_clean]\n"
5070 " time_stamp <%lx>\n"
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005071 " next_to_watch <%x>\n"
Auke Kok9d5c8242008-01-24 02:22:38 -08005072 " jiffies <%lx>\n"
5073 " desc.status <%x>\n",
Alexander Duyck2d064c02008-07-08 15:10:12 -07005074 tx_ring->queue_index,
Alexander Duyckfce99e32009-10-27 15:51:27 +00005075 readl(tx_ring->head),
5076 readl(tx_ring->tail),
Auke Kok9d5c8242008-01-24 02:22:38 -08005077 tx_ring->next_to_use,
5078 tx_ring->next_to_clean,
Alexander Duyckf7ba2052009-10-27 23:48:51 +00005079 tx_ring->buffer_info[eop].time_stamp,
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005080 eop,
Auke Kok9d5c8242008-01-24 02:22:38 -08005081 jiffies,
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005082 eop_desc->wb.status);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07005083 netif_stop_subqueue(netdev, tx_ring->queue_index);
Auke Kok9d5c8242008-01-24 02:22:38 -08005084 }
5085 }
5086 tx_ring->total_bytes += total_bytes;
5087 tx_ring->total_packets += total_packets;
Alexander Duycke21ed352008-07-08 15:07:24 -07005088 tx_ring->tx_stats.bytes += total_bytes;
5089 tx_ring->tx_stats.packets += total_packets;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005090 return (count < tx_ring->count);
Auke Kok9d5c8242008-01-24 02:22:38 -08005091}
5092
Auke Kok9d5c8242008-01-24 02:22:38 -08005093/**
5094 * igb_receive_skb - helper function to handle rx indications
Alexander Duyck047e0032009-10-27 15:49:27 +00005095 * @q_vector: structure containing interrupt and ring information
5096 * @skb: packet to send up
5097 * @vlan_tag: vlan tag for packet
Auke Kok9d5c8242008-01-24 02:22:38 -08005098 **/
Alexander Duyck047e0032009-10-27 15:49:27 +00005099static void igb_receive_skb(struct igb_q_vector *q_vector,
5100 struct sk_buff *skb,
5101 u16 vlan_tag)
Auke Kok9d5c8242008-01-24 02:22:38 -08005102{
Alexander Duyck047e0032009-10-27 15:49:27 +00005103 struct igb_adapter *adapter = q_vector->adapter;
Alexander Duyckd3352522008-07-08 15:12:13 -07005104
Alexander Duyck31b24b92010-03-23 18:35:18 +00005105 if (vlan_tag && adapter->vlgrp)
Alexander Duyck047e0032009-10-27 15:49:27 +00005106 vlan_gro_receive(&q_vector->napi, adapter->vlgrp,
5107 vlan_tag, skb);
Alexander Duyck182ff8d2009-04-27 22:35:33 +00005108 else
Alexander Duyck047e0032009-10-27 15:49:27 +00005109 napi_gro_receive(&q_vector->napi, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005110}
5111
Alexander Duyck04a5fca2009-10-27 15:52:27 +00005112static inline void igb_rx_checksum_adv(struct igb_ring *ring,
Auke Kok9d5c8242008-01-24 02:22:38 -08005113 u32 status_err, struct sk_buff *skb)
5114{
5115 skb->ip_summed = CHECKSUM_NONE;
5116
5117 /* Ignore Checksum bit is set or checksum is disabled through ethtool */
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005118 if (!(ring->flags & IGB_RING_FLAG_RX_CSUM) ||
5119 (status_err & E1000_RXD_STAT_IXSM))
Auke Kok9d5c8242008-01-24 02:22:38 -08005120 return;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005121
Auke Kok9d5c8242008-01-24 02:22:38 -08005122 /* TCP/UDP checksum error bit is set */
5123 if (status_err &
5124 (E1000_RXDEXT_STATERR_TCPE | E1000_RXDEXT_STATERR_IPE)) {
Jesse Brandeburgb9473562009-04-27 22:36:13 +00005125 /*
5126 * work around errata with sctp packets where the TCPE aka
5127 * L4E bit is set incorrectly on 64 byte (60 byte w/o crc)
5128 * packets, (aka let the stack check the crc32c)
5129 */
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005130 if ((skb->len == 60) &&
5131 (ring->flags & IGB_RING_FLAG_RX_SCTP_CSUM))
Alexander Duyck04a5fca2009-10-27 15:52:27 +00005132 ring->rx_stats.csum_err++;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005133
Auke Kok9d5c8242008-01-24 02:22:38 -08005134 /* let the stack verify checksum errors */
Auke Kok9d5c8242008-01-24 02:22:38 -08005135 return;
5136 }
5137 /* It must be a TCP or UDP packet with a valid checksum */
5138 if (status_err & (E1000_RXD_STAT_TCPCS | E1000_RXD_STAT_UDPCS))
5139 skb->ip_summed = CHECKSUM_UNNECESSARY;
5140
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005141 dev_dbg(&ring->pdev->dev, "cksum success: bits %08X\n", status_err);
Auke Kok9d5c8242008-01-24 02:22:38 -08005142}
5143
Nick Nunley757b77e2010-03-26 11:36:47 +00005144static void igb_rx_hwtstamp(struct igb_q_vector *q_vector, u32 staterr,
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005145 struct sk_buff *skb)
5146{
5147 struct igb_adapter *adapter = q_vector->adapter;
5148 struct e1000_hw *hw = &adapter->hw;
5149 u64 regval;
5150
5151 /*
5152 * If this bit is set, then the RX registers contain the time stamp. No
5153 * other packet will be time stamped until we read these registers, so
5154 * read the registers to make them available again. Because only one
5155 * packet can be time stamped at a time, we know that the register
5156 * values must belong to this one here and therefore we don't need to
5157 * compare any of the additional attributes stored for it.
5158 *
5159 * If nothing went wrong, then it should have a skb_shared_tx that we
5160 * can turn into a skb_shared_hwtstamps.
5161 */
Nick Nunley757b77e2010-03-26 11:36:47 +00005162 if (staterr & E1000_RXDADV_STAT_TSIP) {
5163 u32 *stamp = (u32 *)skb->data;
5164 regval = le32_to_cpu(*(stamp + 2));
5165 regval |= (u64)le32_to_cpu(*(stamp + 3)) << 32;
5166 skb_pull(skb, IGB_TS_HDR_LEN);
5167 } else {
5168 if(!(rd32(E1000_TSYNCRXCTL) & E1000_TSYNCRXCTL_VALID))
5169 return;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005170
Nick Nunley757b77e2010-03-26 11:36:47 +00005171 regval = rd32(E1000_RXSTMPL);
5172 regval |= (u64)rd32(E1000_RXSTMPH) << 32;
5173 }
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005174
5175 igb_systim_to_hwtstamp(adapter, skb_hwtstamps(skb), regval);
5176}
Alexander Duyck4c844852009-10-27 15:52:07 +00005177static inline u16 igb_get_hlen(struct igb_ring *rx_ring,
Alexander Duyck2d94d8a2009-07-23 18:10:06 +00005178 union e1000_adv_rx_desc *rx_desc)
5179{
5180 /* HW will not DMA in data larger than the given buffer, even if it
5181 * parses the (NFS, of course) header to be larger. In that case, it
5182 * fills the header buffer and spills the rest into the page.
5183 */
5184 u16 hlen = (le16_to_cpu(rx_desc->wb.lower.lo_dword.hdr_info) &
5185 E1000_RXDADV_HDRBUFLEN_MASK) >> E1000_RXDADV_HDRBUFLEN_SHIFT;
Alexander Duyck4c844852009-10-27 15:52:07 +00005186 if (hlen > rx_ring->rx_buffer_len)
5187 hlen = rx_ring->rx_buffer_len;
Alexander Duyck2d94d8a2009-07-23 18:10:06 +00005188 return hlen;
5189}
5190
Alexander Duyck047e0032009-10-27 15:49:27 +00005191static bool igb_clean_rx_irq_adv(struct igb_q_vector *q_vector,
5192 int *work_done, int budget)
Auke Kok9d5c8242008-01-24 02:22:38 -08005193{
Alexander Duyck047e0032009-10-27 15:49:27 +00005194 struct igb_ring *rx_ring = q_vector->rx_ring;
Alexander Duycke694e962009-10-27 15:53:06 +00005195 struct net_device *netdev = rx_ring->netdev;
Alexander Duyck80785292009-10-27 15:51:47 +00005196 struct pci_dev *pdev = rx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08005197 union e1000_adv_rx_desc *rx_desc , *next_rxd;
5198 struct igb_buffer *buffer_info , *next_buffer;
5199 struct sk_buff *skb;
Auke Kok9d5c8242008-01-24 02:22:38 -08005200 bool cleaned = false;
5201 int cleaned_count = 0;
Alexander Duyckd1eff352009-11-12 18:38:35 +00005202 int current_node = numa_node_id();
Auke Kok9d5c8242008-01-24 02:22:38 -08005203 unsigned int total_bytes = 0, total_packets = 0;
Alexander Duyck73cd78f2009-02-12 18:16:59 +00005204 unsigned int i;
Alexander Duyck2d94d8a2009-07-23 18:10:06 +00005205 u32 staterr;
5206 u16 length;
Alexander Duyck047e0032009-10-27 15:49:27 +00005207 u16 vlan_tag;
Auke Kok9d5c8242008-01-24 02:22:38 -08005208
5209 i = rx_ring->next_to_clean;
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005210 buffer_info = &rx_ring->buffer_info[i];
Auke Kok9d5c8242008-01-24 02:22:38 -08005211 rx_desc = E1000_RX_DESC_ADV(*rx_ring, i);
5212 staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
5213
5214 while (staterr & E1000_RXD_STAT_DD) {
5215 if (*work_done >= budget)
5216 break;
5217 (*work_done)++;
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005218
5219 skb = buffer_info->skb;
5220 prefetch(skb->data - NET_IP_ALIGN);
5221 buffer_info->skb = NULL;
5222
5223 i++;
5224 if (i == rx_ring->count)
5225 i = 0;
Alexander Duyck42d07812009-10-27 23:51:16 +00005226
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005227 next_rxd = E1000_RX_DESC_ADV(*rx_ring, i);
5228 prefetch(next_rxd);
5229 next_buffer = &rx_ring->buffer_info[i];
5230
5231 length = le16_to_cpu(rx_desc->wb.upper.length);
5232 cleaned = true;
5233 cleaned_count++;
5234
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005235 if (buffer_info->dma) {
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005236 pci_unmap_single(pdev, buffer_info->dma,
Alexander Duyck4c844852009-10-27 15:52:07 +00005237 rx_ring->rx_buffer_len,
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005238 PCI_DMA_FROMDEVICE);
Jesse Brandeburg91615f72009-06-30 12:45:15 +00005239 buffer_info->dma = 0;
Alexander Duyck4c844852009-10-27 15:52:07 +00005240 if (rx_ring->rx_buffer_len >= IGB_RXBUFFER_1024) {
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005241 skb_put(skb, length);
5242 goto send_up;
5243 }
Alexander Duyck4c844852009-10-27 15:52:07 +00005244 skb_put(skb, igb_get_hlen(rx_ring, rx_desc));
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005245 }
5246
5247 if (length) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005248 pci_unmap_page(pdev, buffer_info->page_dma,
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005249 PAGE_SIZE / 2, PCI_DMA_FROMDEVICE);
Auke Kok9d5c8242008-01-24 02:22:38 -08005250 buffer_info->page_dma = 0;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005251
Koki Sanagiaa913402010-04-27 01:01:19 +00005252 skb_fill_page_desc(skb, skb_shinfo(skb)->nr_frags,
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005253 buffer_info->page,
5254 buffer_info->page_offset,
5255 length);
5256
Alexander Duyckd1eff352009-11-12 18:38:35 +00005257 if ((page_count(buffer_info->page) != 1) ||
5258 (page_to_nid(buffer_info->page) != current_node))
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005259 buffer_info->page = NULL;
5260 else
5261 get_page(buffer_info->page);
Auke Kok9d5c8242008-01-24 02:22:38 -08005262
5263 skb->len += length;
5264 skb->data_len += length;
5265 skb->truesize += length;
Auke Kok9d5c8242008-01-24 02:22:38 -08005266 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005267
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005268 if (!(staterr & E1000_RXD_STAT_EOP)) {
Alexander Duyckb2d56532008-11-20 00:47:34 -08005269 buffer_info->skb = next_buffer->skb;
5270 buffer_info->dma = next_buffer->dma;
5271 next_buffer->skb = skb;
5272 next_buffer->dma = 0;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005273 goto next_desc;
5274 }
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005275send_up:
Auke Kok9d5c8242008-01-24 02:22:38 -08005276 if (staterr & E1000_RXDEXT_ERR_FRAME_ERR_MASK) {
5277 dev_kfree_skb_irq(skb);
5278 goto next_desc;
5279 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005280
Nick Nunley757b77e2010-03-26 11:36:47 +00005281 if (staterr & (E1000_RXDADV_STAT_TSIP | E1000_RXDADV_STAT_TS))
5282 igb_rx_hwtstamp(q_vector, staterr, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005283 total_bytes += skb->len;
5284 total_packets++;
5285
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005286 igb_rx_checksum_adv(rx_ring, staterr, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005287
5288 skb->protocol = eth_type_trans(skb, netdev);
Alexander Duyck047e0032009-10-27 15:49:27 +00005289 skb_record_rx_queue(skb, rx_ring->queue_index);
Auke Kok9d5c8242008-01-24 02:22:38 -08005290
Alexander Duyck047e0032009-10-27 15:49:27 +00005291 vlan_tag = ((staterr & E1000_RXD_STAT_VP) ?
5292 le16_to_cpu(rx_desc->wb.upper.vlan) : 0);
5293
5294 igb_receive_skb(q_vector, skb, vlan_tag);
Auke Kok9d5c8242008-01-24 02:22:38 -08005295
Auke Kok9d5c8242008-01-24 02:22:38 -08005296next_desc:
5297 rx_desc->wb.upper.status_error = 0;
5298
5299 /* return some buffers to hardware, one at a time is too slow */
5300 if (cleaned_count >= IGB_RX_BUFFER_WRITE) {
Mitch Williams3b644cf2008-06-27 10:59:48 -07005301 igb_alloc_rx_buffers_adv(rx_ring, cleaned_count);
Auke Kok9d5c8242008-01-24 02:22:38 -08005302 cleaned_count = 0;
5303 }
5304
5305 /* use prefetched values */
5306 rx_desc = next_rxd;
5307 buffer_info = next_buffer;
Auke Kok9d5c8242008-01-24 02:22:38 -08005308 staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
5309 }
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005310
Auke Kok9d5c8242008-01-24 02:22:38 -08005311 rx_ring->next_to_clean = i;
Alexander Duyckc493ea42009-03-20 00:16:50 +00005312 cleaned_count = igb_desc_unused(rx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08005313
5314 if (cleaned_count)
Mitch Williams3b644cf2008-06-27 10:59:48 -07005315 igb_alloc_rx_buffers_adv(rx_ring, cleaned_count);
Auke Kok9d5c8242008-01-24 02:22:38 -08005316
5317 rx_ring->total_packets += total_packets;
5318 rx_ring->total_bytes += total_bytes;
5319 rx_ring->rx_stats.packets += total_packets;
5320 rx_ring->rx_stats.bytes += total_bytes;
Auke Kok9d5c8242008-01-24 02:22:38 -08005321 return cleaned;
5322}
5323
Auke Kok9d5c8242008-01-24 02:22:38 -08005324/**
5325 * igb_alloc_rx_buffers_adv - Replace used receive buffers; packet split
5326 * @adapter: address of board private structure
5327 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00005328void igb_alloc_rx_buffers_adv(struct igb_ring *rx_ring, int cleaned_count)
Auke Kok9d5c8242008-01-24 02:22:38 -08005329{
Alexander Duycke694e962009-10-27 15:53:06 +00005330 struct net_device *netdev = rx_ring->netdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08005331 union e1000_adv_rx_desc *rx_desc;
5332 struct igb_buffer *buffer_info;
5333 struct sk_buff *skb;
5334 unsigned int i;
Alexander Duyckdb761762009-02-06 23:15:25 +00005335 int bufsz;
Auke Kok9d5c8242008-01-24 02:22:38 -08005336
5337 i = rx_ring->next_to_use;
5338 buffer_info = &rx_ring->buffer_info[i];
5339
Alexander Duyck4c844852009-10-27 15:52:07 +00005340 bufsz = rx_ring->rx_buffer_len;
Alexander Duyckdb761762009-02-06 23:15:25 +00005341
Auke Kok9d5c8242008-01-24 02:22:38 -08005342 while (cleaned_count--) {
5343 rx_desc = E1000_RX_DESC_ADV(*rx_ring, i);
5344
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005345 if ((bufsz < IGB_RXBUFFER_1024) && !buffer_info->page_dma) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005346 if (!buffer_info->page) {
Alexander Duyck42d07812009-10-27 23:51:16 +00005347 buffer_info->page = netdev_alloc_page(netdev);
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005348 if (!buffer_info->page) {
Alexander Duyck04a5fca2009-10-27 15:52:27 +00005349 rx_ring->rx_stats.alloc_failed++;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005350 goto no_buffers;
5351 }
5352 buffer_info->page_offset = 0;
5353 } else {
5354 buffer_info->page_offset ^= PAGE_SIZE / 2;
Auke Kok9d5c8242008-01-24 02:22:38 -08005355 }
5356 buffer_info->page_dma =
Alexander Duyck80785292009-10-27 15:51:47 +00005357 pci_map_page(rx_ring->pdev, buffer_info->page,
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005358 buffer_info->page_offset,
5359 PAGE_SIZE / 2,
Auke Kok9d5c8242008-01-24 02:22:38 -08005360 PCI_DMA_FROMDEVICE);
Alexander Duyck42d07812009-10-27 23:51:16 +00005361 if (pci_dma_mapping_error(rx_ring->pdev,
5362 buffer_info->page_dma)) {
5363 buffer_info->page_dma = 0;
5364 rx_ring->rx_stats.alloc_failed++;
5365 goto no_buffers;
5366 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005367 }
5368
Alexander Duyck42d07812009-10-27 23:51:16 +00005369 skb = buffer_info->skb;
5370 if (!skb) {
Eric Dumazet89d71a62009-10-13 05:34:20 +00005371 skb = netdev_alloc_skb_ip_align(netdev, bufsz);
Auke Kok9d5c8242008-01-24 02:22:38 -08005372 if (!skb) {
Alexander Duyck04a5fca2009-10-27 15:52:27 +00005373 rx_ring->rx_stats.alloc_failed++;
Auke Kok9d5c8242008-01-24 02:22:38 -08005374 goto no_buffers;
5375 }
5376
Auke Kok9d5c8242008-01-24 02:22:38 -08005377 buffer_info->skb = skb;
Alexander Duyck42d07812009-10-27 23:51:16 +00005378 }
5379 if (!buffer_info->dma) {
Alexander Duyck80785292009-10-27 15:51:47 +00005380 buffer_info->dma = pci_map_single(rx_ring->pdev,
5381 skb->data,
Auke Kok9d5c8242008-01-24 02:22:38 -08005382 bufsz,
5383 PCI_DMA_FROMDEVICE);
Alexander Duyck42d07812009-10-27 23:51:16 +00005384 if (pci_dma_mapping_error(rx_ring->pdev,
5385 buffer_info->dma)) {
5386 buffer_info->dma = 0;
5387 rx_ring->rx_stats.alloc_failed++;
5388 goto no_buffers;
5389 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005390 }
5391 /* Refresh the desc even if buffer_addrs didn't change because
5392 * each write-back erases this info. */
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005393 if (bufsz < IGB_RXBUFFER_1024) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005394 rx_desc->read.pkt_addr =
5395 cpu_to_le64(buffer_info->page_dma);
5396 rx_desc->read.hdr_addr = cpu_to_le64(buffer_info->dma);
5397 } else {
Alexander Duyck42d07812009-10-27 23:51:16 +00005398 rx_desc->read.pkt_addr = cpu_to_le64(buffer_info->dma);
Auke Kok9d5c8242008-01-24 02:22:38 -08005399 rx_desc->read.hdr_addr = 0;
5400 }
5401
5402 i++;
5403 if (i == rx_ring->count)
5404 i = 0;
5405 buffer_info = &rx_ring->buffer_info[i];
5406 }
5407
5408no_buffers:
5409 if (rx_ring->next_to_use != i) {
5410 rx_ring->next_to_use = i;
5411 if (i == 0)
5412 i = (rx_ring->count - 1);
5413 else
5414 i--;
5415
5416 /* Force memory writes to complete before letting h/w
5417 * know there are new descriptors to fetch. (Only
5418 * applicable for weak-ordered memory model archs,
5419 * such as IA-64). */
5420 wmb();
Alexander Duyckfce99e32009-10-27 15:51:27 +00005421 writel(i, rx_ring->tail);
Auke Kok9d5c8242008-01-24 02:22:38 -08005422 }
5423}
5424
5425/**
5426 * igb_mii_ioctl -
5427 * @netdev:
5428 * @ifreq:
5429 * @cmd:
5430 **/
5431static int igb_mii_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
5432{
5433 struct igb_adapter *adapter = netdev_priv(netdev);
5434 struct mii_ioctl_data *data = if_mii(ifr);
5435
5436 if (adapter->hw.phy.media_type != e1000_media_type_copper)
5437 return -EOPNOTSUPP;
5438
5439 switch (cmd) {
5440 case SIOCGMIIPHY:
5441 data->phy_id = adapter->hw.phy.addr;
5442 break;
5443 case SIOCGMIIREG:
Alexander Duyckf5f4cf02008-11-21 21:30:24 -08005444 if (igb_read_phy_reg(&adapter->hw, data->reg_num & 0x1F,
5445 &data->val_out))
Auke Kok9d5c8242008-01-24 02:22:38 -08005446 return -EIO;
5447 break;
5448 case SIOCSMIIREG:
5449 default:
5450 return -EOPNOTSUPP;
5451 }
5452 return 0;
5453}
5454
5455/**
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005456 * igb_hwtstamp_ioctl - control hardware time stamping
5457 * @netdev:
5458 * @ifreq:
5459 * @cmd:
5460 *
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005461 * Outgoing time stamping can be enabled and disabled. Play nice and
5462 * disable it when requested, although it shouldn't case any overhead
5463 * when no packet needs it. At most one packet in the queue may be
5464 * marked for time stamping, otherwise it would be impossible to tell
5465 * for sure to which packet the hardware time stamp belongs.
5466 *
5467 * Incoming time stamping has to be configured via the hardware
5468 * filters. Not all combinations are supported, in particular event
5469 * type has to be specified. Matching the kind of event packet is
5470 * not supported, with the exception of "all V2 events regardless of
5471 * level 2 or 4".
5472 *
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005473 **/
5474static int igb_hwtstamp_ioctl(struct net_device *netdev,
5475 struct ifreq *ifr, int cmd)
5476{
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005477 struct igb_adapter *adapter = netdev_priv(netdev);
5478 struct e1000_hw *hw = &adapter->hw;
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005479 struct hwtstamp_config config;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005480 u32 tsync_tx_ctl = E1000_TSYNCTXCTL_ENABLED;
5481 u32 tsync_rx_ctl = E1000_TSYNCRXCTL_ENABLED;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005482 u32 tsync_rx_cfg = 0;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005483 bool is_l4 = false;
5484 bool is_l2 = false;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005485 u32 regval;
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005486
5487 if (copy_from_user(&config, ifr->ifr_data, sizeof(config)))
5488 return -EFAULT;
5489
5490 /* reserved for future extensions */
5491 if (config.flags)
5492 return -EINVAL;
5493
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005494 switch (config.tx_type) {
5495 case HWTSTAMP_TX_OFF:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005496 tsync_tx_ctl = 0;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005497 case HWTSTAMP_TX_ON:
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005498 break;
5499 default:
5500 return -ERANGE;
5501 }
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005502
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005503 switch (config.rx_filter) {
5504 case HWTSTAMP_FILTER_NONE:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005505 tsync_rx_ctl = 0;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005506 break;
5507 case HWTSTAMP_FILTER_PTP_V1_L4_EVENT:
5508 case HWTSTAMP_FILTER_PTP_V2_L4_EVENT:
5509 case HWTSTAMP_FILTER_PTP_V2_L2_EVENT:
5510 case HWTSTAMP_FILTER_ALL:
5511 /*
5512 * register TSYNCRXCFG must be set, therefore it is not
5513 * possible to time stamp both Sync and Delay_Req messages
5514 * => fall back to time stamping all packets
5515 */
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005516 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_ALL;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005517 config.rx_filter = HWTSTAMP_FILTER_ALL;
5518 break;
5519 case HWTSTAMP_FILTER_PTP_V1_L4_SYNC:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005520 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L4_V1;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005521 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V1_SYNC_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005522 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005523 break;
5524 case HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005525 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L4_V1;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005526 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V1_DELAY_REQ_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005527 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005528 break;
5529 case HWTSTAMP_FILTER_PTP_V2_L2_SYNC:
5530 case HWTSTAMP_FILTER_PTP_V2_L4_SYNC:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005531 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L2_L4_V2;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005532 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V2_SYNC_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005533 is_l2 = true;
5534 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005535 config.rx_filter = HWTSTAMP_FILTER_SOME;
5536 break;
5537 case HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ:
5538 case HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005539 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L2_L4_V2;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005540 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V2_DELAY_REQ_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005541 is_l2 = true;
5542 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005543 config.rx_filter = HWTSTAMP_FILTER_SOME;
5544 break;
5545 case HWTSTAMP_FILTER_PTP_V2_EVENT:
5546 case HWTSTAMP_FILTER_PTP_V2_SYNC:
5547 case HWTSTAMP_FILTER_PTP_V2_DELAY_REQ:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005548 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_EVENT_V2;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005549 config.rx_filter = HWTSTAMP_FILTER_PTP_V2_EVENT;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005550 is_l2 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005551 break;
5552 default:
5553 return -ERANGE;
5554 }
5555
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005556 if (hw->mac.type == e1000_82575) {
5557 if (tsync_rx_ctl | tsync_tx_ctl)
5558 return -EINVAL;
5559 return 0;
5560 }
5561
Nick Nunley757b77e2010-03-26 11:36:47 +00005562 /*
5563 * Per-packet timestamping only works if all packets are
5564 * timestamped, so enable timestamping in all packets as
5565 * long as one rx filter was configured.
5566 */
5567 if ((hw->mac.type == e1000_82580) && tsync_rx_ctl) {
5568 tsync_rx_ctl = E1000_TSYNCRXCTL_ENABLED;
5569 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_ALL;
5570 }
5571
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005572 /* enable/disable TX */
5573 regval = rd32(E1000_TSYNCTXCTL);
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005574 regval &= ~E1000_TSYNCTXCTL_ENABLED;
5575 regval |= tsync_tx_ctl;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005576 wr32(E1000_TSYNCTXCTL, regval);
5577
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005578 /* enable/disable RX */
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005579 regval = rd32(E1000_TSYNCRXCTL);
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005580 regval &= ~(E1000_TSYNCRXCTL_ENABLED | E1000_TSYNCRXCTL_TYPE_MASK);
5581 regval |= tsync_rx_ctl;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005582 wr32(E1000_TSYNCRXCTL, regval);
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005583
5584 /* define which PTP packets are time stamped */
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005585 wr32(E1000_TSYNCRXCFG, tsync_rx_cfg);
5586
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005587 /* define ethertype filter for timestamped packets */
5588 if (is_l2)
5589 wr32(E1000_ETQF(3),
5590 (E1000_ETQF_FILTER_ENABLE | /* enable filter */
5591 E1000_ETQF_1588 | /* enable timestamping */
5592 ETH_P_1588)); /* 1588 eth protocol type */
5593 else
5594 wr32(E1000_ETQF(3), 0);
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005595
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005596#define PTP_PORT 319
5597 /* L4 Queue Filter[3]: filter by destination port and protocol */
5598 if (is_l4) {
5599 u32 ftqf = (IPPROTO_UDP /* UDP */
5600 | E1000_FTQF_VF_BP /* VF not compared */
5601 | E1000_FTQF_1588_TIME_STAMP /* Enable Timestamping */
5602 | E1000_FTQF_MASK); /* mask all inputs */
5603 ftqf &= ~E1000_FTQF_MASK_PROTO_BP; /* enable protocol check */
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005604
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005605 wr32(E1000_IMIR(3), htons(PTP_PORT));
5606 wr32(E1000_IMIREXT(3),
5607 (E1000_IMIREXT_SIZE_BP | E1000_IMIREXT_CTRL_BP));
5608 if (hw->mac.type == e1000_82576) {
5609 /* enable source port check */
5610 wr32(E1000_SPQF(3), htons(PTP_PORT));
5611 ftqf &= ~E1000_FTQF_MASK_SOURCE_PORT_BP;
5612 }
5613 wr32(E1000_FTQF(3), ftqf);
5614 } else {
5615 wr32(E1000_FTQF(3), E1000_FTQF_MASK);
5616 }
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005617 wrfl();
5618
5619 adapter->hwtstamp_config = config;
5620
5621 /* clear TX/RX time stamp registers, just to be sure */
5622 regval = rd32(E1000_TXSTMPH);
5623 regval = rd32(E1000_RXSTMPH);
5624
5625 return copy_to_user(ifr->ifr_data, &config, sizeof(config)) ?
5626 -EFAULT : 0;
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005627}
5628
5629/**
Auke Kok9d5c8242008-01-24 02:22:38 -08005630 * igb_ioctl -
5631 * @netdev:
5632 * @ifreq:
5633 * @cmd:
5634 **/
5635static int igb_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
5636{
5637 switch (cmd) {
5638 case SIOCGMIIPHY:
5639 case SIOCGMIIREG:
5640 case SIOCSMIIREG:
5641 return igb_mii_ioctl(netdev, ifr, cmd);
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005642 case SIOCSHWTSTAMP:
5643 return igb_hwtstamp_ioctl(netdev, ifr, cmd);
Auke Kok9d5c8242008-01-24 02:22:38 -08005644 default:
5645 return -EOPNOTSUPP;
5646 }
5647}
5648
Alexander Duyck009bc062009-07-23 18:08:35 +00005649s32 igb_read_pcie_cap_reg(struct e1000_hw *hw, u32 reg, u16 *value)
5650{
5651 struct igb_adapter *adapter = hw->back;
5652 u16 cap_offset;
5653
5654 cap_offset = pci_find_capability(adapter->pdev, PCI_CAP_ID_EXP);
5655 if (!cap_offset)
5656 return -E1000_ERR_CONFIG;
5657
5658 pci_read_config_word(adapter->pdev, cap_offset + reg, value);
5659
5660 return 0;
5661}
5662
5663s32 igb_write_pcie_cap_reg(struct e1000_hw *hw, u32 reg, u16 *value)
5664{
5665 struct igb_adapter *adapter = hw->back;
5666 u16 cap_offset;
5667
5668 cap_offset = pci_find_capability(adapter->pdev, PCI_CAP_ID_EXP);
5669 if (!cap_offset)
5670 return -E1000_ERR_CONFIG;
5671
5672 pci_write_config_word(adapter->pdev, cap_offset + reg, *value);
5673
5674 return 0;
5675}
5676
Auke Kok9d5c8242008-01-24 02:22:38 -08005677static void igb_vlan_rx_register(struct net_device *netdev,
5678 struct vlan_group *grp)
5679{
5680 struct igb_adapter *adapter = netdev_priv(netdev);
5681 struct e1000_hw *hw = &adapter->hw;
5682 u32 ctrl, rctl;
5683
5684 igb_irq_disable(adapter);
5685 adapter->vlgrp = grp;
5686
5687 if (grp) {
5688 /* enable VLAN tag insert/strip */
5689 ctrl = rd32(E1000_CTRL);
5690 ctrl |= E1000_CTRL_VME;
5691 wr32(E1000_CTRL, ctrl);
5692
Alexander Duyck51466232009-10-27 23:47:35 +00005693 /* Disable CFI check */
Auke Kok9d5c8242008-01-24 02:22:38 -08005694 rctl = rd32(E1000_RCTL);
Auke Kok9d5c8242008-01-24 02:22:38 -08005695 rctl &= ~E1000_RCTL_CFIEN;
5696 wr32(E1000_RCTL, rctl);
Auke Kok9d5c8242008-01-24 02:22:38 -08005697 } else {
5698 /* disable VLAN tag insert/strip */
5699 ctrl = rd32(E1000_CTRL);
5700 ctrl &= ~E1000_CTRL_VME;
5701 wr32(E1000_CTRL, ctrl);
Auke Kok9d5c8242008-01-24 02:22:38 -08005702 }
5703
Alexander Duycke1739522009-02-19 20:39:44 -08005704 igb_rlpml_set(adapter);
5705
Auke Kok9d5c8242008-01-24 02:22:38 -08005706 if (!test_bit(__IGB_DOWN, &adapter->state))
5707 igb_irq_enable(adapter);
5708}
5709
5710static void igb_vlan_rx_add_vid(struct net_device *netdev, u16 vid)
5711{
5712 struct igb_adapter *adapter = netdev_priv(netdev);
5713 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005714 int pf_id = adapter->vfs_allocated_count;
Auke Kok9d5c8242008-01-24 02:22:38 -08005715
Alexander Duyck51466232009-10-27 23:47:35 +00005716 /* attempt to add filter to vlvf array */
5717 igb_vlvf_set(adapter, vid, true, pf_id);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005718
Alexander Duyck51466232009-10-27 23:47:35 +00005719 /* add the filter since PF can receive vlans w/o entry in vlvf */
5720 igb_vfta_set(hw, vid, true);
Auke Kok9d5c8242008-01-24 02:22:38 -08005721}
5722
5723static void igb_vlan_rx_kill_vid(struct net_device *netdev, u16 vid)
5724{
5725 struct igb_adapter *adapter = netdev_priv(netdev);
5726 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005727 int pf_id = adapter->vfs_allocated_count;
Alexander Duyck51466232009-10-27 23:47:35 +00005728 s32 err;
Auke Kok9d5c8242008-01-24 02:22:38 -08005729
5730 igb_irq_disable(adapter);
5731 vlan_group_set_device(adapter->vlgrp, vid, NULL);
5732
5733 if (!test_bit(__IGB_DOWN, &adapter->state))
5734 igb_irq_enable(adapter);
5735
Alexander Duyck51466232009-10-27 23:47:35 +00005736 /* remove vlan from VLVF table array */
5737 err = igb_vlvf_set(adapter, vid, false, pf_id);
Auke Kok9d5c8242008-01-24 02:22:38 -08005738
Alexander Duyck51466232009-10-27 23:47:35 +00005739 /* if vid was not present in VLVF just remove it from table */
5740 if (err)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005741 igb_vfta_set(hw, vid, false);
Auke Kok9d5c8242008-01-24 02:22:38 -08005742}
5743
5744static void igb_restore_vlan(struct igb_adapter *adapter)
5745{
5746 igb_vlan_rx_register(adapter->netdev, adapter->vlgrp);
5747
5748 if (adapter->vlgrp) {
5749 u16 vid;
5750 for (vid = 0; vid < VLAN_GROUP_ARRAY_LEN; vid++) {
5751 if (!vlan_group_get_device(adapter->vlgrp, vid))
5752 continue;
5753 igb_vlan_rx_add_vid(adapter->netdev, vid);
5754 }
5755 }
5756}
5757
5758int igb_set_spd_dplx(struct igb_adapter *adapter, u16 spddplx)
5759{
Alexander Duyck090b1792009-10-27 23:51:55 +00005760 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08005761 struct e1000_mac_info *mac = &adapter->hw.mac;
5762
5763 mac->autoneg = 0;
5764
Auke Kok9d5c8242008-01-24 02:22:38 -08005765 switch (spddplx) {
5766 case SPEED_10 + DUPLEX_HALF:
5767 mac->forced_speed_duplex = ADVERTISE_10_HALF;
5768 break;
5769 case SPEED_10 + DUPLEX_FULL:
5770 mac->forced_speed_duplex = ADVERTISE_10_FULL;
5771 break;
5772 case SPEED_100 + DUPLEX_HALF:
5773 mac->forced_speed_duplex = ADVERTISE_100_HALF;
5774 break;
5775 case SPEED_100 + DUPLEX_FULL:
5776 mac->forced_speed_duplex = ADVERTISE_100_FULL;
5777 break;
5778 case SPEED_1000 + DUPLEX_FULL:
5779 mac->autoneg = 1;
5780 adapter->hw.phy.autoneg_advertised = ADVERTISE_1000_FULL;
5781 break;
5782 case SPEED_1000 + DUPLEX_HALF: /* not supported */
5783 default:
Alexander Duyck090b1792009-10-27 23:51:55 +00005784 dev_err(&pdev->dev, "Unsupported Speed/Duplex configuration\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08005785 return -EINVAL;
5786 }
5787 return 0;
5788}
5789
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005790static int __igb_shutdown(struct pci_dev *pdev, bool *enable_wake)
Auke Kok9d5c8242008-01-24 02:22:38 -08005791{
5792 struct net_device *netdev = pci_get_drvdata(pdev);
5793 struct igb_adapter *adapter = netdev_priv(netdev);
5794 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck2d064c02008-07-08 15:10:12 -07005795 u32 ctrl, rctl, status;
Auke Kok9d5c8242008-01-24 02:22:38 -08005796 u32 wufc = adapter->wol;
5797#ifdef CONFIG_PM
5798 int retval = 0;
5799#endif
5800
5801 netif_device_detach(netdev);
5802
Alexander Duycka88f10e2008-07-08 15:13:38 -07005803 if (netif_running(netdev))
5804 igb_close(netdev);
5805
Alexander Duyck047e0032009-10-27 15:49:27 +00005806 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08005807
5808#ifdef CONFIG_PM
5809 retval = pci_save_state(pdev);
5810 if (retval)
5811 return retval;
5812#endif
5813
5814 status = rd32(E1000_STATUS);
5815 if (status & E1000_STATUS_LU)
5816 wufc &= ~E1000_WUFC_LNKC;
5817
5818 if (wufc) {
5819 igb_setup_rctl(adapter);
Alexander Duyckff41f8d2009-09-03 14:48:56 +00005820 igb_set_rx_mode(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08005821
5822 /* turn on all-multi mode if wake on multicast is enabled */
5823 if (wufc & E1000_WUFC_MC) {
5824 rctl = rd32(E1000_RCTL);
5825 rctl |= E1000_RCTL_MPE;
5826 wr32(E1000_RCTL, rctl);
5827 }
5828
5829 ctrl = rd32(E1000_CTRL);
5830 /* advertise wake from D3Cold */
5831 #define E1000_CTRL_ADVD3WUC 0x00100000
5832 /* phy power management enable */
5833 #define E1000_CTRL_EN_PHY_PWR_MGMT 0x00200000
5834 ctrl |= E1000_CTRL_ADVD3WUC;
5835 wr32(E1000_CTRL, ctrl);
5836
Auke Kok9d5c8242008-01-24 02:22:38 -08005837 /* Allow time for pending master requests to run */
Alexander Duyck330a6d62009-10-27 23:51:35 +00005838 igb_disable_pcie_master(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08005839
5840 wr32(E1000_WUC, E1000_WUC_PME_EN);
5841 wr32(E1000_WUFC, wufc);
Auke Kok9d5c8242008-01-24 02:22:38 -08005842 } else {
5843 wr32(E1000_WUC, 0);
5844 wr32(E1000_WUFC, 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08005845 }
5846
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005847 *enable_wake = wufc || adapter->en_mng_pt;
5848 if (!*enable_wake)
Nick Nunley88a268c2010-02-17 01:01:59 +00005849 igb_power_down_link(adapter);
5850 else
5851 igb_power_up_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08005852
5853 /* Release control of h/w to f/w. If f/w is AMT enabled, this
5854 * would have already happened in close and is redundant. */
5855 igb_release_hw_control(adapter);
5856
5857 pci_disable_device(pdev);
5858
Auke Kok9d5c8242008-01-24 02:22:38 -08005859 return 0;
5860}
5861
5862#ifdef CONFIG_PM
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005863static int igb_suspend(struct pci_dev *pdev, pm_message_t state)
5864{
5865 int retval;
5866 bool wake;
5867
5868 retval = __igb_shutdown(pdev, &wake);
5869 if (retval)
5870 return retval;
5871
5872 if (wake) {
5873 pci_prepare_to_sleep(pdev);
5874 } else {
5875 pci_wake_from_d3(pdev, false);
5876 pci_set_power_state(pdev, PCI_D3hot);
5877 }
5878
5879 return 0;
5880}
5881
Auke Kok9d5c8242008-01-24 02:22:38 -08005882static int igb_resume(struct pci_dev *pdev)
5883{
5884 struct net_device *netdev = pci_get_drvdata(pdev);
5885 struct igb_adapter *adapter = netdev_priv(netdev);
5886 struct e1000_hw *hw = &adapter->hw;
5887 u32 err;
5888
5889 pci_set_power_state(pdev, PCI_D0);
5890 pci_restore_state(pdev);
Nick Nunleyb94f2d72010-02-17 01:02:19 +00005891 pci_save_state(pdev);
Taku Izumi42bfd332008-06-20 12:10:30 +09005892
Alexander Duyckaed5dec2009-02-06 23:16:04 +00005893 err = pci_enable_device_mem(pdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08005894 if (err) {
5895 dev_err(&pdev->dev,
5896 "igb: Cannot enable PCI device from suspend\n");
5897 return err;
5898 }
5899 pci_set_master(pdev);
5900
5901 pci_enable_wake(pdev, PCI_D3hot, 0);
5902 pci_enable_wake(pdev, PCI_D3cold, 0);
5903
Alexander Duyck047e0032009-10-27 15:49:27 +00005904 if (igb_init_interrupt_scheme(adapter)) {
Alexander Duycka88f10e2008-07-08 15:13:38 -07005905 dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
5906 return -ENOMEM;
Auke Kok9d5c8242008-01-24 02:22:38 -08005907 }
5908
Auke Kok9d5c8242008-01-24 02:22:38 -08005909 igb_reset(adapter);
Alexander Duycka8564f02009-02-06 23:21:10 +00005910
5911 /* let the f/w know that the h/w is now under the control of the
5912 * driver. */
5913 igb_get_hw_control(adapter);
5914
Auke Kok9d5c8242008-01-24 02:22:38 -08005915 wr32(E1000_WUS, ~0);
5916
Alexander Duycka88f10e2008-07-08 15:13:38 -07005917 if (netif_running(netdev)) {
5918 err = igb_open(netdev);
5919 if (err)
5920 return err;
5921 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005922
5923 netif_device_attach(netdev);
5924
Auke Kok9d5c8242008-01-24 02:22:38 -08005925 return 0;
5926}
5927#endif
5928
5929static void igb_shutdown(struct pci_dev *pdev)
5930{
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005931 bool wake;
5932
5933 __igb_shutdown(pdev, &wake);
5934
5935 if (system_state == SYSTEM_POWER_OFF) {
5936 pci_wake_from_d3(pdev, wake);
5937 pci_set_power_state(pdev, PCI_D3hot);
5938 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005939}
5940
5941#ifdef CONFIG_NET_POLL_CONTROLLER
5942/*
5943 * Polling 'interrupt' - used by things like netconsole to send skbs
5944 * without having to re-enable interrupts. It's not called while
5945 * the interrupt routine is executing.
5946 */
5947static void igb_netpoll(struct net_device *netdev)
5948{
5949 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005950 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08005951 int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08005952
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005953 if (!adapter->msix_entries) {
Alexander Duyck047e0032009-10-27 15:49:27 +00005954 struct igb_q_vector *q_vector = adapter->q_vector[0];
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005955 igb_irq_disable(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +00005956 napi_schedule(&q_vector->napi);
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005957 return;
5958 }
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07005959
Alexander Duyck047e0032009-10-27 15:49:27 +00005960 for (i = 0; i < adapter->num_q_vectors; i++) {
5961 struct igb_q_vector *q_vector = adapter->q_vector[i];
5962 wr32(E1000_EIMC, q_vector->eims_value);
5963 napi_schedule(&q_vector->napi);
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005964 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005965}
5966#endif /* CONFIG_NET_POLL_CONTROLLER */
5967
5968/**
5969 * igb_io_error_detected - called when PCI error is detected
5970 * @pdev: Pointer to PCI device
5971 * @state: The current pci connection state
5972 *
5973 * This function is called after a PCI bus error affecting
5974 * this device has been detected.
5975 */
5976static pci_ers_result_t igb_io_error_detected(struct pci_dev *pdev,
5977 pci_channel_state_t state)
5978{
5979 struct net_device *netdev = pci_get_drvdata(pdev);
5980 struct igb_adapter *adapter = netdev_priv(netdev);
5981
5982 netif_device_detach(netdev);
5983
Alexander Duyck59ed6ee2009-06-30 12:46:34 +00005984 if (state == pci_channel_io_perm_failure)
5985 return PCI_ERS_RESULT_DISCONNECT;
5986
Auke Kok9d5c8242008-01-24 02:22:38 -08005987 if (netif_running(netdev))
5988 igb_down(adapter);
5989 pci_disable_device(pdev);
5990
5991 /* Request a slot slot reset. */
5992 return PCI_ERS_RESULT_NEED_RESET;
5993}
5994
5995/**
5996 * igb_io_slot_reset - called after the pci bus has been reset.
5997 * @pdev: Pointer to PCI device
5998 *
5999 * Restart the card from scratch, as if from a cold-boot. Implementation
6000 * resembles the first-half of the igb_resume routine.
6001 */
6002static pci_ers_result_t igb_io_slot_reset(struct pci_dev *pdev)
6003{
6004 struct net_device *netdev = pci_get_drvdata(pdev);
6005 struct igb_adapter *adapter = netdev_priv(netdev);
6006 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck40a914f2008-11-27 00:24:37 -08006007 pci_ers_result_t result;
Taku Izumi42bfd332008-06-20 12:10:30 +09006008 int err;
Auke Kok9d5c8242008-01-24 02:22:38 -08006009
Alexander Duyckaed5dec2009-02-06 23:16:04 +00006010 if (pci_enable_device_mem(pdev)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08006011 dev_err(&pdev->dev,
6012 "Cannot re-enable PCI device after reset.\n");
Alexander Duyck40a914f2008-11-27 00:24:37 -08006013 result = PCI_ERS_RESULT_DISCONNECT;
6014 } else {
6015 pci_set_master(pdev);
6016 pci_restore_state(pdev);
Nick Nunleyb94f2d72010-02-17 01:02:19 +00006017 pci_save_state(pdev);
Alexander Duyck40a914f2008-11-27 00:24:37 -08006018
6019 pci_enable_wake(pdev, PCI_D3hot, 0);
6020 pci_enable_wake(pdev, PCI_D3cold, 0);
6021
6022 igb_reset(adapter);
6023 wr32(E1000_WUS, ~0);
6024 result = PCI_ERS_RESULT_RECOVERED;
Auke Kok9d5c8242008-01-24 02:22:38 -08006025 }
Auke Kok9d5c8242008-01-24 02:22:38 -08006026
Jeff Kirsherea943d42008-12-11 20:34:19 -08006027 err = pci_cleanup_aer_uncorrect_error_status(pdev);
6028 if (err) {
6029 dev_err(&pdev->dev, "pci_cleanup_aer_uncorrect_error_status "
6030 "failed 0x%0x\n", err);
6031 /* non-fatal, continue */
6032 }
Auke Kok9d5c8242008-01-24 02:22:38 -08006033
Alexander Duyck40a914f2008-11-27 00:24:37 -08006034 return result;
Auke Kok9d5c8242008-01-24 02:22:38 -08006035}
6036
6037/**
6038 * igb_io_resume - called when traffic can start flowing again.
6039 * @pdev: Pointer to PCI device
6040 *
6041 * This callback is called when the error recovery driver tells us that
6042 * its OK to resume normal operation. Implementation resembles the
6043 * second-half of the igb_resume routine.
6044 */
6045static void igb_io_resume(struct pci_dev *pdev)
6046{
6047 struct net_device *netdev = pci_get_drvdata(pdev);
6048 struct igb_adapter *adapter = netdev_priv(netdev);
6049
Auke Kok9d5c8242008-01-24 02:22:38 -08006050 if (netif_running(netdev)) {
6051 if (igb_up(adapter)) {
6052 dev_err(&pdev->dev, "igb_up failed after reset\n");
6053 return;
6054 }
6055 }
6056
6057 netif_device_attach(netdev);
6058
6059 /* let the f/w know that the h/w is now under the control of the
6060 * driver. */
6061 igb_get_hw_control(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08006062}
6063
Alexander Duyck26ad9172009-10-05 06:32:49 +00006064static void igb_rar_set_qsel(struct igb_adapter *adapter, u8 *addr, u32 index,
6065 u8 qsel)
6066{
6067 u32 rar_low, rar_high;
6068 struct e1000_hw *hw = &adapter->hw;
6069
6070 /* HW expects these in little endian so we reverse the byte order
6071 * from network order (big endian) to little endian
6072 */
6073 rar_low = ((u32) addr[0] | ((u32) addr[1] << 8) |
6074 ((u32) addr[2] << 16) | ((u32) addr[3] << 24));
6075 rar_high = ((u32) addr[4] | ((u32) addr[5] << 8));
6076
6077 /* Indicate to hardware the Address is Valid. */
6078 rar_high |= E1000_RAH_AV;
6079
6080 if (hw->mac.type == e1000_82575)
6081 rar_high |= E1000_RAH_POOL_1 * qsel;
6082 else
6083 rar_high |= E1000_RAH_POOL_1 << qsel;
6084
6085 wr32(E1000_RAL(index), rar_low);
6086 wrfl();
6087 wr32(E1000_RAH(index), rar_high);
6088 wrfl();
6089}
6090
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006091static int igb_set_vf_mac(struct igb_adapter *adapter,
6092 int vf, unsigned char *mac_addr)
6093{
6094 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckff41f8d2009-09-03 14:48:56 +00006095 /* VF MAC addresses start at end of receive addresses and moves
6096 * torwards the first, as a result a collision should not be possible */
6097 int rar_entry = hw->mac.rar_entry_count - (vf + 1);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006098
Alexander Duyck37680112009-02-19 20:40:30 -08006099 memcpy(adapter->vf_data[vf].vf_mac_addresses, mac_addr, ETH_ALEN);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006100
Alexander Duyck26ad9172009-10-05 06:32:49 +00006101 igb_rar_set_qsel(adapter, mac_addr, rar_entry, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006102
6103 return 0;
6104}
6105
Williams, Mitch A8151d292010-02-10 01:44:24 +00006106static int igb_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
6107{
6108 struct igb_adapter *adapter = netdev_priv(netdev);
6109 if (!is_valid_ether_addr(mac) || (vf >= adapter->vfs_allocated_count))
6110 return -EINVAL;
6111 adapter->vf_data[vf].flags |= IGB_VF_FLAG_PF_SET_MAC;
6112 dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n", mac, vf);
6113 dev_info(&adapter->pdev->dev, "Reload the VF driver to make this"
6114 " change effective.");
6115 if (test_bit(__IGB_DOWN, &adapter->state)) {
6116 dev_warn(&adapter->pdev->dev, "The VF MAC address has been set,"
6117 " but the PF device is not up.\n");
6118 dev_warn(&adapter->pdev->dev, "Bring the PF device up before"
6119 " attempting to use the VF device.\n");
6120 }
6121 return igb_set_vf_mac(adapter, vf, mac);
6122}
6123
6124static int igb_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate)
6125{
6126 return -EOPNOTSUPP;
6127}
6128
6129static int igb_ndo_get_vf_config(struct net_device *netdev,
6130 int vf, struct ifla_vf_info *ivi)
6131{
6132 struct igb_adapter *adapter = netdev_priv(netdev);
6133 if (vf >= adapter->vfs_allocated_count)
6134 return -EINVAL;
6135 ivi->vf = vf;
6136 memcpy(&ivi->mac, adapter->vf_data[vf].vf_mac_addresses, ETH_ALEN);
6137 ivi->tx_rate = 0;
6138 ivi->vlan = adapter->vf_data[vf].pf_vlan;
6139 ivi->qos = adapter->vf_data[vf].pf_qos;
6140 return 0;
6141}
6142
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006143static void igb_vmm_control(struct igb_adapter *adapter)
6144{
6145 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck10d8e902009-10-27 15:54:04 +00006146 u32 reg;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006147
Alexander Duyck52a1dd42010-03-22 14:07:46 +00006148 switch (hw->mac.type) {
6149 case e1000_82575:
6150 default:
6151 /* replication is not supported for 82575 */
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006152 return;
Alexander Duyck52a1dd42010-03-22 14:07:46 +00006153 case e1000_82576:
6154 /* notify HW that the MAC is adding vlan tags */
6155 reg = rd32(E1000_DTXCTL);
6156 reg |= E1000_DTXCTL_VLAN_ADDED;
6157 wr32(E1000_DTXCTL, reg);
6158 case e1000_82580:
6159 /* enable replication vlan tag stripping */
6160 reg = rd32(E1000_RPLOLR);
6161 reg |= E1000_RPLOLR_STRVLAN;
6162 wr32(E1000_RPLOLR, reg);
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +00006163 case e1000_i350:
6164 /* none of the above registers are supported by i350 */
Alexander Duyck52a1dd42010-03-22 14:07:46 +00006165 break;
6166 }
Alexander Duyck10d8e902009-10-27 15:54:04 +00006167
Alexander Duyckd4960302009-10-27 15:53:45 +00006168 if (adapter->vfs_allocated_count) {
6169 igb_vmdq_set_loopback_pf(hw, true);
6170 igb_vmdq_set_replication_pf(hw, true);
6171 } else {
6172 igb_vmdq_set_loopback_pf(hw, false);
6173 igb_vmdq_set_replication_pf(hw, false);
6174 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006175}
6176
Auke Kok9d5c8242008-01-24 02:22:38 -08006177/* igb_main.c */