blob: 7d755dd2688db15dea87674df707efe22d76d603 [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>
35#include <net/checksum.h>
36#include <net/ip6_checksum.h>
Patrick Ohlyc6cb0902009-02-12 05:03:42 +000037#include <linux/net_tstamp.h>
Auke Kok9d5c8242008-01-24 02:22:38 -080038#include <linux/mii.h>
39#include <linux/ethtool.h>
40#include <linux/if_vlan.h>
41#include <linux/pci.h>
Alexander Duyckc54106b2008-10-16 21:26:57 -070042#include <linux/pci-aspm.h>
Auke Kok9d5c8242008-01-24 02:22:38 -080043#include <linux/delay.h>
44#include <linux/interrupt.h>
45#include <linux/if_ether.h>
Alexander Duyck40a914f2008-11-27 00:24:37 -080046#include <linux/aer.h>
Jeff Kirsher421e02f2008-10-17 11:08:31 -070047#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -070048#include <linux/dca.h>
49#endif
Auke Kok9d5c8242008-01-24 02:22:38 -080050#include "igb.h"
51
Alexander Duyck55cac242009-11-19 12:42:21 +000052#define DRV_VERSION "2.1.0-k2"
Auke Kok9d5c8242008-01-24 02:22:38 -080053char igb_driver_name[] = "igb";
54char igb_driver_version[] = DRV_VERSION;
55static const char igb_driver_string[] =
56 "Intel(R) Gigabit Ethernet Network Driver";
Alexander Duyck86d5d382009-02-06 23:23:12 +000057static const char igb_copyright[] = "Copyright (c) 2007-2009 Intel Corporation.";
Auke Kok9d5c8242008-01-24 02:22:38 -080058
Auke Kok9d5c8242008-01-24 02:22:38 -080059static const struct e1000_info *igb_info_tbl[] = {
60 [board_82575] = &e1000_82575_info,
61};
62
Alexey Dobriyana3aa1882010-01-07 11:58:11 +000063static DEFINE_PCI_DEVICE_TABLE(igb_pci_tbl) = {
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +000064 { PCI_VDEVICE(INTEL, E1000_DEV_ID_I350_COPPER), board_82575 },
65 { PCI_VDEVICE(INTEL, E1000_DEV_ID_I350_FIBER), board_82575 },
66 { PCI_VDEVICE(INTEL, E1000_DEV_ID_I350_SERDES), board_82575 },
67 { PCI_VDEVICE(INTEL, E1000_DEV_ID_I350_SGMII), board_82575 },
Alexander Duyck55cac242009-11-19 12:42:21 +000068 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_COPPER), board_82575 },
69 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_FIBER), board_82575 },
70 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_SERDES), board_82575 },
71 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_SGMII), board_82575 },
72 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_COPPER_DUAL), board_82575 },
Alexander Duyck2d064c02008-07-08 15:10:12 -070073 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576), board_82575 },
Alexander Duyck9eb23412009-03-13 20:42:15 +000074 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_NS), board_82575 },
Alexander Duyck747d49b2009-10-05 06:33:27 +000075 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_NS_SERDES), board_82575 },
Alexander Duyck2d064c02008-07-08 15:10:12 -070076 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_FIBER), board_82575 },
77 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_SERDES), board_82575 },
Alexander Duyck4703bf72009-07-23 18:09:48 +000078 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_SERDES_QUAD), board_82575 },
Carolyn Wybornyb894fa22010-03-19 06:07:48 +000079 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_QUAD_COPPER_ET2), board_82575 },
Alexander Duyckc8ea5ea2009-03-13 20:42:35 +000080 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_QUAD_COPPER), board_82575 },
Auke Kok9d5c8242008-01-24 02:22:38 -080081 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82575EB_COPPER), board_82575 },
82 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82575EB_FIBER_SERDES), board_82575 },
83 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82575GB_QUAD_COPPER), board_82575 },
84 /* required last entry */
85 {0, }
86};
87
88MODULE_DEVICE_TABLE(pci, igb_pci_tbl);
89
90void igb_reset(struct igb_adapter *);
91static int igb_setup_all_tx_resources(struct igb_adapter *);
92static int igb_setup_all_rx_resources(struct igb_adapter *);
93static void igb_free_all_tx_resources(struct igb_adapter *);
94static void igb_free_all_rx_resources(struct igb_adapter *);
Alexander Duyck06cf2662009-10-27 15:53:25 +000095static void igb_setup_mrqc(struct igb_adapter *);
Auke Kok9d5c8242008-01-24 02:22:38 -080096void igb_update_stats(struct igb_adapter *);
97static int igb_probe(struct pci_dev *, const struct pci_device_id *);
98static void __devexit igb_remove(struct pci_dev *pdev);
99static int igb_sw_init(struct igb_adapter *);
100static int igb_open(struct net_device *);
101static int igb_close(struct net_device *);
102static void igb_configure_tx(struct igb_adapter *);
103static void igb_configure_rx(struct igb_adapter *);
Auke Kok9d5c8242008-01-24 02:22:38 -0800104static void igb_clean_all_tx_rings(struct igb_adapter *);
105static void igb_clean_all_rx_rings(struct igb_adapter *);
Mitch Williams3b644cf2008-06-27 10:59:48 -0700106static void igb_clean_tx_ring(struct igb_ring *);
107static void igb_clean_rx_ring(struct igb_ring *);
Alexander Duyckff41f8d2009-09-03 14:48:56 +0000108static void igb_set_rx_mode(struct net_device *);
Auke Kok9d5c8242008-01-24 02:22:38 -0800109static void igb_update_phy_info(unsigned long);
110static void igb_watchdog(unsigned long);
111static void igb_watchdog_task(struct work_struct *);
Alexander Duyckb1a436c2009-10-27 15:54:43 +0000112static netdev_tx_t igb_xmit_frame_adv(struct sk_buff *skb, struct net_device *);
Auke Kok9d5c8242008-01-24 02:22:38 -0800113static struct net_device_stats *igb_get_stats(struct net_device *);
114static int igb_change_mtu(struct net_device *, int);
115static int igb_set_mac(struct net_device *, void *);
Alexander Duyck68d480c2009-10-05 06:33:08 +0000116static void igb_set_uta(struct igb_adapter *adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800117static irqreturn_t igb_intr(int irq, void *);
118static irqreturn_t igb_intr_msi(int irq, void *);
119static irqreturn_t igb_msix_other(int irq, void *);
Alexander Duyck047e0032009-10-27 15:49:27 +0000120static irqreturn_t igb_msix_ring(int irq, void *);
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700121#ifdef CONFIG_IGB_DCA
Alexander Duyck047e0032009-10-27 15:49:27 +0000122static void igb_update_dca(struct igb_q_vector *);
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700123static void igb_setup_dca(struct igb_adapter *);
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700124#endif /* CONFIG_IGB_DCA */
Alexander Duyck047e0032009-10-27 15:49:27 +0000125static bool igb_clean_tx_irq(struct igb_q_vector *);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700126static int igb_poll(struct napi_struct *, int);
Alexander Duyck047e0032009-10-27 15:49:27 +0000127static bool igb_clean_rx_irq_adv(struct igb_q_vector *, int *, int);
Auke Kok9d5c8242008-01-24 02:22:38 -0800128static int igb_ioctl(struct net_device *, struct ifreq *, int cmd);
129static void igb_tx_timeout(struct net_device *);
130static void igb_reset_task(struct work_struct *);
131static void igb_vlan_rx_register(struct net_device *, struct vlan_group *);
132static void igb_vlan_rx_add_vid(struct net_device *, u16);
133static void igb_vlan_rx_kill_vid(struct net_device *, u16);
134static void igb_restore_vlan(struct igb_adapter *);
Alexander Duyck26ad9172009-10-05 06:32:49 +0000135static void igb_rar_set_qsel(struct igb_adapter *, u8 *, u32 , u8);
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800136static void igb_ping_all_vfs(struct igb_adapter *);
137static void igb_msg_task(struct igb_adapter *);
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800138static void igb_vmm_control(struct igb_adapter *);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +0000139static int igb_set_vf_mac(struct igb_adapter *, int, unsigned char *);
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800140static void igb_restore_vf_multicasts(struct igb_adapter *adapter);
Williams, Mitch A8151d292010-02-10 01:44:24 +0000141static int igb_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac);
142static int igb_ndo_set_vf_vlan(struct net_device *netdev,
143 int vf, u16 vlan, u8 qos);
144static int igb_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate);
145static int igb_ndo_get_vf_config(struct net_device *netdev, int vf,
146 struct ifla_vf_info *ivi);
Auke Kok9d5c8242008-01-24 02:22:38 -0800147
Auke Kok9d5c8242008-01-24 02:22:38 -0800148#ifdef CONFIG_PM
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +0000149static int igb_suspend(struct pci_dev *, pm_message_t);
Auke Kok9d5c8242008-01-24 02:22:38 -0800150static int igb_resume(struct pci_dev *);
151#endif
152static void igb_shutdown(struct pci_dev *);
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700153#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700154static int igb_notify_dca(struct notifier_block *, unsigned long, void *);
155static struct notifier_block dca_notifier = {
156 .notifier_call = igb_notify_dca,
157 .next = NULL,
158 .priority = 0
159};
160#endif
Auke Kok9d5c8242008-01-24 02:22:38 -0800161#ifdef CONFIG_NET_POLL_CONTROLLER
162/* for netdump / net console */
163static void igb_netpoll(struct net_device *);
164#endif
Alexander Duyck37680112009-02-19 20:40:30 -0800165#ifdef CONFIG_PCI_IOV
Alexander Duyck2a3abf62009-04-07 14:37:52 +0000166static unsigned int max_vfs = 0;
167module_param(max_vfs, uint, 0);
168MODULE_PARM_DESC(max_vfs, "Maximum number of virtual functions to allocate "
169 "per physical function");
170#endif /* CONFIG_PCI_IOV */
171
Auke Kok9d5c8242008-01-24 02:22:38 -0800172static pci_ers_result_t igb_io_error_detected(struct pci_dev *,
173 pci_channel_state_t);
174static pci_ers_result_t igb_io_slot_reset(struct pci_dev *);
175static void igb_io_resume(struct pci_dev *);
176
177static struct pci_error_handlers igb_err_handler = {
178 .error_detected = igb_io_error_detected,
179 .slot_reset = igb_io_slot_reset,
180 .resume = igb_io_resume,
181};
182
183
184static struct pci_driver igb_driver = {
185 .name = igb_driver_name,
186 .id_table = igb_pci_tbl,
187 .probe = igb_probe,
188 .remove = __devexit_p(igb_remove),
189#ifdef CONFIG_PM
190 /* Power Managment Hooks */
191 .suspend = igb_suspend,
192 .resume = igb_resume,
193#endif
194 .shutdown = igb_shutdown,
195 .err_handler = &igb_err_handler
196};
197
198MODULE_AUTHOR("Intel Corporation, <e1000-devel@lists.sourceforge.net>");
199MODULE_DESCRIPTION("Intel(R) Gigabit Ethernet Network Driver");
200MODULE_LICENSE("GPL");
201MODULE_VERSION(DRV_VERSION);
202
Patrick Ohly38c845c2009-02-12 05:03:41 +0000203/**
Patrick Ohly38c845c2009-02-12 05:03:41 +0000204 * igb_read_clock - read raw cycle counter (to be used by time counter)
205 */
206static cycle_t igb_read_clock(const struct cyclecounter *tc)
207{
208 struct igb_adapter *adapter =
209 container_of(tc, struct igb_adapter, cycles);
210 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +0000211 u64 stamp = 0;
212 int shift = 0;
Patrick Ohly38c845c2009-02-12 05:03:41 +0000213
Alexander Duyck55cac242009-11-19 12:42:21 +0000214 /*
215 * The timestamp latches on lowest register read. For the 82580
216 * the lowest register is SYSTIMR instead of SYSTIML. However we never
217 * adjusted TIMINCA so SYSTIMR will just read as all 0s so ignore it.
218 */
219 if (hw->mac.type == e1000_82580) {
220 stamp = rd32(E1000_SYSTIMR) >> 8;
221 shift = IGB_82580_TSYNC_SHIFT;
222 }
223
Alexander Duyckc5b9bd52009-10-27 23:46:01 +0000224 stamp |= (u64)rd32(E1000_SYSTIML) << shift;
225 stamp |= (u64)rd32(E1000_SYSTIMH) << (shift + 32);
Patrick Ohly38c845c2009-02-12 05:03:41 +0000226 return stamp;
227}
228
Auke Kok9d5c8242008-01-24 02:22:38 -0800229/**
Alexander Duyckc0410762010-03-25 13:10:08 +0000230 * igb_get_hw_dev - return device
Auke Kok9d5c8242008-01-24 02:22:38 -0800231 * used by hardware layer to print debugging information
232 **/
Alexander Duyckc0410762010-03-25 13:10:08 +0000233struct net_device *igb_get_hw_dev(struct e1000_hw *hw)
Auke Kok9d5c8242008-01-24 02:22:38 -0800234{
235 struct igb_adapter *adapter = hw->back;
Alexander Duyckc0410762010-03-25 13:10:08 +0000236 return adapter->netdev;
Auke Kok9d5c8242008-01-24 02:22:38 -0800237}
Patrick Ohly38c845c2009-02-12 05:03:41 +0000238
239/**
Auke Kok9d5c8242008-01-24 02:22:38 -0800240 * igb_init_module - Driver Registration Routine
241 *
242 * igb_init_module is the first routine called when the driver is
243 * loaded. All it does is register with the PCI subsystem.
244 **/
245static int __init igb_init_module(void)
246{
247 int ret;
248 printk(KERN_INFO "%s - version %s\n",
249 igb_driver_string, igb_driver_version);
250
251 printk(KERN_INFO "%s\n", igb_copyright);
252
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700253#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700254 dca_register_notify(&dca_notifier);
255#endif
Alexander Duyckbbd98fe2009-01-31 00:52:30 -0800256 ret = pci_register_driver(&igb_driver);
Auke Kok9d5c8242008-01-24 02:22:38 -0800257 return ret;
258}
259
260module_init(igb_init_module);
261
262/**
263 * igb_exit_module - Driver Exit Cleanup Routine
264 *
265 * igb_exit_module is called just before the driver is removed
266 * from memory.
267 **/
268static void __exit igb_exit_module(void)
269{
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700270#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700271 dca_unregister_notify(&dca_notifier);
272#endif
Auke Kok9d5c8242008-01-24 02:22:38 -0800273 pci_unregister_driver(&igb_driver);
274}
275
276module_exit(igb_exit_module);
277
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800278#define Q_IDX_82576(i) (((i & 0x1) << 3) + (i >> 1))
279/**
280 * igb_cache_ring_register - Descriptor ring to register mapping
281 * @adapter: board private structure to initialize
282 *
283 * Once we know the feature-set enabled for the device, we'll cache
284 * the register offset the descriptor ring is assigned to.
285 **/
286static void igb_cache_ring_register(struct igb_adapter *adapter)
287{
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000288 int i = 0, j = 0;
Alexander Duyck047e0032009-10-27 15:49:27 +0000289 u32 rbase_offset = adapter->vfs_allocated_count;
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800290
291 switch (adapter->hw.mac.type) {
292 case e1000_82576:
293 /* The queues are allocated for virtualization such that VF 0
294 * is allocated queues 0 and 8, VF 1 queues 1 and 9, etc.
295 * In order to avoid collision we start at the first free queue
296 * and continue consuming queues in the same sequence
297 */
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000298 if (adapter->vfs_allocated_count) {
Alexander Duycka99955f2009-11-12 18:37:19 +0000299 for (; i < adapter->rss_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000300 adapter->rx_ring[i]->reg_idx = rbase_offset +
301 Q_IDX_82576(i);
Alexander Duycka99955f2009-11-12 18:37:19 +0000302 for (; j < adapter->rss_queues; j++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000303 adapter->tx_ring[j]->reg_idx = rbase_offset +
304 Q_IDX_82576(j);
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000305 }
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800306 case e1000_82575:
Alexander Duyck55cac242009-11-19 12:42:21 +0000307 case e1000_82580:
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +0000308 case e1000_i350:
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800309 default:
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000310 for (; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000311 adapter->rx_ring[i]->reg_idx = rbase_offset + i;
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000312 for (; j < adapter->num_tx_queues; j++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000313 adapter->tx_ring[j]->reg_idx = rbase_offset + j;
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800314 break;
315 }
316}
317
Alexander Duyck047e0032009-10-27 15:49:27 +0000318static void igb_free_queues(struct igb_adapter *adapter)
319{
Alexander Duyck3025a442010-02-17 01:02:39 +0000320 int i;
Alexander Duyck047e0032009-10-27 15:49:27 +0000321
Alexander Duyck3025a442010-02-17 01:02:39 +0000322 for (i = 0; i < adapter->num_tx_queues; i++) {
323 kfree(adapter->tx_ring[i]);
324 adapter->tx_ring[i] = NULL;
325 }
326 for (i = 0; i < adapter->num_rx_queues; i++) {
327 kfree(adapter->rx_ring[i]);
328 adapter->rx_ring[i] = NULL;
329 }
Alexander Duyck047e0032009-10-27 15:49:27 +0000330 adapter->num_rx_queues = 0;
331 adapter->num_tx_queues = 0;
332}
333
Auke Kok9d5c8242008-01-24 02:22:38 -0800334/**
335 * igb_alloc_queues - Allocate memory for all rings
336 * @adapter: board private structure to initialize
337 *
338 * We allocate one ring per queue at run-time since we don't know the
339 * number of queues at compile-time.
340 **/
341static int igb_alloc_queues(struct igb_adapter *adapter)
342{
Alexander Duyck3025a442010-02-17 01:02:39 +0000343 struct igb_ring *ring;
Auke Kok9d5c8242008-01-24 02:22:38 -0800344 int i;
345
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700346 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +0000347 ring = kzalloc(sizeof(struct igb_ring), GFP_KERNEL);
348 if (!ring)
349 goto err;
Alexander Duyck68fd9912008-11-20 00:48:10 -0800350 ring->count = adapter->tx_ring_count;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700351 ring->queue_index = i;
Alexander Duyck80785292009-10-27 15:51:47 +0000352 ring->pdev = adapter->pdev;
Alexander Duycke694e962009-10-27 15:53:06 +0000353 ring->netdev = adapter->netdev;
Alexander Duyck85ad76b2009-10-27 15:52:46 +0000354 /* For 82575, context index must be unique per ring. */
355 if (adapter->hw.mac.type == e1000_82575)
356 ring->flags = IGB_RING_FLAG_TX_CTX_IDX;
Alexander Duyck3025a442010-02-17 01:02:39 +0000357 adapter->tx_ring[i] = ring;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700358 }
Alexander Duyck85ad76b2009-10-27 15:52:46 +0000359
Auke Kok9d5c8242008-01-24 02:22:38 -0800360 for (i = 0; i < adapter->num_rx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +0000361 ring = kzalloc(sizeof(struct igb_ring), GFP_KERNEL);
362 if (!ring)
363 goto err;
Alexander Duyck68fd9912008-11-20 00:48:10 -0800364 ring->count = adapter->rx_ring_count;
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700365 ring->queue_index = i;
Alexander Duyck80785292009-10-27 15:51:47 +0000366 ring->pdev = adapter->pdev;
Alexander Duycke694e962009-10-27 15:53:06 +0000367 ring->netdev = adapter->netdev;
Alexander Duyck4c844852009-10-27 15:52:07 +0000368 ring->rx_buffer_len = MAXIMUM_ETHERNET_VLAN_SIZE;
Alexander Duyck85ad76b2009-10-27 15:52:46 +0000369 ring->flags = IGB_RING_FLAG_RX_CSUM; /* enable rx checksum */
370 /* set flag indicating ring supports SCTP checksum offload */
371 if (adapter->hw.mac.type >= e1000_82576)
372 ring->flags |= IGB_RING_FLAG_RX_SCTP_CSUM;
Alexander Duyck3025a442010-02-17 01:02:39 +0000373 adapter->rx_ring[i] = ring;
Auke Kok9d5c8242008-01-24 02:22:38 -0800374 }
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800375
376 igb_cache_ring_register(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +0000377
Auke Kok9d5c8242008-01-24 02:22:38 -0800378 return 0;
Auke Kok9d5c8242008-01-24 02:22:38 -0800379
Alexander Duyck047e0032009-10-27 15:49:27 +0000380err:
381 igb_free_queues(adapter);
Alexander Duycka88f10e2008-07-08 15:13:38 -0700382
Alexander Duyck047e0032009-10-27 15:49:27 +0000383 return -ENOMEM;
Alexander Duycka88f10e2008-07-08 15:13:38 -0700384}
385
Auke Kok9d5c8242008-01-24 02:22:38 -0800386#define IGB_N0_QUEUE -1
Alexander Duyck047e0032009-10-27 15:49:27 +0000387static void igb_assign_vector(struct igb_q_vector *q_vector, int msix_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -0800388{
389 u32 msixbm = 0;
Alexander Duyck047e0032009-10-27 15:49:27 +0000390 struct igb_adapter *adapter = q_vector->adapter;
Auke Kok9d5c8242008-01-24 02:22:38 -0800391 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700392 u32 ivar, index;
Alexander Duyck047e0032009-10-27 15:49:27 +0000393 int rx_queue = IGB_N0_QUEUE;
394 int tx_queue = IGB_N0_QUEUE;
395
396 if (q_vector->rx_ring)
397 rx_queue = q_vector->rx_ring->reg_idx;
398 if (q_vector->tx_ring)
399 tx_queue = q_vector->tx_ring->reg_idx;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700400
401 switch (hw->mac.type) {
402 case e1000_82575:
Auke Kok9d5c8242008-01-24 02:22:38 -0800403 /* The 82575 assigns vectors using a bitmask, which matches the
404 bitmask for the EICR/EIMS/EIMC registers. To assign one
405 or more queues to a vector, we write the appropriate bits
406 into the MSIXBM register for that vector. */
Alexander Duyck047e0032009-10-27 15:49:27 +0000407 if (rx_queue > IGB_N0_QUEUE)
Auke Kok9d5c8242008-01-24 02:22:38 -0800408 msixbm = E1000_EICR_RX_QUEUE0 << rx_queue;
Alexander Duyck047e0032009-10-27 15:49:27 +0000409 if (tx_queue > IGB_N0_QUEUE)
Auke Kok9d5c8242008-01-24 02:22:38 -0800410 msixbm |= E1000_EICR_TX_QUEUE0 << tx_queue;
Alexander Duyckfeeb2722010-02-03 21:59:51 +0000411 if (!adapter->msix_entries && msix_vector == 0)
412 msixbm |= E1000_EIMS_OTHER;
Auke Kok9d5c8242008-01-24 02:22:38 -0800413 array_wr32(E1000_MSIXBM(0), msix_vector, msixbm);
Alexander Duyck047e0032009-10-27 15:49:27 +0000414 q_vector->eims_value = msixbm;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700415 break;
416 case e1000_82576:
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800417 /* 82576 uses a table-based method for assigning vectors.
Alexander Duyck2d064c02008-07-08 15:10:12 -0700418 Each queue has a single entry in the table to which we write
419 a vector number along with a "valid" bit. Sadly, the layout
420 of the table is somewhat counterintuitive. */
421 if (rx_queue > IGB_N0_QUEUE) {
Alexander Duyck047e0032009-10-27 15:49:27 +0000422 index = (rx_queue & 0x7);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700423 ivar = array_rd32(E1000_IVAR0, index);
Alexander Duyck047e0032009-10-27 15:49:27 +0000424 if (rx_queue < 8) {
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800425 /* vector goes into low byte of register */
426 ivar = ivar & 0xFFFFFF00;
427 ivar |= msix_vector | E1000_IVAR_VALID;
Alexander Duyck047e0032009-10-27 15:49:27 +0000428 } else {
429 /* vector goes into third byte of register */
430 ivar = ivar & 0xFF00FFFF;
431 ivar |= (msix_vector | E1000_IVAR_VALID) << 16;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700432 }
Alexander Duyck2d064c02008-07-08 15:10:12 -0700433 array_wr32(E1000_IVAR0, index, ivar);
434 }
435 if (tx_queue > IGB_N0_QUEUE) {
Alexander Duyck047e0032009-10-27 15:49:27 +0000436 index = (tx_queue & 0x7);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700437 ivar = array_rd32(E1000_IVAR0, index);
Alexander Duyck047e0032009-10-27 15:49:27 +0000438 if (tx_queue < 8) {
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800439 /* vector goes into second byte of register */
440 ivar = ivar & 0xFFFF00FF;
441 ivar |= (msix_vector | E1000_IVAR_VALID) << 8;
Alexander Duyck047e0032009-10-27 15:49:27 +0000442 } else {
443 /* vector goes into high byte of register */
444 ivar = ivar & 0x00FFFFFF;
445 ivar |= (msix_vector | E1000_IVAR_VALID) << 24;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700446 }
Alexander Duyck2d064c02008-07-08 15:10:12 -0700447 array_wr32(E1000_IVAR0, index, ivar);
448 }
Alexander Duyck047e0032009-10-27 15:49:27 +0000449 q_vector->eims_value = 1 << msix_vector;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700450 break;
Alexander Duyck55cac242009-11-19 12:42:21 +0000451 case e1000_82580:
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +0000452 case e1000_i350:
Alexander Duyck55cac242009-11-19 12:42:21 +0000453 /* 82580 uses the same table-based approach as 82576 but has fewer
454 entries as a result we carry over for queues greater than 4. */
455 if (rx_queue > IGB_N0_QUEUE) {
456 index = (rx_queue >> 1);
457 ivar = array_rd32(E1000_IVAR0, index);
458 if (rx_queue & 0x1) {
459 /* vector goes into third byte of register */
460 ivar = ivar & 0xFF00FFFF;
461 ivar |= (msix_vector | E1000_IVAR_VALID) << 16;
462 } else {
463 /* vector goes into low byte of register */
464 ivar = ivar & 0xFFFFFF00;
465 ivar |= msix_vector | E1000_IVAR_VALID;
466 }
467 array_wr32(E1000_IVAR0, index, ivar);
468 }
469 if (tx_queue > IGB_N0_QUEUE) {
470 index = (tx_queue >> 1);
471 ivar = array_rd32(E1000_IVAR0, index);
472 if (tx_queue & 0x1) {
473 /* vector goes into high byte of register */
474 ivar = ivar & 0x00FFFFFF;
475 ivar |= (msix_vector | E1000_IVAR_VALID) << 24;
476 } else {
477 /* vector goes into second byte of register */
478 ivar = ivar & 0xFFFF00FF;
479 ivar |= (msix_vector | E1000_IVAR_VALID) << 8;
480 }
481 array_wr32(E1000_IVAR0, index, ivar);
482 }
483 q_vector->eims_value = 1 << msix_vector;
484 break;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700485 default:
486 BUG();
487 break;
488 }
Alexander Duyck26b39272010-02-17 01:00:41 +0000489
490 /* add q_vector eims value to global eims_enable_mask */
491 adapter->eims_enable_mask |= q_vector->eims_value;
492
493 /* configure q_vector to set itr on first interrupt */
494 q_vector->set_itr = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -0800495}
496
497/**
498 * igb_configure_msix - Configure MSI-X hardware
499 *
500 * igb_configure_msix sets up the hardware to properly
501 * generate MSI-X interrupts.
502 **/
503static void igb_configure_msix(struct igb_adapter *adapter)
504{
505 u32 tmp;
506 int i, vector = 0;
507 struct e1000_hw *hw = &adapter->hw;
508
509 adapter->eims_enable_mask = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -0800510
511 /* set vector for other causes, i.e. link changes */
Alexander Duyck2d064c02008-07-08 15:10:12 -0700512 switch (hw->mac.type) {
513 case e1000_82575:
Auke Kok9d5c8242008-01-24 02:22:38 -0800514 tmp = rd32(E1000_CTRL_EXT);
515 /* enable MSI-X PBA support*/
516 tmp |= E1000_CTRL_EXT_PBA_CLR;
517
518 /* Auto-Mask interrupts upon ICR read. */
519 tmp |= E1000_CTRL_EXT_EIAME;
520 tmp |= E1000_CTRL_EXT_IRCA;
521
522 wr32(E1000_CTRL_EXT, tmp);
Alexander Duyck047e0032009-10-27 15:49:27 +0000523
524 /* enable msix_other interrupt */
525 array_wr32(E1000_MSIXBM(0), vector++,
526 E1000_EIMS_OTHER);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700527 adapter->eims_other = E1000_EIMS_OTHER;
Auke Kok9d5c8242008-01-24 02:22:38 -0800528
Alexander Duyck2d064c02008-07-08 15:10:12 -0700529 break;
530
531 case e1000_82576:
Alexander Duyck55cac242009-11-19 12:42:21 +0000532 case e1000_82580:
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +0000533 case e1000_i350:
Alexander Duyck047e0032009-10-27 15:49:27 +0000534 /* Turn on MSI-X capability first, or our settings
535 * won't stick. And it will take days to debug. */
536 wr32(E1000_GPIE, E1000_GPIE_MSIX_MODE |
537 E1000_GPIE_PBA | E1000_GPIE_EIAME |
538 E1000_GPIE_NSICR);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700539
Alexander Duyck047e0032009-10-27 15:49:27 +0000540 /* enable msix_other interrupt */
541 adapter->eims_other = 1 << vector;
542 tmp = (vector++ | E1000_IVAR_VALID) << 8;
543
544 wr32(E1000_IVAR_MISC, tmp);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700545 break;
546 default:
547 /* do nothing, since nothing else supports MSI-X */
548 break;
549 } /* switch (hw->mac.type) */
Alexander Duyck047e0032009-10-27 15:49:27 +0000550
551 adapter->eims_enable_mask |= adapter->eims_other;
552
Alexander Duyck26b39272010-02-17 01:00:41 +0000553 for (i = 0; i < adapter->num_q_vectors; i++)
554 igb_assign_vector(adapter->q_vector[i], vector++);
Alexander Duyck047e0032009-10-27 15:49:27 +0000555
Auke Kok9d5c8242008-01-24 02:22:38 -0800556 wrfl();
557}
558
559/**
560 * igb_request_msix - Initialize MSI-X interrupts
561 *
562 * igb_request_msix allocates MSI-X vectors and requests interrupts from the
563 * kernel.
564 **/
565static int igb_request_msix(struct igb_adapter *adapter)
566{
567 struct net_device *netdev = adapter->netdev;
Alexander Duyck047e0032009-10-27 15:49:27 +0000568 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -0800569 int i, err = 0, vector = 0;
570
Auke Kok9d5c8242008-01-24 02:22:38 -0800571 err = request_irq(adapter->msix_entries[vector].vector,
Joe Perchesa0607fd2009-11-18 23:29:17 -0800572 igb_msix_other, 0, netdev->name, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800573 if (err)
574 goto out;
Alexander Duyck047e0032009-10-27 15:49:27 +0000575 vector++;
576
577 for (i = 0; i < adapter->num_q_vectors; i++) {
578 struct igb_q_vector *q_vector = adapter->q_vector[i];
579
580 q_vector->itr_register = hw->hw_addr + E1000_EITR(vector);
581
582 if (q_vector->rx_ring && q_vector->tx_ring)
583 sprintf(q_vector->name, "%s-TxRx-%u", netdev->name,
584 q_vector->rx_ring->queue_index);
585 else if (q_vector->tx_ring)
586 sprintf(q_vector->name, "%s-tx-%u", netdev->name,
587 q_vector->tx_ring->queue_index);
588 else if (q_vector->rx_ring)
589 sprintf(q_vector->name, "%s-rx-%u", netdev->name,
590 q_vector->rx_ring->queue_index);
591 else
592 sprintf(q_vector->name, "%s-unused", netdev->name);
593
594 err = request_irq(adapter->msix_entries[vector].vector,
Joe Perchesa0607fd2009-11-18 23:29:17 -0800595 igb_msix_ring, 0, q_vector->name,
Alexander Duyck047e0032009-10-27 15:49:27 +0000596 q_vector);
597 if (err)
598 goto out;
599 vector++;
600 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800601
Auke Kok9d5c8242008-01-24 02:22:38 -0800602 igb_configure_msix(adapter);
603 return 0;
604out:
605 return err;
606}
607
608static void igb_reset_interrupt_capability(struct igb_adapter *adapter)
609{
610 if (adapter->msix_entries) {
611 pci_disable_msix(adapter->pdev);
612 kfree(adapter->msix_entries);
613 adapter->msix_entries = NULL;
Alexander Duyck047e0032009-10-27 15:49:27 +0000614 } else if (adapter->flags & IGB_FLAG_HAS_MSI) {
Auke Kok9d5c8242008-01-24 02:22:38 -0800615 pci_disable_msi(adapter->pdev);
Alexander Duyck047e0032009-10-27 15:49:27 +0000616 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800617}
618
Alexander Duyck047e0032009-10-27 15:49:27 +0000619/**
620 * igb_free_q_vectors - Free memory allocated for interrupt vectors
621 * @adapter: board private structure to initialize
622 *
623 * This function frees the memory allocated to the q_vectors. In addition if
624 * NAPI is enabled it will delete any references to the NAPI struct prior
625 * to freeing the q_vector.
626 **/
627static void igb_free_q_vectors(struct igb_adapter *adapter)
628{
629 int v_idx;
630
631 for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
632 struct igb_q_vector *q_vector = adapter->q_vector[v_idx];
633 adapter->q_vector[v_idx] = NULL;
Nick Nunleyfe0592b2010-02-17 01:05:35 +0000634 if (!q_vector)
635 continue;
Alexander Duyck047e0032009-10-27 15:49:27 +0000636 netif_napi_del(&q_vector->napi);
637 kfree(q_vector);
638 }
639 adapter->num_q_vectors = 0;
640}
641
642/**
643 * igb_clear_interrupt_scheme - reset the device to a state of no interrupts
644 *
645 * This function resets the device so that it has 0 rx queues, tx queues, and
646 * MSI-X interrupts allocated.
647 */
648static void igb_clear_interrupt_scheme(struct igb_adapter *adapter)
649{
650 igb_free_queues(adapter);
651 igb_free_q_vectors(adapter);
652 igb_reset_interrupt_capability(adapter);
653}
Auke Kok9d5c8242008-01-24 02:22:38 -0800654
655/**
656 * igb_set_interrupt_capability - set MSI or MSI-X if supported
657 *
658 * Attempt to configure interrupts using the best available
659 * capabilities of the hardware and kernel.
660 **/
661static void igb_set_interrupt_capability(struct igb_adapter *adapter)
662{
663 int err;
664 int numvecs, i;
665
Alexander Duyck83b71802009-02-06 23:15:45 +0000666 /* Number of supported queues. */
Alexander Duycka99955f2009-11-12 18:37:19 +0000667 adapter->num_rx_queues = adapter->rss_queues;
668 adapter->num_tx_queues = adapter->rss_queues;
Alexander Duyck83b71802009-02-06 23:15:45 +0000669
Alexander Duyck047e0032009-10-27 15:49:27 +0000670 /* start with one vector for every rx queue */
671 numvecs = adapter->num_rx_queues;
672
Daniel Mack3ad2f3f2010-02-03 08:01:28 +0800673 /* if tx handler is separate add 1 for every tx queue */
Alexander Duycka99955f2009-11-12 18:37:19 +0000674 if (!(adapter->flags & IGB_FLAG_QUEUE_PAIRS))
675 numvecs += adapter->num_tx_queues;
Alexander Duyck047e0032009-10-27 15:49:27 +0000676
677 /* store the number of vectors reserved for queues */
678 adapter->num_q_vectors = numvecs;
679
680 /* add 1 vector for link status interrupts */
681 numvecs++;
Auke Kok9d5c8242008-01-24 02:22:38 -0800682 adapter->msix_entries = kcalloc(numvecs, sizeof(struct msix_entry),
683 GFP_KERNEL);
684 if (!adapter->msix_entries)
685 goto msi_only;
686
687 for (i = 0; i < numvecs; i++)
688 adapter->msix_entries[i].entry = i;
689
690 err = pci_enable_msix(adapter->pdev,
691 adapter->msix_entries,
692 numvecs);
693 if (err == 0)
Alexander Duyck34a20e82008-08-26 04:25:13 -0700694 goto out;
Auke Kok9d5c8242008-01-24 02:22:38 -0800695
696 igb_reset_interrupt_capability(adapter);
697
698 /* If we can't do MSI-X, try MSI */
699msi_only:
Alexander Duyck2a3abf62009-04-07 14:37:52 +0000700#ifdef CONFIG_PCI_IOV
701 /* disable SR-IOV for non MSI-X configurations */
702 if (adapter->vf_data) {
703 struct e1000_hw *hw = &adapter->hw;
704 /* disable iov and allow time for transactions to clear */
705 pci_disable_sriov(adapter->pdev);
706 msleep(500);
707
708 kfree(adapter->vf_data);
709 adapter->vf_data = NULL;
710 wr32(E1000_IOVCTL, E1000_IOVCTL_REUSE_VFQ);
711 msleep(100);
712 dev_info(&adapter->pdev->dev, "IOV Disabled\n");
713 }
714#endif
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000715 adapter->vfs_allocated_count = 0;
Alexander Duycka99955f2009-11-12 18:37:19 +0000716 adapter->rss_queues = 1;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000717 adapter->flags |= IGB_FLAG_QUEUE_PAIRS;
Auke Kok9d5c8242008-01-24 02:22:38 -0800718 adapter->num_rx_queues = 1;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700719 adapter->num_tx_queues = 1;
Alexander Duyck047e0032009-10-27 15:49:27 +0000720 adapter->num_q_vectors = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -0800721 if (!pci_enable_msi(adapter->pdev))
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700722 adapter->flags |= IGB_FLAG_HAS_MSI;
Alexander Duyck34a20e82008-08-26 04:25:13 -0700723out:
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700724 /* Notify the stack of the (possibly) reduced Tx Queue count. */
David S. Millerfd2ea0a2008-07-17 01:56:23 -0700725 adapter->netdev->real_num_tx_queues = adapter->num_tx_queues;
Auke Kok9d5c8242008-01-24 02:22:38 -0800726 return;
727}
728
729/**
Alexander Duyck047e0032009-10-27 15:49:27 +0000730 * igb_alloc_q_vectors - Allocate memory for interrupt vectors
731 * @adapter: board private structure to initialize
732 *
733 * We allocate one q_vector per queue interrupt. If allocation fails we
734 * return -ENOMEM.
735 **/
736static int igb_alloc_q_vectors(struct igb_adapter *adapter)
737{
738 struct igb_q_vector *q_vector;
739 struct e1000_hw *hw = &adapter->hw;
740 int v_idx;
741
742 for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
743 q_vector = kzalloc(sizeof(struct igb_q_vector), GFP_KERNEL);
744 if (!q_vector)
745 goto err_out;
746 q_vector->adapter = adapter;
Alexander Duyck047e0032009-10-27 15:49:27 +0000747 q_vector->itr_register = hw->hw_addr + E1000_EITR(0);
748 q_vector->itr_val = IGB_START_ITR;
Alexander Duyck047e0032009-10-27 15:49:27 +0000749 netif_napi_add(adapter->netdev, &q_vector->napi, igb_poll, 64);
750 adapter->q_vector[v_idx] = q_vector;
751 }
752 return 0;
753
754err_out:
Nick Nunleyfe0592b2010-02-17 01:05:35 +0000755 igb_free_q_vectors(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +0000756 return -ENOMEM;
757}
758
759static void igb_map_rx_ring_to_vector(struct igb_adapter *adapter,
760 int ring_idx, int v_idx)
761{
Alexander Duyck3025a442010-02-17 01:02:39 +0000762 struct igb_q_vector *q_vector = adapter->q_vector[v_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000763
Alexander Duyck3025a442010-02-17 01:02:39 +0000764 q_vector->rx_ring = adapter->rx_ring[ring_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000765 q_vector->rx_ring->q_vector = q_vector;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000766 q_vector->itr_val = adapter->rx_itr_setting;
767 if (q_vector->itr_val && q_vector->itr_val <= 3)
768 q_vector->itr_val = IGB_START_ITR;
Alexander Duyck047e0032009-10-27 15:49:27 +0000769}
770
771static void igb_map_tx_ring_to_vector(struct igb_adapter *adapter,
772 int ring_idx, int v_idx)
773{
Alexander Duyck3025a442010-02-17 01:02:39 +0000774 struct igb_q_vector *q_vector = adapter->q_vector[v_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000775
Alexander Duyck3025a442010-02-17 01:02:39 +0000776 q_vector->tx_ring = adapter->tx_ring[ring_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000777 q_vector->tx_ring->q_vector = q_vector;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000778 q_vector->itr_val = adapter->tx_itr_setting;
779 if (q_vector->itr_val && q_vector->itr_val <= 3)
780 q_vector->itr_val = IGB_START_ITR;
Alexander Duyck047e0032009-10-27 15:49:27 +0000781}
782
783/**
784 * igb_map_ring_to_vector - maps allocated queues to vectors
785 *
786 * This function maps the recently allocated queues to vectors.
787 **/
788static int igb_map_ring_to_vector(struct igb_adapter *adapter)
789{
790 int i;
791 int v_idx = 0;
792
793 if ((adapter->num_q_vectors < adapter->num_rx_queues) ||
794 (adapter->num_q_vectors < adapter->num_tx_queues))
795 return -ENOMEM;
796
797 if (adapter->num_q_vectors >=
798 (adapter->num_rx_queues + adapter->num_tx_queues)) {
799 for (i = 0; i < adapter->num_rx_queues; i++)
800 igb_map_rx_ring_to_vector(adapter, i, v_idx++);
801 for (i = 0; i < adapter->num_tx_queues; i++)
802 igb_map_tx_ring_to_vector(adapter, i, v_idx++);
803 } else {
804 for (i = 0; i < adapter->num_rx_queues; i++) {
805 if (i < adapter->num_tx_queues)
806 igb_map_tx_ring_to_vector(adapter, i, v_idx);
807 igb_map_rx_ring_to_vector(adapter, i, v_idx++);
808 }
809 for (; i < adapter->num_tx_queues; i++)
810 igb_map_tx_ring_to_vector(adapter, i, v_idx++);
811 }
812 return 0;
813}
814
815/**
816 * igb_init_interrupt_scheme - initialize interrupts, allocate queues/vectors
817 *
818 * This function initializes the interrupts and allocates all of the queues.
819 **/
820static int igb_init_interrupt_scheme(struct igb_adapter *adapter)
821{
822 struct pci_dev *pdev = adapter->pdev;
823 int err;
824
825 igb_set_interrupt_capability(adapter);
826
827 err = igb_alloc_q_vectors(adapter);
828 if (err) {
829 dev_err(&pdev->dev, "Unable to allocate memory for vectors\n");
830 goto err_alloc_q_vectors;
831 }
832
833 err = igb_alloc_queues(adapter);
834 if (err) {
835 dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
836 goto err_alloc_queues;
837 }
838
839 err = igb_map_ring_to_vector(adapter);
840 if (err) {
841 dev_err(&pdev->dev, "Invalid q_vector to ring mapping\n");
842 goto err_map_queues;
843 }
844
845
846 return 0;
847err_map_queues:
848 igb_free_queues(adapter);
849err_alloc_queues:
850 igb_free_q_vectors(adapter);
851err_alloc_q_vectors:
852 igb_reset_interrupt_capability(adapter);
853 return err;
854}
855
856/**
Auke Kok9d5c8242008-01-24 02:22:38 -0800857 * igb_request_irq - initialize interrupts
858 *
859 * Attempts to configure interrupts using the best available
860 * capabilities of the hardware and kernel.
861 **/
862static int igb_request_irq(struct igb_adapter *adapter)
863{
864 struct net_device *netdev = adapter->netdev;
Alexander Duyck047e0032009-10-27 15:49:27 +0000865 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -0800866 int err = 0;
867
868 if (adapter->msix_entries) {
869 err = igb_request_msix(adapter);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700870 if (!err)
Auke Kok9d5c8242008-01-24 02:22:38 -0800871 goto request_done;
Auke Kok9d5c8242008-01-24 02:22:38 -0800872 /* fall back to MSI */
Alexander Duyck047e0032009-10-27 15:49:27 +0000873 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800874 if (!pci_enable_msi(adapter->pdev))
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700875 adapter->flags |= IGB_FLAG_HAS_MSI;
Auke Kok9d5c8242008-01-24 02:22:38 -0800876 igb_free_all_tx_resources(adapter);
877 igb_free_all_rx_resources(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +0000878 adapter->num_tx_queues = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -0800879 adapter->num_rx_queues = 1;
Alexander Duyck047e0032009-10-27 15:49:27 +0000880 adapter->num_q_vectors = 1;
881 err = igb_alloc_q_vectors(adapter);
882 if (err) {
883 dev_err(&pdev->dev,
884 "Unable to allocate memory for vectors\n");
885 goto request_done;
886 }
887 err = igb_alloc_queues(adapter);
888 if (err) {
889 dev_err(&pdev->dev,
890 "Unable to allocate memory for queues\n");
891 igb_free_q_vectors(adapter);
892 goto request_done;
893 }
894 igb_setup_all_tx_resources(adapter);
895 igb_setup_all_rx_resources(adapter);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700896 } else {
Alexander Duyckfeeb2722010-02-03 21:59:51 +0000897 igb_assign_vector(adapter->q_vector[0], 0);
Auke Kok9d5c8242008-01-24 02:22:38 -0800898 }
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700899
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700900 if (adapter->flags & IGB_FLAG_HAS_MSI) {
Joe Perchesa0607fd2009-11-18 23:29:17 -0800901 err = request_irq(adapter->pdev->irq, igb_intr_msi, 0,
Alexander Duyck047e0032009-10-27 15:49:27 +0000902 netdev->name, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800903 if (!err)
904 goto request_done;
Alexander Duyck047e0032009-10-27 15:49:27 +0000905
Auke Kok9d5c8242008-01-24 02:22:38 -0800906 /* fall back to legacy interrupts */
907 igb_reset_interrupt_capability(adapter);
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700908 adapter->flags &= ~IGB_FLAG_HAS_MSI;
Auke Kok9d5c8242008-01-24 02:22:38 -0800909 }
910
Joe Perchesa0607fd2009-11-18 23:29:17 -0800911 err = request_irq(adapter->pdev->irq, igb_intr, IRQF_SHARED,
Alexander Duyck047e0032009-10-27 15:49:27 +0000912 netdev->name, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800913
Andy Gospodarek6cb5e572008-02-15 14:05:25 -0800914 if (err)
Auke Kok9d5c8242008-01-24 02:22:38 -0800915 dev_err(&adapter->pdev->dev, "Error %d getting interrupt\n",
916 err);
Auke Kok9d5c8242008-01-24 02:22:38 -0800917
918request_done:
919 return err;
920}
921
922static void igb_free_irq(struct igb_adapter *adapter)
923{
Auke Kok9d5c8242008-01-24 02:22:38 -0800924 if (adapter->msix_entries) {
925 int vector = 0, i;
926
Alexander Duyck047e0032009-10-27 15:49:27 +0000927 free_irq(adapter->msix_entries[vector++].vector, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800928
Alexander Duyck047e0032009-10-27 15:49:27 +0000929 for (i = 0; i < adapter->num_q_vectors; i++) {
930 struct igb_q_vector *q_vector = adapter->q_vector[i];
931 free_irq(adapter->msix_entries[vector++].vector,
932 q_vector);
933 }
934 } else {
935 free_irq(adapter->pdev->irq, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800936 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800937}
938
939/**
940 * igb_irq_disable - Mask off interrupt generation on the NIC
941 * @adapter: board private structure
942 **/
943static void igb_irq_disable(struct igb_adapter *adapter)
944{
945 struct e1000_hw *hw = &adapter->hw;
946
Alexander Duyck25568a52009-10-27 23:49:59 +0000947 /*
948 * we need to be careful when disabling interrupts. The VFs are also
949 * mapped into these registers and so clearing the bits can cause
950 * issues on the VF drivers so we only need to clear what we set
951 */
Auke Kok9d5c8242008-01-24 02:22:38 -0800952 if (adapter->msix_entries) {
Alexander Duyck2dfd1212009-09-03 14:49:15 +0000953 u32 regval = rd32(E1000_EIAM);
954 wr32(E1000_EIAM, regval & ~adapter->eims_enable_mask);
955 wr32(E1000_EIMC, adapter->eims_enable_mask);
956 regval = rd32(E1000_EIAC);
957 wr32(E1000_EIAC, regval & ~adapter->eims_enable_mask);
Auke Kok9d5c8242008-01-24 02:22:38 -0800958 }
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700959
960 wr32(E1000_IAM, 0);
Auke Kok9d5c8242008-01-24 02:22:38 -0800961 wr32(E1000_IMC, ~0);
962 wrfl();
963 synchronize_irq(adapter->pdev->irq);
964}
965
966/**
967 * igb_irq_enable - Enable default interrupt generation settings
968 * @adapter: board private structure
969 **/
970static void igb_irq_enable(struct igb_adapter *adapter)
971{
972 struct e1000_hw *hw = &adapter->hw;
973
974 if (adapter->msix_entries) {
Alexander Duyck25568a52009-10-27 23:49:59 +0000975 u32 ims = E1000_IMS_LSC | E1000_IMS_DOUTSYNC;
Alexander Duyck2dfd1212009-09-03 14:49:15 +0000976 u32 regval = rd32(E1000_EIAC);
977 wr32(E1000_EIAC, regval | adapter->eims_enable_mask);
978 regval = rd32(E1000_EIAM);
979 wr32(E1000_EIAM, regval | adapter->eims_enable_mask);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700980 wr32(E1000_EIMS, adapter->eims_enable_mask);
Alexander Duyck25568a52009-10-27 23:49:59 +0000981 if (adapter->vfs_allocated_count) {
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800982 wr32(E1000_MBVFIMR, 0xFF);
Alexander Duyck25568a52009-10-27 23:49:59 +0000983 ims |= E1000_IMS_VMMB;
984 }
Alexander Duyck55cac242009-11-19 12:42:21 +0000985 if (adapter->hw.mac.type == e1000_82580)
986 ims |= E1000_IMS_DRSTA;
987
Alexander Duyck25568a52009-10-27 23:49:59 +0000988 wr32(E1000_IMS, ims);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700989 } else {
Alexander Duyck55cac242009-11-19 12:42:21 +0000990 wr32(E1000_IMS, IMS_ENABLE_MASK |
991 E1000_IMS_DRSTA);
992 wr32(E1000_IAM, IMS_ENABLE_MASK |
993 E1000_IMS_DRSTA);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700994 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800995}
996
997static void igb_update_mng_vlan(struct igb_adapter *adapter)
998{
Alexander Duyck51466232009-10-27 23:47:35 +0000999 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08001000 u16 vid = adapter->hw.mng_cookie.vlan_id;
1001 u16 old_vid = adapter->mng_vlan_id;
Auke Kok9d5c8242008-01-24 02:22:38 -08001002
Alexander Duyck51466232009-10-27 23:47:35 +00001003 if (hw->mng_cookie.status & E1000_MNG_DHCP_COOKIE_STATUS_VLAN) {
1004 /* add VID to filter table */
1005 igb_vfta_set(hw, vid, true);
1006 adapter->mng_vlan_id = vid;
1007 } else {
1008 adapter->mng_vlan_id = IGB_MNG_VLAN_NONE;
1009 }
1010
1011 if ((old_vid != (u16)IGB_MNG_VLAN_NONE) &&
1012 (vid != old_vid) &&
1013 !vlan_group_get_device(adapter->vlgrp, old_vid)) {
1014 /* remove VID from filter table */
1015 igb_vfta_set(hw, old_vid, false);
Auke Kok9d5c8242008-01-24 02:22:38 -08001016 }
1017}
1018
1019/**
1020 * igb_release_hw_control - release control of the h/w to f/w
1021 * @adapter: address of board private structure
1022 *
1023 * igb_release_hw_control resets CTRL_EXT:DRV_LOAD bit.
1024 * For ASF and Pass Through versions of f/w this means that the
1025 * driver is no longer loaded.
1026 *
1027 **/
1028static void igb_release_hw_control(struct igb_adapter *adapter)
1029{
1030 struct e1000_hw *hw = &adapter->hw;
1031 u32 ctrl_ext;
1032
1033 /* Let firmware take over control of h/w */
1034 ctrl_ext = rd32(E1000_CTRL_EXT);
1035 wr32(E1000_CTRL_EXT,
1036 ctrl_ext & ~E1000_CTRL_EXT_DRV_LOAD);
1037}
1038
Auke Kok9d5c8242008-01-24 02:22:38 -08001039/**
1040 * igb_get_hw_control - get control of the h/w from f/w
1041 * @adapter: address of board private structure
1042 *
1043 * igb_get_hw_control sets CTRL_EXT:DRV_LOAD bit.
1044 * For ASF and Pass Through versions of f/w this means that
1045 * the driver is loaded.
1046 *
1047 **/
1048static void igb_get_hw_control(struct igb_adapter *adapter)
1049{
1050 struct e1000_hw *hw = &adapter->hw;
1051 u32 ctrl_ext;
1052
1053 /* Let firmware know the driver has taken over */
1054 ctrl_ext = rd32(E1000_CTRL_EXT);
1055 wr32(E1000_CTRL_EXT,
1056 ctrl_ext | E1000_CTRL_EXT_DRV_LOAD);
1057}
1058
Auke Kok9d5c8242008-01-24 02:22:38 -08001059/**
1060 * igb_configure - configure the hardware for RX and TX
1061 * @adapter: private board structure
1062 **/
1063static void igb_configure(struct igb_adapter *adapter)
1064{
1065 struct net_device *netdev = adapter->netdev;
1066 int i;
1067
1068 igb_get_hw_control(adapter);
Alexander Duyckff41f8d2009-09-03 14:48:56 +00001069 igb_set_rx_mode(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001070
1071 igb_restore_vlan(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001072
Alexander Duyck85b430b2009-10-27 15:50:29 +00001073 igb_setup_tctl(adapter);
Alexander Duyck06cf2662009-10-27 15:53:25 +00001074 igb_setup_mrqc(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001075 igb_setup_rctl(adapter);
Alexander Duyck85b430b2009-10-27 15:50:29 +00001076
1077 igb_configure_tx(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001078 igb_configure_rx(adapter);
Alexander Duyck662d7202008-06-27 11:00:29 -07001079
1080 igb_rx_fifo_flush_82575(&adapter->hw);
1081
Alexander Duyckc493ea42009-03-20 00:16:50 +00001082 /* call igb_desc_unused which always leaves
Auke Kok9d5c8242008-01-24 02:22:38 -08001083 * at least 1 descriptor unused to make sure
1084 * next_to_use != next_to_clean */
1085 for (i = 0; i < adapter->num_rx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00001086 struct igb_ring *ring = adapter->rx_ring[i];
Alexander Duyckc493ea42009-03-20 00:16:50 +00001087 igb_alloc_rx_buffers_adv(ring, igb_desc_unused(ring));
Auke Kok9d5c8242008-01-24 02:22:38 -08001088 }
1089
1090
1091 adapter->tx_queue_len = netdev->tx_queue_len;
1092}
1093
Nick Nunley88a268c2010-02-17 01:01:59 +00001094/**
1095 * igb_power_up_link - Power up the phy/serdes link
1096 * @adapter: address of board private structure
1097 **/
1098void igb_power_up_link(struct igb_adapter *adapter)
1099{
1100 if (adapter->hw.phy.media_type == e1000_media_type_copper)
1101 igb_power_up_phy_copper(&adapter->hw);
1102 else
1103 igb_power_up_serdes_link_82575(&adapter->hw);
1104}
1105
1106/**
1107 * igb_power_down_link - Power down the phy/serdes link
1108 * @adapter: address of board private structure
1109 */
1110static void igb_power_down_link(struct igb_adapter *adapter)
1111{
1112 if (adapter->hw.phy.media_type == e1000_media_type_copper)
1113 igb_power_down_phy_copper_82575(&adapter->hw);
1114 else
1115 igb_shutdown_serdes_link_82575(&adapter->hw);
1116}
Auke Kok9d5c8242008-01-24 02:22:38 -08001117
1118/**
1119 * igb_up - Open the interface and prepare it to handle traffic
1120 * @adapter: board private structure
1121 **/
Auke Kok9d5c8242008-01-24 02:22:38 -08001122int igb_up(struct igb_adapter *adapter)
1123{
1124 struct e1000_hw *hw = &adapter->hw;
1125 int i;
1126
1127 /* hardware has been reset, we need to reload some things */
1128 igb_configure(adapter);
1129
1130 clear_bit(__IGB_DOWN, &adapter->state);
1131
Alexander Duyck047e0032009-10-27 15:49:27 +00001132 for (i = 0; i < adapter->num_q_vectors; i++) {
1133 struct igb_q_vector *q_vector = adapter->q_vector[i];
1134 napi_enable(&q_vector->napi);
1135 }
PJ Waskiewicz844290e2008-06-27 11:00:39 -07001136 if (adapter->msix_entries)
Auke Kok9d5c8242008-01-24 02:22:38 -08001137 igb_configure_msix(adapter);
Alexander Duyckfeeb2722010-02-03 21:59:51 +00001138 else
1139 igb_assign_vector(adapter->q_vector[0], 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08001140
1141 /* Clear any pending interrupts. */
1142 rd32(E1000_ICR);
1143 igb_irq_enable(adapter);
1144
Alexander Duyckd4960302009-10-27 15:53:45 +00001145 /* notify VFs that reset has been completed */
1146 if (adapter->vfs_allocated_count) {
1147 u32 reg_data = rd32(E1000_CTRL_EXT);
1148 reg_data |= E1000_CTRL_EXT_PFRSTD;
1149 wr32(E1000_CTRL_EXT, reg_data);
1150 }
1151
Jesse Brandeburg4cb9be72009-04-21 18:42:05 +00001152 netif_tx_start_all_queues(adapter->netdev);
1153
Alexander Duyck25568a52009-10-27 23:49:59 +00001154 /* start the watchdog. */
1155 hw->mac.get_link_status = 1;
1156 schedule_work(&adapter->watchdog_task);
1157
Auke Kok9d5c8242008-01-24 02:22:38 -08001158 return 0;
1159}
1160
1161void igb_down(struct igb_adapter *adapter)
1162{
Auke Kok9d5c8242008-01-24 02:22:38 -08001163 struct net_device *netdev = adapter->netdev;
Alexander Duyck330a6d62009-10-27 23:51:35 +00001164 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08001165 u32 tctl, rctl;
1166 int i;
1167
1168 /* signal that we're down so the interrupt handler does not
1169 * reschedule our watchdog timer */
1170 set_bit(__IGB_DOWN, &adapter->state);
1171
1172 /* disable receives in the hardware */
1173 rctl = rd32(E1000_RCTL);
1174 wr32(E1000_RCTL, rctl & ~E1000_RCTL_EN);
1175 /* flush and sleep below */
1176
David S. Millerfd2ea0a2008-07-17 01:56:23 -07001177 netif_tx_stop_all_queues(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001178
1179 /* disable transmits in the hardware */
1180 tctl = rd32(E1000_TCTL);
1181 tctl &= ~E1000_TCTL_EN;
1182 wr32(E1000_TCTL, tctl);
1183 /* flush both disables and wait for them to finish */
1184 wrfl();
1185 msleep(10);
1186
Alexander Duyck047e0032009-10-27 15:49:27 +00001187 for (i = 0; i < adapter->num_q_vectors; i++) {
1188 struct igb_q_vector *q_vector = adapter->q_vector[i];
1189 napi_disable(&q_vector->napi);
1190 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001191
Auke Kok9d5c8242008-01-24 02:22:38 -08001192 igb_irq_disable(adapter);
1193
1194 del_timer_sync(&adapter->watchdog_timer);
1195 del_timer_sync(&adapter->phy_info_timer);
1196
1197 netdev->tx_queue_len = adapter->tx_queue_len;
1198 netif_carrier_off(netdev);
Alexander Duyck04fe6352009-02-06 23:22:32 +00001199
1200 /* record the stats before reset*/
1201 igb_update_stats(adapter);
1202
Auke Kok9d5c8242008-01-24 02:22:38 -08001203 adapter->link_speed = 0;
1204 adapter->link_duplex = 0;
1205
Jeff Kirsher30236822008-06-24 17:01:15 -07001206 if (!pci_channel_offline(adapter->pdev))
1207 igb_reset(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001208 igb_clean_all_tx_rings(adapter);
1209 igb_clean_all_rx_rings(adapter);
Alexander Duyck7e0e99e2009-05-21 13:06:56 +00001210#ifdef CONFIG_IGB_DCA
1211
1212 /* since we reset the hardware DCA settings were cleared */
1213 igb_setup_dca(adapter);
1214#endif
Auke Kok9d5c8242008-01-24 02:22:38 -08001215}
1216
1217void igb_reinit_locked(struct igb_adapter *adapter)
1218{
1219 WARN_ON(in_interrupt());
1220 while (test_and_set_bit(__IGB_RESETTING, &adapter->state))
1221 msleep(1);
1222 igb_down(adapter);
1223 igb_up(adapter);
1224 clear_bit(__IGB_RESETTING, &adapter->state);
1225}
1226
1227void igb_reset(struct igb_adapter *adapter)
1228{
Alexander Duyck090b1792009-10-27 23:51:55 +00001229 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08001230 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck2d064c02008-07-08 15:10:12 -07001231 struct e1000_mac_info *mac = &hw->mac;
1232 struct e1000_fc_info *fc = &hw->fc;
Auke Kok9d5c8242008-01-24 02:22:38 -08001233 u32 pba = 0, tx_space, min_tx_space, min_rx_space;
1234 u16 hwm;
1235
1236 /* Repartition Pba for greater than 9k mtu
1237 * To take effect CTRL.RST is required.
1238 */
Alexander Duyckfa4dfae2009-02-06 23:21:31 +00001239 switch (mac->type) {
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +00001240 case e1000_i350:
Alexander Duyck55cac242009-11-19 12:42:21 +00001241 case e1000_82580:
1242 pba = rd32(E1000_RXPBS);
1243 pba = igb_rxpbs_adjust_82580(pba);
1244 break;
Alexander Duyckfa4dfae2009-02-06 23:21:31 +00001245 case e1000_82576:
Alexander Duyckd249be52009-10-27 23:46:38 +00001246 pba = rd32(E1000_RXPBS);
1247 pba &= E1000_RXPBS_SIZE_MASK_82576;
Alexander Duyckfa4dfae2009-02-06 23:21:31 +00001248 break;
1249 case e1000_82575:
1250 default:
1251 pba = E1000_PBA_34K;
1252 break;
Alexander Duyck2d064c02008-07-08 15:10:12 -07001253 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001254
Alexander Duyck2d064c02008-07-08 15:10:12 -07001255 if ((adapter->max_frame_size > ETH_FRAME_LEN + ETH_FCS_LEN) &&
1256 (mac->type < e1000_82576)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08001257 /* adjust PBA for jumbo frames */
1258 wr32(E1000_PBA, pba);
1259
1260 /* To maintain wire speed transmits, the Tx FIFO should be
1261 * large enough to accommodate two full transmit packets,
1262 * rounded up to the next 1KB and expressed in KB. Likewise,
1263 * the Rx FIFO should be large enough to accommodate at least
1264 * one full receive packet and is similarly rounded up and
1265 * expressed in KB. */
1266 pba = rd32(E1000_PBA);
1267 /* upper 16 bits has Tx packet buffer allocation size in KB */
1268 tx_space = pba >> 16;
1269 /* lower 16 bits has Rx packet buffer allocation size in KB */
1270 pba &= 0xffff;
1271 /* the tx fifo also stores 16 bytes of information about the tx
1272 * but don't include ethernet FCS because hardware appends it */
1273 min_tx_space = (adapter->max_frame_size +
Alexander Duyck85e8d002009-02-16 00:00:20 -08001274 sizeof(union e1000_adv_tx_desc) -
Auke Kok9d5c8242008-01-24 02:22:38 -08001275 ETH_FCS_LEN) * 2;
1276 min_tx_space = ALIGN(min_tx_space, 1024);
1277 min_tx_space >>= 10;
1278 /* software strips receive CRC, so leave room for it */
1279 min_rx_space = adapter->max_frame_size;
1280 min_rx_space = ALIGN(min_rx_space, 1024);
1281 min_rx_space >>= 10;
1282
1283 /* If current Tx allocation is less than the min Tx FIFO size,
1284 * and the min Tx FIFO size is less than the current Rx FIFO
1285 * allocation, take space away from current Rx allocation */
1286 if (tx_space < min_tx_space &&
1287 ((min_tx_space - tx_space) < pba)) {
1288 pba = pba - (min_tx_space - tx_space);
1289
1290 /* if short on rx space, rx wins and must trump tx
1291 * adjustment */
1292 if (pba < min_rx_space)
1293 pba = min_rx_space;
1294 }
Alexander Duyck2d064c02008-07-08 15:10:12 -07001295 wr32(E1000_PBA, pba);
Auke Kok9d5c8242008-01-24 02:22:38 -08001296 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001297
1298 /* flow control settings */
1299 /* The high water mark must be low enough to fit one full frame
1300 * (or the size used for early receive) above it in the Rx FIFO.
1301 * Set it to the lower of:
1302 * - 90% of the Rx FIFO size, or
1303 * - the full Rx FIFO size minus one full frame */
1304 hwm = min(((pba << 10) * 9 / 10),
Alexander Duyck2d064c02008-07-08 15:10:12 -07001305 ((pba << 10) - 2 * adapter->max_frame_size));
Auke Kok9d5c8242008-01-24 02:22:38 -08001306
Alexander Duyckd405ea32009-12-23 13:21:27 +00001307 fc->high_water = hwm & 0xFFF0; /* 16-byte granularity */
1308 fc->low_water = fc->high_water - 16;
Auke Kok9d5c8242008-01-24 02:22:38 -08001309 fc->pause_time = 0xFFFF;
1310 fc->send_xon = 1;
Alexander Duyck0cce1192009-07-23 18:10:24 +00001311 fc->current_mode = fc->requested_mode;
Auke Kok9d5c8242008-01-24 02:22:38 -08001312
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001313 /* disable receive for all VFs and wait one second */
1314 if (adapter->vfs_allocated_count) {
1315 int i;
1316 for (i = 0 ; i < adapter->vfs_allocated_count; i++)
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00001317 adapter->vf_data[i].flags = 0;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001318
1319 /* ping all the active vfs to let them know we are going down */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00001320 igb_ping_all_vfs(adapter);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001321
1322 /* disable transmits and receives */
1323 wr32(E1000_VFRE, 0);
1324 wr32(E1000_VFTE, 0);
1325 }
1326
Auke Kok9d5c8242008-01-24 02:22:38 -08001327 /* Allow time for pending master requests to run */
Alexander Duyck330a6d62009-10-27 23:51:35 +00001328 hw->mac.ops.reset_hw(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001329 wr32(E1000_WUC, 0);
1330
Alexander Duyck330a6d62009-10-27 23:51:35 +00001331 if (hw->mac.ops.init_hw(hw))
Alexander Duyck090b1792009-10-27 23:51:55 +00001332 dev_err(&pdev->dev, "Hardware Error\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08001333
Alexander Duyck55cac242009-11-19 12:42:21 +00001334 if (hw->mac.type == e1000_82580) {
1335 u32 reg = rd32(E1000_PCIEMISC);
1336 wr32(E1000_PCIEMISC,
1337 reg & ~E1000_PCIEMISC_LX_DECISION);
1338 }
Nick Nunley88a268c2010-02-17 01:01:59 +00001339 if (!netif_running(adapter->netdev))
1340 igb_power_down_link(adapter);
1341
Auke Kok9d5c8242008-01-24 02:22:38 -08001342 igb_update_mng_vlan(adapter);
1343
1344 /* Enable h/w to recognize an 802.1Q VLAN Ethernet packet */
1345 wr32(E1000_VET, ETHERNET_IEEE_VLAN_TYPE);
1346
Alexander Duyck330a6d62009-10-27 23:51:35 +00001347 igb_get_phy_info(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001348}
1349
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001350static const struct net_device_ops igb_netdev_ops = {
Alexander Duyck559e9c42009-10-27 23:52:50 +00001351 .ndo_open = igb_open,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001352 .ndo_stop = igb_close,
Stephen Hemminger00829822008-11-20 20:14:53 -08001353 .ndo_start_xmit = igb_xmit_frame_adv,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001354 .ndo_get_stats = igb_get_stats,
Alexander Duyckff41f8d2009-09-03 14:48:56 +00001355 .ndo_set_rx_mode = igb_set_rx_mode,
1356 .ndo_set_multicast_list = igb_set_rx_mode,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001357 .ndo_set_mac_address = igb_set_mac,
1358 .ndo_change_mtu = igb_change_mtu,
1359 .ndo_do_ioctl = igb_ioctl,
1360 .ndo_tx_timeout = igb_tx_timeout,
1361 .ndo_validate_addr = eth_validate_addr,
1362 .ndo_vlan_rx_register = igb_vlan_rx_register,
1363 .ndo_vlan_rx_add_vid = igb_vlan_rx_add_vid,
1364 .ndo_vlan_rx_kill_vid = igb_vlan_rx_kill_vid,
Williams, Mitch A8151d292010-02-10 01:44:24 +00001365 .ndo_set_vf_mac = igb_ndo_set_vf_mac,
1366 .ndo_set_vf_vlan = igb_ndo_set_vf_vlan,
1367 .ndo_set_vf_tx_rate = igb_ndo_set_vf_bw,
1368 .ndo_get_vf_config = igb_ndo_get_vf_config,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001369#ifdef CONFIG_NET_POLL_CONTROLLER
1370 .ndo_poll_controller = igb_netpoll,
1371#endif
1372};
1373
Taku Izumi42bfd33a2008-06-20 12:10:30 +09001374/**
Auke Kok9d5c8242008-01-24 02:22:38 -08001375 * igb_probe - Device Initialization Routine
1376 * @pdev: PCI device information struct
1377 * @ent: entry in igb_pci_tbl
1378 *
1379 * Returns 0 on success, negative on failure
1380 *
1381 * igb_probe initializes an adapter identified by a pci_dev structure.
1382 * The OS initialization, configuring of the adapter private structure,
1383 * and a hardware reset occur.
1384 **/
1385static int __devinit igb_probe(struct pci_dev *pdev,
1386 const struct pci_device_id *ent)
1387{
1388 struct net_device *netdev;
1389 struct igb_adapter *adapter;
1390 struct e1000_hw *hw;
Alexander Duyck4337e992009-10-27 23:48:31 +00001391 u16 eeprom_data = 0;
1392 static int global_quad_port_a; /* global quad port a indication */
Auke Kok9d5c8242008-01-24 02:22:38 -08001393 const struct e1000_info *ei = igb_info_tbl[ent->driver_data];
1394 unsigned long mmio_start, mmio_len;
David S. Miller2d6a5e92009-03-17 15:01:30 -07001395 int err, pci_using_dac;
Auke Kok9d5c8242008-01-24 02:22:38 -08001396 u16 eeprom_apme_mask = IGB_EEPROM_APME;
1397 u32 part_num;
1398
Alexander Duyckaed5dec2009-02-06 23:16:04 +00001399 err = pci_enable_device_mem(pdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001400 if (err)
1401 return err;
1402
1403 pci_using_dac = 0;
Yang Hongyang6a355282009-04-06 19:01:13 -07001404 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
Auke Kok9d5c8242008-01-24 02:22:38 -08001405 if (!err) {
Yang Hongyang6a355282009-04-06 19:01:13 -07001406 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64));
Auke Kok9d5c8242008-01-24 02:22:38 -08001407 if (!err)
1408 pci_using_dac = 1;
1409 } else {
Yang Hongyang284901a2009-04-06 19:01:15 -07001410 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
Auke Kok9d5c8242008-01-24 02:22:38 -08001411 if (err) {
Yang Hongyang284901a2009-04-06 19:01:15 -07001412 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
Auke Kok9d5c8242008-01-24 02:22:38 -08001413 if (err) {
1414 dev_err(&pdev->dev, "No usable DMA "
1415 "configuration, aborting\n");
1416 goto err_dma;
1417 }
1418 }
1419 }
1420
Alexander Duyckaed5dec2009-02-06 23:16:04 +00001421 err = pci_request_selected_regions(pdev, pci_select_bars(pdev,
1422 IORESOURCE_MEM),
1423 igb_driver_name);
Auke Kok9d5c8242008-01-24 02:22:38 -08001424 if (err)
1425 goto err_pci_reg;
1426
Frans Pop19d5afd2009-10-02 10:04:12 -07001427 pci_enable_pcie_error_reporting(pdev);
Alexander Duyck40a914f2008-11-27 00:24:37 -08001428
Auke Kok9d5c8242008-01-24 02:22:38 -08001429 pci_set_master(pdev);
Auke Kokc682fc22008-04-23 11:09:34 -07001430 pci_save_state(pdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001431
1432 err = -ENOMEM;
Alexander Duyck1bfaf072009-02-19 20:39:23 -08001433 netdev = alloc_etherdev_mq(sizeof(struct igb_adapter),
1434 IGB_ABS_MAX_TX_QUEUES);
Auke Kok9d5c8242008-01-24 02:22:38 -08001435 if (!netdev)
1436 goto err_alloc_etherdev;
1437
1438 SET_NETDEV_DEV(netdev, &pdev->dev);
1439
1440 pci_set_drvdata(pdev, netdev);
1441 adapter = netdev_priv(netdev);
1442 adapter->netdev = netdev;
1443 adapter->pdev = pdev;
1444 hw = &adapter->hw;
1445 hw->back = adapter;
1446 adapter->msg_enable = NETIF_MSG_DRV | NETIF_MSG_PROBE;
1447
1448 mmio_start = pci_resource_start(pdev, 0);
1449 mmio_len = pci_resource_len(pdev, 0);
1450
1451 err = -EIO;
Alexander Duyck28b07592009-02-06 23:20:31 +00001452 hw->hw_addr = ioremap(mmio_start, mmio_len);
1453 if (!hw->hw_addr)
Auke Kok9d5c8242008-01-24 02:22:38 -08001454 goto err_ioremap;
1455
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001456 netdev->netdev_ops = &igb_netdev_ops;
Auke Kok9d5c8242008-01-24 02:22:38 -08001457 igb_set_ethtool_ops(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001458 netdev->watchdog_timeo = 5 * HZ;
Auke Kok9d5c8242008-01-24 02:22:38 -08001459
1460 strncpy(netdev->name, pci_name(pdev), sizeof(netdev->name) - 1);
1461
1462 netdev->mem_start = mmio_start;
1463 netdev->mem_end = mmio_start + mmio_len;
1464
Auke Kok9d5c8242008-01-24 02:22:38 -08001465 /* PCI config space info */
1466 hw->vendor_id = pdev->vendor;
1467 hw->device_id = pdev->device;
1468 hw->revision_id = pdev->revision;
1469 hw->subsystem_vendor_id = pdev->subsystem_vendor;
1470 hw->subsystem_device_id = pdev->subsystem_device;
1471
Auke Kok9d5c8242008-01-24 02:22:38 -08001472 /* Copy the default MAC, PHY and NVM function pointers */
1473 memcpy(&hw->mac.ops, ei->mac_ops, sizeof(hw->mac.ops));
1474 memcpy(&hw->phy.ops, ei->phy_ops, sizeof(hw->phy.ops));
1475 memcpy(&hw->nvm.ops, ei->nvm_ops, sizeof(hw->nvm.ops));
1476 /* Initialize skew-specific constants */
1477 err = ei->get_invariants(hw);
1478 if (err)
Alexander Duyck450c87c2009-02-06 23:22:11 +00001479 goto err_sw_init;
Auke Kok9d5c8242008-01-24 02:22:38 -08001480
Alexander Duyck450c87c2009-02-06 23:22:11 +00001481 /* setup the private structure */
Auke Kok9d5c8242008-01-24 02:22:38 -08001482 err = igb_sw_init(adapter);
1483 if (err)
1484 goto err_sw_init;
1485
1486 igb_get_bus_info_pcie(hw);
1487
1488 hw->phy.autoneg_wait_to_complete = false;
Auke Kok9d5c8242008-01-24 02:22:38 -08001489
1490 /* Copper options */
1491 if (hw->phy.media_type == e1000_media_type_copper) {
1492 hw->phy.mdix = AUTO_ALL_MODES;
1493 hw->phy.disable_polarity_correction = false;
1494 hw->phy.ms_type = e1000_ms_hw_default;
1495 }
1496
1497 if (igb_check_reset_block(hw))
1498 dev_info(&pdev->dev,
1499 "PHY reset is blocked due to SOL/IDER session.\n");
1500
1501 netdev->features = NETIF_F_SG |
Alexander Duyck7d8eb292009-02-06 23:18:27 +00001502 NETIF_F_IP_CSUM |
Auke Kok9d5c8242008-01-24 02:22:38 -08001503 NETIF_F_HW_VLAN_TX |
1504 NETIF_F_HW_VLAN_RX |
1505 NETIF_F_HW_VLAN_FILTER;
1506
Alexander Duyck7d8eb292009-02-06 23:18:27 +00001507 netdev->features |= NETIF_F_IPV6_CSUM;
Auke Kok9d5c8242008-01-24 02:22:38 -08001508 netdev->features |= NETIF_F_TSO;
Auke Kok9d5c8242008-01-24 02:22:38 -08001509 netdev->features |= NETIF_F_TSO6;
Herbert Xu5c0999b2009-01-19 15:20:57 -08001510 netdev->features |= NETIF_F_GRO;
Alexander Duyckd3352522008-07-08 15:12:13 -07001511
Jeff Kirsher48f29ff2008-06-05 04:06:27 -07001512 netdev->vlan_features |= NETIF_F_TSO;
1513 netdev->vlan_features |= NETIF_F_TSO6;
Alexander Duyck7d8eb292009-02-06 23:18:27 +00001514 netdev->vlan_features |= NETIF_F_IP_CSUM;
Alexander Duyckcd1da502009-08-25 04:47:50 +00001515 netdev->vlan_features |= NETIF_F_IPV6_CSUM;
Jeff Kirsher48f29ff2008-06-05 04:06:27 -07001516 netdev->vlan_features |= NETIF_F_SG;
1517
Auke Kok9d5c8242008-01-24 02:22:38 -08001518 if (pci_using_dac)
1519 netdev->features |= NETIF_F_HIGHDMA;
1520
Alexander Duyck5b043fb2009-10-27 23:52:31 +00001521 if (hw->mac.type >= e1000_82576)
Jesse Brandeburgb9473562009-04-27 22:36:13 +00001522 netdev->features |= NETIF_F_SCTP_CSUM;
1523
Alexander Duyck330a6d62009-10-27 23:51:35 +00001524 adapter->en_mng_pt = igb_enable_mng_pass_thru(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001525
1526 /* before reading the NVM, reset the controller to put the device in a
1527 * known good starting state */
1528 hw->mac.ops.reset_hw(hw);
1529
1530 /* make sure the NVM is good */
1531 if (igb_validate_nvm_checksum(hw) < 0) {
1532 dev_err(&pdev->dev, "The NVM Checksum Is Not Valid\n");
1533 err = -EIO;
1534 goto err_eeprom;
1535 }
1536
1537 /* copy the MAC address out of the NVM */
1538 if (hw->mac.ops.read_mac_addr(hw))
1539 dev_err(&pdev->dev, "NVM Read Error\n");
1540
1541 memcpy(netdev->dev_addr, hw->mac.addr, netdev->addr_len);
1542 memcpy(netdev->perm_addr, hw->mac.addr, netdev->addr_len);
1543
1544 if (!is_valid_ether_addr(netdev->perm_addr)) {
1545 dev_err(&pdev->dev, "Invalid MAC Address\n");
1546 err = -EIO;
1547 goto err_eeprom;
1548 }
1549
Alexander Duyck0e340482009-03-20 00:17:08 +00001550 setup_timer(&adapter->watchdog_timer, &igb_watchdog,
1551 (unsigned long) adapter);
1552 setup_timer(&adapter->phy_info_timer, &igb_update_phy_info,
1553 (unsigned long) adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001554
1555 INIT_WORK(&adapter->reset_task, igb_reset_task);
1556 INIT_WORK(&adapter->watchdog_task, igb_watchdog_task);
1557
Alexander Duyck450c87c2009-02-06 23:22:11 +00001558 /* Initialize link properties that are user-changeable */
Auke Kok9d5c8242008-01-24 02:22:38 -08001559 adapter->fc_autoneg = true;
1560 hw->mac.autoneg = true;
1561 hw->phy.autoneg_advertised = 0x2f;
1562
Alexander Duyck0cce1192009-07-23 18:10:24 +00001563 hw->fc.requested_mode = e1000_fc_default;
1564 hw->fc.current_mode = e1000_fc_default;
Auke Kok9d5c8242008-01-24 02:22:38 -08001565
Auke Kok9d5c8242008-01-24 02:22:38 -08001566 igb_validate_mdi_setting(hw);
1567
Auke Kok9d5c8242008-01-24 02:22:38 -08001568 /* Initial Wake on LAN setting If APM wake is enabled in the EEPROM,
1569 * enable the ACPI Magic Packet filter
1570 */
1571
Alexander Duycka2cf8b62009-03-13 20:41:17 +00001572 if (hw->bus.func == 0)
Alexander Duyck312c75a2009-02-06 23:17:47 +00001573 hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_A, 1, &eeprom_data);
Alexander Duyck55cac242009-11-19 12:42:21 +00001574 else if (hw->mac.type == e1000_82580)
1575 hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_A +
1576 NVM_82580_LAN_FUNC_OFFSET(hw->bus.func), 1,
1577 &eeprom_data);
Alexander Duycka2cf8b62009-03-13 20:41:17 +00001578 else if (hw->bus.func == 1)
1579 hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_B, 1, &eeprom_data);
Auke Kok9d5c8242008-01-24 02:22:38 -08001580
1581 if (eeprom_data & eeprom_apme_mask)
1582 adapter->eeprom_wol |= E1000_WUFC_MAG;
1583
1584 /* now that we have the eeprom settings, apply the special cases where
1585 * the eeprom may be wrong or the board simply won't support wake on
1586 * lan on a particular port */
1587 switch (pdev->device) {
1588 case E1000_DEV_ID_82575GB_QUAD_COPPER:
1589 adapter->eeprom_wol = 0;
1590 break;
1591 case E1000_DEV_ID_82575EB_FIBER_SERDES:
Alexander Duyck2d064c02008-07-08 15:10:12 -07001592 case E1000_DEV_ID_82576_FIBER:
1593 case E1000_DEV_ID_82576_SERDES:
Auke Kok9d5c8242008-01-24 02:22:38 -08001594 /* Wake events only supported on port A for dual fiber
1595 * regardless of eeprom setting */
1596 if (rd32(E1000_STATUS) & E1000_STATUS_FUNC_1)
1597 adapter->eeprom_wol = 0;
1598 break;
Alexander Duyckc8ea5ea2009-03-13 20:42:35 +00001599 case E1000_DEV_ID_82576_QUAD_COPPER:
1600 /* if quad port adapter, disable WoL on all but port A */
1601 if (global_quad_port_a != 0)
1602 adapter->eeprom_wol = 0;
1603 else
1604 adapter->flags |= IGB_FLAG_QUAD_PORT_A;
1605 /* Reset for multiple quad port adapters */
1606 if (++global_quad_port_a == 4)
1607 global_quad_port_a = 0;
1608 break;
Auke Kok9d5c8242008-01-24 02:22:38 -08001609 }
1610
1611 /* initialize the wol settings based on the eeprom settings */
1612 adapter->wol = adapter->eeprom_wol;
\"Rafael J. Wysocki\e1b86d82008-11-07 20:30:37 +00001613 device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);
Auke Kok9d5c8242008-01-24 02:22:38 -08001614
1615 /* reset the hardware with the new settings */
1616 igb_reset(adapter);
1617
1618 /* let the f/w know that the h/w is now under the control of the
1619 * driver. */
1620 igb_get_hw_control(adapter);
1621
Auke Kok9d5c8242008-01-24 02:22:38 -08001622 strcpy(netdev->name, "eth%d");
1623 err = register_netdev(netdev);
1624 if (err)
1625 goto err_register;
1626
Jesse Brandeburgb168dfc2009-04-17 20:44:32 +00001627 /* carrier off reporting is important to ethtool even BEFORE open */
1628 netif_carrier_off(netdev);
1629
Jeff Kirsher421e02f2008-10-17 11:08:31 -07001630#ifdef CONFIG_IGB_DCA
Alexander Duyckbbd98fe2009-01-31 00:52:30 -08001631 if (dca_add_requester(&pdev->dev) == 0) {
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001632 adapter->flags |= IGB_FLAG_DCA_ENABLED;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001633 dev_info(&pdev->dev, "DCA enabled\n");
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001634 igb_setup_dca(adapter);
1635 }
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00001636
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001637#endif
Auke Kok9d5c8242008-01-24 02:22:38 -08001638 dev_info(&pdev->dev, "Intel(R) Gigabit Ethernet Network Connection\n");
1639 /* print bus type/speed/width info */
Johannes Berg7c510e42008-10-27 17:47:26 -07001640 dev_info(&pdev->dev, "%s: (PCIe:%s:%s) %pM\n",
Auke Kok9d5c8242008-01-24 02:22:38 -08001641 netdev->name,
Alexander Duyck559e9c42009-10-27 23:52:50 +00001642 ((hw->bus.speed == e1000_bus_speed_2500) ? "2.5Gb/s" :
1643 "unknown"),
Alexander Duyck59c3de82009-03-31 20:38:00 +00001644 ((hw->bus.width == e1000_bus_width_pcie_x4) ? "Width x4" :
1645 (hw->bus.width == e1000_bus_width_pcie_x2) ? "Width x2" :
1646 (hw->bus.width == e1000_bus_width_pcie_x1) ? "Width x1" :
1647 "unknown"),
Johannes Berg7c510e42008-10-27 17:47:26 -07001648 netdev->dev_addr);
Auke Kok9d5c8242008-01-24 02:22:38 -08001649
1650 igb_read_part_num(hw, &part_num);
1651 dev_info(&pdev->dev, "%s: PBA No: %06x-%03x\n", netdev->name,
1652 (part_num >> 8), (part_num & 0xff));
1653
1654 dev_info(&pdev->dev,
1655 "Using %s interrupts. %d rx queue(s), %d tx queue(s)\n",
1656 adapter->msix_entries ? "MSI-X" :
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001657 (adapter->flags & IGB_FLAG_HAS_MSI) ? "MSI" : "legacy",
Auke Kok9d5c8242008-01-24 02:22:38 -08001658 adapter->num_rx_queues, adapter->num_tx_queues);
1659
Auke Kok9d5c8242008-01-24 02:22:38 -08001660 return 0;
1661
1662err_register:
1663 igb_release_hw_control(adapter);
1664err_eeprom:
1665 if (!igb_check_reset_block(hw))
Alexander Duyckf5f4cf02008-11-21 21:30:24 -08001666 igb_reset_phy(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001667
1668 if (hw->flash_address)
1669 iounmap(hw->flash_address);
Auke Kok9d5c8242008-01-24 02:22:38 -08001670err_sw_init:
Alexander Duyck047e0032009-10-27 15:49:27 +00001671 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001672 iounmap(hw->hw_addr);
1673err_ioremap:
1674 free_netdev(netdev);
1675err_alloc_etherdev:
Alexander Duyck559e9c42009-10-27 23:52:50 +00001676 pci_release_selected_regions(pdev,
1677 pci_select_bars(pdev, IORESOURCE_MEM));
Auke Kok9d5c8242008-01-24 02:22:38 -08001678err_pci_reg:
1679err_dma:
1680 pci_disable_device(pdev);
1681 return err;
1682}
1683
1684/**
1685 * igb_remove - Device Removal Routine
1686 * @pdev: PCI device information struct
1687 *
1688 * igb_remove is called by the PCI subsystem to alert the driver
1689 * that it should release a PCI device. The could be caused by a
1690 * Hot-Plug event, or because the driver is going to be removed from
1691 * memory.
1692 **/
1693static void __devexit igb_remove(struct pci_dev *pdev)
1694{
1695 struct net_device *netdev = pci_get_drvdata(pdev);
1696 struct igb_adapter *adapter = netdev_priv(netdev);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001697 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08001698
1699 /* flush_scheduled work may reschedule our watchdog task, so
1700 * explicitly disable watchdog tasks from being rescheduled */
1701 set_bit(__IGB_DOWN, &adapter->state);
1702 del_timer_sync(&adapter->watchdog_timer);
1703 del_timer_sync(&adapter->phy_info_timer);
1704
1705 flush_scheduled_work();
1706
Jeff Kirsher421e02f2008-10-17 11:08:31 -07001707#ifdef CONFIG_IGB_DCA
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001708 if (adapter->flags & IGB_FLAG_DCA_ENABLED) {
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001709 dev_info(&pdev->dev, "DCA disabled\n");
1710 dca_remove_requester(&pdev->dev);
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001711 adapter->flags &= ~IGB_FLAG_DCA_ENABLED;
Alexander Duyckcbd347a2009-02-15 23:59:44 -08001712 wr32(E1000_DCA_CTRL, E1000_DCA_CTRL_DCA_MODE_DISABLE);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001713 }
1714#endif
1715
Auke Kok9d5c8242008-01-24 02:22:38 -08001716 /* Release control of h/w to f/w. If f/w is AMT enabled, this
1717 * would have already happened in close and is redundant. */
1718 igb_release_hw_control(adapter);
1719
1720 unregister_netdev(netdev);
1721
Alexander Duyck047e0032009-10-27 15:49:27 +00001722 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001723
Alexander Duyck37680112009-02-19 20:40:30 -08001724#ifdef CONFIG_PCI_IOV
1725 /* reclaim resources allocated to VFs */
1726 if (adapter->vf_data) {
1727 /* disable iov and allow time for transactions to clear */
1728 pci_disable_sriov(pdev);
1729 msleep(500);
1730
1731 kfree(adapter->vf_data);
1732 adapter->vf_data = NULL;
1733 wr32(E1000_IOVCTL, E1000_IOVCTL_REUSE_VFQ);
1734 msleep(100);
1735 dev_info(&pdev->dev, "IOV Disabled\n");
1736 }
1737#endif
Alexander Duyck559e9c42009-10-27 23:52:50 +00001738
Alexander Duyck28b07592009-02-06 23:20:31 +00001739 iounmap(hw->hw_addr);
1740 if (hw->flash_address)
1741 iounmap(hw->flash_address);
Alexander Duyck559e9c42009-10-27 23:52:50 +00001742 pci_release_selected_regions(pdev,
1743 pci_select_bars(pdev, IORESOURCE_MEM));
Auke Kok9d5c8242008-01-24 02:22:38 -08001744
1745 free_netdev(netdev);
1746
Frans Pop19d5afd2009-10-02 10:04:12 -07001747 pci_disable_pcie_error_reporting(pdev);
Alexander Duyck40a914f2008-11-27 00:24:37 -08001748
Auke Kok9d5c8242008-01-24 02:22:38 -08001749 pci_disable_device(pdev);
1750}
1751
1752/**
Alexander Duycka6b623e2009-10-27 23:47:53 +00001753 * igb_probe_vfs - Initialize vf data storage and add VFs to pci config space
1754 * @adapter: board private structure to initialize
1755 *
1756 * This function initializes the vf specific data storage and then attempts to
1757 * allocate the VFs. The reason for ordering it this way is because it is much
1758 * mor expensive time wise to disable SR-IOV than it is to allocate and free
1759 * the memory for the VFs.
1760 **/
1761static void __devinit igb_probe_vfs(struct igb_adapter * adapter)
1762{
1763#ifdef CONFIG_PCI_IOV
1764 struct pci_dev *pdev = adapter->pdev;
1765
1766 if (adapter->vfs_allocated_count > 7)
1767 adapter->vfs_allocated_count = 7;
1768
1769 if (adapter->vfs_allocated_count) {
1770 adapter->vf_data = kcalloc(adapter->vfs_allocated_count,
1771 sizeof(struct vf_data_storage),
1772 GFP_KERNEL);
1773 /* if allocation failed then we do not support SR-IOV */
1774 if (!adapter->vf_data) {
1775 adapter->vfs_allocated_count = 0;
1776 dev_err(&pdev->dev, "Unable to allocate memory for VF "
1777 "Data Storage\n");
1778 }
1779 }
1780
1781 if (pci_enable_sriov(pdev, adapter->vfs_allocated_count)) {
1782 kfree(adapter->vf_data);
1783 adapter->vf_data = NULL;
1784#endif /* CONFIG_PCI_IOV */
1785 adapter->vfs_allocated_count = 0;
1786#ifdef CONFIG_PCI_IOV
1787 } else {
1788 unsigned char mac_addr[ETH_ALEN];
1789 int i;
1790 dev_info(&pdev->dev, "%d vfs allocated\n",
1791 adapter->vfs_allocated_count);
1792 for (i = 0; i < adapter->vfs_allocated_count; i++) {
1793 random_ether_addr(mac_addr);
1794 igb_set_vf_mac(adapter, i, mac_addr);
1795 }
1796 }
1797#endif /* CONFIG_PCI_IOV */
1798}
1799
Alexander Duyck115f4592009-11-12 18:37:00 +00001800
1801/**
1802 * igb_init_hw_timer - Initialize hardware timer used with IEEE 1588 timestamp
1803 * @adapter: board private structure to initialize
1804 *
1805 * igb_init_hw_timer initializes the function pointer and values for the hw
1806 * timer found in hardware.
1807 **/
1808static void igb_init_hw_timer(struct igb_adapter *adapter)
1809{
1810 struct e1000_hw *hw = &adapter->hw;
1811
1812 switch (hw->mac.type) {
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +00001813 case e1000_i350:
Alexander Duyck55cac242009-11-19 12:42:21 +00001814 case e1000_82580:
1815 memset(&adapter->cycles, 0, sizeof(adapter->cycles));
1816 adapter->cycles.read = igb_read_clock;
1817 adapter->cycles.mask = CLOCKSOURCE_MASK(64);
1818 adapter->cycles.mult = 1;
1819 /*
1820 * The 82580 timesync updates the system timer every 8ns by 8ns
1821 * and the value cannot be shifted. Instead we need to shift
1822 * the registers to generate a 64bit timer value. As a result
1823 * SYSTIMR/L/H, TXSTMPL/H, RXSTMPL/H all have to be shifted by
1824 * 24 in order to generate a larger value for synchronization.
1825 */
1826 adapter->cycles.shift = IGB_82580_TSYNC_SHIFT;
1827 /* disable system timer temporarily by setting bit 31 */
1828 wr32(E1000_TSAUXC, 0x80000000);
1829 wrfl();
1830
1831 /* Set registers so that rollover occurs soon to test this. */
1832 wr32(E1000_SYSTIMR, 0x00000000);
1833 wr32(E1000_SYSTIML, 0x80000000);
1834 wr32(E1000_SYSTIMH, 0x000000FF);
1835 wrfl();
1836
1837 /* enable system timer by clearing bit 31 */
1838 wr32(E1000_TSAUXC, 0x0);
1839 wrfl();
1840
1841 timecounter_init(&adapter->clock,
1842 &adapter->cycles,
1843 ktime_to_ns(ktime_get_real()));
1844 /*
1845 * Synchronize our NIC clock against system wall clock. NIC
1846 * time stamp reading requires ~3us per sample, each sample
1847 * was pretty stable even under load => only require 10
1848 * samples for each offset comparison.
1849 */
1850 memset(&adapter->compare, 0, sizeof(adapter->compare));
1851 adapter->compare.source = &adapter->clock;
1852 adapter->compare.target = ktime_get_real;
1853 adapter->compare.num_samples = 10;
1854 timecompare_update(&adapter->compare, 0);
1855 break;
Alexander Duyck115f4592009-11-12 18:37:00 +00001856 case e1000_82576:
1857 /*
1858 * Initialize hardware timer: we keep it running just in case
1859 * that some program needs it later on.
1860 */
1861 memset(&adapter->cycles, 0, sizeof(adapter->cycles));
1862 adapter->cycles.read = igb_read_clock;
1863 adapter->cycles.mask = CLOCKSOURCE_MASK(64);
1864 adapter->cycles.mult = 1;
1865 /**
1866 * Scale the NIC clock cycle by a large factor so that
1867 * relatively small clock corrections can be added or
1868 * substracted at each clock tick. The drawbacks of a large
1869 * factor are a) that the clock register overflows more quickly
1870 * (not such a big deal) and b) that the increment per tick has
1871 * to fit into 24 bits. As a result we need to use a shift of
1872 * 19 so we can fit a value of 16 into the TIMINCA register.
1873 */
1874 adapter->cycles.shift = IGB_82576_TSYNC_SHIFT;
1875 wr32(E1000_TIMINCA,
1876 (1 << E1000_TIMINCA_16NS_SHIFT) |
1877 (16 << IGB_82576_TSYNC_SHIFT));
1878
1879 /* Set registers so that rollover occurs soon to test this. */
1880 wr32(E1000_SYSTIML, 0x00000000);
1881 wr32(E1000_SYSTIMH, 0xFF800000);
1882 wrfl();
1883
1884 timecounter_init(&adapter->clock,
1885 &adapter->cycles,
1886 ktime_to_ns(ktime_get_real()));
1887 /*
1888 * Synchronize our NIC clock against system wall clock. NIC
1889 * time stamp reading requires ~3us per sample, each sample
1890 * was pretty stable even under load => only require 10
1891 * samples for each offset comparison.
1892 */
1893 memset(&adapter->compare, 0, sizeof(adapter->compare));
1894 adapter->compare.source = &adapter->clock;
1895 adapter->compare.target = ktime_get_real;
1896 adapter->compare.num_samples = 10;
1897 timecompare_update(&adapter->compare, 0);
1898 break;
1899 case e1000_82575:
1900 /* 82575 does not support timesync */
1901 default:
1902 break;
1903 }
1904
1905}
1906
Alexander Duycka6b623e2009-10-27 23:47:53 +00001907/**
Auke Kok9d5c8242008-01-24 02:22:38 -08001908 * igb_sw_init - Initialize general software structures (struct igb_adapter)
1909 * @adapter: board private structure to initialize
1910 *
1911 * igb_sw_init initializes the Adapter private data structure.
1912 * Fields are initialized based on PCI device information and
1913 * OS network device settings (MTU size).
1914 **/
1915static int __devinit igb_sw_init(struct igb_adapter *adapter)
1916{
1917 struct e1000_hw *hw = &adapter->hw;
1918 struct net_device *netdev = adapter->netdev;
1919 struct pci_dev *pdev = adapter->pdev;
1920
1921 pci_read_config_word(pdev, PCI_COMMAND, &hw->bus.pci_cmd_word);
1922
Alexander Duyck68fd9912008-11-20 00:48:10 -08001923 adapter->tx_ring_count = IGB_DEFAULT_TXD;
1924 adapter->rx_ring_count = IGB_DEFAULT_RXD;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +00001925 adapter->rx_itr_setting = IGB_DEFAULT_ITR;
1926 adapter->tx_itr_setting = IGB_DEFAULT_ITR;
1927
Auke Kok9d5c8242008-01-24 02:22:38 -08001928 adapter->max_frame_size = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
1929 adapter->min_frame_size = ETH_ZLEN + ETH_FCS_LEN;
1930
Alexander Duycka6b623e2009-10-27 23:47:53 +00001931#ifdef CONFIG_PCI_IOV
1932 if (hw->mac.type == e1000_82576)
1933 adapter->vfs_allocated_count = max_vfs;
1934
1935#endif /* CONFIG_PCI_IOV */
Alexander Duycka99955f2009-11-12 18:37:19 +00001936 adapter->rss_queues = min_t(u32, IGB_MAX_RX_QUEUES, num_online_cpus());
1937
1938 /*
1939 * if rss_queues > 4 or vfs are going to be allocated with rss_queues
1940 * then we should combine the queues into a queue pair in order to
1941 * conserve interrupts due to limited supply
1942 */
1943 if ((adapter->rss_queues > 4) ||
1944 ((adapter->rss_queues > 1) && (adapter->vfs_allocated_count > 6)))
1945 adapter->flags |= IGB_FLAG_QUEUE_PAIRS;
1946
Alexander Duycka6b623e2009-10-27 23:47:53 +00001947 /* This call may decrease the number of queues */
Alexander Duyck047e0032009-10-27 15:49:27 +00001948 if (igb_init_interrupt_scheme(adapter)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08001949 dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
1950 return -ENOMEM;
1951 }
1952
Alexander Duyck115f4592009-11-12 18:37:00 +00001953 igb_init_hw_timer(adapter);
Alexander Duycka6b623e2009-10-27 23:47:53 +00001954 igb_probe_vfs(adapter);
1955
Auke Kok9d5c8242008-01-24 02:22:38 -08001956 /* Explicitly disable IRQ since the NIC can be in any state. */
1957 igb_irq_disable(adapter);
1958
1959 set_bit(__IGB_DOWN, &adapter->state);
1960 return 0;
1961}
1962
1963/**
1964 * igb_open - Called when a network interface is made active
1965 * @netdev: network interface device structure
1966 *
1967 * Returns 0 on success, negative value on failure
1968 *
1969 * The open entry point is called when a network interface is made
1970 * active by the system (IFF_UP). At this point all resources needed
1971 * for transmit and receive operations are allocated, the interrupt
1972 * handler is registered with the OS, the watchdog timer is started,
1973 * and the stack is notified that the interface is ready.
1974 **/
1975static int igb_open(struct net_device *netdev)
1976{
1977 struct igb_adapter *adapter = netdev_priv(netdev);
1978 struct e1000_hw *hw = &adapter->hw;
1979 int err;
1980 int i;
1981
1982 /* disallow open during test */
1983 if (test_bit(__IGB_TESTING, &adapter->state))
1984 return -EBUSY;
1985
Jesse Brandeburgb168dfc2009-04-17 20:44:32 +00001986 netif_carrier_off(netdev);
1987
Auke Kok9d5c8242008-01-24 02:22:38 -08001988 /* allocate transmit descriptors */
1989 err = igb_setup_all_tx_resources(adapter);
1990 if (err)
1991 goto err_setup_tx;
1992
1993 /* allocate receive descriptors */
1994 err = igb_setup_all_rx_resources(adapter);
1995 if (err)
1996 goto err_setup_rx;
1997
Nick Nunley88a268c2010-02-17 01:01:59 +00001998 igb_power_up_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001999
Auke Kok9d5c8242008-01-24 02:22:38 -08002000 /* before we allocate an interrupt, we must be ready to handle it.
2001 * Setting DEBUG_SHIRQ in the kernel makes it fire an interrupt
2002 * as soon as we call pci_request_irq, so we have to setup our
2003 * clean_rx handler before we do so. */
2004 igb_configure(adapter);
2005
2006 err = igb_request_irq(adapter);
2007 if (err)
2008 goto err_req_irq;
2009
2010 /* From here on the code is the same as igb_up() */
2011 clear_bit(__IGB_DOWN, &adapter->state);
2012
Alexander Duyck047e0032009-10-27 15:49:27 +00002013 for (i = 0; i < adapter->num_q_vectors; i++) {
2014 struct igb_q_vector *q_vector = adapter->q_vector[i];
2015 napi_enable(&q_vector->napi);
2016 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002017
2018 /* Clear any pending interrupts. */
2019 rd32(E1000_ICR);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07002020
2021 igb_irq_enable(adapter);
2022
Alexander Duyckd4960302009-10-27 15:53:45 +00002023 /* notify VFs that reset has been completed */
2024 if (adapter->vfs_allocated_count) {
2025 u32 reg_data = rd32(E1000_CTRL_EXT);
2026 reg_data |= E1000_CTRL_EXT_PFRSTD;
2027 wr32(E1000_CTRL_EXT, reg_data);
2028 }
2029
Jeff Kirsherd55b53f2008-07-18 04:33:03 -07002030 netif_tx_start_all_queues(netdev);
2031
Alexander Duyck25568a52009-10-27 23:49:59 +00002032 /* start the watchdog. */
2033 hw->mac.get_link_status = 1;
2034 schedule_work(&adapter->watchdog_task);
Auke Kok9d5c8242008-01-24 02:22:38 -08002035
2036 return 0;
2037
2038err_req_irq:
2039 igb_release_hw_control(adapter);
Nick Nunley88a268c2010-02-17 01:01:59 +00002040 igb_power_down_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08002041 igb_free_all_rx_resources(adapter);
2042err_setup_rx:
2043 igb_free_all_tx_resources(adapter);
2044err_setup_tx:
2045 igb_reset(adapter);
2046
2047 return err;
2048}
2049
2050/**
2051 * igb_close - Disables a network interface
2052 * @netdev: network interface device structure
2053 *
2054 * Returns 0, this is not allowed to fail
2055 *
2056 * The close entry point is called when an interface is de-activated
2057 * by the OS. The hardware is still under the driver's control, but
2058 * needs to be disabled. A global MAC reset is issued to stop the
2059 * hardware, and all transmit and receive resources are freed.
2060 **/
2061static int igb_close(struct net_device *netdev)
2062{
2063 struct igb_adapter *adapter = netdev_priv(netdev);
2064
2065 WARN_ON(test_bit(__IGB_RESETTING, &adapter->state));
2066 igb_down(adapter);
2067
2068 igb_free_irq(adapter);
2069
2070 igb_free_all_tx_resources(adapter);
2071 igb_free_all_rx_resources(adapter);
2072
Auke Kok9d5c8242008-01-24 02:22:38 -08002073 return 0;
2074}
2075
2076/**
2077 * igb_setup_tx_resources - allocate Tx resources (Descriptors)
Auke Kok9d5c8242008-01-24 02:22:38 -08002078 * @tx_ring: tx descriptor ring (for a specific queue) to setup
2079 *
2080 * Return 0 on success, negative on failure
2081 **/
Alexander Duyck80785292009-10-27 15:51:47 +00002082int igb_setup_tx_resources(struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002083{
Alexander Duyck80785292009-10-27 15:51:47 +00002084 struct pci_dev *pdev = tx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002085 int size;
2086
2087 size = sizeof(struct igb_buffer) * tx_ring->count;
2088 tx_ring->buffer_info = vmalloc(size);
2089 if (!tx_ring->buffer_info)
2090 goto err;
2091 memset(tx_ring->buffer_info, 0, size);
2092
2093 /* round up to nearest 4K */
Alexander Duyck85e8d002009-02-16 00:00:20 -08002094 tx_ring->size = tx_ring->count * sizeof(union e1000_adv_tx_desc);
Auke Kok9d5c8242008-01-24 02:22:38 -08002095 tx_ring->size = ALIGN(tx_ring->size, 4096);
2096
Alexander Duyck439705e2009-10-27 23:49:20 +00002097 tx_ring->desc = pci_alloc_consistent(pdev,
2098 tx_ring->size,
Auke Kok9d5c8242008-01-24 02:22:38 -08002099 &tx_ring->dma);
2100
2101 if (!tx_ring->desc)
2102 goto err;
2103
Auke Kok9d5c8242008-01-24 02:22:38 -08002104 tx_ring->next_to_use = 0;
2105 tx_ring->next_to_clean = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002106 return 0;
2107
2108err:
2109 vfree(tx_ring->buffer_info);
Alexander Duyck047e0032009-10-27 15:49:27 +00002110 dev_err(&pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08002111 "Unable to allocate memory for the transmit descriptor ring\n");
2112 return -ENOMEM;
2113}
2114
2115/**
2116 * igb_setup_all_tx_resources - wrapper to allocate Tx resources
2117 * (Descriptors) for all queues
2118 * @adapter: board private structure
2119 *
2120 * Return 0 on success, negative on failure
2121 **/
2122static int igb_setup_all_tx_resources(struct igb_adapter *adapter)
2123{
Alexander Duyck439705e2009-10-27 23:49:20 +00002124 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002125 int i, err = 0;
2126
2127 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00002128 err = igb_setup_tx_resources(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002129 if (err) {
Alexander Duyck439705e2009-10-27 23:49:20 +00002130 dev_err(&pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08002131 "Allocation for Tx Queue %u failed\n", i);
2132 for (i--; i >= 0; i--)
Alexander Duyck3025a442010-02-17 01:02:39 +00002133 igb_free_tx_resources(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002134 break;
2135 }
2136 }
2137
Alexander Duycka99955f2009-11-12 18:37:19 +00002138 for (i = 0; i < IGB_ABS_MAX_TX_QUEUES; i++) {
Alexander Duyck439705e2009-10-27 23:49:20 +00002139 int r_idx = i % adapter->num_tx_queues;
Alexander Duyck3025a442010-02-17 01:02:39 +00002140 adapter->multi_tx_table[i] = adapter->tx_ring[r_idx];
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00002141 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002142 return err;
2143}
2144
2145/**
Alexander Duyck85b430b2009-10-27 15:50:29 +00002146 * igb_setup_tctl - configure the transmit control registers
2147 * @adapter: Board private structure
Auke Kok9d5c8242008-01-24 02:22:38 -08002148 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002149void igb_setup_tctl(struct igb_adapter *adapter)
Auke Kok9d5c8242008-01-24 02:22:38 -08002150{
Auke Kok9d5c8242008-01-24 02:22:38 -08002151 struct e1000_hw *hw = &adapter->hw;
2152 u32 tctl;
Auke Kok9d5c8242008-01-24 02:22:38 -08002153
Alexander Duyck85b430b2009-10-27 15:50:29 +00002154 /* disable queue 0 which is enabled by default on 82575 and 82576 */
2155 wr32(E1000_TXDCTL(0), 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08002156
2157 /* Program the Transmit Control Register */
Auke Kok9d5c8242008-01-24 02:22:38 -08002158 tctl = rd32(E1000_TCTL);
2159 tctl &= ~E1000_TCTL_CT;
2160 tctl |= E1000_TCTL_PSP | E1000_TCTL_RTLC |
2161 (E1000_COLLISION_THRESHOLD << E1000_CT_SHIFT);
2162
2163 igb_config_collision_dist(hw);
2164
Auke Kok9d5c8242008-01-24 02:22:38 -08002165 /* Enable transmits */
2166 tctl |= E1000_TCTL_EN;
2167
2168 wr32(E1000_TCTL, tctl);
2169}
2170
2171/**
Alexander Duyck85b430b2009-10-27 15:50:29 +00002172 * igb_configure_tx_ring - Configure transmit ring after Reset
2173 * @adapter: board private structure
2174 * @ring: tx ring to configure
2175 *
2176 * Configure a transmit ring after a reset.
2177 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002178void igb_configure_tx_ring(struct igb_adapter *adapter,
2179 struct igb_ring *ring)
Alexander Duyck85b430b2009-10-27 15:50:29 +00002180{
2181 struct e1000_hw *hw = &adapter->hw;
2182 u32 txdctl;
2183 u64 tdba = ring->dma;
2184 int reg_idx = ring->reg_idx;
2185
2186 /* disable the queue */
2187 txdctl = rd32(E1000_TXDCTL(reg_idx));
2188 wr32(E1000_TXDCTL(reg_idx),
2189 txdctl & ~E1000_TXDCTL_QUEUE_ENABLE);
2190 wrfl();
2191 mdelay(10);
2192
2193 wr32(E1000_TDLEN(reg_idx),
2194 ring->count * sizeof(union e1000_adv_tx_desc));
2195 wr32(E1000_TDBAL(reg_idx),
2196 tdba & 0x00000000ffffffffULL);
2197 wr32(E1000_TDBAH(reg_idx), tdba >> 32);
2198
Alexander Duyckfce99e32009-10-27 15:51:27 +00002199 ring->head = hw->hw_addr + E1000_TDH(reg_idx);
2200 ring->tail = hw->hw_addr + E1000_TDT(reg_idx);
2201 writel(0, ring->head);
2202 writel(0, ring->tail);
Alexander Duyck85b430b2009-10-27 15:50:29 +00002203
2204 txdctl |= IGB_TX_PTHRESH;
2205 txdctl |= IGB_TX_HTHRESH << 8;
2206 txdctl |= IGB_TX_WTHRESH << 16;
2207
2208 txdctl |= E1000_TXDCTL_QUEUE_ENABLE;
2209 wr32(E1000_TXDCTL(reg_idx), txdctl);
2210}
2211
2212/**
2213 * igb_configure_tx - Configure transmit Unit after Reset
2214 * @adapter: board private structure
2215 *
2216 * Configure the Tx unit of the MAC after a reset.
2217 **/
2218static void igb_configure_tx(struct igb_adapter *adapter)
2219{
2220 int i;
2221
2222 for (i = 0; i < adapter->num_tx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002223 igb_configure_tx_ring(adapter, adapter->tx_ring[i]);
Alexander Duyck85b430b2009-10-27 15:50:29 +00002224}
2225
2226/**
Auke Kok9d5c8242008-01-24 02:22:38 -08002227 * igb_setup_rx_resources - allocate Rx resources (Descriptors)
Auke Kok9d5c8242008-01-24 02:22:38 -08002228 * @rx_ring: rx descriptor ring (for a specific queue) to setup
2229 *
2230 * Returns 0 on success, negative on failure
2231 **/
Alexander Duyck80785292009-10-27 15:51:47 +00002232int igb_setup_rx_resources(struct igb_ring *rx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002233{
Alexander Duyck80785292009-10-27 15:51:47 +00002234 struct pci_dev *pdev = rx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002235 int size, desc_len;
2236
2237 size = sizeof(struct igb_buffer) * rx_ring->count;
2238 rx_ring->buffer_info = vmalloc(size);
2239 if (!rx_ring->buffer_info)
2240 goto err;
2241 memset(rx_ring->buffer_info, 0, size);
2242
2243 desc_len = sizeof(union e1000_adv_rx_desc);
2244
2245 /* Round up to nearest 4K */
2246 rx_ring->size = rx_ring->count * desc_len;
2247 rx_ring->size = ALIGN(rx_ring->size, 4096);
2248
2249 rx_ring->desc = pci_alloc_consistent(pdev, rx_ring->size,
2250 &rx_ring->dma);
2251
2252 if (!rx_ring->desc)
2253 goto err;
2254
2255 rx_ring->next_to_clean = 0;
2256 rx_ring->next_to_use = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002257
Auke Kok9d5c8242008-01-24 02:22:38 -08002258 return 0;
2259
2260err:
2261 vfree(rx_ring->buffer_info);
Alexander Duyck439705e2009-10-27 23:49:20 +00002262 rx_ring->buffer_info = NULL;
Alexander Duyck80785292009-10-27 15:51:47 +00002263 dev_err(&pdev->dev, "Unable to allocate memory for "
Auke Kok9d5c8242008-01-24 02:22:38 -08002264 "the receive descriptor ring\n");
2265 return -ENOMEM;
2266}
2267
2268/**
2269 * igb_setup_all_rx_resources - wrapper to allocate Rx resources
2270 * (Descriptors) for all queues
2271 * @adapter: board private structure
2272 *
2273 * Return 0 on success, negative on failure
2274 **/
2275static int igb_setup_all_rx_resources(struct igb_adapter *adapter)
2276{
Alexander Duyck439705e2009-10-27 23:49:20 +00002277 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002278 int i, err = 0;
2279
2280 for (i = 0; i < adapter->num_rx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00002281 err = igb_setup_rx_resources(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002282 if (err) {
Alexander Duyck439705e2009-10-27 23:49:20 +00002283 dev_err(&pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08002284 "Allocation for Rx Queue %u failed\n", i);
2285 for (i--; i >= 0; i--)
Alexander Duyck3025a442010-02-17 01:02:39 +00002286 igb_free_rx_resources(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002287 break;
2288 }
2289 }
2290
2291 return err;
2292}
2293
2294/**
Alexander Duyck06cf2662009-10-27 15:53:25 +00002295 * igb_setup_mrqc - configure the multiple receive queue control registers
2296 * @adapter: Board private structure
2297 **/
2298static void igb_setup_mrqc(struct igb_adapter *adapter)
2299{
2300 struct e1000_hw *hw = &adapter->hw;
2301 u32 mrqc, rxcsum;
2302 u32 j, num_rx_queues, shift = 0, shift2 = 0;
2303 union e1000_reta {
2304 u32 dword;
2305 u8 bytes[4];
2306 } reta;
2307 static const u8 rsshash[40] = {
2308 0x6d, 0x5a, 0x56, 0xda, 0x25, 0x5b, 0x0e, 0xc2, 0x41, 0x67,
2309 0x25, 0x3d, 0x43, 0xa3, 0x8f, 0xb0, 0xd0, 0xca, 0x2b, 0xcb,
2310 0xae, 0x7b, 0x30, 0xb4, 0x77, 0xcb, 0x2d, 0xa3, 0x80, 0x30,
2311 0xf2, 0x0c, 0x6a, 0x42, 0xb7, 0x3b, 0xbe, 0xac, 0x01, 0xfa };
2312
2313 /* Fill out hash function seeds */
2314 for (j = 0; j < 10; j++) {
2315 u32 rsskey = rsshash[(j * 4)];
2316 rsskey |= rsshash[(j * 4) + 1] << 8;
2317 rsskey |= rsshash[(j * 4) + 2] << 16;
2318 rsskey |= rsshash[(j * 4) + 3] << 24;
2319 array_wr32(E1000_RSSRK(0), j, rsskey);
2320 }
2321
Alexander Duycka99955f2009-11-12 18:37:19 +00002322 num_rx_queues = adapter->rss_queues;
Alexander Duyck06cf2662009-10-27 15:53:25 +00002323
2324 if (adapter->vfs_allocated_count) {
2325 /* 82575 and 82576 supports 2 RSS queues for VMDq */
2326 switch (hw->mac.type) {
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +00002327 case e1000_i350:
Alexander Duyck55cac242009-11-19 12:42:21 +00002328 case e1000_82580:
2329 num_rx_queues = 1;
2330 shift = 0;
2331 break;
Alexander Duyck06cf2662009-10-27 15:53:25 +00002332 case e1000_82576:
2333 shift = 3;
2334 num_rx_queues = 2;
2335 break;
2336 case e1000_82575:
2337 shift = 2;
2338 shift2 = 6;
2339 default:
2340 break;
2341 }
2342 } else {
2343 if (hw->mac.type == e1000_82575)
2344 shift = 6;
2345 }
2346
2347 for (j = 0; j < (32 * 4); j++) {
2348 reta.bytes[j & 3] = (j % num_rx_queues) << shift;
2349 if (shift2)
2350 reta.bytes[j & 3] |= num_rx_queues << shift2;
2351 if ((j & 3) == 3)
2352 wr32(E1000_RETA(j >> 2), reta.dword);
2353 }
2354
2355 /*
2356 * Disable raw packet checksumming so that RSS hash is placed in
2357 * descriptor on writeback. No need to enable TCP/UDP/IP checksum
2358 * offloads as they are enabled by default
2359 */
2360 rxcsum = rd32(E1000_RXCSUM);
2361 rxcsum |= E1000_RXCSUM_PCSD;
2362
2363 if (adapter->hw.mac.type >= e1000_82576)
2364 /* Enable Receive Checksum Offload for SCTP */
2365 rxcsum |= E1000_RXCSUM_CRCOFL;
2366
2367 /* Don't need to set TUOFL or IPOFL, they default to 1 */
2368 wr32(E1000_RXCSUM, rxcsum);
2369
2370 /* If VMDq is enabled then we set the appropriate mode for that, else
2371 * we default to RSS so that an RSS hash is calculated per packet even
2372 * if we are only using one queue */
2373 if (adapter->vfs_allocated_count) {
2374 if (hw->mac.type > e1000_82575) {
2375 /* Set the default pool for the PF's first queue */
2376 u32 vtctl = rd32(E1000_VT_CTL);
2377 vtctl &= ~(E1000_VT_CTL_DEFAULT_POOL_MASK |
2378 E1000_VT_CTL_DISABLE_DEF_POOL);
2379 vtctl |= adapter->vfs_allocated_count <<
2380 E1000_VT_CTL_DEFAULT_POOL_SHIFT;
2381 wr32(E1000_VT_CTL, vtctl);
2382 }
Alexander Duycka99955f2009-11-12 18:37:19 +00002383 if (adapter->rss_queues > 1)
Alexander Duyck06cf2662009-10-27 15:53:25 +00002384 mrqc = E1000_MRQC_ENABLE_VMDQ_RSS_2Q;
2385 else
2386 mrqc = E1000_MRQC_ENABLE_VMDQ;
2387 } else {
2388 mrqc = E1000_MRQC_ENABLE_RSS_4Q;
2389 }
2390 igb_vmm_control(adapter);
2391
2392 mrqc |= (E1000_MRQC_RSS_FIELD_IPV4 |
2393 E1000_MRQC_RSS_FIELD_IPV4_TCP);
2394 mrqc |= (E1000_MRQC_RSS_FIELD_IPV6 |
2395 E1000_MRQC_RSS_FIELD_IPV6_TCP);
2396 mrqc |= (E1000_MRQC_RSS_FIELD_IPV4_UDP |
2397 E1000_MRQC_RSS_FIELD_IPV6_UDP);
2398 mrqc |= (E1000_MRQC_RSS_FIELD_IPV6_UDP_EX |
2399 E1000_MRQC_RSS_FIELD_IPV6_TCP_EX);
2400
2401 wr32(E1000_MRQC, mrqc);
2402}
2403
2404/**
Auke Kok9d5c8242008-01-24 02:22:38 -08002405 * igb_setup_rctl - configure the receive control registers
2406 * @adapter: Board private structure
2407 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002408void igb_setup_rctl(struct igb_adapter *adapter)
Auke Kok9d5c8242008-01-24 02:22:38 -08002409{
2410 struct e1000_hw *hw = &adapter->hw;
2411 u32 rctl;
Auke Kok9d5c8242008-01-24 02:22:38 -08002412
2413 rctl = rd32(E1000_RCTL);
2414
2415 rctl &= ~(3 << E1000_RCTL_MO_SHIFT);
Alexander Duyck69d728b2008-11-25 01:04:03 -08002416 rctl &= ~(E1000_RCTL_LBM_TCVR | E1000_RCTL_LBM_MAC);
Auke Kok9d5c8242008-01-24 02:22:38 -08002417
Alexander Duyck69d728b2008-11-25 01:04:03 -08002418 rctl |= E1000_RCTL_EN | E1000_RCTL_BAM | E1000_RCTL_RDMTS_HALF |
Alexander Duyck28b07592009-02-06 23:20:31 +00002419 (hw->mac.mc_filter_type << E1000_RCTL_MO_SHIFT);
Auke Kok9d5c8242008-01-24 02:22:38 -08002420
Auke Kok87cb7e82008-07-08 15:08:29 -07002421 /*
2422 * enable stripping of CRC. It's unlikely this will break BMC
2423 * redirection as it did with e1000. Newer features require
2424 * that the HW strips the CRC.
Alexander Duyck73cd78f2009-02-12 18:16:59 +00002425 */
Auke Kok87cb7e82008-07-08 15:08:29 -07002426 rctl |= E1000_RCTL_SECRC;
Auke Kok9d5c8242008-01-24 02:22:38 -08002427
Alexander Duyck559e9c42009-10-27 23:52:50 +00002428 /* disable store bad packets and clear size bits. */
Alexander Duyckec54d7d2009-01-31 00:52:57 -08002429 rctl &= ~(E1000_RCTL_SBP | E1000_RCTL_SZ_256);
Auke Kok9d5c8242008-01-24 02:22:38 -08002430
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002431 /* enable LPE to prevent packets larger than max_frame_size */
2432 rctl |= E1000_RCTL_LPE;
Auke Kok9d5c8242008-01-24 02:22:38 -08002433
Alexander Duyck952f72a2009-10-27 15:51:07 +00002434 /* disable queue 0 to prevent tail write w/o re-config */
2435 wr32(E1000_RXDCTL(0), 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08002436
Alexander Duycke1739522009-02-19 20:39:44 -08002437 /* Attention!!! For SR-IOV PF driver operations you must enable
2438 * queue drop for all VF and PF queues to prevent head of line blocking
2439 * if an un-trusted VF does not provide descriptors to hardware.
2440 */
2441 if (adapter->vfs_allocated_count) {
Alexander Duycke1739522009-02-19 20:39:44 -08002442 /* set all queue drop enable bits */
2443 wr32(E1000_QDE, ALL_QUEUES);
Alexander Duycke1739522009-02-19 20:39:44 -08002444 }
2445
Auke Kok9d5c8242008-01-24 02:22:38 -08002446 wr32(E1000_RCTL, rctl);
2447}
2448
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002449static inline int igb_set_vf_rlpml(struct igb_adapter *adapter, int size,
2450 int vfn)
2451{
2452 struct e1000_hw *hw = &adapter->hw;
2453 u32 vmolr;
2454
2455 /* if it isn't the PF check to see if VFs are enabled and
2456 * increase the size to support vlan tags */
2457 if (vfn < adapter->vfs_allocated_count &&
2458 adapter->vf_data[vfn].vlans_enabled)
2459 size += VLAN_TAG_SIZE;
2460
2461 vmolr = rd32(E1000_VMOLR(vfn));
2462 vmolr &= ~E1000_VMOLR_RLPML_MASK;
2463 vmolr |= size | E1000_VMOLR_LPE;
2464 wr32(E1000_VMOLR(vfn), vmolr);
2465
2466 return 0;
2467}
2468
Auke Kok9d5c8242008-01-24 02:22:38 -08002469/**
Alexander Duycke1739522009-02-19 20:39:44 -08002470 * igb_rlpml_set - set maximum receive packet size
2471 * @adapter: board private structure
2472 *
2473 * Configure maximum receivable packet size.
2474 **/
2475static void igb_rlpml_set(struct igb_adapter *adapter)
2476{
2477 u32 max_frame_size = adapter->max_frame_size;
2478 struct e1000_hw *hw = &adapter->hw;
2479 u16 pf_id = adapter->vfs_allocated_count;
2480
2481 if (adapter->vlgrp)
2482 max_frame_size += VLAN_TAG_SIZE;
2483
2484 /* if vfs are enabled we set RLPML to the largest possible request
2485 * size and set the VMOLR RLPML to the size we need */
2486 if (pf_id) {
2487 igb_set_vf_rlpml(adapter, max_frame_size, pf_id);
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002488 max_frame_size = MAX_JUMBO_FRAME_SIZE;
Alexander Duycke1739522009-02-19 20:39:44 -08002489 }
2490
2491 wr32(E1000_RLPML, max_frame_size);
2492}
2493
Williams, Mitch A8151d292010-02-10 01:44:24 +00002494static inline void igb_set_vmolr(struct igb_adapter *adapter,
2495 int vfn, bool aupe)
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002496{
2497 struct e1000_hw *hw = &adapter->hw;
2498 u32 vmolr;
2499
2500 /*
2501 * This register exists only on 82576 and newer so if we are older then
2502 * we should exit and do nothing
2503 */
2504 if (hw->mac.type < e1000_82576)
2505 return;
2506
2507 vmolr = rd32(E1000_VMOLR(vfn));
Williams, Mitch A8151d292010-02-10 01:44:24 +00002508 vmolr |= E1000_VMOLR_STRVLAN; /* Strip vlan tags */
2509 if (aupe)
2510 vmolr |= E1000_VMOLR_AUPE; /* Accept untagged packets */
2511 else
2512 vmolr &= ~(E1000_VMOLR_AUPE); /* Tagged packets ONLY */
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002513
2514 /* clear all bits that might not be set */
2515 vmolr &= ~(E1000_VMOLR_BAM | E1000_VMOLR_RSSE);
2516
Alexander Duycka99955f2009-11-12 18:37:19 +00002517 if (adapter->rss_queues > 1 && vfn == adapter->vfs_allocated_count)
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002518 vmolr |= E1000_VMOLR_RSSE; /* enable RSS */
2519 /*
2520 * for VMDq only allow the VFs and pool 0 to accept broadcast and
2521 * multicast packets
2522 */
2523 if (vfn <= adapter->vfs_allocated_count)
2524 vmolr |= E1000_VMOLR_BAM; /* Accept broadcast */
2525
2526 wr32(E1000_VMOLR(vfn), vmolr);
2527}
2528
Alexander Duycke1739522009-02-19 20:39:44 -08002529/**
Alexander Duyck85b430b2009-10-27 15:50:29 +00002530 * igb_configure_rx_ring - Configure a receive ring after Reset
2531 * @adapter: board private structure
2532 * @ring: receive ring to be configured
2533 *
2534 * Configure the Rx unit of the MAC after a reset.
2535 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002536void igb_configure_rx_ring(struct igb_adapter *adapter,
2537 struct igb_ring *ring)
Alexander Duyck85b430b2009-10-27 15:50:29 +00002538{
2539 struct e1000_hw *hw = &adapter->hw;
2540 u64 rdba = ring->dma;
2541 int reg_idx = ring->reg_idx;
Alexander Duyck952f72a2009-10-27 15:51:07 +00002542 u32 srrctl, rxdctl;
Alexander Duyck85b430b2009-10-27 15:50:29 +00002543
2544 /* disable the queue */
2545 rxdctl = rd32(E1000_RXDCTL(reg_idx));
2546 wr32(E1000_RXDCTL(reg_idx),
2547 rxdctl & ~E1000_RXDCTL_QUEUE_ENABLE);
2548
2549 /* Set DMA base address registers */
2550 wr32(E1000_RDBAL(reg_idx),
2551 rdba & 0x00000000ffffffffULL);
2552 wr32(E1000_RDBAH(reg_idx), rdba >> 32);
2553 wr32(E1000_RDLEN(reg_idx),
2554 ring->count * sizeof(union e1000_adv_rx_desc));
2555
2556 /* initialize head and tail */
Alexander Duyckfce99e32009-10-27 15:51:27 +00002557 ring->head = hw->hw_addr + E1000_RDH(reg_idx);
2558 ring->tail = hw->hw_addr + E1000_RDT(reg_idx);
2559 writel(0, ring->head);
2560 writel(0, ring->tail);
Alexander Duyck85b430b2009-10-27 15:50:29 +00002561
Alexander Duyck952f72a2009-10-27 15:51:07 +00002562 /* set descriptor configuration */
Alexander Duyck4c844852009-10-27 15:52:07 +00002563 if (ring->rx_buffer_len < IGB_RXBUFFER_1024) {
2564 srrctl = ALIGN(ring->rx_buffer_len, 64) <<
Alexander Duyck952f72a2009-10-27 15:51:07 +00002565 E1000_SRRCTL_BSIZEHDRSIZE_SHIFT;
2566#if (PAGE_SIZE / 2) > IGB_RXBUFFER_16384
2567 srrctl |= IGB_RXBUFFER_16384 >>
2568 E1000_SRRCTL_BSIZEPKT_SHIFT;
2569#else
2570 srrctl |= (PAGE_SIZE / 2) >>
2571 E1000_SRRCTL_BSIZEPKT_SHIFT;
2572#endif
2573 srrctl |= E1000_SRRCTL_DESCTYPE_HDR_SPLIT_ALWAYS;
2574 } else {
Alexander Duyck4c844852009-10-27 15:52:07 +00002575 srrctl = ALIGN(ring->rx_buffer_len, 1024) >>
Alexander Duyck952f72a2009-10-27 15:51:07 +00002576 E1000_SRRCTL_BSIZEPKT_SHIFT;
2577 srrctl |= E1000_SRRCTL_DESCTYPE_ADV_ONEBUF;
2578 }
Nick Nunleye6bdb6f2010-02-17 01:03:38 +00002579 /* Only set Drop Enable if we are supporting multiple queues */
2580 if (adapter->vfs_allocated_count || adapter->num_rx_queues > 1)
2581 srrctl |= E1000_SRRCTL_DROP_EN;
Alexander Duyck952f72a2009-10-27 15:51:07 +00002582
2583 wr32(E1000_SRRCTL(reg_idx), srrctl);
2584
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002585 /* set filtering for VMDQ pools */
Williams, Mitch A8151d292010-02-10 01:44:24 +00002586 igb_set_vmolr(adapter, reg_idx & 0x7, true);
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002587
Alexander Duyck85b430b2009-10-27 15:50:29 +00002588 /* enable receive descriptor fetching */
2589 rxdctl = rd32(E1000_RXDCTL(reg_idx));
2590 rxdctl |= E1000_RXDCTL_QUEUE_ENABLE;
2591 rxdctl &= 0xFFF00000;
2592 rxdctl |= IGB_RX_PTHRESH;
2593 rxdctl |= IGB_RX_HTHRESH << 8;
2594 rxdctl |= IGB_RX_WTHRESH << 16;
2595 wr32(E1000_RXDCTL(reg_idx), rxdctl);
2596}
2597
2598/**
Auke Kok9d5c8242008-01-24 02:22:38 -08002599 * igb_configure_rx - Configure receive Unit after Reset
2600 * @adapter: board private structure
2601 *
2602 * Configure the Rx unit of the MAC after a reset.
2603 **/
2604static void igb_configure_rx(struct igb_adapter *adapter)
2605{
Hannes Eder91075842009-02-18 19:36:04 -08002606 int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08002607
Alexander Duyck68d480c2009-10-05 06:33:08 +00002608 /* set UTA to appropriate mode */
2609 igb_set_uta(adapter);
2610
Alexander Duyck26ad9172009-10-05 06:32:49 +00002611 /* set the correct pool for the PF default MAC address in entry 0 */
2612 igb_rar_set_qsel(adapter, adapter->hw.mac.addr, 0,
2613 adapter->vfs_allocated_count);
2614
Alexander Duyck06cf2662009-10-27 15:53:25 +00002615 /* Setup the HW Rx Head and Tail Descriptor Pointers and
2616 * the Base and Length of the Rx Descriptor Ring */
2617 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002618 igb_configure_rx_ring(adapter, adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002619}
2620
2621/**
2622 * igb_free_tx_resources - Free Tx Resources per Queue
Auke Kok9d5c8242008-01-24 02:22:38 -08002623 * @tx_ring: Tx descriptor ring for a specific queue
2624 *
2625 * Free all transmit software resources
2626 **/
Alexander Duyck68fd9912008-11-20 00:48:10 -08002627void igb_free_tx_resources(struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002628{
Mitch Williams3b644cf2008-06-27 10:59:48 -07002629 igb_clean_tx_ring(tx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08002630
2631 vfree(tx_ring->buffer_info);
2632 tx_ring->buffer_info = NULL;
2633
Alexander Duyck439705e2009-10-27 23:49:20 +00002634 /* if not set, then don't free */
2635 if (!tx_ring->desc)
2636 return;
2637
Alexander Duyck80785292009-10-27 15:51:47 +00002638 pci_free_consistent(tx_ring->pdev, tx_ring->size,
2639 tx_ring->desc, tx_ring->dma);
Auke Kok9d5c8242008-01-24 02:22:38 -08002640
2641 tx_ring->desc = NULL;
2642}
2643
2644/**
2645 * igb_free_all_tx_resources - Free Tx Resources for All Queues
2646 * @adapter: board private structure
2647 *
2648 * Free all transmit software resources
2649 **/
2650static void igb_free_all_tx_resources(struct igb_adapter *adapter)
2651{
2652 int i;
2653
2654 for (i = 0; i < adapter->num_tx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002655 igb_free_tx_resources(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002656}
2657
Alexander Duyckb1a436c2009-10-27 15:54:43 +00002658void igb_unmap_and_free_tx_resource(struct igb_ring *tx_ring,
2659 struct igb_buffer *buffer_info)
Auke Kok9d5c8242008-01-24 02:22:38 -08002660{
Alexander Duyck6366ad32009-12-02 16:47:18 +00002661 if (buffer_info->dma) {
2662 if (buffer_info->mapped_as_page)
2663 pci_unmap_page(tx_ring->pdev,
2664 buffer_info->dma,
2665 buffer_info->length,
2666 PCI_DMA_TODEVICE);
2667 else
2668 pci_unmap_single(tx_ring->pdev,
2669 buffer_info->dma,
2670 buffer_info->length,
2671 PCI_DMA_TODEVICE);
2672 buffer_info->dma = 0;
2673 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002674 if (buffer_info->skb) {
2675 dev_kfree_skb_any(buffer_info->skb);
2676 buffer_info->skb = NULL;
2677 }
2678 buffer_info->time_stamp = 0;
Alexander Duyck6366ad32009-12-02 16:47:18 +00002679 buffer_info->length = 0;
2680 buffer_info->next_to_watch = 0;
2681 buffer_info->mapped_as_page = false;
Auke Kok9d5c8242008-01-24 02:22:38 -08002682}
2683
2684/**
2685 * igb_clean_tx_ring - Free Tx Buffers
Auke Kok9d5c8242008-01-24 02:22:38 -08002686 * @tx_ring: ring to be cleaned
2687 **/
Mitch Williams3b644cf2008-06-27 10:59:48 -07002688static void igb_clean_tx_ring(struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002689{
2690 struct igb_buffer *buffer_info;
2691 unsigned long size;
2692 unsigned int i;
2693
2694 if (!tx_ring->buffer_info)
2695 return;
2696 /* Free all the Tx ring sk_buffs */
2697
2698 for (i = 0; i < tx_ring->count; i++) {
2699 buffer_info = &tx_ring->buffer_info[i];
Alexander Duyck80785292009-10-27 15:51:47 +00002700 igb_unmap_and_free_tx_resource(tx_ring, buffer_info);
Auke Kok9d5c8242008-01-24 02:22:38 -08002701 }
2702
2703 size = sizeof(struct igb_buffer) * tx_ring->count;
2704 memset(tx_ring->buffer_info, 0, size);
2705
2706 /* Zero out the descriptor ring */
Auke Kok9d5c8242008-01-24 02:22:38 -08002707 memset(tx_ring->desc, 0, tx_ring->size);
2708
2709 tx_ring->next_to_use = 0;
2710 tx_ring->next_to_clean = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002711}
2712
2713/**
2714 * igb_clean_all_tx_rings - Free Tx Buffers for all queues
2715 * @adapter: board private structure
2716 **/
2717static void igb_clean_all_tx_rings(struct igb_adapter *adapter)
2718{
2719 int i;
2720
2721 for (i = 0; i < adapter->num_tx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002722 igb_clean_tx_ring(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002723}
2724
2725/**
2726 * igb_free_rx_resources - Free Rx Resources
Auke Kok9d5c8242008-01-24 02:22:38 -08002727 * @rx_ring: ring to clean the resources from
2728 *
2729 * Free all receive software resources
2730 **/
Alexander Duyck68fd9912008-11-20 00:48:10 -08002731void igb_free_rx_resources(struct igb_ring *rx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002732{
Mitch Williams3b644cf2008-06-27 10:59:48 -07002733 igb_clean_rx_ring(rx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08002734
2735 vfree(rx_ring->buffer_info);
2736 rx_ring->buffer_info = NULL;
2737
Alexander Duyck439705e2009-10-27 23:49:20 +00002738 /* if not set, then don't free */
2739 if (!rx_ring->desc)
2740 return;
2741
Alexander Duyck80785292009-10-27 15:51:47 +00002742 pci_free_consistent(rx_ring->pdev, rx_ring->size,
2743 rx_ring->desc, rx_ring->dma);
Auke Kok9d5c8242008-01-24 02:22:38 -08002744
2745 rx_ring->desc = NULL;
2746}
2747
2748/**
2749 * igb_free_all_rx_resources - Free Rx Resources for All Queues
2750 * @adapter: board private structure
2751 *
2752 * Free all receive software resources
2753 **/
2754static void igb_free_all_rx_resources(struct igb_adapter *adapter)
2755{
2756 int i;
2757
2758 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002759 igb_free_rx_resources(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002760}
2761
2762/**
2763 * igb_clean_rx_ring - Free Rx Buffers per Queue
Auke Kok9d5c8242008-01-24 02:22:38 -08002764 * @rx_ring: ring to free buffers from
2765 **/
Mitch Williams3b644cf2008-06-27 10:59:48 -07002766static void igb_clean_rx_ring(struct igb_ring *rx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002767{
2768 struct igb_buffer *buffer_info;
Auke Kok9d5c8242008-01-24 02:22:38 -08002769 unsigned long size;
2770 unsigned int i;
2771
2772 if (!rx_ring->buffer_info)
2773 return;
Alexander Duyck439705e2009-10-27 23:49:20 +00002774
Auke Kok9d5c8242008-01-24 02:22:38 -08002775 /* Free all the Rx ring sk_buffs */
2776 for (i = 0; i < rx_ring->count; i++) {
2777 buffer_info = &rx_ring->buffer_info[i];
2778 if (buffer_info->dma) {
Alexander Duyck80785292009-10-27 15:51:47 +00002779 pci_unmap_single(rx_ring->pdev,
2780 buffer_info->dma,
Alexander Duyck4c844852009-10-27 15:52:07 +00002781 rx_ring->rx_buffer_len,
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002782 PCI_DMA_FROMDEVICE);
Auke Kok9d5c8242008-01-24 02:22:38 -08002783 buffer_info->dma = 0;
2784 }
2785
2786 if (buffer_info->skb) {
2787 dev_kfree_skb(buffer_info->skb);
2788 buffer_info->skb = NULL;
2789 }
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002790 if (buffer_info->page_dma) {
Alexander Duyck80785292009-10-27 15:51:47 +00002791 pci_unmap_page(rx_ring->pdev,
2792 buffer_info->page_dma,
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002793 PAGE_SIZE / 2,
2794 PCI_DMA_FROMDEVICE);
2795 buffer_info->page_dma = 0;
2796 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002797 if (buffer_info->page) {
Auke Kok9d5c8242008-01-24 02:22:38 -08002798 put_page(buffer_info->page);
2799 buffer_info->page = NULL;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07002800 buffer_info->page_offset = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002801 }
2802 }
2803
Auke Kok9d5c8242008-01-24 02:22:38 -08002804 size = sizeof(struct igb_buffer) * rx_ring->count;
2805 memset(rx_ring->buffer_info, 0, size);
2806
2807 /* Zero out the descriptor ring */
2808 memset(rx_ring->desc, 0, rx_ring->size);
2809
2810 rx_ring->next_to_clean = 0;
2811 rx_ring->next_to_use = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002812}
2813
2814/**
2815 * igb_clean_all_rx_rings - Free Rx Buffers for all queues
2816 * @adapter: board private structure
2817 **/
2818static void igb_clean_all_rx_rings(struct igb_adapter *adapter)
2819{
2820 int i;
2821
2822 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002823 igb_clean_rx_ring(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002824}
2825
2826/**
2827 * igb_set_mac - Change the Ethernet Address of the NIC
2828 * @netdev: network interface device structure
2829 * @p: pointer to an address structure
2830 *
2831 * Returns 0 on success, negative on failure
2832 **/
2833static int igb_set_mac(struct net_device *netdev, void *p)
2834{
2835 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyck28b07592009-02-06 23:20:31 +00002836 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08002837 struct sockaddr *addr = p;
2838
2839 if (!is_valid_ether_addr(addr->sa_data))
2840 return -EADDRNOTAVAIL;
2841
2842 memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
Alexander Duyck28b07592009-02-06 23:20:31 +00002843 memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
Auke Kok9d5c8242008-01-24 02:22:38 -08002844
Alexander Duyck26ad9172009-10-05 06:32:49 +00002845 /* set the correct pool for the new PF MAC address in entry 0 */
2846 igb_rar_set_qsel(adapter, hw->mac.addr, 0,
2847 adapter->vfs_allocated_count);
Alexander Duycke1739522009-02-19 20:39:44 -08002848
Auke Kok9d5c8242008-01-24 02:22:38 -08002849 return 0;
2850}
2851
2852/**
Alexander Duyck68d480c2009-10-05 06:33:08 +00002853 * igb_write_mc_addr_list - write multicast addresses to MTA
2854 * @netdev: network interface device structure
2855 *
2856 * Writes multicast address list to the MTA hash table.
2857 * Returns: -ENOMEM on failure
2858 * 0 on no addresses written
2859 * X on writing X addresses to MTA
2860 **/
2861static int igb_write_mc_addr_list(struct net_device *netdev)
2862{
2863 struct igb_adapter *adapter = netdev_priv(netdev);
2864 struct e1000_hw *hw = &adapter->hw;
Jiri Pirko48e2f182010-02-22 09:22:26 +00002865 struct dev_mc_list *mc_ptr;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002866 u8 *mta_list;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002867 int i;
2868
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00002869 if (netdev_mc_empty(netdev)) {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002870 /* nothing to program, so clear mc list */
2871 igb_update_mc_addr_list(hw, NULL, 0);
2872 igb_restore_vf_multicasts(adapter);
2873 return 0;
2874 }
2875
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00002876 mta_list = kzalloc(netdev_mc_count(netdev) * 6, GFP_ATOMIC);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002877 if (!mta_list)
2878 return -ENOMEM;
2879
Alexander Duyck68d480c2009-10-05 06:33:08 +00002880 /* The shared function expects a packed array of only addresses. */
Jiri Pirko48e2f182010-02-22 09:22:26 +00002881 i = 0;
2882 netdev_for_each_mc_addr(mc_ptr, netdev)
2883 memcpy(mta_list + (i++ * ETH_ALEN), mc_ptr->dmi_addr, ETH_ALEN);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002884
Alexander Duyck68d480c2009-10-05 06:33:08 +00002885 igb_update_mc_addr_list(hw, mta_list, i);
2886 kfree(mta_list);
2887
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00002888 return netdev_mc_count(netdev);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002889}
2890
2891/**
2892 * igb_write_uc_addr_list - write unicast addresses to RAR table
2893 * @netdev: network interface device structure
2894 *
2895 * Writes unicast address list to the RAR table.
2896 * Returns: -ENOMEM on failure/insufficient address space
2897 * 0 on no addresses written
2898 * X on writing X addresses to the RAR table
2899 **/
2900static int igb_write_uc_addr_list(struct net_device *netdev)
2901{
2902 struct igb_adapter *adapter = netdev_priv(netdev);
2903 struct e1000_hw *hw = &adapter->hw;
2904 unsigned int vfn = adapter->vfs_allocated_count;
2905 unsigned int rar_entries = hw->mac.rar_entry_count - (vfn + 1);
2906 int count = 0;
2907
2908 /* return ENOMEM indicating insufficient memory for addresses */
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08002909 if (netdev_uc_count(netdev) > rar_entries)
Alexander Duyck68d480c2009-10-05 06:33:08 +00002910 return -ENOMEM;
2911
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08002912 if (!netdev_uc_empty(netdev) && rar_entries) {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002913 struct netdev_hw_addr *ha;
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08002914
2915 netdev_for_each_uc_addr(ha, netdev) {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002916 if (!rar_entries)
2917 break;
2918 igb_rar_set_qsel(adapter, ha->addr,
2919 rar_entries--,
2920 vfn);
2921 count++;
2922 }
2923 }
2924 /* write the addresses in reverse order to avoid write combining */
2925 for (; rar_entries > 0 ; rar_entries--) {
2926 wr32(E1000_RAH(rar_entries), 0);
2927 wr32(E1000_RAL(rar_entries), 0);
2928 }
2929 wrfl();
2930
2931 return count;
2932}
2933
2934/**
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002935 * igb_set_rx_mode - Secondary Unicast, Multicast and Promiscuous mode set
Auke Kok9d5c8242008-01-24 02:22:38 -08002936 * @netdev: network interface device structure
2937 *
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002938 * The set_rx_mode entry point is called whenever the unicast or multicast
2939 * address lists or the network interface flags are updated. This routine is
2940 * responsible for configuring the hardware for proper unicast, multicast,
Auke Kok9d5c8242008-01-24 02:22:38 -08002941 * promiscuous mode, and all-multi behavior.
2942 **/
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002943static void igb_set_rx_mode(struct net_device *netdev)
Auke Kok9d5c8242008-01-24 02:22:38 -08002944{
2945 struct igb_adapter *adapter = netdev_priv(netdev);
2946 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002947 unsigned int vfn = adapter->vfs_allocated_count;
2948 u32 rctl, vmolr = 0;
2949 int count;
Auke Kok9d5c8242008-01-24 02:22:38 -08002950
2951 /* Check for Promiscuous and All Multicast modes */
Auke Kok9d5c8242008-01-24 02:22:38 -08002952 rctl = rd32(E1000_RCTL);
2953
Alexander Duyck68d480c2009-10-05 06:33:08 +00002954 /* clear the effected bits */
2955 rctl &= ~(E1000_RCTL_UPE | E1000_RCTL_MPE | E1000_RCTL_VFE);
2956
Patrick McHardy746b9f02008-07-16 20:15:45 -07002957 if (netdev->flags & IFF_PROMISC) {
Auke Kok9d5c8242008-01-24 02:22:38 -08002958 rctl |= (E1000_RCTL_UPE | E1000_RCTL_MPE);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002959 vmolr |= (E1000_VMOLR_ROPE | E1000_VMOLR_MPME);
Patrick McHardy746b9f02008-07-16 20:15:45 -07002960 } else {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002961 if (netdev->flags & IFF_ALLMULTI) {
Patrick McHardy746b9f02008-07-16 20:15:45 -07002962 rctl |= E1000_RCTL_MPE;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002963 vmolr |= E1000_VMOLR_MPME;
2964 } else {
2965 /*
2966 * Write addresses to the MTA, if the attempt fails
2967 * then we should just turn on promiscous mode so
2968 * that we can at least receive multicast traffic
2969 */
2970 count = igb_write_mc_addr_list(netdev);
2971 if (count < 0) {
2972 rctl |= E1000_RCTL_MPE;
2973 vmolr |= E1000_VMOLR_MPME;
2974 } else if (count) {
2975 vmolr |= E1000_VMOLR_ROMPE;
2976 }
2977 }
2978 /*
2979 * Write addresses to available RAR registers, if there is not
2980 * sufficient space to store all the addresses then enable
2981 * unicast promiscous mode
2982 */
2983 count = igb_write_uc_addr_list(netdev);
2984 if (count < 0) {
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002985 rctl |= E1000_RCTL_UPE;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002986 vmolr |= E1000_VMOLR_ROPE;
2987 }
Patrick McHardy78ed11a2008-07-16 20:16:14 -07002988 rctl |= E1000_RCTL_VFE;
Patrick McHardy746b9f02008-07-16 20:15:45 -07002989 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002990 wr32(E1000_RCTL, rctl);
2991
Alexander Duyck68d480c2009-10-05 06:33:08 +00002992 /*
2993 * In order to support SR-IOV and eventually VMDq it is necessary to set
2994 * the VMOLR to enable the appropriate modes. Without this workaround
2995 * we will have issues with VLAN tag stripping not being done for frames
2996 * that are only arriving because we are the default pool
2997 */
2998 if (hw->mac.type < e1000_82576)
Alexander Duyck28fc06f2009-07-23 18:08:54 +00002999 return;
Alexander Duyck28fc06f2009-07-23 18:08:54 +00003000
Alexander Duyck68d480c2009-10-05 06:33:08 +00003001 vmolr |= rd32(E1000_VMOLR(vfn)) &
3002 ~(E1000_VMOLR_ROPE | E1000_VMOLR_MPME | E1000_VMOLR_ROMPE);
3003 wr32(E1000_VMOLR(vfn), vmolr);
Alexander Duyck28fc06f2009-07-23 18:08:54 +00003004 igb_restore_vf_multicasts(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003005}
3006
3007/* Need to wait a few seconds after link up to get diagnostic information from
3008 * the phy */
3009static void igb_update_phy_info(unsigned long data)
3010{
3011 struct igb_adapter *adapter = (struct igb_adapter *) data;
Alexander Duyckf5f4cf02008-11-21 21:30:24 -08003012 igb_get_phy_info(&adapter->hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08003013}
3014
3015/**
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003016 * igb_has_link - check shared code for link and determine up/down
3017 * @adapter: pointer to driver private info
3018 **/
Nick Nunley31455352010-02-17 01:01:21 +00003019bool igb_has_link(struct igb_adapter *adapter)
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003020{
3021 struct e1000_hw *hw = &adapter->hw;
3022 bool link_active = false;
3023 s32 ret_val = 0;
3024
3025 /* get_link_status is set on LSC (link status) interrupt or
3026 * rx sequence error interrupt. get_link_status will stay
3027 * false until the e1000_check_for_link establishes link
3028 * for copper adapters ONLY
3029 */
3030 switch (hw->phy.media_type) {
3031 case e1000_media_type_copper:
3032 if (hw->mac.get_link_status) {
3033 ret_val = hw->mac.ops.check_for_link(hw);
3034 link_active = !hw->mac.get_link_status;
3035 } else {
3036 link_active = true;
3037 }
3038 break;
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003039 case e1000_media_type_internal_serdes:
3040 ret_val = hw->mac.ops.check_for_link(hw);
3041 link_active = hw->mac.serdes_has_link;
3042 break;
3043 default:
3044 case e1000_media_type_unknown:
3045 break;
3046 }
3047
3048 return link_active;
3049}
3050
3051/**
Auke Kok9d5c8242008-01-24 02:22:38 -08003052 * igb_watchdog - Timer Call-back
3053 * @data: pointer to adapter cast into an unsigned long
3054 **/
3055static void igb_watchdog(unsigned long data)
3056{
3057 struct igb_adapter *adapter = (struct igb_adapter *)data;
3058 /* Do the rest outside of interrupt context */
3059 schedule_work(&adapter->watchdog_task);
3060}
3061
3062static void igb_watchdog_task(struct work_struct *work)
3063{
3064 struct igb_adapter *adapter = container_of(work,
Alexander Duyck559e9c42009-10-27 23:52:50 +00003065 struct igb_adapter,
3066 watchdog_task);
Auke Kok9d5c8242008-01-24 02:22:38 -08003067 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08003068 struct net_device *netdev = adapter->netdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003069 u32 link;
Alexander Duyck7a6ea552008-08-26 04:25:03 -07003070 int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003071
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003072 link = igb_has_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003073 if (link) {
3074 if (!netif_carrier_ok(netdev)) {
3075 u32 ctrl;
Alexander Duyck330a6d62009-10-27 23:51:35 +00003076 hw->mac.ops.get_speed_and_duplex(hw,
3077 &adapter->link_speed,
3078 &adapter->link_duplex);
Auke Kok9d5c8242008-01-24 02:22:38 -08003079
3080 ctrl = rd32(E1000_CTRL);
Alexander Duyck527d47c2008-11-27 00:21:39 -08003081 /* Links status message must follow this format */
3082 printk(KERN_INFO "igb: %s NIC Link is Up %d Mbps %s, "
Auke Kok9d5c8242008-01-24 02:22:38 -08003083 "Flow Control: %s\n",
Alexander Duyck559e9c42009-10-27 23:52:50 +00003084 netdev->name,
3085 adapter->link_speed,
3086 adapter->link_duplex == FULL_DUPLEX ?
Auke Kok9d5c8242008-01-24 02:22:38 -08003087 "Full Duplex" : "Half Duplex",
Alexander Duyck559e9c42009-10-27 23:52:50 +00003088 ((ctrl & E1000_CTRL_TFCE) &&
3089 (ctrl & E1000_CTRL_RFCE)) ? "RX/TX" :
3090 ((ctrl & E1000_CTRL_RFCE) ? "RX" :
3091 ((ctrl & E1000_CTRL_TFCE) ? "TX" : "None")));
Auke Kok9d5c8242008-01-24 02:22:38 -08003092
3093 /* tweak tx_queue_len according to speed/duplex and
3094 * adjust the timeout factor */
3095 netdev->tx_queue_len = adapter->tx_queue_len;
3096 adapter->tx_timeout_factor = 1;
3097 switch (adapter->link_speed) {
3098 case SPEED_10:
3099 netdev->tx_queue_len = 10;
3100 adapter->tx_timeout_factor = 14;
3101 break;
3102 case SPEED_100:
3103 netdev->tx_queue_len = 100;
3104 /* maybe add some timeout factor ? */
3105 break;
3106 }
3107
3108 netif_carrier_on(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08003109
Alexander Duyck4ae196d2009-02-19 20:40:07 -08003110 igb_ping_all_vfs(adapter);
3111
Alexander Duyck4b1a9872009-02-06 23:19:50 +00003112 /* link state has changed, schedule phy info update */
Auke Kok9d5c8242008-01-24 02:22:38 -08003113 if (!test_bit(__IGB_DOWN, &adapter->state))
3114 mod_timer(&adapter->phy_info_timer,
3115 round_jiffies(jiffies + 2 * HZ));
3116 }
3117 } else {
3118 if (netif_carrier_ok(netdev)) {
3119 adapter->link_speed = 0;
3120 adapter->link_duplex = 0;
Alexander Duyck527d47c2008-11-27 00:21:39 -08003121 /* Links status message must follow this format */
3122 printk(KERN_INFO "igb: %s NIC Link is Down\n",
3123 netdev->name);
Auke Kok9d5c8242008-01-24 02:22:38 -08003124 netif_carrier_off(netdev);
Alexander Duyck4b1a9872009-02-06 23:19:50 +00003125
Alexander Duyck4ae196d2009-02-19 20:40:07 -08003126 igb_ping_all_vfs(adapter);
3127
Alexander Duyck4b1a9872009-02-06 23:19:50 +00003128 /* link state has changed, schedule phy info update */
Auke Kok9d5c8242008-01-24 02:22:38 -08003129 if (!test_bit(__IGB_DOWN, &adapter->state))
3130 mod_timer(&adapter->phy_info_timer,
3131 round_jiffies(jiffies + 2 * HZ));
3132 }
3133 }
3134
Auke Kok9d5c8242008-01-24 02:22:38 -08003135 igb_update_stats(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003136
Alexander Duyckdbabb062009-11-12 18:38:16 +00003137 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00003138 struct igb_ring *tx_ring = adapter->tx_ring[i];
Alexander Duyckdbabb062009-11-12 18:38:16 +00003139 if (!netif_carrier_ok(netdev)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003140 /* We've lost link, so the controller stops DMA,
3141 * but we've got queued Tx work that's never going
3142 * to get done, so reset controller to flush Tx.
3143 * (Do the reset outside of interrupt context). */
Alexander Duyckdbabb062009-11-12 18:38:16 +00003144 if (igb_desc_unused(tx_ring) + 1 < tx_ring->count) {
3145 adapter->tx_timeout_count++;
3146 schedule_work(&adapter->reset_task);
3147 /* return immediately since reset is imminent */
3148 return;
3149 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003150 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003151
Alexander Duyckdbabb062009-11-12 18:38:16 +00003152 /* Force detection of hung controller every watchdog period */
3153 tx_ring->detect_tx_hung = true;
3154 }
Alexander Duyckf7ba2052009-10-27 23:48:51 +00003155
Auke Kok9d5c8242008-01-24 02:22:38 -08003156 /* Cause software interrupt to ensure rx ring is cleaned */
Alexander Duyck7a6ea552008-08-26 04:25:03 -07003157 if (adapter->msix_entries) {
Alexander Duyck047e0032009-10-27 15:49:27 +00003158 u32 eics = 0;
3159 for (i = 0; i < adapter->num_q_vectors; i++) {
3160 struct igb_q_vector *q_vector = adapter->q_vector[i];
3161 eics |= q_vector->eims_value;
3162 }
Alexander Duyck7a6ea552008-08-26 04:25:03 -07003163 wr32(E1000_EICS, eics);
3164 } else {
3165 wr32(E1000_ICS, E1000_ICS_RXDMT0);
3166 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003167
Auke Kok9d5c8242008-01-24 02:22:38 -08003168 /* Reset the timer */
3169 if (!test_bit(__IGB_DOWN, &adapter->state))
3170 mod_timer(&adapter->watchdog_timer,
3171 round_jiffies(jiffies + 2 * HZ));
3172}
3173
3174enum latency_range {
3175 lowest_latency = 0,
3176 low_latency = 1,
3177 bulk_latency = 2,
3178 latency_invalid = 255
3179};
3180
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003181/**
3182 * igb_update_ring_itr - update the dynamic ITR value based on packet size
3183 *
3184 * Stores a new ITR value based on strictly on packet size. This
3185 * algorithm is less sophisticated than that used in igb_update_itr,
3186 * due to the difficulty of synchronizing statistics across multiple
3187 * receive rings. The divisors and thresholds used by this fuction
3188 * were determined based on theoretical maximum wire speed and testing
3189 * data, in order to minimize response time while increasing bulk
3190 * throughput.
3191 * This functionality is controlled by the InterruptThrottleRate module
3192 * parameter (see igb_param.c)
3193 * NOTE: This function is called only when operating in a multiqueue
3194 * receive environment.
Alexander Duyck047e0032009-10-27 15:49:27 +00003195 * @q_vector: pointer to q_vector
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003196 **/
Alexander Duyck047e0032009-10-27 15:49:27 +00003197static void igb_update_ring_itr(struct igb_q_vector *q_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -08003198{
Alexander Duyck047e0032009-10-27 15:49:27 +00003199 int new_val = q_vector->itr_val;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003200 int avg_wire_size = 0;
Alexander Duyck047e0032009-10-27 15:49:27 +00003201 struct igb_adapter *adapter = q_vector->adapter;
Auke Kok9d5c8242008-01-24 02:22:38 -08003202
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003203 /* For non-gigabit speeds, just fix the interrupt rate at 4000
3204 * ints/sec - ITR timer value of 120 ticks.
3205 */
3206 if (adapter->link_speed != SPEED_1000) {
Alexander Duyck047e0032009-10-27 15:49:27 +00003207 new_val = 976;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003208 goto set_itr_val;
3209 }
Alexander Duyck047e0032009-10-27 15:49:27 +00003210
3211 if (q_vector->rx_ring && q_vector->rx_ring->total_packets) {
3212 struct igb_ring *ring = q_vector->rx_ring;
3213 avg_wire_size = ring->total_bytes / ring->total_packets;
3214 }
3215
3216 if (q_vector->tx_ring && q_vector->tx_ring->total_packets) {
3217 struct igb_ring *ring = q_vector->tx_ring;
3218 avg_wire_size = max_t(u32, avg_wire_size,
3219 (ring->total_bytes /
3220 ring->total_packets));
3221 }
3222
3223 /* if avg_wire_size isn't set no work was done */
3224 if (!avg_wire_size)
3225 goto clear_counts;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003226
3227 /* Add 24 bytes to size to account for CRC, preamble, and gap */
3228 avg_wire_size += 24;
3229
3230 /* Don't starve jumbo frames */
3231 avg_wire_size = min(avg_wire_size, 3000);
3232
3233 /* Give a little boost to mid-size frames */
3234 if ((avg_wire_size > 300) && (avg_wire_size < 1200))
3235 new_val = avg_wire_size / 3;
3236 else
3237 new_val = avg_wire_size / 2;
3238
Nick Nunleyabe1c362010-02-17 01:03:19 +00003239 /* when in itr mode 3 do not exceed 20K ints/sec */
3240 if (adapter->rx_itr_setting == 3 && new_val < 196)
3241 new_val = 196;
3242
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003243set_itr_val:
Alexander Duyck047e0032009-10-27 15:49:27 +00003244 if (new_val != q_vector->itr_val) {
3245 q_vector->itr_val = new_val;
3246 q_vector->set_itr = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -08003247 }
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003248clear_counts:
Alexander Duyck047e0032009-10-27 15:49:27 +00003249 if (q_vector->rx_ring) {
3250 q_vector->rx_ring->total_bytes = 0;
3251 q_vector->rx_ring->total_packets = 0;
3252 }
3253 if (q_vector->tx_ring) {
3254 q_vector->tx_ring->total_bytes = 0;
3255 q_vector->tx_ring->total_packets = 0;
3256 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003257}
3258
3259/**
3260 * igb_update_itr - update the dynamic ITR value based on statistics
3261 * Stores a new ITR value based on packets and byte
3262 * counts during the last interrupt. The advantage of per interrupt
3263 * computation is faster updates and more accurate ITR for the current
3264 * traffic pattern. Constants in this function were computed
3265 * based on theoretical maximum wire speed and thresholds were set based
3266 * on testing data as well as attempting to minimize response time
3267 * while increasing bulk throughput.
3268 * this functionality is controlled by the InterruptThrottleRate module
3269 * parameter (see igb_param.c)
3270 * NOTE: These calculations are only valid when operating in a single-
3271 * queue environment.
3272 * @adapter: pointer to adapter
Alexander Duyck047e0032009-10-27 15:49:27 +00003273 * @itr_setting: current q_vector->itr_val
Auke Kok9d5c8242008-01-24 02:22:38 -08003274 * @packets: the number of packets during this measurement interval
3275 * @bytes: the number of bytes during this measurement interval
3276 **/
3277static unsigned int igb_update_itr(struct igb_adapter *adapter, u16 itr_setting,
3278 int packets, int bytes)
3279{
3280 unsigned int retval = itr_setting;
3281
3282 if (packets == 0)
3283 goto update_itr_done;
3284
3285 switch (itr_setting) {
3286 case lowest_latency:
3287 /* handle TSO and jumbo frames */
3288 if (bytes/packets > 8000)
3289 retval = bulk_latency;
3290 else if ((packets < 5) && (bytes > 512))
3291 retval = low_latency;
3292 break;
3293 case low_latency: /* 50 usec aka 20000 ints/s */
3294 if (bytes > 10000) {
3295 /* this if handles the TSO accounting */
3296 if (bytes/packets > 8000) {
3297 retval = bulk_latency;
3298 } else if ((packets < 10) || ((bytes/packets) > 1200)) {
3299 retval = bulk_latency;
3300 } else if ((packets > 35)) {
3301 retval = lowest_latency;
3302 }
3303 } else if (bytes/packets > 2000) {
3304 retval = bulk_latency;
3305 } else if (packets <= 2 && bytes < 512) {
3306 retval = lowest_latency;
3307 }
3308 break;
3309 case bulk_latency: /* 250 usec aka 4000 ints/s */
3310 if (bytes > 25000) {
3311 if (packets > 35)
3312 retval = low_latency;
Alexander Duyck1e5c3d22009-02-12 18:17:21 +00003313 } else if (bytes < 1500) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003314 retval = low_latency;
3315 }
3316 break;
3317 }
3318
3319update_itr_done:
3320 return retval;
3321}
3322
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003323static void igb_set_itr(struct igb_adapter *adapter)
Auke Kok9d5c8242008-01-24 02:22:38 -08003324{
Alexander Duyck047e0032009-10-27 15:49:27 +00003325 struct igb_q_vector *q_vector = adapter->q_vector[0];
Auke Kok9d5c8242008-01-24 02:22:38 -08003326 u16 current_itr;
Alexander Duyck047e0032009-10-27 15:49:27 +00003327 u32 new_itr = q_vector->itr_val;
Auke Kok9d5c8242008-01-24 02:22:38 -08003328
3329 /* for non-gigabit speeds, just fix the interrupt rate at 4000 */
3330 if (adapter->link_speed != SPEED_1000) {
3331 current_itr = 0;
3332 new_itr = 4000;
3333 goto set_itr_now;
3334 }
3335
3336 adapter->rx_itr = igb_update_itr(adapter,
3337 adapter->rx_itr,
Alexander Duyck3025a442010-02-17 01:02:39 +00003338 q_vector->rx_ring->total_packets,
3339 q_vector->rx_ring->total_bytes);
Auke Kok9d5c8242008-01-24 02:22:38 -08003340
Alexander Duyck047e0032009-10-27 15:49:27 +00003341 adapter->tx_itr = igb_update_itr(adapter,
3342 adapter->tx_itr,
Alexander Duyck3025a442010-02-17 01:02:39 +00003343 q_vector->tx_ring->total_packets,
3344 q_vector->tx_ring->total_bytes);
Alexander Duyck047e0032009-10-27 15:49:27 +00003345 current_itr = max(adapter->rx_itr, adapter->tx_itr);
Auke Kok9d5c8242008-01-24 02:22:38 -08003346
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003347 /* conservative mode (itr 3) eliminates the lowest_latency setting */
Alexander Duyck4fc82ad2009-10-27 23:45:42 +00003348 if (adapter->rx_itr_setting == 3 && current_itr == lowest_latency)
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003349 current_itr = low_latency;
3350
Auke Kok9d5c8242008-01-24 02:22:38 -08003351 switch (current_itr) {
3352 /* counts and packets in update_itr are dependent on these numbers */
3353 case lowest_latency:
Alexander Duyck78b1f6072009-04-23 11:20:29 +00003354 new_itr = 56; /* aka 70,000 ints/sec */
Auke Kok9d5c8242008-01-24 02:22:38 -08003355 break;
3356 case low_latency:
Alexander Duyck78b1f6072009-04-23 11:20:29 +00003357 new_itr = 196; /* aka 20,000 ints/sec */
Auke Kok9d5c8242008-01-24 02:22:38 -08003358 break;
3359 case bulk_latency:
Alexander Duyck78b1f6072009-04-23 11:20:29 +00003360 new_itr = 980; /* aka 4,000 ints/sec */
Auke Kok9d5c8242008-01-24 02:22:38 -08003361 break;
3362 default:
3363 break;
3364 }
3365
3366set_itr_now:
Alexander Duyck3025a442010-02-17 01:02:39 +00003367 q_vector->rx_ring->total_bytes = 0;
3368 q_vector->rx_ring->total_packets = 0;
3369 q_vector->tx_ring->total_bytes = 0;
3370 q_vector->tx_ring->total_packets = 0;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003371
Alexander Duyck047e0032009-10-27 15:49:27 +00003372 if (new_itr != q_vector->itr_val) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003373 /* this attempts to bias the interrupt rate towards Bulk
3374 * by adding intermediate steps when interrupt rate is
3375 * increasing */
Alexander Duyck047e0032009-10-27 15:49:27 +00003376 new_itr = new_itr > q_vector->itr_val ?
3377 max((new_itr * q_vector->itr_val) /
3378 (new_itr + (q_vector->itr_val >> 2)),
3379 new_itr) :
Auke Kok9d5c8242008-01-24 02:22:38 -08003380 new_itr;
3381 /* Don't write the value here; it resets the adapter's
3382 * internal timer, and causes us to delay far longer than
3383 * we should between interrupts. Instead, we write the ITR
3384 * value at the beginning of the next interrupt so the timing
3385 * ends up being correct.
3386 */
Alexander Duyck047e0032009-10-27 15:49:27 +00003387 q_vector->itr_val = new_itr;
3388 q_vector->set_itr = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -08003389 }
3390
3391 return;
3392}
3393
Auke Kok9d5c8242008-01-24 02:22:38 -08003394#define IGB_TX_FLAGS_CSUM 0x00000001
3395#define IGB_TX_FLAGS_VLAN 0x00000002
3396#define IGB_TX_FLAGS_TSO 0x00000004
3397#define IGB_TX_FLAGS_IPV4 0x00000008
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003398#define IGB_TX_FLAGS_TSTAMP 0x00000010
3399#define IGB_TX_FLAGS_VLAN_MASK 0xffff0000
3400#define IGB_TX_FLAGS_VLAN_SHIFT 16
Auke Kok9d5c8242008-01-24 02:22:38 -08003401
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003402static inline int igb_tso_adv(struct igb_ring *tx_ring,
Auke Kok9d5c8242008-01-24 02:22:38 -08003403 struct sk_buff *skb, u32 tx_flags, u8 *hdr_len)
3404{
3405 struct e1000_adv_tx_context_desc *context_desc;
3406 unsigned int i;
3407 int err;
3408 struct igb_buffer *buffer_info;
3409 u32 info = 0, tu_cmd = 0;
Nick Nunley91d4ee32010-02-17 01:04:56 +00003410 u32 mss_l4len_idx;
3411 u8 l4len;
Auke Kok9d5c8242008-01-24 02:22:38 -08003412
3413 if (skb_header_cloned(skb)) {
3414 err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
3415 if (err)
3416 return err;
3417 }
3418
3419 l4len = tcp_hdrlen(skb);
3420 *hdr_len += l4len;
3421
3422 if (skb->protocol == htons(ETH_P_IP)) {
3423 struct iphdr *iph = ip_hdr(skb);
3424 iph->tot_len = 0;
3425 iph->check = 0;
3426 tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
3427 iph->daddr, 0,
3428 IPPROTO_TCP,
3429 0);
Sridhar Samudrala8e1e8a42010-01-23 02:02:21 -08003430 } else if (skb_is_gso_v6(skb)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003431 ipv6_hdr(skb)->payload_len = 0;
3432 tcp_hdr(skb)->check = ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
3433 &ipv6_hdr(skb)->daddr,
3434 0, IPPROTO_TCP, 0);
3435 }
3436
3437 i = tx_ring->next_to_use;
3438
3439 buffer_info = &tx_ring->buffer_info[i];
3440 context_desc = E1000_TX_CTXTDESC_ADV(*tx_ring, i);
3441 /* VLAN MACLEN IPLEN */
3442 if (tx_flags & IGB_TX_FLAGS_VLAN)
3443 info |= (tx_flags & IGB_TX_FLAGS_VLAN_MASK);
3444 info |= (skb_network_offset(skb) << E1000_ADVTXD_MACLEN_SHIFT);
3445 *hdr_len += skb_network_offset(skb);
3446 info |= skb_network_header_len(skb);
3447 *hdr_len += skb_network_header_len(skb);
3448 context_desc->vlan_macip_lens = cpu_to_le32(info);
3449
3450 /* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
3451 tu_cmd |= (E1000_TXD_CMD_DEXT | E1000_ADVTXD_DTYP_CTXT);
3452
3453 if (skb->protocol == htons(ETH_P_IP))
3454 tu_cmd |= E1000_ADVTXD_TUCMD_IPV4;
3455 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_TCP;
3456
3457 context_desc->type_tucmd_mlhl = cpu_to_le32(tu_cmd);
3458
3459 /* MSS L4LEN IDX */
3460 mss_l4len_idx = (skb_shinfo(skb)->gso_size << E1000_ADVTXD_MSS_SHIFT);
3461 mss_l4len_idx |= (l4len << E1000_ADVTXD_L4LEN_SHIFT);
3462
Alexander Duyck73cd78f2009-02-12 18:16:59 +00003463 /* For 82575, context index must be unique per ring. */
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003464 if (tx_ring->flags & IGB_RING_FLAG_TX_CTX_IDX)
3465 mss_l4len_idx |= tx_ring->reg_idx << 4;
Auke Kok9d5c8242008-01-24 02:22:38 -08003466
3467 context_desc->mss_l4len_idx = cpu_to_le32(mss_l4len_idx);
3468 context_desc->seqnum_seed = 0;
3469
3470 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003471 buffer_info->next_to_watch = i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003472 buffer_info->dma = 0;
3473 i++;
3474 if (i == tx_ring->count)
3475 i = 0;
3476
3477 tx_ring->next_to_use = i;
3478
3479 return true;
3480}
3481
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003482static inline bool igb_tx_csum_adv(struct igb_ring *tx_ring,
3483 struct sk_buff *skb, u32 tx_flags)
Auke Kok9d5c8242008-01-24 02:22:38 -08003484{
3485 struct e1000_adv_tx_context_desc *context_desc;
Alexander Duyck80785292009-10-27 15:51:47 +00003486 struct pci_dev *pdev = tx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003487 struct igb_buffer *buffer_info;
3488 u32 info = 0, tu_cmd = 0;
Alexander Duyck80785292009-10-27 15:51:47 +00003489 unsigned int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003490
3491 if ((skb->ip_summed == CHECKSUM_PARTIAL) ||
3492 (tx_flags & IGB_TX_FLAGS_VLAN)) {
3493 i = tx_ring->next_to_use;
3494 buffer_info = &tx_ring->buffer_info[i];
3495 context_desc = E1000_TX_CTXTDESC_ADV(*tx_ring, i);
3496
3497 if (tx_flags & IGB_TX_FLAGS_VLAN)
3498 info |= (tx_flags & IGB_TX_FLAGS_VLAN_MASK);
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003499
Auke Kok9d5c8242008-01-24 02:22:38 -08003500 info |= (skb_network_offset(skb) << E1000_ADVTXD_MACLEN_SHIFT);
3501 if (skb->ip_summed == CHECKSUM_PARTIAL)
3502 info |= skb_network_header_len(skb);
3503
3504 context_desc->vlan_macip_lens = cpu_to_le32(info);
3505
3506 tu_cmd |= (E1000_TXD_CMD_DEXT | E1000_ADVTXD_DTYP_CTXT);
3507
3508 if (skb->ip_summed == CHECKSUM_PARTIAL) {
Arthur Jonesfa4a7ef2009-03-21 16:55:07 -07003509 __be16 protocol;
3510
3511 if (skb->protocol == cpu_to_be16(ETH_P_8021Q)) {
3512 const struct vlan_ethhdr *vhdr =
3513 (const struct vlan_ethhdr*)skb->data;
3514
3515 protocol = vhdr->h_vlan_encapsulated_proto;
3516 } else {
3517 protocol = skb->protocol;
3518 }
3519
3520 switch (protocol) {
Harvey Harrison09640e62009-02-01 00:45:17 -08003521 case cpu_to_be16(ETH_P_IP):
Auke Kok9d5c8242008-01-24 02:22:38 -08003522 tu_cmd |= E1000_ADVTXD_TUCMD_IPV4;
Mitch Williams44b0cda2008-03-07 10:32:13 -08003523 if (ip_hdr(skb)->protocol == IPPROTO_TCP)
3524 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_TCP;
Jesse Brandeburgb9473562009-04-27 22:36:13 +00003525 else if (ip_hdr(skb)->protocol == IPPROTO_SCTP)
3526 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_SCTP;
Mitch Williams44b0cda2008-03-07 10:32:13 -08003527 break;
Harvey Harrison09640e62009-02-01 00:45:17 -08003528 case cpu_to_be16(ETH_P_IPV6):
Mitch Williams44b0cda2008-03-07 10:32:13 -08003529 /* XXX what about other V6 headers?? */
3530 if (ipv6_hdr(skb)->nexthdr == IPPROTO_TCP)
3531 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_TCP;
Jesse Brandeburgb9473562009-04-27 22:36:13 +00003532 else if (ipv6_hdr(skb)->nexthdr == IPPROTO_SCTP)
3533 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_SCTP;
Mitch Williams44b0cda2008-03-07 10:32:13 -08003534 break;
3535 default:
3536 if (unlikely(net_ratelimit()))
Alexander Duyck80785292009-10-27 15:51:47 +00003537 dev_warn(&pdev->dev,
Mitch Williams44b0cda2008-03-07 10:32:13 -08003538 "partial checksum but proto=%x!\n",
3539 skb->protocol);
3540 break;
3541 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003542 }
3543
3544 context_desc->type_tucmd_mlhl = cpu_to_le32(tu_cmd);
3545 context_desc->seqnum_seed = 0;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003546 if (tx_ring->flags & IGB_RING_FLAG_TX_CTX_IDX)
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07003547 context_desc->mss_l4len_idx =
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003548 cpu_to_le32(tx_ring->reg_idx << 4);
Auke Kok9d5c8242008-01-24 02:22:38 -08003549
3550 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003551 buffer_info->next_to_watch = i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003552 buffer_info->dma = 0;
3553
3554 i++;
3555 if (i == tx_ring->count)
3556 i = 0;
3557 tx_ring->next_to_use = i;
3558
3559 return true;
3560 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003561 return false;
3562}
3563
3564#define IGB_MAX_TXD_PWR 16
3565#define IGB_MAX_DATA_PER_TXD (1<<IGB_MAX_TXD_PWR)
3566
Alexander Duyck80785292009-10-27 15:51:47 +00003567static inline int igb_tx_map_adv(struct igb_ring *tx_ring, struct sk_buff *skb,
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003568 unsigned int first)
Auke Kok9d5c8242008-01-24 02:22:38 -08003569{
3570 struct igb_buffer *buffer_info;
Alexander Duyck80785292009-10-27 15:51:47 +00003571 struct pci_dev *pdev = tx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003572 unsigned int len = skb_headlen(skb);
3573 unsigned int count = 0, i;
3574 unsigned int f;
3575
3576 i = tx_ring->next_to_use;
3577
3578 buffer_info = &tx_ring->buffer_info[i];
3579 BUG_ON(len >= IGB_MAX_DATA_PER_TXD);
3580 buffer_info->length = len;
3581 /* set time_stamp *before* dma to help avoid a possible race */
3582 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003583 buffer_info->next_to_watch = i;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003584 buffer_info->dma = pci_map_single(pdev, skb->data, len,
3585 PCI_DMA_TODEVICE);
3586 if (pci_dma_mapping_error(pdev, buffer_info->dma))
3587 goto dma_error;
Auke Kok9d5c8242008-01-24 02:22:38 -08003588
3589 for (f = 0; f < skb_shinfo(skb)->nr_frags; f++) {
3590 struct skb_frag_struct *frag;
3591
Alexander Duyck85811452010-01-23 01:35:00 -08003592 count++;
Alexander Duyck65689fe2009-03-20 00:17:43 +00003593 i++;
3594 if (i == tx_ring->count)
3595 i = 0;
3596
Auke Kok9d5c8242008-01-24 02:22:38 -08003597 frag = &skb_shinfo(skb)->frags[f];
3598 len = frag->size;
3599
3600 buffer_info = &tx_ring->buffer_info[i];
3601 BUG_ON(len >= IGB_MAX_DATA_PER_TXD);
3602 buffer_info->length = len;
3603 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003604 buffer_info->next_to_watch = i;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003605 buffer_info->mapped_as_page = true;
3606 buffer_info->dma = pci_map_page(pdev,
3607 frag->page,
3608 frag->page_offset,
3609 len,
3610 PCI_DMA_TODEVICE);
3611 if (pci_dma_mapping_error(pdev, buffer_info->dma))
3612 goto dma_error;
3613
Auke Kok9d5c8242008-01-24 02:22:38 -08003614 }
3615
Auke Kok9d5c8242008-01-24 02:22:38 -08003616 tx_ring->buffer_info[i].skb = skb;
Nick Nunley40e90c22010-02-17 01:04:37 +00003617 tx_ring->buffer_info[i].gso_segs = skb_shinfo(skb)->gso_segs ?: 1;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003618 tx_ring->buffer_info[first].next_to_watch = i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003619
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003620 return ++count;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003621
3622dma_error:
3623 dev_err(&pdev->dev, "TX DMA map failed\n");
3624
3625 /* clear timestamp and dma mappings for failed buffer_info mapping */
3626 buffer_info->dma = 0;
3627 buffer_info->time_stamp = 0;
3628 buffer_info->length = 0;
3629 buffer_info->next_to_watch = 0;
3630 buffer_info->mapped_as_page = false;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003631
3632 /* clear timestamp and dma mappings for remaining portion of packet */
Nick Nunleya77ff702010-02-17 01:06:16 +00003633 while (count--) {
3634 if (i == 0)
3635 i = tx_ring->count;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003636 i--;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003637 buffer_info = &tx_ring->buffer_info[i];
3638 igb_unmap_and_free_tx_resource(tx_ring, buffer_info);
3639 }
3640
3641 return 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08003642}
3643
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003644static inline void igb_tx_queue_adv(struct igb_ring *tx_ring,
Nick Nunley91d4ee32010-02-17 01:04:56 +00003645 u32 tx_flags, int count, u32 paylen,
Auke Kok9d5c8242008-01-24 02:22:38 -08003646 u8 hdr_len)
3647{
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003648 union e1000_adv_tx_desc *tx_desc;
Auke Kok9d5c8242008-01-24 02:22:38 -08003649 struct igb_buffer *buffer_info;
3650 u32 olinfo_status = 0, cmd_type_len;
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003651 unsigned int i = tx_ring->next_to_use;
Auke Kok9d5c8242008-01-24 02:22:38 -08003652
3653 cmd_type_len = (E1000_ADVTXD_DTYP_DATA | E1000_ADVTXD_DCMD_IFCS |
3654 E1000_ADVTXD_DCMD_DEXT);
3655
3656 if (tx_flags & IGB_TX_FLAGS_VLAN)
3657 cmd_type_len |= E1000_ADVTXD_DCMD_VLE;
3658
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003659 if (tx_flags & IGB_TX_FLAGS_TSTAMP)
3660 cmd_type_len |= E1000_ADVTXD_MAC_TSTAMP;
3661
Auke Kok9d5c8242008-01-24 02:22:38 -08003662 if (tx_flags & IGB_TX_FLAGS_TSO) {
3663 cmd_type_len |= E1000_ADVTXD_DCMD_TSE;
3664
3665 /* insert tcp checksum */
3666 olinfo_status |= E1000_TXD_POPTS_TXSM << 8;
3667
3668 /* insert ip checksum */
3669 if (tx_flags & IGB_TX_FLAGS_IPV4)
3670 olinfo_status |= E1000_TXD_POPTS_IXSM << 8;
3671
3672 } else if (tx_flags & IGB_TX_FLAGS_CSUM) {
3673 olinfo_status |= E1000_TXD_POPTS_TXSM << 8;
3674 }
3675
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003676 if ((tx_ring->flags & IGB_RING_FLAG_TX_CTX_IDX) &&
3677 (tx_flags & (IGB_TX_FLAGS_CSUM |
3678 IGB_TX_FLAGS_TSO |
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07003679 IGB_TX_FLAGS_VLAN)))
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003680 olinfo_status |= tx_ring->reg_idx << 4;
Auke Kok9d5c8242008-01-24 02:22:38 -08003681
3682 olinfo_status |= ((paylen - hdr_len) << E1000_ADVTXD_PAYLEN_SHIFT);
3683
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003684 do {
Auke Kok9d5c8242008-01-24 02:22:38 -08003685 buffer_info = &tx_ring->buffer_info[i];
3686 tx_desc = E1000_TX_DESC_ADV(*tx_ring, i);
3687 tx_desc->read.buffer_addr = cpu_to_le64(buffer_info->dma);
3688 tx_desc->read.cmd_type_len =
3689 cpu_to_le32(cmd_type_len | buffer_info->length);
3690 tx_desc->read.olinfo_status = cpu_to_le32(olinfo_status);
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003691 count--;
Auke Kok9d5c8242008-01-24 02:22:38 -08003692 i++;
3693 if (i == tx_ring->count)
3694 i = 0;
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003695 } while (count > 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08003696
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003697 tx_desc->read.cmd_type_len |= cpu_to_le32(IGB_ADVTXD_DCMD);
Auke Kok9d5c8242008-01-24 02:22:38 -08003698 /* Force memory writes to complete before letting h/w
3699 * know there are new descriptors to fetch. (Only
3700 * applicable for weak-ordered memory model archs,
3701 * such as IA-64). */
3702 wmb();
3703
3704 tx_ring->next_to_use = i;
Alexander Duyckfce99e32009-10-27 15:51:27 +00003705 writel(i, tx_ring->tail);
Auke Kok9d5c8242008-01-24 02:22:38 -08003706 /* we need this if more than one processor can write to our tail
3707 * at a time, it syncronizes IO on IA64/Altix systems */
3708 mmiowb();
3709}
3710
Alexander Duycke694e962009-10-27 15:53:06 +00003711static int __igb_maybe_stop_tx(struct igb_ring *tx_ring, int size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003712{
Alexander Duycke694e962009-10-27 15:53:06 +00003713 struct net_device *netdev = tx_ring->netdev;
3714
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003715 netif_stop_subqueue(netdev, tx_ring->queue_index);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003716
Auke Kok9d5c8242008-01-24 02:22:38 -08003717 /* Herbert's original patch had:
3718 * smp_mb__after_netif_stop_queue();
3719 * but since that doesn't exist yet, just open code it. */
3720 smp_mb();
3721
3722 /* We need to check again in a case another CPU has just
3723 * made room available. */
Alexander Duyckc493ea42009-03-20 00:16:50 +00003724 if (igb_desc_unused(tx_ring) < size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003725 return -EBUSY;
3726
3727 /* A reprieve! */
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003728 netif_wake_subqueue(netdev, tx_ring->queue_index);
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00003729 tx_ring->tx_stats.restart_queue++;
Auke Kok9d5c8242008-01-24 02:22:38 -08003730 return 0;
3731}
3732
Nick Nunley717ba082010-02-17 01:04:18 +00003733static inline int igb_maybe_stop_tx(struct igb_ring *tx_ring, int size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003734{
Alexander Duyckc493ea42009-03-20 00:16:50 +00003735 if (igb_desc_unused(tx_ring) >= size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003736 return 0;
Alexander Duycke694e962009-10-27 15:53:06 +00003737 return __igb_maybe_stop_tx(tx_ring, size);
Auke Kok9d5c8242008-01-24 02:22:38 -08003738}
3739
Alexander Duyckb1a436c2009-10-27 15:54:43 +00003740netdev_tx_t igb_xmit_frame_ring_adv(struct sk_buff *skb,
3741 struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08003742{
Alexander Duycke694e962009-10-27 15:53:06 +00003743 struct igb_adapter *adapter = netdev_priv(tx_ring->netdev);
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003744 int tso = 0, count;
Nick Nunley91d4ee32010-02-17 01:04:56 +00003745 u32 tx_flags = 0;
3746 u16 first;
3747 u8 hdr_len = 0;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00003748 union skb_shared_tx *shtx = skb_tx(skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08003749
Auke Kok9d5c8242008-01-24 02:22:38 -08003750 /* need: 1 descriptor per page,
3751 * + 2 desc gap to keep tail from touching head,
3752 * + 1 desc for skb->data,
3753 * + 1 desc for context descriptor,
3754 * otherwise try next time */
Alexander Duycke694e962009-10-27 15:53:06 +00003755 if (igb_maybe_stop_tx(tx_ring, skb_shinfo(skb)->nr_frags + 4)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003756 /* this is a hard error */
Auke Kok9d5c8242008-01-24 02:22:38 -08003757 return NETDEV_TX_BUSY;
3758 }
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003759
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003760 if (unlikely(shtx->hardware)) {
3761 shtx->in_progress = 1;
3762 tx_flags |= IGB_TX_FLAGS_TSTAMP;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003763 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003764
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003765 if (vlan_tx_tag_present(skb) && adapter->vlgrp) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003766 tx_flags |= IGB_TX_FLAGS_VLAN;
3767 tx_flags |= (vlan_tx_tag_get(skb) << IGB_TX_FLAGS_VLAN_SHIFT);
3768 }
3769
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003770 if (skb->protocol == htons(ETH_P_IP))
3771 tx_flags |= IGB_TX_FLAGS_IPV4;
3772
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003773 first = tx_ring->next_to_use;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003774 if (skb_is_gso(skb)) {
3775 tso = igb_tso_adv(tx_ring, skb, tx_flags, &hdr_len);
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003776
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003777 if (tso < 0) {
3778 dev_kfree_skb_any(skb);
3779 return NETDEV_TX_OK;
3780 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003781 }
3782
3783 if (tso)
3784 tx_flags |= IGB_TX_FLAGS_TSO;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003785 else if (igb_tx_csum_adv(tx_ring, skb, tx_flags) &&
Alexander Duyckbc1cbd32009-02-13 14:45:17 +00003786 (skb->ip_summed == CHECKSUM_PARTIAL))
3787 tx_flags |= IGB_TX_FLAGS_CSUM;
Auke Kok9d5c8242008-01-24 02:22:38 -08003788
Alexander Duyck65689fe2009-03-20 00:17:43 +00003789 /*
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003790 * count reflects descriptors mapped, if 0 or less then mapping error
Alexander Duyck65689fe2009-03-20 00:17:43 +00003791 * has occured and we need to rewind the descriptor queue
3792 */
Alexander Duyck80785292009-10-27 15:51:47 +00003793 count = igb_tx_map_adv(tx_ring, skb, first);
Alexander Duyck6366ad32009-12-02 16:47:18 +00003794 if (!count) {
Alexander Duyck65689fe2009-03-20 00:17:43 +00003795 dev_kfree_skb_any(skb);
3796 tx_ring->buffer_info[first].time_stamp = 0;
3797 tx_ring->next_to_use = first;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003798 return NETDEV_TX_OK;
Alexander Duyck65689fe2009-03-20 00:17:43 +00003799 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003800
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003801 igb_tx_queue_adv(tx_ring, tx_flags, count, skb->len, hdr_len);
3802
3803 /* Make sure there is space in the ring for the next send. */
Alexander Duycke694e962009-10-27 15:53:06 +00003804 igb_maybe_stop_tx(tx_ring, MAX_SKB_FRAGS + 4);
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003805
Auke Kok9d5c8242008-01-24 02:22:38 -08003806 return NETDEV_TX_OK;
3807}
3808
Stephen Hemminger3b29a562009-08-31 19:50:55 +00003809static netdev_tx_t igb_xmit_frame_adv(struct sk_buff *skb,
3810 struct net_device *netdev)
Auke Kok9d5c8242008-01-24 02:22:38 -08003811{
3812 struct igb_adapter *adapter = netdev_priv(netdev);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003813 struct igb_ring *tx_ring;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003814 int r_idx = 0;
Alexander Duyckb1a436c2009-10-27 15:54:43 +00003815
3816 if (test_bit(__IGB_DOWN, &adapter->state)) {
3817 dev_kfree_skb_any(skb);
3818 return NETDEV_TX_OK;
3819 }
3820
3821 if (skb->len <= 0) {
3822 dev_kfree_skb_any(skb);
3823 return NETDEV_TX_OK;
3824 }
3825
Alexander Duyck1bfaf072009-02-19 20:39:23 -08003826 r_idx = skb->queue_mapping & (IGB_ABS_MAX_TX_QUEUES - 1);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003827 tx_ring = adapter->multi_tx_table[r_idx];
Auke Kok9d5c8242008-01-24 02:22:38 -08003828
3829 /* This goes back to the question of how to logically map a tx queue
3830 * to a flow. Right now, performance is impacted slightly negatively
3831 * if using multiple tx queues. If the stack breaks away from a
3832 * single qdisc implementation, we can look at this again. */
Alexander Duycke694e962009-10-27 15:53:06 +00003833 return igb_xmit_frame_ring_adv(skb, tx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08003834}
3835
3836/**
3837 * igb_tx_timeout - Respond to a Tx Hang
3838 * @netdev: network interface device structure
3839 **/
3840static void igb_tx_timeout(struct net_device *netdev)
3841{
3842 struct igb_adapter *adapter = netdev_priv(netdev);
3843 struct e1000_hw *hw = &adapter->hw;
3844
3845 /* Do the reset outside of interrupt context */
3846 adapter->tx_timeout_count++;
Alexander Duyckf7ba2052009-10-27 23:48:51 +00003847
Alexander Duyck55cac242009-11-19 12:42:21 +00003848 if (hw->mac.type == e1000_82580)
3849 hw->dev_spec._82575.global_device_reset = true;
3850
Auke Kok9d5c8242008-01-24 02:22:38 -08003851 schedule_work(&adapter->reset_task);
Alexander Duyck265de402009-02-06 23:22:52 +00003852 wr32(E1000_EICS,
3853 (adapter->eims_enable_mask & ~adapter->eims_other));
Auke Kok9d5c8242008-01-24 02:22:38 -08003854}
3855
3856static void igb_reset_task(struct work_struct *work)
3857{
3858 struct igb_adapter *adapter;
3859 adapter = container_of(work, struct igb_adapter, reset_task);
3860
3861 igb_reinit_locked(adapter);
3862}
3863
3864/**
3865 * igb_get_stats - Get System Network Statistics
3866 * @netdev: network interface device structure
3867 *
3868 * Returns the address of the device statistics structure.
3869 * The statistics are actually updated from the timer callback.
3870 **/
Alexander Duyck73cd78f2009-02-12 18:16:59 +00003871static struct net_device_stats *igb_get_stats(struct net_device *netdev)
Auke Kok9d5c8242008-01-24 02:22:38 -08003872{
Auke Kok9d5c8242008-01-24 02:22:38 -08003873 /* only return the current stats */
Ajit Khaparde8d24e932009-10-07 02:42:56 +00003874 return &netdev->stats;
Auke Kok9d5c8242008-01-24 02:22:38 -08003875}
3876
3877/**
3878 * igb_change_mtu - Change the Maximum Transfer Unit
3879 * @netdev: network interface device structure
3880 * @new_mtu: new value for maximum frame size
3881 *
3882 * Returns 0 on success, negative on failure
3883 **/
3884static int igb_change_mtu(struct net_device *netdev, int new_mtu)
3885{
3886 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyck090b1792009-10-27 23:51:55 +00003887 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003888 int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;
Alexander Duyck4c844852009-10-27 15:52:07 +00003889 u32 rx_buffer_len, i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003890
Alexander Duyckc809d222009-10-27 23:52:13 +00003891 if ((new_mtu < 68) || (max_frame > MAX_JUMBO_FRAME_SIZE)) {
Alexander Duyck090b1792009-10-27 23:51:55 +00003892 dev_err(&pdev->dev, "Invalid MTU setting\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08003893 return -EINVAL;
3894 }
3895
Auke Kok9d5c8242008-01-24 02:22:38 -08003896 if (max_frame > MAX_STD_JUMBO_FRAME_SIZE) {
Alexander Duyck090b1792009-10-27 23:51:55 +00003897 dev_err(&pdev->dev, "MTU > 9216 not supported.\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08003898 return -EINVAL;
3899 }
3900
3901 while (test_and_set_bit(__IGB_RESETTING, &adapter->state))
3902 msleep(1);
Alexander Duyck73cd78f2009-02-12 18:16:59 +00003903
Auke Kok9d5c8242008-01-24 02:22:38 -08003904 /* igb_down has a dependency on max_frame_size */
3905 adapter->max_frame_size = max_frame;
Alexander Duyck559e9c42009-10-27 23:52:50 +00003906
Auke Kok9d5c8242008-01-24 02:22:38 -08003907 /* NOTE: netdev_alloc_skb reserves 16 bytes, and typically NET_IP_ALIGN
3908 * means we reserve 2 more, this pushes us to allocate from the next
3909 * larger slab size.
3910 * i.e. RXBUFFER_2048 --> size-4096 slab
3911 */
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
3920 if (netif_running(netdev))
3921 igb_down(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003922
Alexander Duyck090b1792009-10-27 23:51:55 +00003923 dev_info(&pdev->dev, "changing MTU from %d to %d\n",
Auke Kok9d5c8242008-01-24 02:22:38 -08003924 netdev->mtu, new_mtu);
3925 netdev->mtu = new_mtu;
3926
Alexander Duyck4c844852009-10-27 15:52:07 +00003927 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00003928 adapter->rx_ring[i]->rx_buffer_len = rx_buffer_len;
Alexander Duyck4c844852009-10-27 15:52:07 +00003929
Auke Kok9d5c8242008-01-24 02:22:38 -08003930 if (netif_running(netdev))
3931 igb_up(adapter);
3932 else
3933 igb_reset(adapter);
3934
3935 clear_bit(__IGB_RESETTING, &adapter->state);
3936
3937 return 0;
3938}
3939
3940/**
3941 * igb_update_stats - Update the board statistics counters
3942 * @adapter: board private structure
3943 **/
3944
3945void igb_update_stats(struct igb_adapter *adapter)
3946{
Alexander Duyck128e45e2009-11-12 18:37:38 +00003947 struct net_device_stats *net_stats = igb_get_stats(adapter->netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08003948 struct e1000_hw *hw = &adapter->hw;
3949 struct pci_dev *pdev = adapter->pdev;
Nick Nunley43915c7c2010-02-17 01:03:58 +00003950 u32 rnbc, reg;
Auke Kok9d5c8242008-01-24 02:22:38 -08003951 u16 phy_tmp;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003952 int i;
3953 u64 bytes, packets;
Auke Kok9d5c8242008-01-24 02:22:38 -08003954
3955#define PHY_IDLE_ERROR_COUNT_MASK 0x00FF
3956
3957 /*
3958 * Prevent stats update while adapter is being reset, or if the pci
3959 * connection is down.
3960 */
3961 if (adapter->link_speed == 0)
3962 return;
3963 if (pci_channel_offline(pdev))
3964 return;
3965
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003966 bytes = 0;
3967 packets = 0;
3968 for (i = 0; i < adapter->num_rx_queues; i++) {
3969 u32 rqdpc_tmp = rd32(E1000_RQDPC(i)) & 0x0FFF;
Alexander Duyck3025a442010-02-17 01:02:39 +00003970 struct igb_ring *ring = adapter->rx_ring[i];
3971 ring->rx_stats.drops += rqdpc_tmp;
Alexander Duyck128e45e2009-11-12 18:37:38 +00003972 net_stats->rx_fifo_errors += rqdpc_tmp;
Alexander Duyck3025a442010-02-17 01:02:39 +00003973 bytes += ring->rx_stats.bytes;
3974 packets += ring->rx_stats.packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003975 }
3976
Alexander Duyck128e45e2009-11-12 18:37:38 +00003977 net_stats->rx_bytes = bytes;
3978 net_stats->rx_packets = packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003979
3980 bytes = 0;
3981 packets = 0;
3982 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00003983 struct igb_ring *ring = adapter->tx_ring[i];
3984 bytes += ring->tx_stats.bytes;
3985 packets += ring->tx_stats.packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003986 }
Alexander Duyck128e45e2009-11-12 18:37:38 +00003987 net_stats->tx_bytes = bytes;
3988 net_stats->tx_packets = packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003989
3990 /* read stats registers */
Auke Kok9d5c8242008-01-24 02:22:38 -08003991 adapter->stats.crcerrs += rd32(E1000_CRCERRS);
3992 adapter->stats.gprc += rd32(E1000_GPRC);
3993 adapter->stats.gorc += rd32(E1000_GORCL);
3994 rd32(E1000_GORCH); /* clear GORCL */
3995 adapter->stats.bprc += rd32(E1000_BPRC);
3996 adapter->stats.mprc += rd32(E1000_MPRC);
3997 adapter->stats.roc += rd32(E1000_ROC);
3998
3999 adapter->stats.prc64 += rd32(E1000_PRC64);
4000 adapter->stats.prc127 += rd32(E1000_PRC127);
4001 adapter->stats.prc255 += rd32(E1000_PRC255);
4002 adapter->stats.prc511 += rd32(E1000_PRC511);
4003 adapter->stats.prc1023 += rd32(E1000_PRC1023);
4004 adapter->stats.prc1522 += rd32(E1000_PRC1522);
4005 adapter->stats.symerrs += rd32(E1000_SYMERRS);
4006 adapter->stats.sec += rd32(E1000_SEC);
4007
4008 adapter->stats.mpc += rd32(E1000_MPC);
4009 adapter->stats.scc += rd32(E1000_SCC);
4010 adapter->stats.ecol += rd32(E1000_ECOL);
4011 adapter->stats.mcc += rd32(E1000_MCC);
4012 adapter->stats.latecol += rd32(E1000_LATECOL);
4013 adapter->stats.dc += rd32(E1000_DC);
4014 adapter->stats.rlec += rd32(E1000_RLEC);
4015 adapter->stats.xonrxc += rd32(E1000_XONRXC);
4016 adapter->stats.xontxc += rd32(E1000_XONTXC);
4017 adapter->stats.xoffrxc += rd32(E1000_XOFFRXC);
4018 adapter->stats.xofftxc += rd32(E1000_XOFFTXC);
4019 adapter->stats.fcruc += rd32(E1000_FCRUC);
4020 adapter->stats.gptc += rd32(E1000_GPTC);
4021 adapter->stats.gotc += rd32(E1000_GOTCL);
4022 rd32(E1000_GOTCH); /* clear GOTCL */
Alexander Duyck3f9c0162009-10-27 23:48:12 +00004023 rnbc = rd32(E1000_RNBC);
4024 adapter->stats.rnbc += rnbc;
Alexander Duyck128e45e2009-11-12 18:37:38 +00004025 net_stats->rx_fifo_errors += rnbc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004026 adapter->stats.ruc += rd32(E1000_RUC);
4027 adapter->stats.rfc += rd32(E1000_RFC);
4028 adapter->stats.rjc += rd32(E1000_RJC);
4029 adapter->stats.tor += rd32(E1000_TORH);
4030 adapter->stats.tot += rd32(E1000_TOTH);
4031 adapter->stats.tpr += rd32(E1000_TPR);
4032
4033 adapter->stats.ptc64 += rd32(E1000_PTC64);
4034 adapter->stats.ptc127 += rd32(E1000_PTC127);
4035 adapter->stats.ptc255 += rd32(E1000_PTC255);
4036 adapter->stats.ptc511 += rd32(E1000_PTC511);
4037 adapter->stats.ptc1023 += rd32(E1000_PTC1023);
4038 adapter->stats.ptc1522 += rd32(E1000_PTC1522);
4039
4040 adapter->stats.mptc += rd32(E1000_MPTC);
4041 adapter->stats.bptc += rd32(E1000_BPTC);
4042
Nick Nunley2d0b0f62010-02-17 01:02:59 +00004043 adapter->stats.tpt += rd32(E1000_TPT);
4044 adapter->stats.colc += rd32(E1000_COLC);
Auke Kok9d5c8242008-01-24 02:22:38 -08004045
4046 adapter->stats.algnerrc += rd32(E1000_ALGNERRC);
Nick Nunley43915c7c2010-02-17 01:03:58 +00004047 /* read internal phy specific stats */
4048 reg = rd32(E1000_CTRL_EXT);
4049 if (!(reg & E1000_CTRL_EXT_LINK_MODE_MASK)) {
4050 adapter->stats.rxerrc += rd32(E1000_RXERRC);
4051 adapter->stats.tncrs += rd32(E1000_TNCRS);
4052 }
4053
Auke Kok9d5c8242008-01-24 02:22:38 -08004054 adapter->stats.tsctc += rd32(E1000_TSCTC);
4055 adapter->stats.tsctfc += rd32(E1000_TSCTFC);
4056
4057 adapter->stats.iac += rd32(E1000_IAC);
4058 adapter->stats.icrxoc += rd32(E1000_ICRXOC);
4059 adapter->stats.icrxptc += rd32(E1000_ICRXPTC);
4060 adapter->stats.icrxatc += rd32(E1000_ICRXATC);
4061 adapter->stats.ictxptc += rd32(E1000_ICTXPTC);
4062 adapter->stats.ictxatc += rd32(E1000_ICTXATC);
4063 adapter->stats.ictxqec += rd32(E1000_ICTXQEC);
4064 adapter->stats.ictxqmtc += rd32(E1000_ICTXQMTC);
4065 adapter->stats.icrxdmtc += rd32(E1000_ICRXDMTC);
4066
4067 /* Fill out the OS statistics structure */
Alexander Duyck128e45e2009-11-12 18:37:38 +00004068 net_stats->multicast = adapter->stats.mprc;
4069 net_stats->collisions = adapter->stats.colc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004070
4071 /* Rx Errors */
4072
4073 /* RLEC on some newer hardware can be incorrect so build
Jesper Dangaard Brouer8c0ab702009-05-26 13:50:31 +00004074 * our own version based on RUC and ROC */
Alexander Duyck128e45e2009-11-12 18:37:38 +00004075 net_stats->rx_errors = adapter->stats.rxerrc +
Auke Kok9d5c8242008-01-24 02:22:38 -08004076 adapter->stats.crcerrs + adapter->stats.algnerrc +
4077 adapter->stats.ruc + adapter->stats.roc +
4078 adapter->stats.cexterr;
Alexander Duyck128e45e2009-11-12 18:37:38 +00004079 net_stats->rx_length_errors = adapter->stats.ruc +
4080 adapter->stats.roc;
4081 net_stats->rx_crc_errors = adapter->stats.crcerrs;
4082 net_stats->rx_frame_errors = adapter->stats.algnerrc;
4083 net_stats->rx_missed_errors = adapter->stats.mpc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004084
4085 /* Tx Errors */
Alexander Duyck128e45e2009-11-12 18:37:38 +00004086 net_stats->tx_errors = adapter->stats.ecol +
4087 adapter->stats.latecol;
4088 net_stats->tx_aborted_errors = adapter->stats.ecol;
4089 net_stats->tx_window_errors = adapter->stats.latecol;
4090 net_stats->tx_carrier_errors = adapter->stats.tncrs;
Auke Kok9d5c8242008-01-24 02:22:38 -08004091
4092 /* Tx Dropped needs to be maintained elsewhere */
4093
4094 /* Phy Stats */
4095 if (hw->phy.media_type == e1000_media_type_copper) {
4096 if ((adapter->link_speed == SPEED_1000) &&
Alexander Duyck73cd78f2009-02-12 18:16:59 +00004097 (!igb_read_phy_reg(hw, PHY_1000T_STATUS, &phy_tmp))) {
Auke Kok9d5c8242008-01-24 02:22:38 -08004098 phy_tmp &= PHY_IDLE_ERROR_COUNT_MASK;
4099 adapter->phy_stats.idle_errors += phy_tmp;
4100 }
4101 }
4102
4103 /* Management Stats */
4104 adapter->stats.mgptc += rd32(E1000_MGTPTC);
4105 adapter->stats.mgprc += rd32(E1000_MGTPRC);
4106 adapter->stats.mgpdc += rd32(E1000_MGTPDC);
4107}
4108
Auke Kok9d5c8242008-01-24 02:22:38 -08004109static irqreturn_t igb_msix_other(int irq, void *data)
4110{
Alexander Duyck047e0032009-10-27 15:49:27 +00004111 struct igb_adapter *adapter = data;
Auke Kok9d5c8242008-01-24 02:22:38 -08004112 struct e1000_hw *hw = &adapter->hw;
PJ Waskiewicz844290e2008-06-27 11:00:39 -07004113 u32 icr = rd32(E1000_ICR);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07004114 /* reading ICR causes bit 31 of EICR to be cleared */
Alexander Duyckdda0e082009-02-06 23:19:08 +00004115
Alexander Duyck7f081d42010-01-07 17:41:00 +00004116 if (icr & E1000_ICR_DRSTA)
4117 schedule_work(&adapter->reset_task);
4118
Alexander Duyck047e0032009-10-27 15:49:27 +00004119 if (icr & E1000_ICR_DOUTSYNC) {
Alexander Duyckdda0e082009-02-06 23:19:08 +00004120 /* HW is reporting DMA is out of sync */
4121 adapter->stats.doosync++;
4122 }
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00004123
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004124 /* Check for a mailbox event */
4125 if (icr & E1000_ICR_VMMB)
4126 igb_msg_task(adapter);
4127
4128 if (icr & E1000_ICR_LSC) {
4129 hw->mac.get_link_status = 1;
4130 /* guard against interrupt when we're going down */
4131 if (!test_bit(__IGB_DOWN, &adapter->state))
4132 mod_timer(&adapter->watchdog_timer, jiffies + 1);
4133 }
4134
Alexander Duyck25568a52009-10-27 23:49:59 +00004135 if (adapter->vfs_allocated_count)
4136 wr32(E1000_IMS, E1000_IMS_LSC |
4137 E1000_IMS_VMMB |
4138 E1000_IMS_DOUTSYNC);
4139 else
4140 wr32(E1000_IMS, E1000_IMS_LSC | E1000_IMS_DOUTSYNC);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07004141 wr32(E1000_EIMS, adapter->eims_other);
Auke Kok9d5c8242008-01-24 02:22:38 -08004142
4143 return IRQ_HANDLED;
4144}
4145
Alexander Duyck047e0032009-10-27 15:49:27 +00004146static void igb_write_itr(struct igb_q_vector *q_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -08004147{
Alexander Duyck26b39272010-02-17 01:00:41 +00004148 struct igb_adapter *adapter = q_vector->adapter;
Alexander Duyck047e0032009-10-27 15:49:27 +00004149 u32 itr_val = q_vector->itr_val & 0x7FFC;
Auke Kok9d5c8242008-01-24 02:22:38 -08004150
Alexander Duyck047e0032009-10-27 15:49:27 +00004151 if (!q_vector->set_itr)
4152 return;
Alexander Duyck73cd78f2009-02-12 18:16:59 +00004153
Alexander Duyck047e0032009-10-27 15:49:27 +00004154 if (!itr_val)
4155 itr_val = 0x4;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004156
Alexander Duyck26b39272010-02-17 01:00:41 +00004157 if (adapter->hw.mac.type == e1000_82575)
4158 itr_val |= itr_val << 16;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004159 else
Alexander Duyck047e0032009-10-27 15:49:27 +00004160 itr_val |= 0x8000000;
4161
4162 writel(itr_val, q_vector->itr_register);
4163 q_vector->set_itr = 0;
4164}
4165
4166static irqreturn_t igb_msix_ring(int irq, void *data)
4167{
4168 struct igb_q_vector *q_vector = data;
4169
4170 /* Write the ITR value calculated from the previous interrupt. */
4171 igb_write_itr(q_vector);
4172
4173 napi_schedule(&q_vector->napi);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004174
Auke Kok9d5c8242008-01-24 02:22:38 -08004175 return IRQ_HANDLED;
4176}
4177
Jeff Kirsher421e02f2008-10-17 11:08:31 -07004178#ifdef CONFIG_IGB_DCA
Alexander Duyck047e0032009-10-27 15:49:27 +00004179static void igb_update_dca(struct igb_q_vector *q_vector)
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004180{
Alexander Duyck047e0032009-10-27 15:49:27 +00004181 struct igb_adapter *adapter = q_vector->adapter;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004182 struct e1000_hw *hw = &adapter->hw;
4183 int cpu = get_cpu();
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004184
Alexander Duyck047e0032009-10-27 15:49:27 +00004185 if (q_vector->cpu == cpu)
4186 goto out_no_update;
4187
4188 if (q_vector->tx_ring) {
4189 int q = q_vector->tx_ring->reg_idx;
4190 u32 dca_txctrl = rd32(E1000_DCA_TXCTRL(q));
4191 if (hw->mac.type == e1000_82575) {
4192 dca_txctrl &= ~E1000_DCA_TXCTRL_CPUID_MASK;
4193 dca_txctrl |= dca3_get_tag(&adapter->pdev->dev, cpu);
4194 } else {
4195 dca_txctrl &= ~E1000_DCA_TXCTRL_CPUID_MASK_82576;
4196 dca_txctrl |= dca3_get_tag(&adapter->pdev->dev, cpu) <<
4197 E1000_DCA_TXCTRL_CPUID_SHIFT;
4198 }
4199 dca_txctrl |= E1000_DCA_TXCTRL_DESC_DCA_EN;
4200 wr32(E1000_DCA_TXCTRL(q), dca_txctrl);
4201 }
4202 if (q_vector->rx_ring) {
4203 int q = q_vector->rx_ring->reg_idx;
4204 u32 dca_rxctrl = rd32(E1000_DCA_RXCTRL(q));
4205 if (hw->mac.type == e1000_82575) {
4206 dca_rxctrl &= ~E1000_DCA_RXCTRL_CPUID_MASK;
4207 dca_rxctrl |= dca3_get_tag(&adapter->pdev->dev, cpu);
4208 } else {
Alexander Duyck2d064c02008-07-08 15:10:12 -07004209 dca_rxctrl &= ~E1000_DCA_RXCTRL_CPUID_MASK_82576;
Maciej Sosnowski92be7912009-03-13 20:40:21 +00004210 dca_rxctrl |= dca3_get_tag(&adapter->pdev->dev, cpu) <<
Alexander Duyck2d064c02008-07-08 15:10:12 -07004211 E1000_DCA_RXCTRL_CPUID_SHIFT;
Alexander Duyck2d064c02008-07-08 15:10:12 -07004212 }
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004213 dca_rxctrl |= E1000_DCA_RXCTRL_DESC_DCA_EN;
4214 dca_rxctrl |= E1000_DCA_RXCTRL_HEAD_DCA_EN;
4215 dca_rxctrl |= E1000_DCA_RXCTRL_DATA_DCA_EN;
4216 wr32(E1000_DCA_RXCTRL(q), dca_rxctrl);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004217 }
Alexander Duyck047e0032009-10-27 15:49:27 +00004218 q_vector->cpu = cpu;
4219out_no_update:
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004220 put_cpu();
4221}
4222
4223static void igb_setup_dca(struct igb_adapter *adapter)
4224{
Alexander Duyck7e0e99e2009-05-21 13:06:56 +00004225 struct e1000_hw *hw = &adapter->hw;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004226 int i;
4227
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004228 if (!(adapter->flags & IGB_FLAG_DCA_ENABLED))
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004229 return;
4230
Alexander Duyck7e0e99e2009-05-21 13:06:56 +00004231 /* Always use CB2 mode, difference is masked in the CB driver. */
4232 wr32(E1000_DCA_CTRL, E1000_DCA_CTRL_DCA_MODE_CB2);
4233
Alexander Duyck047e0032009-10-27 15:49:27 +00004234 for (i = 0; i < adapter->num_q_vectors; i++) {
Alexander Duyck26b39272010-02-17 01:00:41 +00004235 adapter->q_vector[i]->cpu = -1;
4236 igb_update_dca(adapter->q_vector[i]);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004237 }
4238}
4239
4240static int __igb_notify_dca(struct device *dev, void *data)
4241{
4242 struct net_device *netdev = dev_get_drvdata(dev);
4243 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyck090b1792009-10-27 23:51:55 +00004244 struct pci_dev *pdev = adapter->pdev;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004245 struct e1000_hw *hw = &adapter->hw;
4246 unsigned long event = *(unsigned long *)data;
4247
4248 switch (event) {
4249 case DCA_PROVIDER_ADD:
4250 /* if already enabled, don't do it again */
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004251 if (adapter->flags & IGB_FLAG_DCA_ENABLED)
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004252 break;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004253 if (dca_add_requester(dev) == 0) {
Alexander Duyckbbd98fe2009-01-31 00:52:30 -08004254 adapter->flags |= IGB_FLAG_DCA_ENABLED;
Alexander Duyck090b1792009-10-27 23:51:55 +00004255 dev_info(&pdev->dev, "DCA enabled\n");
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004256 igb_setup_dca(adapter);
4257 break;
4258 }
4259 /* Fall Through since DCA is disabled. */
4260 case DCA_PROVIDER_REMOVE:
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004261 if (adapter->flags & IGB_FLAG_DCA_ENABLED) {
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004262 /* without this a class_device is left
Alexander Duyck047e0032009-10-27 15:49:27 +00004263 * hanging around in the sysfs model */
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004264 dca_remove_requester(dev);
Alexander Duyck090b1792009-10-27 23:51:55 +00004265 dev_info(&pdev->dev, "DCA disabled\n");
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004266 adapter->flags &= ~IGB_FLAG_DCA_ENABLED;
Alexander Duyckcbd347a2009-02-15 23:59:44 -08004267 wr32(E1000_DCA_CTRL, E1000_DCA_CTRL_DCA_MODE_DISABLE);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004268 }
4269 break;
4270 }
Alexander Duyckbbd98fe2009-01-31 00:52:30 -08004271
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004272 return 0;
4273}
4274
4275static int igb_notify_dca(struct notifier_block *nb, unsigned long event,
4276 void *p)
4277{
4278 int ret_val;
4279
4280 ret_val = driver_for_each_device(&igb_driver.driver, NULL, &event,
4281 __igb_notify_dca);
4282
4283 return ret_val ? NOTIFY_BAD : NOTIFY_DONE;
4284}
Jeff Kirsher421e02f2008-10-17 11:08:31 -07004285#endif /* CONFIG_IGB_DCA */
Auke Kok9d5c8242008-01-24 02:22:38 -08004286
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004287static void igb_ping_all_vfs(struct igb_adapter *adapter)
4288{
4289 struct e1000_hw *hw = &adapter->hw;
4290 u32 ping;
4291 int i;
4292
4293 for (i = 0 ; i < adapter->vfs_allocated_count; i++) {
4294 ping = E1000_PF_CONTROL_MSG;
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004295 if (adapter->vf_data[i].flags & IGB_VF_FLAG_CTS)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004296 ping |= E1000_VT_MSGTYPE_CTS;
4297 igb_write_mbx(hw, &ping, 1, i);
4298 }
4299}
4300
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004301static int igb_set_vf_promisc(struct igb_adapter *adapter, u32 *msgbuf, u32 vf)
4302{
4303 struct e1000_hw *hw = &adapter->hw;
4304 u32 vmolr = rd32(E1000_VMOLR(vf));
4305 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
4306
4307 vf_data->flags |= ~(IGB_VF_FLAG_UNI_PROMISC |
4308 IGB_VF_FLAG_MULTI_PROMISC);
4309 vmolr &= ~(E1000_VMOLR_ROPE | E1000_VMOLR_ROMPE | E1000_VMOLR_MPME);
4310
4311 if (*msgbuf & E1000_VF_SET_PROMISC_MULTICAST) {
4312 vmolr |= E1000_VMOLR_MPME;
4313 *msgbuf &= ~E1000_VF_SET_PROMISC_MULTICAST;
4314 } else {
4315 /*
4316 * if we have hashes and we are clearing a multicast promisc
4317 * flag we need to write the hashes to the MTA as this step
4318 * was previously skipped
4319 */
4320 if (vf_data->num_vf_mc_hashes > 30) {
4321 vmolr |= E1000_VMOLR_MPME;
4322 } else if (vf_data->num_vf_mc_hashes) {
4323 int j;
4324 vmolr |= E1000_VMOLR_ROMPE;
4325 for (j = 0; j < vf_data->num_vf_mc_hashes; j++)
4326 igb_mta_set(hw, vf_data->vf_mc_hashes[j]);
4327 }
4328 }
4329
4330 wr32(E1000_VMOLR(vf), vmolr);
4331
4332 /* there are flags left unprocessed, likely not supported */
4333 if (*msgbuf & E1000_VT_MSGINFO_MASK)
4334 return -EINVAL;
4335
4336 return 0;
4337
4338}
4339
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004340static int igb_set_vf_multicasts(struct igb_adapter *adapter,
4341 u32 *msgbuf, u32 vf)
4342{
4343 int n = (msgbuf[0] & E1000_VT_MSGINFO_MASK) >> E1000_VT_MSGINFO_SHIFT;
4344 u16 *hash_list = (u16 *)&msgbuf[1];
4345 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
4346 int i;
4347
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004348 /* salt away the number of multicast addresses assigned
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004349 * to this VF for later use to restore when the PF multi cast
4350 * list changes
4351 */
4352 vf_data->num_vf_mc_hashes = n;
4353
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004354 /* only up to 30 hash values supported */
4355 if (n > 30)
4356 n = 30;
4357
4358 /* store the hashes for later use */
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004359 for (i = 0; i < n; i++)
Joe Perchesa419aef2009-08-18 11:18:35 -07004360 vf_data->vf_mc_hashes[i] = hash_list[i];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004361
4362 /* Flush and reset the mta with the new values */
Alexander Duyckff41f8d2009-09-03 14:48:56 +00004363 igb_set_rx_mode(adapter->netdev);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004364
4365 return 0;
4366}
4367
4368static void igb_restore_vf_multicasts(struct igb_adapter *adapter)
4369{
4370 struct e1000_hw *hw = &adapter->hw;
4371 struct vf_data_storage *vf_data;
4372 int i, j;
4373
4374 for (i = 0; i < adapter->vfs_allocated_count; i++) {
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004375 u32 vmolr = rd32(E1000_VMOLR(i));
4376 vmolr &= ~(E1000_VMOLR_ROMPE | E1000_VMOLR_MPME);
4377
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004378 vf_data = &adapter->vf_data[i];
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004379
4380 if ((vf_data->num_vf_mc_hashes > 30) ||
4381 (vf_data->flags & IGB_VF_FLAG_MULTI_PROMISC)) {
4382 vmolr |= E1000_VMOLR_MPME;
4383 } else if (vf_data->num_vf_mc_hashes) {
4384 vmolr |= E1000_VMOLR_ROMPE;
4385 for (j = 0; j < vf_data->num_vf_mc_hashes; j++)
4386 igb_mta_set(hw, vf_data->vf_mc_hashes[j]);
4387 }
4388 wr32(E1000_VMOLR(i), vmolr);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004389 }
4390}
4391
4392static void igb_clear_vf_vfta(struct igb_adapter *adapter, u32 vf)
4393{
4394 struct e1000_hw *hw = &adapter->hw;
4395 u32 pool_mask, reg, vid;
4396 int i;
4397
4398 pool_mask = 1 << (E1000_VLVF_POOLSEL_SHIFT + vf);
4399
4400 /* Find the vlan filter for this id */
4401 for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
4402 reg = rd32(E1000_VLVF(i));
4403
4404 /* remove the vf from the pool */
4405 reg &= ~pool_mask;
4406
4407 /* if pool is empty then remove entry from vfta */
4408 if (!(reg & E1000_VLVF_POOLSEL_MASK) &&
4409 (reg & E1000_VLVF_VLANID_ENABLE)) {
4410 reg = 0;
4411 vid = reg & E1000_VLVF_VLANID_MASK;
4412 igb_vfta_set(hw, vid, false);
4413 }
4414
4415 wr32(E1000_VLVF(i), reg);
4416 }
Alexander Duyckae641bd2009-09-03 14:49:33 +00004417
4418 adapter->vf_data[vf].vlans_enabled = 0;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004419}
4420
4421static s32 igb_vlvf_set(struct igb_adapter *adapter, u32 vid, bool add, u32 vf)
4422{
4423 struct e1000_hw *hw = &adapter->hw;
4424 u32 reg, i;
4425
Alexander Duyck51466232009-10-27 23:47:35 +00004426 /* The vlvf table only exists on 82576 hardware and newer */
4427 if (hw->mac.type < e1000_82576)
4428 return -1;
4429
4430 /* we only need to do this if VMDq is enabled */
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004431 if (!adapter->vfs_allocated_count)
4432 return -1;
4433
4434 /* Find the vlan filter for this id */
4435 for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
4436 reg = rd32(E1000_VLVF(i));
4437 if ((reg & E1000_VLVF_VLANID_ENABLE) &&
4438 vid == (reg & E1000_VLVF_VLANID_MASK))
4439 break;
4440 }
4441
4442 if (add) {
4443 if (i == E1000_VLVF_ARRAY_SIZE) {
4444 /* Did not find a matching VLAN ID entry that was
4445 * enabled. Search for a free filter entry, i.e.
4446 * one without the enable bit set
4447 */
4448 for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
4449 reg = rd32(E1000_VLVF(i));
4450 if (!(reg & E1000_VLVF_VLANID_ENABLE))
4451 break;
4452 }
4453 }
4454 if (i < E1000_VLVF_ARRAY_SIZE) {
4455 /* Found an enabled/available entry */
4456 reg |= 1 << (E1000_VLVF_POOLSEL_SHIFT + vf);
4457
4458 /* if !enabled we need to set this up in vfta */
4459 if (!(reg & E1000_VLVF_VLANID_ENABLE)) {
Alexander Duyck51466232009-10-27 23:47:35 +00004460 /* add VID to filter table */
4461 igb_vfta_set(hw, vid, true);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004462 reg |= E1000_VLVF_VLANID_ENABLE;
4463 }
Alexander Duyckcad6d052009-03-13 20:41:37 +00004464 reg &= ~E1000_VLVF_VLANID_MASK;
4465 reg |= vid;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004466 wr32(E1000_VLVF(i), reg);
Alexander Duyckae641bd2009-09-03 14:49:33 +00004467
4468 /* do not modify RLPML for PF devices */
4469 if (vf >= adapter->vfs_allocated_count)
4470 return 0;
4471
4472 if (!adapter->vf_data[vf].vlans_enabled) {
4473 u32 size;
4474 reg = rd32(E1000_VMOLR(vf));
4475 size = reg & E1000_VMOLR_RLPML_MASK;
4476 size += 4;
4477 reg &= ~E1000_VMOLR_RLPML_MASK;
4478 reg |= size;
4479 wr32(E1000_VMOLR(vf), reg);
4480 }
Alexander Duyckae641bd2009-09-03 14:49:33 +00004481
Alexander Duyck51466232009-10-27 23:47:35 +00004482 adapter->vf_data[vf].vlans_enabled++;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004483 return 0;
4484 }
4485 } else {
4486 if (i < E1000_VLVF_ARRAY_SIZE) {
4487 /* remove vf from the pool */
4488 reg &= ~(1 << (E1000_VLVF_POOLSEL_SHIFT + vf));
4489 /* if pool is empty then remove entry from vfta */
4490 if (!(reg & E1000_VLVF_POOLSEL_MASK)) {
4491 reg = 0;
4492 igb_vfta_set(hw, vid, false);
4493 }
4494 wr32(E1000_VLVF(i), reg);
Alexander Duyckae641bd2009-09-03 14:49:33 +00004495
4496 /* do not modify RLPML for PF devices */
4497 if (vf >= adapter->vfs_allocated_count)
4498 return 0;
4499
4500 adapter->vf_data[vf].vlans_enabled--;
4501 if (!adapter->vf_data[vf].vlans_enabled) {
4502 u32 size;
4503 reg = rd32(E1000_VMOLR(vf));
4504 size = reg & E1000_VMOLR_RLPML_MASK;
4505 size -= 4;
4506 reg &= ~E1000_VMOLR_RLPML_MASK;
4507 reg |= size;
4508 wr32(E1000_VMOLR(vf), reg);
4509 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004510 }
4511 }
Williams, Mitch A8151d292010-02-10 01:44:24 +00004512 return 0;
4513}
4514
4515static void igb_set_vmvir(struct igb_adapter *adapter, u32 vid, u32 vf)
4516{
4517 struct e1000_hw *hw = &adapter->hw;
4518
4519 if (vid)
4520 wr32(E1000_VMVIR(vf), (vid | E1000_VMVIR_VLANA_DEFAULT));
4521 else
4522 wr32(E1000_VMVIR(vf), 0);
4523}
4524
4525static int igb_ndo_set_vf_vlan(struct net_device *netdev,
4526 int vf, u16 vlan, u8 qos)
4527{
4528 int err = 0;
4529 struct igb_adapter *adapter = netdev_priv(netdev);
4530
4531 if ((vf >= adapter->vfs_allocated_count) || (vlan > 4095) || (qos > 7))
4532 return -EINVAL;
4533 if (vlan || qos) {
4534 err = igb_vlvf_set(adapter, vlan, !!vlan, vf);
4535 if (err)
4536 goto out;
4537 igb_set_vmvir(adapter, vlan | (qos << VLAN_PRIO_SHIFT), vf);
4538 igb_set_vmolr(adapter, vf, !vlan);
4539 adapter->vf_data[vf].pf_vlan = vlan;
4540 adapter->vf_data[vf].pf_qos = qos;
4541 dev_info(&adapter->pdev->dev,
4542 "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
4543 if (test_bit(__IGB_DOWN, &adapter->state)) {
4544 dev_warn(&adapter->pdev->dev,
4545 "The VF VLAN has been set,"
4546 " but the PF device is not up.\n");
4547 dev_warn(&adapter->pdev->dev,
4548 "Bring the PF device up before"
4549 " attempting to use the VF device.\n");
4550 }
4551 } else {
4552 igb_vlvf_set(adapter, adapter->vf_data[vf].pf_vlan,
4553 false, vf);
4554 igb_set_vmvir(adapter, vlan, vf);
4555 igb_set_vmolr(adapter, vf, true);
4556 adapter->vf_data[vf].pf_vlan = 0;
4557 adapter->vf_data[vf].pf_qos = 0;
4558 }
4559out:
4560 return err;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004561}
4562
4563static int igb_set_vf_vlan(struct igb_adapter *adapter, u32 *msgbuf, u32 vf)
4564{
4565 int add = (msgbuf[0] & E1000_VT_MSGINFO_MASK) >> E1000_VT_MSGINFO_SHIFT;
4566 int vid = (msgbuf[1] & E1000_VLVF_VLANID_MASK);
4567
4568 return igb_vlvf_set(adapter, vid, add, vf);
4569}
4570
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004571static inline void igb_vf_reset(struct igb_adapter *adapter, u32 vf)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004572{
Williams, Mitch A8151d292010-02-10 01:44:24 +00004573 /* clear flags */
4574 adapter->vf_data[vf].flags &= ~(IGB_VF_FLAG_PF_SET_MAC);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004575 adapter->vf_data[vf].last_nack = jiffies;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004576
4577 /* reset offloads to defaults */
Williams, Mitch A8151d292010-02-10 01:44:24 +00004578 igb_set_vmolr(adapter, vf, true);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004579
4580 /* reset vlans for device */
4581 igb_clear_vf_vfta(adapter, vf);
Williams, Mitch A8151d292010-02-10 01:44:24 +00004582 if (adapter->vf_data[vf].pf_vlan)
4583 igb_ndo_set_vf_vlan(adapter->netdev, vf,
4584 adapter->vf_data[vf].pf_vlan,
4585 adapter->vf_data[vf].pf_qos);
4586 else
4587 igb_clear_vf_vfta(adapter, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004588
4589 /* reset multicast table array for vf */
4590 adapter->vf_data[vf].num_vf_mc_hashes = 0;
4591
4592 /* Flush and reset the mta with the new values */
Alexander Duyckff41f8d2009-09-03 14:48:56 +00004593 igb_set_rx_mode(adapter->netdev);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004594}
4595
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004596static void igb_vf_reset_event(struct igb_adapter *adapter, u32 vf)
4597{
4598 unsigned char *vf_mac = adapter->vf_data[vf].vf_mac_addresses;
4599
4600 /* generate a new mac address as we were hotplug removed/added */
Williams, Mitch A8151d292010-02-10 01:44:24 +00004601 if (!(adapter->vf_data[vf].flags & IGB_VF_FLAG_PF_SET_MAC))
4602 random_ether_addr(vf_mac);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004603
4604 /* process remaining reset events */
4605 igb_vf_reset(adapter, vf);
4606}
4607
4608static void igb_vf_reset_msg(struct igb_adapter *adapter, u32 vf)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004609{
4610 struct e1000_hw *hw = &adapter->hw;
4611 unsigned char *vf_mac = adapter->vf_data[vf].vf_mac_addresses;
Alexander Duyckff41f8d2009-09-03 14:48:56 +00004612 int rar_entry = hw->mac.rar_entry_count - (vf + 1);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004613 u32 reg, msgbuf[3];
4614 u8 *addr = (u8 *)(&msgbuf[1]);
4615
4616 /* process all the same items cleared in a function level reset */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004617 igb_vf_reset(adapter, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004618
4619 /* set vf mac address */
Alexander Duyck26ad9172009-10-05 06:32:49 +00004620 igb_rar_set_qsel(adapter, vf_mac, rar_entry, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004621
4622 /* enable transmit and receive for vf */
4623 reg = rd32(E1000_VFTE);
4624 wr32(E1000_VFTE, reg | (1 << vf));
4625 reg = rd32(E1000_VFRE);
4626 wr32(E1000_VFRE, reg | (1 << vf));
4627
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004628 adapter->vf_data[vf].flags = IGB_VF_FLAG_CTS;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004629
4630 /* reply to reset with ack and vf mac address */
4631 msgbuf[0] = E1000_VF_RESET | E1000_VT_MSGTYPE_ACK;
4632 memcpy(addr, vf_mac, 6);
4633 igb_write_mbx(hw, msgbuf, 3, vf);
4634}
4635
4636static int igb_set_vf_mac_addr(struct igb_adapter *adapter, u32 *msg, int vf)
4637{
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004638 unsigned char *addr = (char *)&msg[1];
4639 int err = -1;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004640
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004641 if (is_valid_ether_addr(addr))
4642 err = igb_set_vf_mac(adapter, vf, addr);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004643
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004644 return err;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004645}
4646
4647static void igb_rcv_ack_from_vf(struct igb_adapter *adapter, u32 vf)
4648{
4649 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004650 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004651 u32 msg = E1000_VT_MSGTYPE_NACK;
4652
4653 /* if device isn't clear to send it shouldn't be reading either */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004654 if (!(vf_data->flags & IGB_VF_FLAG_CTS) &&
4655 time_after(jiffies, vf_data->last_nack + (2 * HZ))) {
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004656 igb_write_mbx(hw, &msg, 1, vf);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004657 vf_data->last_nack = jiffies;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004658 }
4659}
4660
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004661static void igb_rcv_msg_from_vf(struct igb_adapter *adapter, u32 vf)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004662{
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004663 struct pci_dev *pdev = adapter->pdev;
4664 u32 msgbuf[E1000_VFMAILBOX_SIZE];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004665 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004666 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004667 s32 retval;
4668
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004669 retval = igb_read_mbx(hw, msgbuf, E1000_VFMAILBOX_SIZE, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004670
Alexander Duyckfef45f42009-12-11 22:57:34 -08004671 if (retval) {
4672 /* if receive failed revoke VF CTS stats and restart init */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004673 dev_err(&pdev->dev, "Error receiving message from VF\n");
Alexander Duyckfef45f42009-12-11 22:57:34 -08004674 vf_data->flags &= ~IGB_VF_FLAG_CTS;
4675 if (!time_after(jiffies, vf_data->last_nack + (2 * HZ)))
4676 return;
4677 goto out;
4678 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004679
4680 /* this is a message we already processed, do nothing */
4681 if (msgbuf[0] & (E1000_VT_MSGTYPE_ACK | E1000_VT_MSGTYPE_NACK))
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004682 return;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004683
4684 /*
4685 * until the vf completes a reset it should not be
4686 * allowed to start any configuration.
4687 */
4688
4689 if (msgbuf[0] == E1000_VF_RESET) {
4690 igb_vf_reset_msg(adapter, vf);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004691 return;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004692 }
4693
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004694 if (!(vf_data->flags & IGB_VF_FLAG_CTS)) {
Alexander Duyckfef45f42009-12-11 22:57:34 -08004695 if (!time_after(jiffies, vf_data->last_nack + (2 * HZ)))
4696 return;
4697 retval = -1;
4698 goto out;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004699 }
4700
4701 switch ((msgbuf[0] & 0xFFFF)) {
4702 case E1000_VF_SET_MAC_ADDR:
4703 retval = igb_set_vf_mac_addr(adapter, msgbuf, vf);
4704 break;
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004705 case E1000_VF_SET_PROMISC:
4706 retval = igb_set_vf_promisc(adapter, msgbuf, vf);
4707 break;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004708 case E1000_VF_SET_MULTICAST:
4709 retval = igb_set_vf_multicasts(adapter, msgbuf, vf);
4710 break;
4711 case E1000_VF_SET_LPE:
4712 retval = igb_set_vf_rlpml(adapter, msgbuf[1], vf);
4713 break;
4714 case E1000_VF_SET_VLAN:
Williams, Mitch A8151d292010-02-10 01:44:24 +00004715 if (adapter->vf_data[vf].pf_vlan)
4716 retval = -1;
4717 else
4718 retval = igb_set_vf_vlan(adapter, msgbuf, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004719 break;
4720 default:
Alexander Duyck090b1792009-10-27 23:51:55 +00004721 dev_err(&pdev->dev, "Unhandled Msg %08x\n", msgbuf[0]);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004722 retval = -1;
4723 break;
4724 }
4725
Alexander Duyckfef45f42009-12-11 22:57:34 -08004726 msgbuf[0] |= E1000_VT_MSGTYPE_CTS;
4727out:
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004728 /* notify the VF of the results of what it sent us */
4729 if (retval)
4730 msgbuf[0] |= E1000_VT_MSGTYPE_NACK;
4731 else
4732 msgbuf[0] |= E1000_VT_MSGTYPE_ACK;
4733
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004734 igb_write_mbx(hw, msgbuf, 1, vf);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004735}
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004736
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004737static void igb_msg_task(struct igb_adapter *adapter)
4738{
4739 struct e1000_hw *hw = &adapter->hw;
4740 u32 vf;
4741
4742 for (vf = 0; vf < adapter->vfs_allocated_count; vf++) {
4743 /* process any reset requests */
4744 if (!igb_check_for_rst(hw, vf))
4745 igb_vf_reset_event(adapter, vf);
4746
4747 /* process any messages pending */
4748 if (!igb_check_for_msg(hw, vf))
4749 igb_rcv_msg_from_vf(adapter, vf);
4750
4751 /* process any acks */
4752 if (!igb_check_for_ack(hw, vf))
4753 igb_rcv_ack_from_vf(adapter, vf);
4754 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004755}
4756
Auke Kok9d5c8242008-01-24 02:22:38 -08004757/**
Alexander Duyck68d480c2009-10-05 06:33:08 +00004758 * igb_set_uta - Set unicast filter table address
4759 * @adapter: board private structure
4760 *
4761 * The unicast table address is a register array of 32-bit registers.
4762 * The table is meant to be used in a way similar to how the MTA is used
4763 * however due to certain limitations in the hardware it is necessary to
4764 * set all the hash bits to 1 and use the VMOLR ROPE bit as a promiscous
4765 * enable bit to allow vlan tag stripping when promiscous mode is enabled
4766 **/
4767static void igb_set_uta(struct igb_adapter *adapter)
4768{
4769 struct e1000_hw *hw = &adapter->hw;
4770 int i;
4771
4772 /* The UTA table only exists on 82576 hardware and newer */
4773 if (hw->mac.type < e1000_82576)
4774 return;
4775
4776 /* we only need to do this if VMDq is enabled */
4777 if (!adapter->vfs_allocated_count)
4778 return;
4779
4780 for (i = 0; i < hw->mac.uta_reg_count; i++)
4781 array_wr32(E1000_UTA, i, ~0);
4782}
4783
4784/**
Auke Kok9d5c8242008-01-24 02:22:38 -08004785 * igb_intr_msi - Interrupt Handler
4786 * @irq: interrupt number
4787 * @data: pointer to a network interface device structure
4788 **/
4789static irqreturn_t igb_intr_msi(int irq, void *data)
4790{
Alexander Duyck047e0032009-10-27 15:49:27 +00004791 struct igb_adapter *adapter = data;
4792 struct igb_q_vector *q_vector = adapter->q_vector[0];
Auke Kok9d5c8242008-01-24 02:22:38 -08004793 struct e1000_hw *hw = &adapter->hw;
4794 /* read ICR disables interrupts using IAM */
4795 u32 icr = rd32(E1000_ICR);
4796
Alexander Duyck047e0032009-10-27 15:49:27 +00004797 igb_write_itr(q_vector);
Auke Kok9d5c8242008-01-24 02:22:38 -08004798
Alexander Duyck7f081d42010-01-07 17:41:00 +00004799 if (icr & E1000_ICR_DRSTA)
4800 schedule_work(&adapter->reset_task);
4801
Alexander Duyck047e0032009-10-27 15:49:27 +00004802 if (icr & E1000_ICR_DOUTSYNC) {
Alexander Duyckdda0e082009-02-06 23:19:08 +00004803 /* HW is reporting DMA is out of sync */
4804 adapter->stats.doosync++;
4805 }
4806
Auke Kok9d5c8242008-01-24 02:22:38 -08004807 if (icr & (E1000_ICR_RXSEQ | E1000_ICR_LSC)) {
4808 hw->mac.get_link_status = 1;
4809 if (!test_bit(__IGB_DOWN, &adapter->state))
4810 mod_timer(&adapter->watchdog_timer, jiffies + 1);
4811 }
4812
Alexander Duyck047e0032009-10-27 15:49:27 +00004813 napi_schedule(&q_vector->napi);
Auke Kok9d5c8242008-01-24 02:22:38 -08004814
4815 return IRQ_HANDLED;
4816}
4817
4818/**
Alexander Duyck4a3c6432009-02-06 23:20:49 +00004819 * igb_intr - Legacy Interrupt Handler
Auke Kok9d5c8242008-01-24 02:22:38 -08004820 * @irq: interrupt number
4821 * @data: pointer to a network interface device structure
4822 **/
4823static irqreturn_t igb_intr(int irq, void *data)
4824{
Alexander Duyck047e0032009-10-27 15:49:27 +00004825 struct igb_adapter *adapter = data;
4826 struct igb_q_vector *q_vector = adapter->q_vector[0];
Auke Kok9d5c8242008-01-24 02:22:38 -08004827 struct e1000_hw *hw = &adapter->hw;
4828 /* Interrupt Auto-Mask...upon reading ICR, interrupts are masked. No
4829 * need for the IMC write */
4830 u32 icr = rd32(E1000_ICR);
Auke Kok9d5c8242008-01-24 02:22:38 -08004831 if (!icr)
4832 return IRQ_NONE; /* Not our interrupt */
4833
Alexander Duyck047e0032009-10-27 15:49:27 +00004834 igb_write_itr(q_vector);
Auke Kok9d5c8242008-01-24 02:22:38 -08004835
4836 /* IMS will not auto-mask if INT_ASSERTED is not set, and if it is
4837 * not set, then the adapter didn't send an interrupt */
4838 if (!(icr & E1000_ICR_INT_ASSERTED))
4839 return IRQ_NONE;
4840
Alexander Duyck7f081d42010-01-07 17:41:00 +00004841 if (icr & E1000_ICR_DRSTA)
4842 schedule_work(&adapter->reset_task);
4843
Alexander Duyck047e0032009-10-27 15:49:27 +00004844 if (icr & E1000_ICR_DOUTSYNC) {
Alexander Duyckdda0e082009-02-06 23:19:08 +00004845 /* HW is reporting DMA is out of sync */
4846 adapter->stats.doosync++;
4847 }
4848
Auke Kok9d5c8242008-01-24 02:22:38 -08004849 if (icr & (E1000_ICR_RXSEQ | E1000_ICR_LSC)) {
4850 hw->mac.get_link_status = 1;
4851 /* guard against interrupt when we're going down */
4852 if (!test_bit(__IGB_DOWN, &adapter->state))
4853 mod_timer(&adapter->watchdog_timer, jiffies + 1);
4854 }
4855
Alexander Duyck047e0032009-10-27 15:49:27 +00004856 napi_schedule(&q_vector->napi);
Auke Kok9d5c8242008-01-24 02:22:38 -08004857
4858 return IRQ_HANDLED;
4859}
4860
Alexander Duyck047e0032009-10-27 15:49:27 +00004861static inline void igb_ring_irq_enable(struct igb_q_vector *q_vector)
Alexander Duyck46544252009-02-19 20:39:04 -08004862{
Alexander Duyck047e0032009-10-27 15:49:27 +00004863 struct igb_adapter *adapter = q_vector->adapter;
Alexander Duyck46544252009-02-19 20:39:04 -08004864 struct e1000_hw *hw = &adapter->hw;
4865
Alexander Duyck4fc82ad2009-10-27 23:45:42 +00004866 if ((q_vector->rx_ring && (adapter->rx_itr_setting & 3)) ||
4867 (!q_vector->rx_ring && (adapter->tx_itr_setting & 3))) {
Alexander Duyck047e0032009-10-27 15:49:27 +00004868 if (!adapter->msix_entries)
Alexander Duyck46544252009-02-19 20:39:04 -08004869 igb_set_itr(adapter);
4870 else
Alexander Duyck047e0032009-10-27 15:49:27 +00004871 igb_update_ring_itr(q_vector);
Alexander Duyck46544252009-02-19 20:39:04 -08004872 }
4873
4874 if (!test_bit(__IGB_DOWN, &adapter->state)) {
4875 if (adapter->msix_entries)
Alexander Duyck047e0032009-10-27 15:49:27 +00004876 wr32(E1000_EIMS, q_vector->eims_value);
Alexander Duyck46544252009-02-19 20:39:04 -08004877 else
4878 igb_irq_enable(adapter);
4879 }
4880}
4881
Auke Kok9d5c8242008-01-24 02:22:38 -08004882/**
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004883 * igb_poll - NAPI Rx polling callback
4884 * @napi: napi polling structure
4885 * @budget: count of how many packets we should handle
Auke Kok9d5c8242008-01-24 02:22:38 -08004886 **/
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004887static int igb_poll(struct napi_struct *napi, int budget)
Auke Kok9d5c8242008-01-24 02:22:38 -08004888{
Alexander Duyck047e0032009-10-27 15:49:27 +00004889 struct igb_q_vector *q_vector = container_of(napi,
4890 struct igb_q_vector,
4891 napi);
4892 int tx_clean_complete = 1, work_done = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08004893
Jeff Kirsher421e02f2008-10-17 11:08:31 -07004894#ifdef CONFIG_IGB_DCA
Alexander Duyck047e0032009-10-27 15:49:27 +00004895 if (q_vector->adapter->flags & IGB_FLAG_DCA_ENABLED)
4896 igb_update_dca(q_vector);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004897#endif
Alexander Duyck047e0032009-10-27 15:49:27 +00004898 if (q_vector->tx_ring)
4899 tx_clean_complete = igb_clean_tx_irq(q_vector);
Auke Kok9d5c8242008-01-24 02:22:38 -08004900
Alexander Duyck047e0032009-10-27 15:49:27 +00004901 if (q_vector->rx_ring)
4902 igb_clean_rx_irq_adv(q_vector, &work_done, budget);
4903
4904 if (!tx_clean_complete)
4905 work_done = budget;
Auke Kok9d5c8242008-01-24 02:22:38 -08004906
Alexander Duyck46544252009-02-19 20:39:04 -08004907 /* If not enough Rx work done, exit the polling mode */
Alexander Duyck5e6d5b12009-03-13 20:40:38 +00004908 if (work_done < budget) {
Alexander Duyck46544252009-02-19 20:39:04 -08004909 napi_complete(napi);
Alexander Duyck047e0032009-10-27 15:49:27 +00004910 igb_ring_irq_enable(q_vector);
Alexander Duyck46544252009-02-19 20:39:04 -08004911 }
4912
4913 return work_done;
Auke Kok9d5c8242008-01-24 02:22:38 -08004914}
Al Viro6d8126f2008-03-16 22:23:24 +00004915
Auke Kok9d5c8242008-01-24 02:22:38 -08004916/**
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004917 * igb_systim_to_hwtstamp - convert system time value to hw timestamp
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004918 * @adapter: board private structure
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004919 * @shhwtstamps: timestamp structure to update
4920 * @regval: unsigned 64bit system time value.
4921 *
4922 * We need to convert the system time value stored in the RX/TXSTMP registers
4923 * into a hwtstamp which can be used by the upper level timestamping functions
4924 */
4925static void igb_systim_to_hwtstamp(struct igb_adapter *adapter,
4926 struct skb_shared_hwtstamps *shhwtstamps,
4927 u64 regval)
4928{
4929 u64 ns;
4930
Alexander Duyck55cac242009-11-19 12:42:21 +00004931 /*
4932 * The 82580 starts with 1ns at bit 0 in RX/TXSTMPL, shift this up to
4933 * 24 to match clock shift we setup earlier.
4934 */
4935 if (adapter->hw.mac.type == e1000_82580)
4936 regval <<= IGB_82580_TSYNC_SHIFT;
4937
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004938 ns = timecounter_cyc2time(&adapter->clock, regval);
4939 timecompare_update(&adapter->compare, ns);
4940 memset(shhwtstamps, 0, sizeof(struct skb_shared_hwtstamps));
4941 shhwtstamps->hwtstamp = ns_to_ktime(ns);
4942 shhwtstamps->syststamp = timecompare_transform(&adapter->compare, ns);
4943}
4944
4945/**
4946 * igb_tx_hwtstamp - utility function which checks for TX time stamp
4947 * @q_vector: pointer to q_vector containing needed info
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004948 * @skb: packet that was just sent
4949 *
4950 * If we were asked to do hardware stamping and such a time stamp is
4951 * available, then it must have been for this skb here because we only
4952 * allow only one such packet into the queue.
4953 */
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004954static void igb_tx_hwtstamp(struct igb_q_vector *q_vector, struct sk_buff *skb)
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004955{
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004956 struct igb_adapter *adapter = q_vector->adapter;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004957 union skb_shared_tx *shtx = skb_tx(skb);
4958 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004959 struct skb_shared_hwtstamps shhwtstamps;
4960 u64 regval;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004961
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004962 /* if skb does not support hw timestamp or TX stamp not valid exit */
4963 if (likely(!shtx->hardware) ||
4964 !(rd32(E1000_TSYNCTXCTL) & E1000_TSYNCTXCTL_VALID))
4965 return;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004966
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004967 regval = rd32(E1000_TXSTMPL);
4968 regval |= (u64)rd32(E1000_TXSTMPH) << 32;
4969
4970 igb_systim_to_hwtstamp(adapter, &shhwtstamps, regval);
4971 skb_tstamp_tx(skb, &shhwtstamps);
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004972}
4973
4974/**
Auke Kok9d5c8242008-01-24 02:22:38 -08004975 * igb_clean_tx_irq - Reclaim resources after transmit completes
Alexander Duyck047e0032009-10-27 15:49:27 +00004976 * @q_vector: pointer to q_vector containing needed info
Auke Kok9d5c8242008-01-24 02:22:38 -08004977 * returns true if ring is completely cleaned
4978 **/
Alexander Duyck047e0032009-10-27 15:49:27 +00004979static bool igb_clean_tx_irq(struct igb_q_vector *q_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -08004980{
Alexander Duyck047e0032009-10-27 15:49:27 +00004981 struct igb_adapter *adapter = q_vector->adapter;
4982 struct igb_ring *tx_ring = q_vector->tx_ring;
Alexander Duycke694e962009-10-27 15:53:06 +00004983 struct net_device *netdev = tx_ring->netdev;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08004984 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08004985 struct igb_buffer *buffer_info;
4986 struct sk_buff *skb;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08004987 union e1000_adv_tx_desc *tx_desc, *eop_desc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004988 unsigned int total_bytes = 0, total_packets = 0;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08004989 unsigned int i, eop, count = 0;
4990 bool cleaned = false;
Auke Kok9d5c8242008-01-24 02:22:38 -08004991
Auke Kok9d5c8242008-01-24 02:22:38 -08004992 i = tx_ring->next_to_clean;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08004993 eop = tx_ring->buffer_info[i].next_to_watch;
4994 eop_desc = E1000_TX_DESC_ADV(*tx_ring, eop);
4995
4996 while ((eop_desc->wb.status & cpu_to_le32(E1000_TXD_STAT_DD)) &&
4997 (count < tx_ring->count)) {
4998 for (cleaned = false; !cleaned; count++) {
4999 tx_desc = E1000_TX_DESC_ADV(*tx_ring, i);
Auke Kok9d5c8242008-01-24 02:22:38 -08005000 buffer_info = &tx_ring->buffer_info[i];
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005001 cleaned = (i == eop);
Auke Kok9d5c8242008-01-24 02:22:38 -08005002 skb = buffer_info->skb;
5003
5004 if (skb) {
5005 unsigned int segs, bytecount;
5006 /* gso_segs is currently only valid for tcp */
Nick Nunley40e90c22010-02-17 01:04:37 +00005007 segs = buffer_info->gso_segs;
Auke Kok9d5c8242008-01-24 02:22:38 -08005008 /* multiply data chunks by size of headers */
5009 bytecount = ((segs - 1) * skb_headlen(skb)) +
5010 skb->len;
5011 total_packets += segs;
5012 total_bytes += bytecount;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005013
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005014 igb_tx_hwtstamp(q_vector, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005015 }
5016
Alexander Duyck80785292009-10-27 15:51:47 +00005017 igb_unmap_and_free_tx_resource(tx_ring, buffer_info);
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005018 tx_desc->wb.status = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08005019
5020 i++;
5021 if (i == tx_ring->count)
5022 i = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08005023 }
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005024 eop = tx_ring->buffer_info[i].next_to_watch;
5025 eop_desc = E1000_TX_DESC_ADV(*tx_ring, eop);
5026 }
5027
Auke Kok9d5c8242008-01-24 02:22:38 -08005028 tx_ring->next_to_clean = i;
5029
Alexander Duyckfc7d3452008-08-26 04:25:08 -07005030 if (unlikely(count &&
Auke Kok9d5c8242008-01-24 02:22:38 -08005031 netif_carrier_ok(netdev) &&
Alexander Duyckc493ea42009-03-20 00:16:50 +00005032 igb_desc_unused(tx_ring) >= IGB_TX_QUEUE_WAKE)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005033 /* Make sure that anybody stopping the queue after this
5034 * sees the new next_to_clean.
5035 */
5036 smp_mb();
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07005037 if (__netif_subqueue_stopped(netdev, tx_ring->queue_index) &&
5038 !(test_bit(__IGB_DOWN, &adapter->state))) {
5039 netif_wake_subqueue(netdev, tx_ring->queue_index);
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005040 tx_ring->tx_stats.restart_queue++;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07005041 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005042 }
5043
5044 if (tx_ring->detect_tx_hung) {
5045 /* Detect a transmit hang in hardware, this serializes the
5046 * check with the clearing of time_stamp and movement of i */
5047 tx_ring->detect_tx_hung = false;
5048 if (tx_ring->buffer_info[i].time_stamp &&
5049 time_after(jiffies, tx_ring->buffer_info[i].time_stamp +
Joe Perches8e95a202009-12-03 07:58:21 +00005050 (adapter->tx_timeout_factor * HZ)) &&
5051 !(rd32(E1000_STATUS) & E1000_STATUS_TXOFF)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005052
Auke Kok9d5c8242008-01-24 02:22:38 -08005053 /* detected Tx unit hang */
Alexander Duyck80785292009-10-27 15:51:47 +00005054 dev_err(&tx_ring->pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08005055 "Detected Tx Unit Hang\n"
Alexander Duyck2d064c02008-07-08 15:10:12 -07005056 " Tx Queue <%d>\n"
Auke Kok9d5c8242008-01-24 02:22:38 -08005057 " TDH <%x>\n"
5058 " TDT <%x>\n"
5059 " next_to_use <%x>\n"
5060 " next_to_clean <%x>\n"
Auke Kok9d5c8242008-01-24 02:22:38 -08005061 "buffer_info[next_to_clean]\n"
5062 " time_stamp <%lx>\n"
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005063 " next_to_watch <%x>\n"
Auke Kok9d5c8242008-01-24 02:22:38 -08005064 " jiffies <%lx>\n"
5065 " desc.status <%x>\n",
Alexander Duyck2d064c02008-07-08 15:10:12 -07005066 tx_ring->queue_index,
Alexander Duyckfce99e32009-10-27 15:51:27 +00005067 readl(tx_ring->head),
5068 readl(tx_ring->tail),
Auke Kok9d5c8242008-01-24 02:22:38 -08005069 tx_ring->next_to_use,
5070 tx_ring->next_to_clean,
Alexander Duyckf7ba2052009-10-27 23:48:51 +00005071 tx_ring->buffer_info[eop].time_stamp,
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005072 eop,
Auke Kok9d5c8242008-01-24 02:22:38 -08005073 jiffies,
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005074 eop_desc->wb.status);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07005075 netif_stop_subqueue(netdev, tx_ring->queue_index);
Auke Kok9d5c8242008-01-24 02:22:38 -08005076 }
5077 }
5078 tx_ring->total_bytes += total_bytes;
5079 tx_ring->total_packets += total_packets;
Alexander Duycke21ed352008-07-08 15:07:24 -07005080 tx_ring->tx_stats.bytes += total_bytes;
5081 tx_ring->tx_stats.packets += total_packets;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005082 return (count < tx_ring->count);
Auke Kok9d5c8242008-01-24 02:22:38 -08005083}
5084
Auke Kok9d5c8242008-01-24 02:22:38 -08005085/**
5086 * igb_receive_skb - helper function to handle rx indications
Alexander Duyck047e0032009-10-27 15:49:27 +00005087 * @q_vector: structure containing interrupt and ring information
5088 * @skb: packet to send up
5089 * @vlan_tag: vlan tag for packet
Auke Kok9d5c8242008-01-24 02:22:38 -08005090 **/
Alexander Duyck047e0032009-10-27 15:49:27 +00005091static void igb_receive_skb(struct igb_q_vector *q_vector,
5092 struct sk_buff *skb,
5093 u16 vlan_tag)
Auke Kok9d5c8242008-01-24 02:22:38 -08005094{
Alexander Duyck047e0032009-10-27 15:49:27 +00005095 struct igb_adapter *adapter = q_vector->adapter;
Alexander Duyckd3352522008-07-08 15:12:13 -07005096
Alexander Duyck047e0032009-10-27 15:49:27 +00005097 if (vlan_tag)
5098 vlan_gro_receive(&q_vector->napi, adapter->vlgrp,
5099 vlan_tag, skb);
Alexander Duyck182ff8d2009-04-27 22:35:33 +00005100 else
Alexander Duyck047e0032009-10-27 15:49:27 +00005101 napi_gro_receive(&q_vector->napi, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005102}
5103
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005104static inline void igb_rx_checksum_adv(struct igb_ring *ring,
Auke Kok9d5c8242008-01-24 02:22:38 -08005105 u32 status_err, struct sk_buff *skb)
5106{
5107 skb->ip_summed = CHECKSUM_NONE;
5108
5109 /* Ignore Checksum bit is set or checksum is disabled through ethtool */
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005110 if (!(ring->flags & IGB_RING_FLAG_RX_CSUM) ||
5111 (status_err & E1000_RXD_STAT_IXSM))
Auke Kok9d5c8242008-01-24 02:22:38 -08005112 return;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005113
Auke Kok9d5c8242008-01-24 02:22:38 -08005114 /* TCP/UDP checksum error bit is set */
5115 if (status_err &
5116 (E1000_RXDEXT_STATERR_TCPE | E1000_RXDEXT_STATERR_IPE)) {
Jesse Brandeburgb9473562009-04-27 22:36:13 +00005117 /*
5118 * work around errata with sctp packets where the TCPE aka
5119 * L4E bit is set incorrectly on 64 byte (60 byte w/o crc)
5120 * packets, (aka let the stack check the crc32c)
5121 */
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005122 if ((skb->len == 60) &&
5123 (ring->flags & IGB_RING_FLAG_RX_SCTP_CSUM))
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005124 ring->rx_stats.csum_err++;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005125
Auke Kok9d5c8242008-01-24 02:22:38 -08005126 /* let the stack verify checksum errors */
Auke Kok9d5c8242008-01-24 02:22:38 -08005127 return;
5128 }
5129 /* It must be a TCP or UDP packet with a valid checksum */
5130 if (status_err & (E1000_RXD_STAT_TCPCS | E1000_RXD_STAT_UDPCS))
5131 skb->ip_summed = CHECKSUM_UNNECESSARY;
5132
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005133 dev_dbg(&ring->pdev->dev, "cksum success: bits %08X\n", status_err);
Auke Kok9d5c8242008-01-24 02:22:38 -08005134}
5135
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005136static inline void igb_rx_hwtstamp(struct igb_q_vector *q_vector, u32 staterr,
5137 struct sk_buff *skb)
5138{
5139 struct igb_adapter *adapter = q_vector->adapter;
5140 struct e1000_hw *hw = &adapter->hw;
5141 u64 regval;
5142
5143 /*
5144 * If this bit is set, then the RX registers contain the time stamp. No
5145 * other packet will be time stamped until we read these registers, so
5146 * read the registers to make them available again. Because only one
5147 * packet can be time stamped at a time, we know that the register
5148 * values must belong to this one here and therefore we don't need to
5149 * compare any of the additional attributes stored for it.
5150 *
5151 * If nothing went wrong, then it should have a skb_shared_tx that we
5152 * can turn into a skb_shared_hwtstamps.
5153 */
5154 if (likely(!(staterr & E1000_RXDADV_STAT_TS)))
5155 return;
5156 if (!(rd32(E1000_TSYNCRXCTL) & E1000_TSYNCRXCTL_VALID))
5157 return;
5158
5159 regval = rd32(E1000_RXSTMPL);
5160 regval |= (u64)rd32(E1000_RXSTMPH) << 32;
5161
5162 igb_systim_to_hwtstamp(adapter, skb_hwtstamps(skb), regval);
5163}
Alexander Duyck4c844852009-10-27 15:52:07 +00005164static inline u16 igb_get_hlen(struct igb_ring *rx_ring,
Alexander Duyck2d94d8a2009-07-23 18:10:06 +00005165 union e1000_adv_rx_desc *rx_desc)
5166{
5167 /* HW will not DMA in data larger than the given buffer, even if it
5168 * parses the (NFS, of course) header to be larger. In that case, it
5169 * fills the header buffer and spills the rest into the page.
5170 */
5171 u16 hlen = (le16_to_cpu(rx_desc->wb.lower.lo_dword.hdr_info) &
5172 E1000_RXDADV_HDRBUFLEN_MASK) >> E1000_RXDADV_HDRBUFLEN_SHIFT;
Alexander Duyck4c844852009-10-27 15:52:07 +00005173 if (hlen > rx_ring->rx_buffer_len)
5174 hlen = rx_ring->rx_buffer_len;
Alexander Duyck2d94d8a2009-07-23 18:10:06 +00005175 return hlen;
5176}
5177
Alexander Duyck047e0032009-10-27 15:49:27 +00005178static bool igb_clean_rx_irq_adv(struct igb_q_vector *q_vector,
5179 int *work_done, int budget)
Auke Kok9d5c8242008-01-24 02:22:38 -08005180{
Alexander Duyck047e0032009-10-27 15:49:27 +00005181 struct igb_ring *rx_ring = q_vector->rx_ring;
Alexander Duycke694e962009-10-27 15:53:06 +00005182 struct net_device *netdev = rx_ring->netdev;
Alexander Duyck80785292009-10-27 15:51:47 +00005183 struct pci_dev *pdev = rx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08005184 union e1000_adv_rx_desc *rx_desc , *next_rxd;
5185 struct igb_buffer *buffer_info , *next_buffer;
5186 struct sk_buff *skb;
Auke Kok9d5c8242008-01-24 02:22:38 -08005187 bool cleaned = false;
5188 int cleaned_count = 0;
Alexander Duyckd1eff352009-11-12 18:38:35 +00005189 int current_node = numa_node_id();
Auke Kok9d5c8242008-01-24 02:22:38 -08005190 unsigned int total_bytes = 0, total_packets = 0;
Alexander Duyck73cd78f2009-02-12 18:16:59 +00005191 unsigned int i;
Alexander Duyck2d94d8a2009-07-23 18:10:06 +00005192 u32 staterr;
5193 u16 length;
Alexander Duyck047e0032009-10-27 15:49:27 +00005194 u16 vlan_tag;
Auke Kok9d5c8242008-01-24 02:22:38 -08005195
5196 i = rx_ring->next_to_clean;
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005197 buffer_info = &rx_ring->buffer_info[i];
Auke Kok9d5c8242008-01-24 02:22:38 -08005198 rx_desc = E1000_RX_DESC_ADV(*rx_ring, i);
5199 staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
5200
5201 while (staterr & E1000_RXD_STAT_DD) {
5202 if (*work_done >= budget)
5203 break;
5204 (*work_done)++;
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005205
5206 skb = buffer_info->skb;
5207 prefetch(skb->data - NET_IP_ALIGN);
5208 buffer_info->skb = NULL;
5209
5210 i++;
5211 if (i == rx_ring->count)
5212 i = 0;
Alexander Duyck42d07812009-10-27 23:51:16 +00005213
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005214 next_rxd = E1000_RX_DESC_ADV(*rx_ring, i);
5215 prefetch(next_rxd);
5216 next_buffer = &rx_ring->buffer_info[i];
5217
5218 length = le16_to_cpu(rx_desc->wb.upper.length);
5219 cleaned = true;
5220 cleaned_count++;
5221
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005222 if (buffer_info->dma) {
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005223 pci_unmap_single(pdev, buffer_info->dma,
Alexander Duyck4c844852009-10-27 15:52:07 +00005224 rx_ring->rx_buffer_len,
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005225 PCI_DMA_FROMDEVICE);
Jesse Brandeburg91615f72009-06-30 12:45:15 +00005226 buffer_info->dma = 0;
Alexander Duyck4c844852009-10-27 15:52:07 +00005227 if (rx_ring->rx_buffer_len >= IGB_RXBUFFER_1024) {
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005228 skb_put(skb, length);
5229 goto send_up;
5230 }
Alexander Duyck4c844852009-10-27 15:52:07 +00005231 skb_put(skb, igb_get_hlen(rx_ring, rx_desc));
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005232 }
5233
5234 if (length) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005235 pci_unmap_page(pdev, buffer_info->page_dma,
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005236 PAGE_SIZE / 2, PCI_DMA_FROMDEVICE);
Auke Kok9d5c8242008-01-24 02:22:38 -08005237 buffer_info->page_dma = 0;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005238
5239 skb_fill_page_desc(skb, skb_shinfo(skb)->nr_frags++,
5240 buffer_info->page,
5241 buffer_info->page_offset,
5242 length);
5243
Alexander Duyckd1eff352009-11-12 18:38:35 +00005244 if ((page_count(buffer_info->page) != 1) ||
5245 (page_to_nid(buffer_info->page) != current_node))
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005246 buffer_info->page = NULL;
5247 else
5248 get_page(buffer_info->page);
Auke Kok9d5c8242008-01-24 02:22:38 -08005249
5250 skb->len += length;
5251 skb->data_len += length;
5252 skb->truesize += length;
Auke Kok9d5c8242008-01-24 02:22:38 -08005253 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005254
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005255 if (!(staterr & E1000_RXD_STAT_EOP)) {
Alexander Duyckb2d56532008-11-20 00:47:34 -08005256 buffer_info->skb = next_buffer->skb;
5257 buffer_info->dma = next_buffer->dma;
5258 next_buffer->skb = skb;
5259 next_buffer->dma = 0;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005260 goto next_desc;
5261 }
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005262send_up:
Auke Kok9d5c8242008-01-24 02:22:38 -08005263 if (staterr & E1000_RXDEXT_ERR_FRAME_ERR_MASK) {
5264 dev_kfree_skb_irq(skb);
5265 goto next_desc;
5266 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005267
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005268 igb_rx_hwtstamp(q_vector, staterr, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005269 total_bytes += skb->len;
5270 total_packets++;
5271
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005272 igb_rx_checksum_adv(rx_ring, staterr, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005273
5274 skb->protocol = eth_type_trans(skb, netdev);
Alexander Duyck047e0032009-10-27 15:49:27 +00005275 skb_record_rx_queue(skb, rx_ring->queue_index);
Auke Kok9d5c8242008-01-24 02:22:38 -08005276
Alexander Duyck047e0032009-10-27 15:49:27 +00005277 vlan_tag = ((staterr & E1000_RXD_STAT_VP) ?
5278 le16_to_cpu(rx_desc->wb.upper.vlan) : 0);
5279
5280 igb_receive_skb(q_vector, skb, vlan_tag);
Auke Kok9d5c8242008-01-24 02:22:38 -08005281
Auke Kok9d5c8242008-01-24 02:22:38 -08005282next_desc:
5283 rx_desc->wb.upper.status_error = 0;
5284
5285 /* return some buffers to hardware, one at a time is too slow */
5286 if (cleaned_count >= IGB_RX_BUFFER_WRITE) {
Mitch Williams3b644cf2008-06-27 10:59:48 -07005287 igb_alloc_rx_buffers_adv(rx_ring, cleaned_count);
Auke Kok9d5c8242008-01-24 02:22:38 -08005288 cleaned_count = 0;
5289 }
5290
5291 /* use prefetched values */
5292 rx_desc = next_rxd;
5293 buffer_info = next_buffer;
Auke Kok9d5c8242008-01-24 02:22:38 -08005294 staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
5295 }
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005296
Auke Kok9d5c8242008-01-24 02:22:38 -08005297 rx_ring->next_to_clean = i;
Alexander Duyckc493ea42009-03-20 00:16:50 +00005298 cleaned_count = igb_desc_unused(rx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08005299
5300 if (cleaned_count)
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
5303 rx_ring->total_packets += total_packets;
5304 rx_ring->total_bytes += total_bytes;
5305 rx_ring->rx_stats.packets += total_packets;
5306 rx_ring->rx_stats.bytes += total_bytes;
Auke Kok9d5c8242008-01-24 02:22:38 -08005307 return cleaned;
5308}
5309
Auke Kok9d5c8242008-01-24 02:22:38 -08005310/**
5311 * igb_alloc_rx_buffers_adv - Replace used receive buffers; packet split
5312 * @adapter: address of board private structure
5313 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00005314void igb_alloc_rx_buffers_adv(struct igb_ring *rx_ring, int cleaned_count)
Auke Kok9d5c8242008-01-24 02:22:38 -08005315{
Alexander Duycke694e962009-10-27 15:53:06 +00005316 struct net_device *netdev = rx_ring->netdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08005317 union e1000_adv_rx_desc *rx_desc;
5318 struct igb_buffer *buffer_info;
5319 struct sk_buff *skb;
5320 unsigned int i;
Alexander Duyckdb761762009-02-06 23:15:25 +00005321 int bufsz;
Auke Kok9d5c8242008-01-24 02:22:38 -08005322
5323 i = rx_ring->next_to_use;
5324 buffer_info = &rx_ring->buffer_info[i];
5325
Alexander Duyck4c844852009-10-27 15:52:07 +00005326 bufsz = rx_ring->rx_buffer_len;
Alexander Duyckdb761762009-02-06 23:15:25 +00005327
Auke Kok9d5c8242008-01-24 02:22:38 -08005328 while (cleaned_count--) {
5329 rx_desc = E1000_RX_DESC_ADV(*rx_ring, i);
5330
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005331 if ((bufsz < IGB_RXBUFFER_1024) && !buffer_info->page_dma) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005332 if (!buffer_info->page) {
Alexander Duyck42d07812009-10-27 23:51:16 +00005333 buffer_info->page = netdev_alloc_page(netdev);
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005334 if (!buffer_info->page) {
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005335 rx_ring->rx_stats.alloc_failed++;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005336 goto no_buffers;
5337 }
5338 buffer_info->page_offset = 0;
5339 } else {
5340 buffer_info->page_offset ^= PAGE_SIZE / 2;
Auke Kok9d5c8242008-01-24 02:22:38 -08005341 }
5342 buffer_info->page_dma =
Alexander Duyck80785292009-10-27 15:51:47 +00005343 pci_map_page(rx_ring->pdev, buffer_info->page,
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005344 buffer_info->page_offset,
5345 PAGE_SIZE / 2,
Auke Kok9d5c8242008-01-24 02:22:38 -08005346 PCI_DMA_FROMDEVICE);
Alexander Duyck42d07812009-10-27 23:51:16 +00005347 if (pci_dma_mapping_error(rx_ring->pdev,
5348 buffer_info->page_dma)) {
5349 buffer_info->page_dma = 0;
5350 rx_ring->rx_stats.alloc_failed++;
5351 goto no_buffers;
5352 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005353 }
5354
Alexander Duyck42d07812009-10-27 23:51:16 +00005355 skb = buffer_info->skb;
5356 if (!skb) {
Eric Dumazet89d71a62009-10-13 05:34:20 +00005357 skb = netdev_alloc_skb_ip_align(netdev, bufsz);
Auke Kok9d5c8242008-01-24 02:22:38 -08005358 if (!skb) {
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005359 rx_ring->rx_stats.alloc_failed++;
Auke Kok9d5c8242008-01-24 02:22:38 -08005360 goto no_buffers;
5361 }
5362
Auke Kok9d5c8242008-01-24 02:22:38 -08005363 buffer_info->skb = skb;
Alexander Duyck42d07812009-10-27 23:51:16 +00005364 }
5365 if (!buffer_info->dma) {
Alexander Duyck80785292009-10-27 15:51:47 +00005366 buffer_info->dma = pci_map_single(rx_ring->pdev,
5367 skb->data,
Auke Kok9d5c8242008-01-24 02:22:38 -08005368 bufsz,
5369 PCI_DMA_FROMDEVICE);
Alexander Duyck42d07812009-10-27 23:51:16 +00005370 if (pci_dma_mapping_error(rx_ring->pdev,
5371 buffer_info->dma)) {
5372 buffer_info->dma = 0;
5373 rx_ring->rx_stats.alloc_failed++;
5374 goto no_buffers;
5375 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005376 }
5377 /* Refresh the desc even if buffer_addrs didn't change because
5378 * each write-back erases this info. */
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005379 if (bufsz < IGB_RXBUFFER_1024) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005380 rx_desc->read.pkt_addr =
5381 cpu_to_le64(buffer_info->page_dma);
5382 rx_desc->read.hdr_addr = cpu_to_le64(buffer_info->dma);
5383 } else {
Alexander Duyck42d07812009-10-27 23:51:16 +00005384 rx_desc->read.pkt_addr = cpu_to_le64(buffer_info->dma);
Auke Kok9d5c8242008-01-24 02:22:38 -08005385 rx_desc->read.hdr_addr = 0;
5386 }
5387
5388 i++;
5389 if (i == rx_ring->count)
5390 i = 0;
5391 buffer_info = &rx_ring->buffer_info[i];
5392 }
5393
5394no_buffers:
5395 if (rx_ring->next_to_use != i) {
5396 rx_ring->next_to_use = i;
5397 if (i == 0)
5398 i = (rx_ring->count - 1);
5399 else
5400 i--;
5401
5402 /* Force memory writes to complete before letting h/w
5403 * know there are new descriptors to fetch. (Only
5404 * applicable for weak-ordered memory model archs,
5405 * such as IA-64). */
5406 wmb();
Alexander Duyckfce99e32009-10-27 15:51:27 +00005407 writel(i, rx_ring->tail);
Auke Kok9d5c8242008-01-24 02:22:38 -08005408 }
5409}
5410
5411/**
5412 * igb_mii_ioctl -
5413 * @netdev:
5414 * @ifreq:
5415 * @cmd:
5416 **/
5417static int igb_mii_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
5418{
5419 struct igb_adapter *adapter = netdev_priv(netdev);
5420 struct mii_ioctl_data *data = if_mii(ifr);
5421
5422 if (adapter->hw.phy.media_type != e1000_media_type_copper)
5423 return -EOPNOTSUPP;
5424
5425 switch (cmd) {
5426 case SIOCGMIIPHY:
5427 data->phy_id = adapter->hw.phy.addr;
5428 break;
5429 case SIOCGMIIREG:
Alexander Duyckf5f4cf02008-11-21 21:30:24 -08005430 if (igb_read_phy_reg(&adapter->hw, data->reg_num & 0x1F,
5431 &data->val_out))
Auke Kok9d5c8242008-01-24 02:22:38 -08005432 return -EIO;
5433 break;
5434 case SIOCSMIIREG:
5435 default:
5436 return -EOPNOTSUPP;
5437 }
5438 return 0;
5439}
5440
5441/**
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005442 * igb_hwtstamp_ioctl - control hardware time stamping
5443 * @netdev:
5444 * @ifreq:
5445 * @cmd:
5446 *
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005447 * Outgoing time stamping can be enabled and disabled. Play nice and
5448 * disable it when requested, although it shouldn't case any overhead
5449 * when no packet needs it. At most one packet in the queue may be
5450 * marked for time stamping, otherwise it would be impossible to tell
5451 * for sure to which packet the hardware time stamp belongs.
5452 *
5453 * Incoming time stamping has to be configured via the hardware
5454 * filters. Not all combinations are supported, in particular event
5455 * type has to be specified. Matching the kind of event packet is
5456 * not supported, with the exception of "all V2 events regardless of
5457 * level 2 or 4".
5458 *
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005459 **/
5460static int igb_hwtstamp_ioctl(struct net_device *netdev,
5461 struct ifreq *ifr, int cmd)
5462{
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005463 struct igb_adapter *adapter = netdev_priv(netdev);
5464 struct e1000_hw *hw = &adapter->hw;
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005465 struct hwtstamp_config config;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005466 u32 tsync_tx_ctl = E1000_TSYNCTXCTL_ENABLED;
5467 u32 tsync_rx_ctl = E1000_TSYNCRXCTL_ENABLED;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005468 u32 tsync_rx_cfg = 0;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005469 bool is_l4 = false;
5470 bool is_l2 = false;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005471 u32 regval;
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005472
5473 if (copy_from_user(&config, ifr->ifr_data, sizeof(config)))
5474 return -EFAULT;
5475
5476 /* reserved for future extensions */
5477 if (config.flags)
5478 return -EINVAL;
5479
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005480 switch (config.tx_type) {
5481 case HWTSTAMP_TX_OFF:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005482 tsync_tx_ctl = 0;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005483 case HWTSTAMP_TX_ON:
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005484 break;
5485 default:
5486 return -ERANGE;
5487 }
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005488
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005489 switch (config.rx_filter) {
5490 case HWTSTAMP_FILTER_NONE:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005491 tsync_rx_ctl = 0;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005492 break;
5493 case HWTSTAMP_FILTER_PTP_V1_L4_EVENT:
5494 case HWTSTAMP_FILTER_PTP_V2_L4_EVENT:
5495 case HWTSTAMP_FILTER_PTP_V2_L2_EVENT:
5496 case HWTSTAMP_FILTER_ALL:
5497 /*
5498 * register TSYNCRXCFG must be set, therefore it is not
5499 * possible to time stamp both Sync and Delay_Req messages
5500 * => fall back to time stamping all packets
5501 */
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005502 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_ALL;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005503 config.rx_filter = HWTSTAMP_FILTER_ALL;
5504 break;
5505 case HWTSTAMP_FILTER_PTP_V1_L4_SYNC:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005506 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L4_V1;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005507 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V1_SYNC_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005508 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005509 break;
5510 case HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005511 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L4_V1;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005512 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V1_DELAY_REQ_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005513 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005514 break;
5515 case HWTSTAMP_FILTER_PTP_V2_L2_SYNC:
5516 case HWTSTAMP_FILTER_PTP_V2_L4_SYNC:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005517 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L2_L4_V2;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005518 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V2_SYNC_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005519 is_l2 = true;
5520 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005521 config.rx_filter = HWTSTAMP_FILTER_SOME;
5522 break;
5523 case HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ:
5524 case HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005525 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L2_L4_V2;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005526 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V2_DELAY_REQ_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005527 is_l2 = true;
5528 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005529 config.rx_filter = HWTSTAMP_FILTER_SOME;
5530 break;
5531 case HWTSTAMP_FILTER_PTP_V2_EVENT:
5532 case HWTSTAMP_FILTER_PTP_V2_SYNC:
5533 case HWTSTAMP_FILTER_PTP_V2_DELAY_REQ:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005534 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_EVENT_V2;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005535 config.rx_filter = HWTSTAMP_FILTER_PTP_V2_EVENT;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005536 is_l2 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005537 break;
5538 default:
5539 return -ERANGE;
5540 }
5541
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005542 if (hw->mac.type == e1000_82575) {
5543 if (tsync_rx_ctl | tsync_tx_ctl)
5544 return -EINVAL;
5545 return 0;
5546 }
5547
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005548 /* enable/disable TX */
5549 regval = rd32(E1000_TSYNCTXCTL);
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005550 regval &= ~E1000_TSYNCTXCTL_ENABLED;
5551 regval |= tsync_tx_ctl;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005552 wr32(E1000_TSYNCTXCTL, regval);
5553
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005554 /* enable/disable RX */
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005555 regval = rd32(E1000_TSYNCRXCTL);
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005556 regval &= ~(E1000_TSYNCRXCTL_ENABLED | E1000_TSYNCRXCTL_TYPE_MASK);
5557 regval |= tsync_rx_ctl;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005558 wr32(E1000_TSYNCRXCTL, regval);
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005559
5560 /* define which PTP packets are time stamped */
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005561 wr32(E1000_TSYNCRXCFG, tsync_rx_cfg);
5562
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005563 /* define ethertype filter for timestamped packets */
5564 if (is_l2)
5565 wr32(E1000_ETQF(3),
5566 (E1000_ETQF_FILTER_ENABLE | /* enable filter */
5567 E1000_ETQF_1588 | /* enable timestamping */
5568 ETH_P_1588)); /* 1588 eth protocol type */
5569 else
5570 wr32(E1000_ETQF(3), 0);
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005571
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005572#define PTP_PORT 319
5573 /* L4 Queue Filter[3]: filter by destination port and protocol */
5574 if (is_l4) {
5575 u32 ftqf = (IPPROTO_UDP /* UDP */
5576 | E1000_FTQF_VF_BP /* VF not compared */
5577 | E1000_FTQF_1588_TIME_STAMP /* Enable Timestamping */
5578 | E1000_FTQF_MASK); /* mask all inputs */
5579 ftqf &= ~E1000_FTQF_MASK_PROTO_BP; /* enable protocol check */
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005580
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005581 wr32(E1000_IMIR(3), htons(PTP_PORT));
5582 wr32(E1000_IMIREXT(3),
5583 (E1000_IMIREXT_SIZE_BP | E1000_IMIREXT_CTRL_BP));
5584 if (hw->mac.type == e1000_82576) {
5585 /* enable source port check */
5586 wr32(E1000_SPQF(3), htons(PTP_PORT));
5587 ftqf &= ~E1000_FTQF_MASK_SOURCE_PORT_BP;
5588 }
5589 wr32(E1000_FTQF(3), ftqf);
5590 } else {
5591 wr32(E1000_FTQF(3), E1000_FTQF_MASK);
5592 }
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005593 wrfl();
5594
5595 adapter->hwtstamp_config = config;
5596
5597 /* clear TX/RX time stamp registers, just to be sure */
5598 regval = rd32(E1000_TXSTMPH);
5599 regval = rd32(E1000_RXSTMPH);
5600
5601 return copy_to_user(ifr->ifr_data, &config, sizeof(config)) ?
5602 -EFAULT : 0;
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005603}
5604
5605/**
Auke Kok9d5c8242008-01-24 02:22:38 -08005606 * igb_ioctl -
5607 * @netdev:
5608 * @ifreq:
5609 * @cmd:
5610 **/
5611static int igb_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
5612{
5613 switch (cmd) {
5614 case SIOCGMIIPHY:
5615 case SIOCGMIIREG:
5616 case SIOCSMIIREG:
5617 return igb_mii_ioctl(netdev, ifr, cmd);
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005618 case SIOCSHWTSTAMP:
5619 return igb_hwtstamp_ioctl(netdev, ifr, cmd);
Auke Kok9d5c8242008-01-24 02:22:38 -08005620 default:
5621 return -EOPNOTSUPP;
5622 }
5623}
5624
Alexander Duyck009bc062009-07-23 18:08:35 +00005625s32 igb_read_pcie_cap_reg(struct e1000_hw *hw, u32 reg, u16 *value)
5626{
5627 struct igb_adapter *adapter = hw->back;
5628 u16 cap_offset;
5629
5630 cap_offset = pci_find_capability(adapter->pdev, PCI_CAP_ID_EXP);
5631 if (!cap_offset)
5632 return -E1000_ERR_CONFIG;
5633
5634 pci_read_config_word(adapter->pdev, cap_offset + reg, value);
5635
5636 return 0;
5637}
5638
5639s32 igb_write_pcie_cap_reg(struct e1000_hw *hw, u32 reg, u16 *value)
5640{
5641 struct igb_adapter *adapter = hw->back;
5642 u16 cap_offset;
5643
5644 cap_offset = pci_find_capability(adapter->pdev, PCI_CAP_ID_EXP);
5645 if (!cap_offset)
5646 return -E1000_ERR_CONFIG;
5647
5648 pci_write_config_word(adapter->pdev, cap_offset + reg, *value);
5649
5650 return 0;
5651}
5652
Auke Kok9d5c8242008-01-24 02:22:38 -08005653static void igb_vlan_rx_register(struct net_device *netdev,
5654 struct vlan_group *grp)
5655{
5656 struct igb_adapter *adapter = netdev_priv(netdev);
5657 struct e1000_hw *hw = &adapter->hw;
5658 u32 ctrl, rctl;
5659
5660 igb_irq_disable(adapter);
5661 adapter->vlgrp = grp;
5662
5663 if (grp) {
5664 /* enable VLAN tag insert/strip */
5665 ctrl = rd32(E1000_CTRL);
5666 ctrl |= E1000_CTRL_VME;
5667 wr32(E1000_CTRL, ctrl);
5668
Alexander Duyck51466232009-10-27 23:47:35 +00005669 /* Disable CFI check */
Auke Kok9d5c8242008-01-24 02:22:38 -08005670 rctl = rd32(E1000_RCTL);
Auke Kok9d5c8242008-01-24 02:22:38 -08005671 rctl &= ~E1000_RCTL_CFIEN;
5672 wr32(E1000_RCTL, rctl);
Auke Kok9d5c8242008-01-24 02:22:38 -08005673 } else {
5674 /* disable VLAN tag insert/strip */
5675 ctrl = rd32(E1000_CTRL);
5676 ctrl &= ~E1000_CTRL_VME;
5677 wr32(E1000_CTRL, ctrl);
Auke Kok9d5c8242008-01-24 02:22:38 -08005678 }
5679
Alexander Duycke1739522009-02-19 20:39:44 -08005680 igb_rlpml_set(adapter);
5681
Auke Kok9d5c8242008-01-24 02:22:38 -08005682 if (!test_bit(__IGB_DOWN, &adapter->state))
5683 igb_irq_enable(adapter);
5684}
5685
5686static void igb_vlan_rx_add_vid(struct net_device *netdev, u16 vid)
5687{
5688 struct igb_adapter *adapter = netdev_priv(netdev);
5689 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005690 int pf_id = adapter->vfs_allocated_count;
Auke Kok9d5c8242008-01-24 02:22:38 -08005691
Alexander Duyck51466232009-10-27 23:47:35 +00005692 /* attempt to add filter to vlvf array */
5693 igb_vlvf_set(adapter, vid, true, pf_id);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005694
Alexander Duyck51466232009-10-27 23:47:35 +00005695 /* add the filter since PF can receive vlans w/o entry in vlvf */
5696 igb_vfta_set(hw, vid, true);
Auke Kok9d5c8242008-01-24 02:22:38 -08005697}
5698
5699static void igb_vlan_rx_kill_vid(struct net_device *netdev, u16 vid)
5700{
5701 struct igb_adapter *adapter = netdev_priv(netdev);
5702 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005703 int pf_id = adapter->vfs_allocated_count;
Alexander Duyck51466232009-10-27 23:47:35 +00005704 s32 err;
Auke Kok9d5c8242008-01-24 02:22:38 -08005705
5706 igb_irq_disable(adapter);
5707 vlan_group_set_device(adapter->vlgrp, vid, NULL);
5708
5709 if (!test_bit(__IGB_DOWN, &adapter->state))
5710 igb_irq_enable(adapter);
5711
Alexander Duyck51466232009-10-27 23:47:35 +00005712 /* remove vlan from VLVF table array */
5713 err = igb_vlvf_set(adapter, vid, false, pf_id);
Auke Kok9d5c8242008-01-24 02:22:38 -08005714
Alexander Duyck51466232009-10-27 23:47:35 +00005715 /* if vid was not present in VLVF just remove it from table */
5716 if (err)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005717 igb_vfta_set(hw, vid, false);
Auke Kok9d5c8242008-01-24 02:22:38 -08005718}
5719
5720static void igb_restore_vlan(struct igb_adapter *adapter)
5721{
5722 igb_vlan_rx_register(adapter->netdev, adapter->vlgrp);
5723
5724 if (adapter->vlgrp) {
5725 u16 vid;
5726 for (vid = 0; vid < VLAN_GROUP_ARRAY_LEN; vid++) {
5727 if (!vlan_group_get_device(adapter->vlgrp, vid))
5728 continue;
5729 igb_vlan_rx_add_vid(adapter->netdev, vid);
5730 }
5731 }
5732}
5733
5734int igb_set_spd_dplx(struct igb_adapter *adapter, u16 spddplx)
5735{
Alexander Duyck090b1792009-10-27 23:51:55 +00005736 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08005737 struct e1000_mac_info *mac = &adapter->hw.mac;
5738
5739 mac->autoneg = 0;
5740
Auke Kok9d5c8242008-01-24 02:22:38 -08005741 switch (spddplx) {
5742 case SPEED_10 + DUPLEX_HALF:
5743 mac->forced_speed_duplex = ADVERTISE_10_HALF;
5744 break;
5745 case SPEED_10 + DUPLEX_FULL:
5746 mac->forced_speed_duplex = ADVERTISE_10_FULL;
5747 break;
5748 case SPEED_100 + DUPLEX_HALF:
5749 mac->forced_speed_duplex = ADVERTISE_100_HALF;
5750 break;
5751 case SPEED_100 + DUPLEX_FULL:
5752 mac->forced_speed_duplex = ADVERTISE_100_FULL;
5753 break;
5754 case SPEED_1000 + DUPLEX_FULL:
5755 mac->autoneg = 1;
5756 adapter->hw.phy.autoneg_advertised = ADVERTISE_1000_FULL;
5757 break;
5758 case SPEED_1000 + DUPLEX_HALF: /* not supported */
5759 default:
Alexander Duyck090b1792009-10-27 23:51:55 +00005760 dev_err(&pdev->dev, "Unsupported Speed/Duplex configuration\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08005761 return -EINVAL;
5762 }
5763 return 0;
5764}
5765
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005766static int __igb_shutdown(struct pci_dev *pdev, bool *enable_wake)
Auke Kok9d5c8242008-01-24 02:22:38 -08005767{
5768 struct net_device *netdev = pci_get_drvdata(pdev);
5769 struct igb_adapter *adapter = netdev_priv(netdev);
5770 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck2d064c02008-07-08 15:10:12 -07005771 u32 ctrl, rctl, status;
Auke Kok9d5c8242008-01-24 02:22:38 -08005772 u32 wufc = adapter->wol;
5773#ifdef CONFIG_PM
5774 int retval = 0;
5775#endif
5776
5777 netif_device_detach(netdev);
5778
Alexander Duycka88f10e2008-07-08 15:13:38 -07005779 if (netif_running(netdev))
5780 igb_close(netdev);
5781
Alexander Duyck047e0032009-10-27 15:49:27 +00005782 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08005783
5784#ifdef CONFIG_PM
5785 retval = pci_save_state(pdev);
5786 if (retval)
5787 return retval;
5788#endif
5789
5790 status = rd32(E1000_STATUS);
5791 if (status & E1000_STATUS_LU)
5792 wufc &= ~E1000_WUFC_LNKC;
5793
5794 if (wufc) {
5795 igb_setup_rctl(adapter);
Alexander Duyckff41f8d2009-09-03 14:48:56 +00005796 igb_set_rx_mode(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08005797
5798 /* turn on all-multi mode if wake on multicast is enabled */
5799 if (wufc & E1000_WUFC_MC) {
5800 rctl = rd32(E1000_RCTL);
5801 rctl |= E1000_RCTL_MPE;
5802 wr32(E1000_RCTL, rctl);
5803 }
5804
5805 ctrl = rd32(E1000_CTRL);
5806 /* advertise wake from D3Cold */
5807 #define E1000_CTRL_ADVD3WUC 0x00100000
5808 /* phy power management enable */
5809 #define E1000_CTRL_EN_PHY_PWR_MGMT 0x00200000
5810 ctrl |= E1000_CTRL_ADVD3WUC;
5811 wr32(E1000_CTRL, ctrl);
5812
Auke Kok9d5c8242008-01-24 02:22:38 -08005813 /* Allow time for pending master requests to run */
Alexander Duyck330a6d62009-10-27 23:51:35 +00005814 igb_disable_pcie_master(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08005815
5816 wr32(E1000_WUC, E1000_WUC_PME_EN);
5817 wr32(E1000_WUFC, wufc);
Auke Kok9d5c8242008-01-24 02:22:38 -08005818 } else {
5819 wr32(E1000_WUC, 0);
5820 wr32(E1000_WUFC, 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08005821 }
5822
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005823 *enable_wake = wufc || adapter->en_mng_pt;
5824 if (!*enable_wake)
Nick Nunley88a268c2010-02-17 01:01:59 +00005825 igb_power_down_link(adapter);
5826 else
5827 igb_power_up_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08005828
5829 /* Release control of h/w to f/w. If f/w is AMT enabled, this
5830 * would have already happened in close and is redundant. */
5831 igb_release_hw_control(adapter);
5832
5833 pci_disable_device(pdev);
5834
Auke Kok9d5c8242008-01-24 02:22:38 -08005835 return 0;
5836}
5837
5838#ifdef CONFIG_PM
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005839static int igb_suspend(struct pci_dev *pdev, pm_message_t state)
5840{
5841 int retval;
5842 bool wake;
5843
5844 retval = __igb_shutdown(pdev, &wake);
5845 if (retval)
5846 return retval;
5847
5848 if (wake) {
5849 pci_prepare_to_sleep(pdev);
5850 } else {
5851 pci_wake_from_d3(pdev, false);
5852 pci_set_power_state(pdev, PCI_D3hot);
5853 }
5854
5855 return 0;
5856}
5857
Auke Kok9d5c8242008-01-24 02:22:38 -08005858static int igb_resume(struct pci_dev *pdev)
5859{
5860 struct net_device *netdev = pci_get_drvdata(pdev);
5861 struct igb_adapter *adapter = netdev_priv(netdev);
5862 struct e1000_hw *hw = &adapter->hw;
5863 u32 err;
5864
5865 pci_set_power_state(pdev, PCI_D0);
5866 pci_restore_state(pdev);
Nick Nunleyb94f2d72010-02-17 01:02:19 +00005867 pci_save_state(pdev);
Taku Izumi42bfd33a2008-06-20 12:10:30 +09005868
Alexander Duyckaed5dec2009-02-06 23:16:04 +00005869 err = pci_enable_device_mem(pdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08005870 if (err) {
5871 dev_err(&pdev->dev,
5872 "igb: Cannot enable PCI device from suspend\n");
5873 return err;
5874 }
5875 pci_set_master(pdev);
5876
5877 pci_enable_wake(pdev, PCI_D3hot, 0);
5878 pci_enable_wake(pdev, PCI_D3cold, 0);
5879
Alexander Duyck047e0032009-10-27 15:49:27 +00005880 if (igb_init_interrupt_scheme(adapter)) {
Alexander Duycka88f10e2008-07-08 15:13:38 -07005881 dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
5882 return -ENOMEM;
Auke Kok9d5c8242008-01-24 02:22:38 -08005883 }
5884
Auke Kok9d5c8242008-01-24 02:22:38 -08005885 igb_reset(adapter);
Alexander Duycka8564f02009-02-06 23:21:10 +00005886
5887 /* let the f/w know that the h/w is now under the control of the
5888 * driver. */
5889 igb_get_hw_control(adapter);
5890
Auke Kok9d5c8242008-01-24 02:22:38 -08005891 wr32(E1000_WUS, ~0);
5892
Alexander Duycka88f10e2008-07-08 15:13:38 -07005893 if (netif_running(netdev)) {
5894 err = igb_open(netdev);
5895 if (err)
5896 return err;
5897 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005898
5899 netif_device_attach(netdev);
5900
Auke Kok9d5c8242008-01-24 02:22:38 -08005901 return 0;
5902}
5903#endif
5904
5905static void igb_shutdown(struct pci_dev *pdev)
5906{
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005907 bool wake;
5908
5909 __igb_shutdown(pdev, &wake);
5910
5911 if (system_state == SYSTEM_POWER_OFF) {
5912 pci_wake_from_d3(pdev, wake);
5913 pci_set_power_state(pdev, PCI_D3hot);
5914 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005915}
5916
5917#ifdef CONFIG_NET_POLL_CONTROLLER
5918/*
5919 * Polling 'interrupt' - used by things like netconsole to send skbs
5920 * without having to re-enable interrupts. It's not called while
5921 * the interrupt routine is executing.
5922 */
5923static void igb_netpoll(struct net_device *netdev)
5924{
5925 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005926 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08005927 int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08005928
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005929 if (!adapter->msix_entries) {
Alexander Duyck047e0032009-10-27 15:49:27 +00005930 struct igb_q_vector *q_vector = adapter->q_vector[0];
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005931 igb_irq_disable(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +00005932 napi_schedule(&q_vector->napi);
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005933 return;
5934 }
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07005935
Alexander Duyck047e0032009-10-27 15:49:27 +00005936 for (i = 0; i < adapter->num_q_vectors; i++) {
5937 struct igb_q_vector *q_vector = adapter->q_vector[i];
5938 wr32(E1000_EIMC, q_vector->eims_value);
5939 napi_schedule(&q_vector->napi);
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005940 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005941}
5942#endif /* CONFIG_NET_POLL_CONTROLLER */
5943
5944/**
5945 * igb_io_error_detected - called when PCI error is detected
5946 * @pdev: Pointer to PCI device
5947 * @state: The current pci connection state
5948 *
5949 * This function is called after a PCI bus error affecting
5950 * this device has been detected.
5951 */
5952static pci_ers_result_t igb_io_error_detected(struct pci_dev *pdev,
5953 pci_channel_state_t state)
5954{
5955 struct net_device *netdev = pci_get_drvdata(pdev);
5956 struct igb_adapter *adapter = netdev_priv(netdev);
5957
5958 netif_device_detach(netdev);
5959
Alexander Duyck59ed6ee2009-06-30 12:46:34 +00005960 if (state == pci_channel_io_perm_failure)
5961 return PCI_ERS_RESULT_DISCONNECT;
5962
Auke Kok9d5c8242008-01-24 02:22:38 -08005963 if (netif_running(netdev))
5964 igb_down(adapter);
5965 pci_disable_device(pdev);
5966
5967 /* Request a slot slot reset. */
5968 return PCI_ERS_RESULT_NEED_RESET;
5969}
5970
5971/**
5972 * igb_io_slot_reset - called after the pci bus has been reset.
5973 * @pdev: Pointer to PCI device
5974 *
5975 * Restart the card from scratch, as if from a cold-boot. Implementation
5976 * resembles the first-half of the igb_resume routine.
5977 */
5978static pci_ers_result_t igb_io_slot_reset(struct pci_dev *pdev)
5979{
5980 struct net_device *netdev = pci_get_drvdata(pdev);
5981 struct igb_adapter *adapter = netdev_priv(netdev);
5982 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck40a914f2008-11-27 00:24:37 -08005983 pci_ers_result_t result;
Taku Izumi42bfd33a2008-06-20 12:10:30 +09005984 int err;
Auke Kok9d5c8242008-01-24 02:22:38 -08005985
Alexander Duyckaed5dec2009-02-06 23:16:04 +00005986 if (pci_enable_device_mem(pdev)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005987 dev_err(&pdev->dev,
5988 "Cannot re-enable PCI device after reset.\n");
Alexander Duyck40a914f2008-11-27 00:24:37 -08005989 result = PCI_ERS_RESULT_DISCONNECT;
5990 } else {
5991 pci_set_master(pdev);
5992 pci_restore_state(pdev);
Nick Nunleyb94f2d72010-02-17 01:02:19 +00005993 pci_save_state(pdev);
Alexander Duyck40a914f2008-11-27 00:24:37 -08005994
5995 pci_enable_wake(pdev, PCI_D3hot, 0);
5996 pci_enable_wake(pdev, PCI_D3cold, 0);
5997
5998 igb_reset(adapter);
5999 wr32(E1000_WUS, ~0);
6000 result = PCI_ERS_RESULT_RECOVERED;
Auke Kok9d5c8242008-01-24 02:22:38 -08006001 }
Auke Kok9d5c8242008-01-24 02:22:38 -08006002
Jeff Kirsherea943d42008-12-11 20:34:19 -08006003 err = pci_cleanup_aer_uncorrect_error_status(pdev);
6004 if (err) {
6005 dev_err(&pdev->dev, "pci_cleanup_aer_uncorrect_error_status "
6006 "failed 0x%0x\n", err);
6007 /* non-fatal, continue */
6008 }
Auke Kok9d5c8242008-01-24 02:22:38 -08006009
Alexander Duyck40a914f2008-11-27 00:24:37 -08006010 return result;
Auke Kok9d5c8242008-01-24 02:22:38 -08006011}
6012
6013/**
6014 * igb_io_resume - called when traffic can start flowing again.
6015 * @pdev: Pointer to PCI device
6016 *
6017 * This callback is called when the error recovery driver tells us that
6018 * its OK to resume normal operation. Implementation resembles the
6019 * second-half of the igb_resume routine.
6020 */
6021static void igb_io_resume(struct pci_dev *pdev)
6022{
6023 struct net_device *netdev = pci_get_drvdata(pdev);
6024 struct igb_adapter *adapter = netdev_priv(netdev);
6025
Auke Kok9d5c8242008-01-24 02:22:38 -08006026 if (netif_running(netdev)) {
6027 if (igb_up(adapter)) {
6028 dev_err(&pdev->dev, "igb_up failed after reset\n");
6029 return;
6030 }
6031 }
6032
6033 netif_device_attach(netdev);
6034
6035 /* let the f/w know that the h/w is now under the control of the
6036 * driver. */
6037 igb_get_hw_control(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08006038}
6039
Alexander Duyck26ad9172009-10-05 06:32:49 +00006040static void igb_rar_set_qsel(struct igb_adapter *adapter, u8 *addr, u32 index,
6041 u8 qsel)
6042{
6043 u32 rar_low, rar_high;
6044 struct e1000_hw *hw = &adapter->hw;
6045
6046 /* HW expects these in little endian so we reverse the byte order
6047 * from network order (big endian) to little endian
6048 */
6049 rar_low = ((u32) addr[0] | ((u32) addr[1] << 8) |
6050 ((u32) addr[2] << 16) | ((u32) addr[3] << 24));
6051 rar_high = ((u32) addr[4] | ((u32) addr[5] << 8));
6052
6053 /* Indicate to hardware the Address is Valid. */
6054 rar_high |= E1000_RAH_AV;
6055
6056 if (hw->mac.type == e1000_82575)
6057 rar_high |= E1000_RAH_POOL_1 * qsel;
6058 else
6059 rar_high |= E1000_RAH_POOL_1 << qsel;
6060
6061 wr32(E1000_RAL(index), rar_low);
6062 wrfl();
6063 wr32(E1000_RAH(index), rar_high);
6064 wrfl();
6065}
6066
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006067static int igb_set_vf_mac(struct igb_adapter *adapter,
6068 int vf, unsigned char *mac_addr)
6069{
6070 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckff41f8d2009-09-03 14:48:56 +00006071 /* VF MAC addresses start at end of receive addresses and moves
6072 * torwards the first, as a result a collision should not be possible */
6073 int rar_entry = hw->mac.rar_entry_count - (vf + 1);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006074
Alexander Duyck37680112009-02-19 20:40:30 -08006075 memcpy(adapter->vf_data[vf].vf_mac_addresses, mac_addr, ETH_ALEN);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006076
Alexander Duyck26ad9172009-10-05 06:32:49 +00006077 igb_rar_set_qsel(adapter, mac_addr, rar_entry, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006078
6079 return 0;
6080}
6081
Williams, Mitch A8151d292010-02-10 01:44:24 +00006082static int igb_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
6083{
6084 struct igb_adapter *adapter = netdev_priv(netdev);
6085 if (!is_valid_ether_addr(mac) || (vf >= adapter->vfs_allocated_count))
6086 return -EINVAL;
6087 adapter->vf_data[vf].flags |= IGB_VF_FLAG_PF_SET_MAC;
6088 dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n", mac, vf);
6089 dev_info(&adapter->pdev->dev, "Reload the VF driver to make this"
6090 " change effective.");
6091 if (test_bit(__IGB_DOWN, &adapter->state)) {
6092 dev_warn(&adapter->pdev->dev, "The VF MAC address has been set,"
6093 " but the PF device is not up.\n");
6094 dev_warn(&adapter->pdev->dev, "Bring the PF device up before"
6095 " attempting to use the VF device.\n");
6096 }
6097 return igb_set_vf_mac(adapter, vf, mac);
6098}
6099
6100static int igb_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate)
6101{
6102 return -EOPNOTSUPP;
6103}
6104
6105static int igb_ndo_get_vf_config(struct net_device *netdev,
6106 int vf, struct ifla_vf_info *ivi)
6107{
6108 struct igb_adapter *adapter = netdev_priv(netdev);
6109 if (vf >= adapter->vfs_allocated_count)
6110 return -EINVAL;
6111 ivi->vf = vf;
6112 memcpy(&ivi->mac, adapter->vf_data[vf].vf_mac_addresses, ETH_ALEN);
6113 ivi->tx_rate = 0;
6114 ivi->vlan = adapter->vf_data[vf].pf_vlan;
6115 ivi->qos = adapter->vf_data[vf].pf_qos;
6116 return 0;
6117}
6118
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006119static void igb_vmm_control(struct igb_adapter *adapter)
6120{
6121 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck10d8e902009-10-27 15:54:04 +00006122 u32 reg;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006123
Alexander Duyck52a1dd42010-03-22 14:07:46 +00006124 switch (hw->mac.type) {
6125 case e1000_82575:
6126 default:
6127 /* replication is not supported for 82575 */
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006128 return;
Alexander Duyck52a1dd42010-03-22 14:07:46 +00006129 case e1000_82576:
6130 /* notify HW that the MAC is adding vlan tags */
6131 reg = rd32(E1000_DTXCTL);
6132 reg |= E1000_DTXCTL_VLAN_ADDED;
6133 wr32(E1000_DTXCTL, reg);
6134 case e1000_82580:
6135 /* enable replication vlan tag stripping */
6136 reg = rd32(E1000_RPLOLR);
6137 reg |= E1000_RPLOLR_STRVLAN;
6138 wr32(E1000_RPLOLR, reg);
Alexander Duyckd2ba2ed2010-03-22 14:08:06 +00006139 case e1000_i350:
6140 /* none of the above registers are supported by i350 */
Alexander Duyck52a1dd42010-03-22 14:07:46 +00006141 break;
6142 }
Alexander Duyck10d8e902009-10-27 15:54:04 +00006143
Alexander Duyckd4960302009-10-27 15:53:45 +00006144 if (adapter->vfs_allocated_count) {
6145 igb_vmdq_set_loopback_pf(hw, true);
6146 igb_vmdq_set_replication_pf(hw, true);
6147 } else {
6148 igb_vmdq_set_loopback_pf(hw, false);
6149 igb_vmdq_set_replication_pf(hw, false);
6150 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006151}
6152
Auke Kok9d5c8242008-01-24 02:22:38 -08006153/* igb_main.c */