blob: 583a21c1def391908a04fd1f2a32d8b39ccfa8bc [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 Duyck55cac242009-11-19 12:42:21 +000064 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_COPPER), board_82575 },
65 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_FIBER), board_82575 },
66 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_SERDES), board_82575 },
67 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_SGMII), board_82575 },
68 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82580_COPPER_DUAL), board_82575 },
Alexander Duyck2d064c02008-07-08 15:10:12 -070069 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576), board_82575 },
Alexander Duyck9eb23412009-03-13 20:42:15 +000070 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_NS), board_82575 },
Alexander Duyck747d49b2009-10-05 06:33:27 +000071 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_NS_SERDES), board_82575 },
Alexander Duyck2d064c02008-07-08 15:10:12 -070072 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_FIBER), board_82575 },
73 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_SERDES), board_82575 },
Alexander Duyck4703bf72009-07-23 18:09:48 +000074 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_SERDES_QUAD), board_82575 },
Alexander Duyckc8ea5ea92009-03-13 20:42:35 +000075 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82576_QUAD_COPPER), board_82575 },
Auke Kok9d5c8242008-01-24 02:22:38 -080076 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82575EB_COPPER), board_82575 },
77 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82575EB_FIBER_SERDES), board_82575 },
78 { PCI_VDEVICE(INTEL, E1000_DEV_ID_82575GB_QUAD_COPPER), board_82575 },
79 /* required last entry */
80 {0, }
81};
82
83MODULE_DEVICE_TABLE(pci, igb_pci_tbl);
84
85void igb_reset(struct igb_adapter *);
86static int igb_setup_all_tx_resources(struct igb_adapter *);
87static int igb_setup_all_rx_resources(struct igb_adapter *);
88static void igb_free_all_tx_resources(struct igb_adapter *);
89static void igb_free_all_rx_resources(struct igb_adapter *);
Alexander Duyck06cf2662009-10-27 15:53:25 +000090static void igb_setup_mrqc(struct igb_adapter *);
Auke Kok9d5c8242008-01-24 02:22:38 -080091void igb_update_stats(struct igb_adapter *);
92static int igb_probe(struct pci_dev *, const struct pci_device_id *);
93static void __devexit igb_remove(struct pci_dev *pdev);
94static int igb_sw_init(struct igb_adapter *);
95static int igb_open(struct net_device *);
96static int igb_close(struct net_device *);
97static void igb_configure_tx(struct igb_adapter *);
98static void igb_configure_rx(struct igb_adapter *);
Auke Kok9d5c8242008-01-24 02:22:38 -080099static void igb_clean_all_tx_rings(struct igb_adapter *);
100static void igb_clean_all_rx_rings(struct igb_adapter *);
Mitch Williams3b644cf2008-06-27 10:59:48 -0700101static void igb_clean_tx_ring(struct igb_ring *);
102static void igb_clean_rx_ring(struct igb_ring *);
Alexander Duyckff41f8d2009-09-03 14:48:56 +0000103static void igb_set_rx_mode(struct net_device *);
Auke Kok9d5c8242008-01-24 02:22:38 -0800104static void igb_update_phy_info(unsigned long);
105static void igb_watchdog(unsigned long);
106static void igb_watchdog_task(struct work_struct *);
Alexander Duyckb1a436c2009-10-27 15:54:43 +0000107static netdev_tx_t igb_xmit_frame_adv(struct sk_buff *skb, struct net_device *);
Auke Kok9d5c8242008-01-24 02:22:38 -0800108static struct net_device_stats *igb_get_stats(struct net_device *);
109static int igb_change_mtu(struct net_device *, int);
110static int igb_set_mac(struct net_device *, void *);
Alexander Duyck68d480c2009-10-05 06:33:08 +0000111static void igb_set_uta(struct igb_adapter *adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800112static irqreturn_t igb_intr(int irq, void *);
113static irqreturn_t igb_intr_msi(int irq, void *);
114static irqreturn_t igb_msix_other(int irq, void *);
Alexander Duyck047e0032009-10-27 15:49:27 +0000115static irqreturn_t igb_msix_ring(int irq, void *);
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700116#ifdef CONFIG_IGB_DCA
Alexander Duyck047e0032009-10-27 15:49:27 +0000117static void igb_update_dca(struct igb_q_vector *);
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700118static void igb_setup_dca(struct igb_adapter *);
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700119#endif /* CONFIG_IGB_DCA */
Alexander Duyck047e0032009-10-27 15:49:27 +0000120static bool igb_clean_tx_irq(struct igb_q_vector *);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700121static int igb_poll(struct napi_struct *, int);
Alexander Duyck047e0032009-10-27 15:49:27 +0000122static bool igb_clean_rx_irq_adv(struct igb_q_vector *, int *, int);
Auke Kok9d5c8242008-01-24 02:22:38 -0800123static int igb_ioctl(struct net_device *, struct ifreq *, int cmd);
124static void igb_tx_timeout(struct net_device *);
125static void igb_reset_task(struct work_struct *);
126static void igb_vlan_rx_register(struct net_device *, struct vlan_group *);
127static void igb_vlan_rx_add_vid(struct net_device *, u16);
128static void igb_vlan_rx_kill_vid(struct net_device *, u16);
129static void igb_restore_vlan(struct igb_adapter *);
Alexander Duyck26ad9172009-10-05 06:32:49 +0000130static void igb_rar_set_qsel(struct igb_adapter *, u8 *, u32 , u8);
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800131static void igb_ping_all_vfs(struct igb_adapter *);
132static void igb_msg_task(struct igb_adapter *);
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800133static void igb_vmm_control(struct igb_adapter *);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +0000134static int igb_set_vf_mac(struct igb_adapter *, int, unsigned char *);
Alexander Duyck4ae196d2009-02-19 20:40:07 -0800135static void igb_restore_vf_multicasts(struct igb_adapter *adapter);
Williams, Mitch A8151d292010-02-10 01:44:24 +0000136static int igb_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac);
137static int igb_ndo_set_vf_vlan(struct net_device *netdev,
138 int vf, u16 vlan, u8 qos);
139static int igb_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate);
140static int igb_ndo_get_vf_config(struct net_device *netdev, int vf,
141 struct ifla_vf_info *ivi);
Auke Kok9d5c8242008-01-24 02:22:38 -0800142
Auke Kok9d5c8242008-01-24 02:22:38 -0800143#ifdef CONFIG_PM
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +0000144static int igb_suspend(struct pci_dev *, pm_message_t);
Auke Kok9d5c8242008-01-24 02:22:38 -0800145static int igb_resume(struct pci_dev *);
146#endif
147static void igb_shutdown(struct pci_dev *);
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700148#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700149static int igb_notify_dca(struct notifier_block *, unsigned long, void *);
150static struct notifier_block dca_notifier = {
151 .notifier_call = igb_notify_dca,
152 .next = NULL,
153 .priority = 0
154};
155#endif
Auke Kok9d5c8242008-01-24 02:22:38 -0800156#ifdef CONFIG_NET_POLL_CONTROLLER
157/* for netdump / net console */
158static void igb_netpoll(struct net_device *);
159#endif
Alexander Duyck37680112009-02-19 20:40:30 -0800160#ifdef CONFIG_PCI_IOV
Alexander Duyck2a3abf62009-04-07 14:37:52 +0000161static unsigned int max_vfs = 0;
162module_param(max_vfs, uint, 0);
163MODULE_PARM_DESC(max_vfs, "Maximum number of virtual functions to allocate "
164 "per physical function");
165#endif /* CONFIG_PCI_IOV */
166
Auke Kok9d5c8242008-01-24 02:22:38 -0800167static pci_ers_result_t igb_io_error_detected(struct pci_dev *,
168 pci_channel_state_t);
169static pci_ers_result_t igb_io_slot_reset(struct pci_dev *);
170static void igb_io_resume(struct pci_dev *);
171
172static struct pci_error_handlers igb_err_handler = {
173 .error_detected = igb_io_error_detected,
174 .slot_reset = igb_io_slot_reset,
175 .resume = igb_io_resume,
176};
177
178
179static struct pci_driver igb_driver = {
180 .name = igb_driver_name,
181 .id_table = igb_pci_tbl,
182 .probe = igb_probe,
183 .remove = __devexit_p(igb_remove),
184#ifdef CONFIG_PM
185 /* Power Managment Hooks */
186 .suspend = igb_suspend,
187 .resume = igb_resume,
188#endif
189 .shutdown = igb_shutdown,
190 .err_handler = &igb_err_handler
191};
192
193MODULE_AUTHOR("Intel Corporation, <e1000-devel@lists.sourceforge.net>");
194MODULE_DESCRIPTION("Intel(R) Gigabit Ethernet Network Driver");
195MODULE_LICENSE("GPL");
196MODULE_VERSION(DRV_VERSION);
197
Patrick Ohly38c845c2009-02-12 05:03:41 +0000198/**
Patrick Ohly38c845c2009-02-12 05:03:41 +0000199 * igb_read_clock - read raw cycle counter (to be used by time counter)
200 */
201static cycle_t igb_read_clock(const struct cyclecounter *tc)
202{
203 struct igb_adapter *adapter =
204 container_of(tc, struct igb_adapter, cycles);
205 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +0000206 u64 stamp = 0;
207 int shift = 0;
Patrick Ohly38c845c2009-02-12 05:03:41 +0000208
Alexander Duyck55cac242009-11-19 12:42:21 +0000209 /*
210 * The timestamp latches on lowest register read. For the 82580
211 * the lowest register is SYSTIMR instead of SYSTIML. However we never
212 * adjusted TIMINCA so SYSTIMR will just read as all 0s so ignore it.
213 */
214 if (hw->mac.type == e1000_82580) {
215 stamp = rd32(E1000_SYSTIMR) >> 8;
216 shift = IGB_82580_TSYNC_SHIFT;
217 }
218
Alexander Duyckc5b9bd52009-10-27 23:46:01 +0000219 stamp |= (u64)rd32(E1000_SYSTIML) << shift;
220 stamp |= (u64)rd32(E1000_SYSTIMH) << (shift + 32);
Patrick Ohly38c845c2009-02-12 05:03:41 +0000221 return stamp;
222}
223
Auke Kok9d5c8242008-01-24 02:22:38 -0800224#ifdef DEBUG
225/**
226 * igb_get_hw_dev_name - return device name string
227 * used by hardware layer to print debugging information
228 **/
229char *igb_get_hw_dev_name(struct e1000_hw *hw)
230{
231 struct igb_adapter *adapter = hw->back;
232 return adapter->netdev->name;
233}
Patrick Ohly38c845c2009-02-12 05:03:41 +0000234
235/**
236 * igb_get_time_str - format current NIC and system time as string
237 */
238static char *igb_get_time_str(struct igb_adapter *adapter,
239 char buffer[160])
240{
241 cycle_t hw = adapter->cycles.read(&adapter->cycles);
242 struct timespec nic = ns_to_timespec(timecounter_read(&adapter->clock));
243 struct timespec sys;
244 struct timespec delta;
245 getnstimeofday(&sys);
246
247 delta = timespec_sub(nic, sys);
248
249 sprintf(buffer,
Patrick Ohly33af6bc2009-02-12 05:03:43 +0000250 "HW %llu, NIC %ld.%09lus, SYS %ld.%09lus, NIC-SYS %lds + %09luns",
251 hw,
Patrick Ohly38c845c2009-02-12 05:03:41 +0000252 (long)nic.tv_sec, nic.tv_nsec,
253 (long)sys.tv_sec, sys.tv_nsec,
254 (long)delta.tv_sec, delta.tv_nsec);
255
256 return buffer;
257}
Auke Kok9d5c8242008-01-24 02:22:38 -0800258#endif
259
260/**
261 * igb_init_module - Driver Registration Routine
262 *
263 * igb_init_module is the first routine called when the driver is
264 * loaded. All it does is register with the PCI subsystem.
265 **/
266static int __init igb_init_module(void)
267{
268 int ret;
269 printk(KERN_INFO "%s - version %s\n",
270 igb_driver_string, igb_driver_version);
271
272 printk(KERN_INFO "%s\n", igb_copyright);
273
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700274#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700275 dca_register_notify(&dca_notifier);
276#endif
Alexander Duyckbbd98fe2009-01-31 00:52:30 -0800277 ret = pci_register_driver(&igb_driver);
Auke Kok9d5c8242008-01-24 02:22:38 -0800278 return ret;
279}
280
281module_init(igb_init_module);
282
283/**
284 * igb_exit_module - Driver Exit Cleanup Routine
285 *
286 * igb_exit_module is called just before the driver is removed
287 * from memory.
288 **/
289static void __exit igb_exit_module(void)
290{
Jeff Kirsher421e02f2008-10-17 11:08:31 -0700291#ifdef CONFIG_IGB_DCA
Jeb Cramerfe4506b2008-07-08 15:07:55 -0700292 dca_unregister_notify(&dca_notifier);
293#endif
Auke Kok9d5c8242008-01-24 02:22:38 -0800294 pci_unregister_driver(&igb_driver);
295}
296
297module_exit(igb_exit_module);
298
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800299#define Q_IDX_82576(i) (((i & 0x1) << 3) + (i >> 1))
300/**
301 * igb_cache_ring_register - Descriptor ring to register mapping
302 * @adapter: board private structure to initialize
303 *
304 * Once we know the feature-set enabled for the device, we'll cache
305 * the register offset the descriptor ring is assigned to.
306 **/
307static void igb_cache_ring_register(struct igb_adapter *adapter)
308{
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000309 int i = 0, j = 0;
Alexander Duyck047e0032009-10-27 15:49:27 +0000310 u32 rbase_offset = adapter->vfs_allocated_count;
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800311
312 switch (adapter->hw.mac.type) {
313 case e1000_82576:
314 /* The queues are allocated for virtualization such that VF 0
315 * is allocated queues 0 and 8, VF 1 queues 1 and 9, etc.
316 * In order to avoid collision we start at the first free queue
317 * and continue consuming queues in the same sequence
318 */
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000319 if (adapter->vfs_allocated_count) {
Alexander Duycka99955f2009-11-12 18:37:19 +0000320 for (; i < adapter->rss_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000321 adapter->rx_ring[i]->reg_idx = rbase_offset +
322 Q_IDX_82576(i);
Alexander Duycka99955f2009-11-12 18:37:19 +0000323 for (; j < adapter->rss_queues; j++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000324 adapter->tx_ring[j]->reg_idx = rbase_offset +
325 Q_IDX_82576(j);
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000326 }
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800327 case e1000_82575:
Alexander Duyck55cac242009-11-19 12:42:21 +0000328 case e1000_82580:
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800329 default:
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000330 for (; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000331 adapter->rx_ring[i]->reg_idx = rbase_offset + i;
Alexander Duyckee1b9f02009-10-27 23:49:40 +0000332 for (; j < adapter->num_tx_queues; j++)
Alexander Duyck3025a442010-02-17 01:02:39 +0000333 adapter->tx_ring[j]->reg_idx = rbase_offset + j;
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800334 break;
335 }
336}
337
Alexander Duyck047e0032009-10-27 15:49:27 +0000338static void igb_free_queues(struct igb_adapter *adapter)
339{
Alexander Duyck3025a442010-02-17 01:02:39 +0000340 int i;
Alexander Duyck047e0032009-10-27 15:49:27 +0000341
Alexander Duyck3025a442010-02-17 01:02:39 +0000342 for (i = 0; i < adapter->num_tx_queues; i++) {
343 kfree(adapter->tx_ring[i]);
344 adapter->tx_ring[i] = NULL;
345 }
346 for (i = 0; i < adapter->num_rx_queues; i++) {
347 kfree(adapter->rx_ring[i]);
348 adapter->rx_ring[i] = NULL;
349 }
Alexander Duyck047e0032009-10-27 15:49:27 +0000350 adapter->num_rx_queues = 0;
351 adapter->num_tx_queues = 0;
352}
353
Auke Kok9d5c8242008-01-24 02:22:38 -0800354/**
355 * igb_alloc_queues - Allocate memory for all rings
356 * @adapter: board private structure to initialize
357 *
358 * We allocate one ring per queue at run-time since we don't know the
359 * number of queues at compile-time.
360 **/
361static int igb_alloc_queues(struct igb_adapter *adapter)
362{
Alexander Duyck3025a442010-02-17 01:02:39 +0000363 struct igb_ring *ring;
Auke Kok9d5c8242008-01-24 02:22:38 -0800364 int i;
365
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700366 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +0000367 ring = kzalloc(sizeof(struct igb_ring), GFP_KERNEL);
368 if (!ring)
369 goto err;
Alexander Duyck68fd9912008-11-20 00:48:10 -0800370 ring->count = adapter->tx_ring_count;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700371 ring->queue_index = i;
Alexander Duyck80785292009-10-27 15:51:47 +0000372 ring->pdev = adapter->pdev;
Alexander Duycke694e962009-10-27 15:53:06 +0000373 ring->netdev = adapter->netdev;
Alexander Duyck85ad76b2009-10-27 15:52:46 +0000374 /* For 82575, context index must be unique per ring. */
375 if (adapter->hw.mac.type == e1000_82575)
376 ring->flags = IGB_RING_FLAG_TX_CTX_IDX;
Alexander Duyck3025a442010-02-17 01:02:39 +0000377 adapter->tx_ring[i] = ring;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700378 }
Alexander Duyck85ad76b2009-10-27 15:52:46 +0000379
Auke Kok9d5c8242008-01-24 02:22:38 -0800380 for (i = 0; i < adapter->num_rx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +0000381 ring = kzalloc(sizeof(struct igb_ring), GFP_KERNEL);
382 if (!ring)
383 goto err;
Alexander Duyck68fd9912008-11-20 00:48:10 -0800384 ring->count = adapter->rx_ring_count;
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700385 ring->queue_index = i;
Alexander Duyck80785292009-10-27 15:51:47 +0000386 ring->pdev = adapter->pdev;
Alexander Duycke694e962009-10-27 15:53:06 +0000387 ring->netdev = adapter->netdev;
Alexander Duyck4c844852009-10-27 15:52:07 +0000388 ring->rx_buffer_len = MAXIMUM_ETHERNET_VLAN_SIZE;
Alexander Duyck85ad76b2009-10-27 15:52:46 +0000389 ring->flags = IGB_RING_FLAG_RX_CSUM; /* enable rx checksum */
390 /* set flag indicating ring supports SCTP checksum offload */
391 if (adapter->hw.mac.type >= e1000_82576)
392 ring->flags |= IGB_RING_FLAG_RX_SCTP_CSUM;
Alexander Duyck3025a442010-02-17 01:02:39 +0000393 adapter->rx_ring[i] = ring;
Auke Kok9d5c8242008-01-24 02:22:38 -0800394 }
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800395
396 igb_cache_ring_register(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +0000397
Auke Kok9d5c8242008-01-24 02:22:38 -0800398 return 0;
Auke Kok9d5c8242008-01-24 02:22:38 -0800399
Alexander Duyck047e0032009-10-27 15:49:27 +0000400err:
401 igb_free_queues(adapter);
Alexander Duycka88f10e2008-07-08 15:13:38 -0700402
Alexander Duyck047e0032009-10-27 15:49:27 +0000403 return -ENOMEM;
Alexander Duycka88f10e2008-07-08 15:13:38 -0700404}
405
Auke Kok9d5c8242008-01-24 02:22:38 -0800406#define IGB_N0_QUEUE -1
Alexander Duyck047e0032009-10-27 15:49:27 +0000407static void igb_assign_vector(struct igb_q_vector *q_vector, int msix_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -0800408{
409 u32 msixbm = 0;
Alexander Duyck047e0032009-10-27 15:49:27 +0000410 struct igb_adapter *adapter = q_vector->adapter;
Auke Kok9d5c8242008-01-24 02:22:38 -0800411 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700412 u32 ivar, index;
Alexander Duyck047e0032009-10-27 15:49:27 +0000413 int rx_queue = IGB_N0_QUEUE;
414 int tx_queue = IGB_N0_QUEUE;
415
416 if (q_vector->rx_ring)
417 rx_queue = q_vector->rx_ring->reg_idx;
418 if (q_vector->tx_ring)
419 tx_queue = q_vector->tx_ring->reg_idx;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700420
421 switch (hw->mac.type) {
422 case e1000_82575:
Auke Kok9d5c8242008-01-24 02:22:38 -0800423 /* The 82575 assigns vectors using a bitmask, which matches the
424 bitmask for the EICR/EIMS/EIMC registers. To assign one
425 or more queues to a vector, we write the appropriate bits
426 into the MSIXBM register for that vector. */
Alexander Duyck047e0032009-10-27 15:49:27 +0000427 if (rx_queue > IGB_N0_QUEUE)
Auke Kok9d5c8242008-01-24 02:22:38 -0800428 msixbm = E1000_EICR_RX_QUEUE0 << rx_queue;
Alexander Duyck047e0032009-10-27 15:49:27 +0000429 if (tx_queue > IGB_N0_QUEUE)
Auke Kok9d5c8242008-01-24 02:22:38 -0800430 msixbm |= E1000_EICR_TX_QUEUE0 << tx_queue;
Alexander Duyckfeeb2722010-02-03 21:59:51 +0000431 if (!adapter->msix_entries && msix_vector == 0)
432 msixbm |= E1000_EIMS_OTHER;
Auke Kok9d5c8242008-01-24 02:22:38 -0800433 array_wr32(E1000_MSIXBM(0), msix_vector, msixbm);
Alexander Duyck047e0032009-10-27 15:49:27 +0000434 q_vector->eims_value = msixbm;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700435 break;
436 case e1000_82576:
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800437 /* 82576 uses a table-based method for assigning vectors.
Alexander Duyck2d064c02008-07-08 15:10:12 -0700438 Each queue has a single entry in the table to which we write
439 a vector number along with a "valid" bit. Sadly, the layout
440 of the table is somewhat counterintuitive. */
441 if (rx_queue > IGB_N0_QUEUE) {
Alexander Duyck047e0032009-10-27 15:49:27 +0000442 index = (rx_queue & 0x7);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700443 ivar = array_rd32(E1000_IVAR0, index);
Alexander Duyck047e0032009-10-27 15:49:27 +0000444 if (rx_queue < 8) {
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800445 /* vector goes into low byte of register */
446 ivar = ivar & 0xFFFFFF00;
447 ivar |= msix_vector | E1000_IVAR_VALID;
Alexander Duyck047e0032009-10-27 15:49:27 +0000448 } else {
449 /* vector goes into third byte of register */
450 ivar = ivar & 0xFF00FFFF;
451 ivar |= (msix_vector | E1000_IVAR_VALID) << 16;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700452 }
Alexander Duyck2d064c02008-07-08 15:10:12 -0700453 array_wr32(E1000_IVAR0, index, ivar);
454 }
455 if (tx_queue > IGB_N0_QUEUE) {
Alexander Duyck047e0032009-10-27 15:49:27 +0000456 index = (tx_queue & 0x7);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700457 ivar = array_rd32(E1000_IVAR0, index);
Alexander Duyck047e0032009-10-27 15:49:27 +0000458 if (tx_queue < 8) {
Alexander Duyck26bc19e2008-12-26 01:34:11 -0800459 /* vector goes into second byte of register */
460 ivar = ivar & 0xFFFF00FF;
461 ivar |= (msix_vector | E1000_IVAR_VALID) << 8;
Alexander Duyck047e0032009-10-27 15:49:27 +0000462 } else {
463 /* vector goes into high byte of register */
464 ivar = ivar & 0x00FFFFFF;
465 ivar |= (msix_vector | E1000_IVAR_VALID) << 24;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700466 }
Alexander Duyck2d064c02008-07-08 15:10:12 -0700467 array_wr32(E1000_IVAR0, index, ivar);
468 }
Alexander Duyck047e0032009-10-27 15:49:27 +0000469 q_vector->eims_value = 1 << msix_vector;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700470 break;
Alexander Duyck55cac242009-11-19 12:42:21 +0000471 case e1000_82580:
472 /* 82580 uses the same table-based approach as 82576 but has fewer
473 entries as a result we carry over for queues greater than 4. */
474 if (rx_queue > IGB_N0_QUEUE) {
475 index = (rx_queue >> 1);
476 ivar = array_rd32(E1000_IVAR0, index);
477 if (rx_queue & 0x1) {
478 /* vector goes into third byte of register */
479 ivar = ivar & 0xFF00FFFF;
480 ivar |= (msix_vector | E1000_IVAR_VALID) << 16;
481 } else {
482 /* vector goes into low byte of register */
483 ivar = ivar & 0xFFFFFF00;
484 ivar |= msix_vector | E1000_IVAR_VALID;
485 }
486 array_wr32(E1000_IVAR0, index, ivar);
487 }
488 if (tx_queue > IGB_N0_QUEUE) {
489 index = (tx_queue >> 1);
490 ivar = array_rd32(E1000_IVAR0, index);
491 if (tx_queue & 0x1) {
492 /* vector goes into high byte of register */
493 ivar = ivar & 0x00FFFFFF;
494 ivar |= (msix_vector | E1000_IVAR_VALID) << 24;
495 } else {
496 /* vector goes into second byte of register */
497 ivar = ivar & 0xFFFF00FF;
498 ivar |= (msix_vector | E1000_IVAR_VALID) << 8;
499 }
500 array_wr32(E1000_IVAR0, index, ivar);
501 }
502 q_vector->eims_value = 1 << msix_vector;
503 break;
Alexander Duyck2d064c02008-07-08 15:10:12 -0700504 default:
505 BUG();
506 break;
507 }
Alexander Duyck26b39272010-02-17 01:00:41 +0000508
509 /* add q_vector eims value to global eims_enable_mask */
510 adapter->eims_enable_mask |= q_vector->eims_value;
511
512 /* configure q_vector to set itr on first interrupt */
513 q_vector->set_itr = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -0800514}
515
516/**
517 * igb_configure_msix - Configure MSI-X hardware
518 *
519 * igb_configure_msix sets up the hardware to properly
520 * generate MSI-X interrupts.
521 **/
522static void igb_configure_msix(struct igb_adapter *adapter)
523{
524 u32 tmp;
525 int i, vector = 0;
526 struct e1000_hw *hw = &adapter->hw;
527
528 adapter->eims_enable_mask = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -0800529
530 /* set vector for other causes, i.e. link changes */
Alexander Duyck2d064c02008-07-08 15:10:12 -0700531 switch (hw->mac.type) {
532 case e1000_82575:
Auke Kok9d5c8242008-01-24 02:22:38 -0800533 tmp = rd32(E1000_CTRL_EXT);
534 /* enable MSI-X PBA support*/
535 tmp |= E1000_CTRL_EXT_PBA_CLR;
536
537 /* Auto-Mask interrupts upon ICR read. */
538 tmp |= E1000_CTRL_EXT_EIAME;
539 tmp |= E1000_CTRL_EXT_IRCA;
540
541 wr32(E1000_CTRL_EXT, tmp);
Alexander Duyck047e0032009-10-27 15:49:27 +0000542
543 /* enable msix_other interrupt */
544 array_wr32(E1000_MSIXBM(0), vector++,
545 E1000_EIMS_OTHER);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700546 adapter->eims_other = E1000_EIMS_OTHER;
Auke Kok9d5c8242008-01-24 02:22:38 -0800547
Alexander Duyck2d064c02008-07-08 15:10:12 -0700548 break;
549
550 case e1000_82576:
Alexander Duyck55cac242009-11-19 12:42:21 +0000551 case e1000_82580:
Alexander Duyck047e0032009-10-27 15:49:27 +0000552 /* Turn on MSI-X capability first, or our settings
553 * won't stick. And it will take days to debug. */
554 wr32(E1000_GPIE, E1000_GPIE_MSIX_MODE |
555 E1000_GPIE_PBA | E1000_GPIE_EIAME |
556 E1000_GPIE_NSICR);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700557
Alexander Duyck047e0032009-10-27 15:49:27 +0000558 /* enable msix_other interrupt */
559 adapter->eims_other = 1 << vector;
560 tmp = (vector++ | E1000_IVAR_VALID) << 8;
561
562 wr32(E1000_IVAR_MISC, tmp);
Alexander Duyck2d064c02008-07-08 15:10:12 -0700563 break;
564 default:
565 /* do nothing, since nothing else supports MSI-X */
566 break;
567 } /* switch (hw->mac.type) */
Alexander Duyck047e0032009-10-27 15:49:27 +0000568
569 adapter->eims_enable_mask |= adapter->eims_other;
570
Alexander Duyck26b39272010-02-17 01:00:41 +0000571 for (i = 0; i < adapter->num_q_vectors; i++)
572 igb_assign_vector(adapter->q_vector[i], vector++);
Alexander Duyck047e0032009-10-27 15:49:27 +0000573
Auke Kok9d5c8242008-01-24 02:22:38 -0800574 wrfl();
575}
576
577/**
578 * igb_request_msix - Initialize MSI-X interrupts
579 *
580 * igb_request_msix allocates MSI-X vectors and requests interrupts from the
581 * kernel.
582 **/
583static int igb_request_msix(struct igb_adapter *adapter)
584{
585 struct net_device *netdev = adapter->netdev;
Alexander Duyck047e0032009-10-27 15:49:27 +0000586 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -0800587 int i, err = 0, vector = 0;
588
Auke Kok9d5c8242008-01-24 02:22:38 -0800589 err = request_irq(adapter->msix_entries[vector].vector,
Joe Perchesa0607fd2009-11-18 23:29:17 -0800590 igb_msix_other, 0, netdev->name, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800591 if (err)
592 goto out;
Alexander Duyck047e0032009-10-27 15:49:27 +0000593 vector++;
594
595 for (i = 0; i < adapter->num_q_vectors; i++) {
596 struct igb_q_vector *q_vector = adapter->q_vector[i];
597
598 q_vector->itr_register = hw->hw_addr + E1000_EITR(vector);
599
600 if (q_vector->rx_ring && q_vector->tx_ring)
601 sprintf(q_vector->name, "%s-TxRx-%u", netdev->name,
602 q_vector->rx_ring->queue_index);
603 else if (q_vector->tx_ring)
604 sprintf(q_vector->name, "%s-tx-%u", netdev->name,
605 q_vector->tx_ring->queue_index);
606 else if (q_vector->rx_ring)
607 sprintf(q_vector->name, "%s-rx-%u", netdev->name,
608 q_vector->rx_ring->queue_index);
609 else
610 sprintf(q_vector->name, "%s-unused", netdev->name);
611
612 err = request_irq(adapter->msix_entries[vector].vector,
Joe Perchesa0607fd2009-11-18 23:29:17 -0800613 igb_msix_ring, 0, q_vector->name,
Alexander Duyck047e0032009-10-27 15:49:27 +0000614 q_vector);
615 if (err)
616 goto out;
617 vector++;
618 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800619
Auke Kok9d5c8242008-01-24 02:22:38 -0800620 igb_configure_msix(adapter);
621 return 0;
622out:
623 return err;
624}
625
626static void igb_reset_interrupt_capability(struct igb_adapter *adapter)
627{
628 if (adapter->msix_entries) {
629 pci_disable_msix(adapter->pdev);
630 kfree(adapter->msix_entries);
631 adapter->msix_entries = NULL;
Alexander Duyck047e0032009-10-27 15:49:27 +0000632 } else if (adapter->flags & IGB_FLAG_HAS_MSI) {
Auke Kok9d5c8242008-01-24 02:22:38 -0800633 pci_disable_msi(adapter->pdev);
Alexander Duyck047e0032009-10-27 15:49:27 +0000634 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800635}
636
Alexander Duyck047e0032009-10-27 15:49:27 +0000637/**
638 * igb_free_q_vectors - Free memory allocated for interrupt vectors
639 * @adapter: board private structure to initialize
640 *
641 * This function frees the memory allocated to the q_vectors. In addition if
642 * NAPI is enabled it will delete any references to the NAPI struct prior
643 * to freeing the q_vector.
644 **/
645static void igb_free_q_vectors(struct igb_adapter *adapter)
646{
647 int v_idx;
648
649 for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
650 struct igb_q_vector *q_vector = adapter->q_vector[v_idx];
651 adapter->q_vector[v_idx] = NULL;
Nick Nunleyfe0592b2010-02-17 01:05:35 +0000652 if (!q_vector)
653 continue;
Alexander Duyck047e0032009-10-27 15:49:27 +0000654 netif_napi_del(&q_vector->napi);
655 kfree(q_vector);
656 }
657 adapter->num_q_vectors = 0;
658}
659
660/**
661 * igb_clear_interrupt_scheme - reset the device to a state of no interrupts
662 *
663 * This function resets the device so that it has 0 rx queues, tx queues, and
664 * MSI-X interrupts allocated.
665 */
666static void igb_clear_interrupt_scheme(struct igb_adapter *adapter)
667{
668 igb_free_queues(adapter);
669 igb_free_q_vectors(adapter);
670 igb_reset_interrupt_capability(adapter);
671}
Auke Kok9d5c8242008-01-24 02:22:38 -0800672
673/**
674 * igb_set_interrupt_capability - set MSI or MSI-X if supported
675 *
676 * Attempt to configure interrupts using the best available
677 * capabilities of the hardware and kernel.
678 **/
679static void igb_set_interrupt_capability(struct igb_adapter *adapter)
680{
681 int err;
682 int numvecs, i;
683
Alexander Duyck83b71802009-02-06 23:15:45 +0000684 /* Number of supported queues. */
Alexander Duycka99955f2009-11-12 18:37:19 +0000685 adapter->num_rx_queues = adapter->rss_queues;
686 adapter->num_tx_queues = adapter->rss_queues;
Alexander Duyck83b71802009-02-06 23:15:45 +0000687
Alexander Duyck047e0032009-10-27 15:49:27 +0000688 /* start with one vector for every rx queue */
689 numvecs = adapter->num_rx_queues;
690
691 /* if tx handler is seperate add 1 for every tx queue */
Alexander Duycka99955f2009-11-12 18:37:19 +0000692 if (!(adapter->flags & IGB_FLAG_QUEUE_PAIRS))
693 numvecs += adapter->num_tx_queues;
Alexander Duyck047e0032009-10-27 15:49:27 +0000694
695 /* store the number of vectors reserved for queues */
696 adapter->num_q_vectors = numvecs;
697
698 /* add 1 vector for link status interrupts */
699 numvecs++;
Auke Kok9d5c8242008-01-24 02:22:38 -0800700 adapter->msix_entries = kcalloc(numvecs, sizeof(struct msix_entry),
701 GFP_KERNEL);
702 if (!adapter->msix_entries)
703 goto msi_only;
704
705 for (i = 0; i < numvecs; i++)
706 adapter->msix_entries[i].entry = i;
707
708 err = pci_enable_msix(adapter->pdev,
709 adapter->msix_entries,
710 numvecs);
711 if (err == 0)
Alexander Duyck34a20e82008-08-26 04:25:13 -0700712 goto out;
Auke Kok9d5c8242008-01-24 02:22:38 -0800713
714 igb_reset_interrupt_capability(adapter);
715
716 /* If we can't do MSI-X, try MSI */
717msi_only:
Alexander Duyck2a3abf62009-04-07 14:37:52 +0000718#ifdef CONFIG_PCI_IOV
719 /* disable SR-IOV for non MSI-X configurations */
720 if (adapter->vf_data) {
721 struct e1000_hw *hw = &adapter->hw;
722 /* disable iov and allow time for transactions to clear */
723 pci_disable_sriov(adapter->pdev);
724 msleep(500);
725
726 kfree(adapter->vf_data);
727 adapter->vf_data = NULL;
728 wr32(E1000_IOVCTL, E1000_IOVCTL_REUSE_VFQ);
729 msleep(100);
730 dev_info(&adapter->pdev->dev, "IOV Disabled\n");
731 }
732#endif
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000733 adapter->vfs_allocated_count = 0;
Alexander Duycka99955f2009-11-12 18:37:19 +0000734 adapter->rss_queues = 1;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000735 adapter->flags |= IGB_FLAG_QUEUE_PAIRS;
Auke Kok9d5c8242008-01-24 02:22:38 -0800736 adapter->num_rx_queues = 1;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700737 adapter->num_tx_queues = 1;
Alexander Duyck047e0032009-10-27 15:49:27 +0000738 adapter->num_q_vectors = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -0800739 if (!pci_enable_msi(adapter->pdev))
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700740 adapter->flags |= IGB_FLAG_HAS_MSI;
Alexander Duyck34a20e82008-08-26 04:25:13 -0700741out:
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -0700742 /* Notify the stack of the (possibly) reduced Tx Queue count. */
David S. Millerfd2ea0a2008-07-17 01:56:23 -0700743 adapter->netdev->real_num_tx_queues = adapter->num_tx_queues;
Auke Kok9d5c8242008-01-24 02:22:38 -0800744 return;
745}
746
747/**
Alexander Duyck047e0032009-10-27 15:49:27 +0000748 * igb_alloc_q_vectors - Allocate memory for interrupt vectors
749 * @adapter: board private structure to initialize
750 *
751 * We allocate one q_vector per queue interrupt. If allocation fails we
752 * return -ENOMEM.
753 **/
754static int igb_alloc_q_vectors(struct igb_adapter *adapter)
755{
756 struct igb_q_vector *q_vector;
757 struct e1000_hw *hw = &adapter->hw;
758 int v_idx;
759
760 for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
761 q_vector = kzalloc(sizeof(struct igb_q_vector), GFP_KERNEL);
762 if (!q_vector)
763 goto err_out;
764 q_vector->adapter = adapter;
Alexander Duyck047e0032009-10-27 15:49:27 +0000765 q_vector->itr_register = hw->hw_addr + E1000_EITR(0);
766 q_vector->itr_val = IGB_START_ITR;
Alexander Duyck047e0032009-10-27 15:49:27 +0000767 netif_napi_add(adapter->netdev, &q_vector->napi, igb_poll, 64);
768 adapter->q_vector[v_idx] = q_vector;
769 }
770 return 0;
771
772err_out:
Nick Nunleyfe0592b2010-02-17 01:05:35 +0000773 igb_free_q_vectors(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +0000774 return -ENOMEM;
775}
776
777static void igb_map_rx_ring_to_vector(struct igb_adapter *adapter,
778 int ring_idx, int v_idx)
779{
Alexander Duyck3025a442010-02-17 01:02:39 +0000780 struct igb_q_vector *q_vector = adapter->q_vector[v_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000781
Alexander Duyck3025a442010-02-17 01:02:39 +0000782 q_vector->rx_ring = adapter->rx_ring[ring_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000783 q_vector->rx_ring->q_vector = q_vector;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000784 q_vector->itr_val = adapter->rx_itr_setting;
785 if (q_vector->itr_val && q_vector->itr_val <= 3)
786 q_vector->itr_val = IGB_START_ITR;
Alexander Duyck047e0032009-10-27 15:49:27 +0000787}
788
789static void igb_map_tx_ring_to_vector(struct igb_adapter *adapter,
790 int ring_idx, int v_idx)
791{
Alexander Duyck3025a442010-02-17 01:02:39 +0000792 struct igb_q_vector *q_vector = adapter->q_vector[v_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000793
Alexander Duyck3025a442010-02-17 01:02:39 +0000794 q_vector->tx_ring = adapter->tx_ring[ring_idx];
Alexander Duyck047e0032009-10-27 15:49:27 +0000795 q_vector->tx_ring->q_vector = q_vector;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +0000796 q_vector->itr_val = adapter->tx_itr_setting;
797 if (q_vector->itr_val && q_vector->itr_val <= 3)
798 q_vector->itr_val = IGB_START_ITR;
Alexander Duyck047e0032009-10-27 15:49:27 +0000799}
800
801/**
802 * igb_map_ring_to_vector - maps allocated queues to vectors
803 *
804 * This function maps the recently allocated queues to vectors.
805 **/
806static int igb_map_ring_to_vector(struct igb_adapter *adapter)
807{
808 int i;
809 int v_idx = 0;
810
811 if ((adapter->num_q_vectors < adapter->num_rx_queues) ||
812 (adapter->num_q_vectors < adapter->num_tx_queues))
813 return -ENOMEM;
814
815 if (adapter->num_q_vectors >=
816 (adapter->num_rx_queues + adapter->num_tx_queues)) {
817 for (i = 0; i < adapter->num_rx_queues; i++)
818 igb_map_rx_ring_to_vector(adapter, i, v_idx++);
819 for (i = 0; i < adapter->num_tx_queues; i++)
820 igb_map_tx_ring_to_vector(adapter, i, v_idx++);
821 } else {
822 for (i = 0; i < adapter->num_rx_queues; i++) {
823 if (i < adapter->num_tx_queues)
824 igb_map_tx_ring_to_vector(adapter, i, v_idx);
825 igb_map_rx_ring_to_vector(adapter, i, v_idx++);
826 }
827 for (; i < adapter->num_tx_queues; i++)
828 igb_map_tx_ring_to_vector(adapter, i, v_idx++);
829 }
830 return 0;
831}
832
833/**
834 * igb_init_interrupt_scheme - initialize interrupts, allocate queues/vectors
835 *
836 * This function initializes the interrupts and allocates all of the queues.
837 **/
838static int igb_init_interrupt_scheme(struct igb_adapter *adapter)
839{
840 struct pci_dev *pdev = adapter->pdev;
841 int err;
842
843 igb_set_interrupt_capability(adapter);
844
845 err = igb_alloc_q_vectors(adapter);
846 if (err) {
847 dev_err(&pdev->dev, "Unable to allocate memory for vectors\n");
848 goto err_alloc_q_vectors;
849 }
850
851 err = igb_alloc_queues(adapter);
852 if (err) {
853 dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
854 goto err_alloc_queues;
855 }
856
857 err = igb_map_ring_to_vector(adapter);
858 if (err) {
859 dev_err(&pdev->dev, "Invalid q_vector to ring mapping\n");
860 goto err_map_queues;
861 }
862
863
864 return 0;
865err_map_queues:
866 igb_free_queues(adapter);
867err_alloc_queues:
868 igb_free_q_vectors(adapter);
869err_alloc_q_vectors:
870 igb_reset_interrupt_capability(adapter);
871 return err;
872}
873
874/**
Auke Kok9d5c8242008-01-24 02:22:38 -0800875 * igb_request_irq - initialize interrupts
876 *
877 * Attempts to configure interrupts using the best available
878 * capabilities of the hardware and kernel.
879 **/
880static int igb_request_irq(struct igb_adapter *adapter)
881{
882 struct net_device *netdev = adapter->netdev;
Alexander Duyck047e0032009-10-27 15:49:27 +0000883 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -0800884 int err = 0;
885
886 if (adapter->msix_entries) {
887 err = igb_request_msix(adapter);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700888 if (!err)
Auke Kok9d5c8242008-01-24 02:22:38 -0800889 goto request_done;
Auke Kok9d5c8242008-01-24 02:22:38 -0800890 /* fall back to MSI */
Alexander Duyck047e0032009-10-27 15:49:27 +0000891 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800892 if (!pci_enable_msi(adapter->pdev))
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700893 adapter->flags |= IGB_FLAG_HAS_MSI;
Auke Kok9d5c8242008-01-24 02:22:38 -0800894 igb_free_all_tx_resources(adapter);
895 igb_free_all_rx_resources(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +0000896 adapter->num_tx_queues = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -0800897 adapter->num_rx_queues = 1;
Alexander Duyck047e0032009-10-27 15:49:27 +0000898 adapter->num_q_vectors = 1;
899 err = igb_alloc_q_vectors(adapter);
900 if (err) {
901 dev_err(&pdev->dev,
902 "Unable to allocate memory for vectors\n");
903 goto request_done;
904 }
905 err = igb_alloc_queues(adapter);
906 if (err) {
907 dev_err(&pdev->dev,
908 "Unable to allocate memory for queues\n");
909 igb_free_q_vectors(adapter);
910 goto request_done;
911 }
912 igb_setup_all_tx_resources(adapter);
913 igb_setup_all_rx_resources(adapter);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700914 } else {
Alexander Duyckfeeb2722010-02-03 21:59:51 +0000915 igb_assign_vector(adapter->q_vector[0], 0);
Auke Kok9d5c8242008-01-24 02:22:38 -0800916 }
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700917
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700918 if (adapter->flags & IGB_FLAG_HAS_MSI) {
Joe Perchesa0607fd2009-11-18 23:29:17 -0800919 err = request_irq(adapter->pdev->irq, igb_intr_msi, 0,
Alexander Duyck047e0032009-10-27 15:49:27 +0000920 netdev->name, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800921 if (!err)
922 goto request_done;
Alexander Duyck047e0032009-10-27 15:49:27 +0000923
Auke Kok9d5c8242008-01-24 02:22:38 -0800924 /* fall back to legacy interrupts */
925 igb_reset_interrupt_capability(adapter);
Alexander Duyck7dfc16f2008-07-08 15:10:46 -0700926 adapter->flags &= ~IGB_FLAG_HAS_MSI;
Auke Kok9d5c8242008-01-24 02:22:38 -0800927 }
928
Joe Perchesa0607fd2009-11-18 23:29:17 -0800929 err = request_irq(adapter->pdev->irq, igb_intr, IRQF_SHARED,
Alexander Duyck047e0032009-10-27 15:49:27 +0000930 netdev->name, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800931
Andy Gospodarek6cb5e572008-02-15 14:05:25 -0800932 if (err)
Auke Kok9d5c8242008-01-24 02:22:38 -0800933 dev_err(&adapter->pdev->dev, "Error %d getting interrupt\n",
934 err);
Auke Kok9d5c8242008-01-24 02:22:38 -0800935
936request_done:
937 return err;
938}
939
940static void igb_free_irq(struct igb_adapter *adapter)
941{
Auke Kok9d5c8242008-01-24 02:22:38 -0800942 if (adapter->msix_entries) {
943 int vector = 0, i;
944
Alexander Duyck047e0032009-10-27 15:49:27 +0000945 free_irq(adapter->msix_entries[vector++].vector, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800946
Alexander Duyck047e0032009-10-27 15:49:27 +0000947 for (i = 0; i < adapter->num_q_vectors; i++) {
948 struct igb_q_vector *q_vector = adapter->q_vector[i];
949 free_irq(adapter->msix_entries[vector++].vector,
950 q_vector);
951 }
952 } else {
953 free_irq(adapter->pdev->irq, adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -0800954 }
Auke Kok9d5c8242008-01-24 02:22:38 -0800955}
956
957/**
958 * igb_irq_disable - Mask off interrupt generation on the NIC
959 * @adapter: board private structure
960 **/
961static void igb_irq_disable(struct igb_adapter *adapter)
962{
963 struct e1000_hw *hw = &adapter->hw;
964
Alexander Duyck25568a52009-10-27 23:49:59 +0000965 /*
966 * we need to be careful when disabling interrupts. The VFs are also
967 * mapped into these registers and so clearing the bits can cause
968 * issues on the VF drivers so we only need to clear what we set
969 */
Auke Kok9d5c8242008-01-24 02:22:38 -0800970 if (adapter->msix_entries) {
Alexander Duyck2dfd1212009-09-03 14:49:15 +0000971 u32 regval = rd32(E1000_EIAM);
972 wr32(E1000_EIAM, regval & ~adapter->eims_enable_mask);
973 wr32(E1000_EIMC, adapter->eims_enable_mask);
974 regval = rd32(E1000_EIAC);
975 wr32(E1000_EIAC, regval & ~adapter->eims_enable_mask);
Auke Kok9d5c8242008-01-24 02:22:38 -0800976 }
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700977
978 wr32(E1000_IAM, 0);
Auke Kok9d5c8242008-01-24 02:22:38 -0800979 wr32(E1000_IMC, ~0);
980 wrfl();
981 synchronize_irq(adapter->pdev->irq);
982}
983
984/**
985 * igb_irq_enable - Enable default interrupt generation settings
986 * @adapter: board private structure
987 **/
988static void igb_irq_enable(struct igb_adapter *adapter)
989{
990 struct e1000_hw *hw = &adapter->hw;
991
992 if (adapter->msix_entries) {
Alexander Duyck25568a52009-10-27 23:49:59 +0000993 u32 ims = E1000_IMS_LSC | E1000_IMS_DOUTSYNC;
Alexander Duyck2dfd1212009-09-03 14:49:15 +0000994 u32 regval = rd32(E1000_EIAC);
995 wr32(E1000_EIAC, regval | adapter->eims_enable_mask);
996 regval = rd32(E1000_EIAM);
997 wr32(E1000_EIAM, regval | adapter->eims_enable_mask);
PJ Waskiewicz844290e2008-06-27 11:00:39 -0700998 wr32(E1000_EIMS, adapter->eims_enable_mask);
Alexander Duyck25568a52009-10-27 23:49:59 +0000999 if (adapter->vfs_allocated_count) {
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001000 wr32(E1000_MBVFIMR, 0xFF);
Alexander Duyck25568a52009-10-27 23:49:59 +00001001 ims |= E1000_IMS_VMMB;
1002 }
Alexander Duyck55cac242009-11-19 12:42:21 +00001003 if (adapter->hw.mac.type == e1000_82580)
1004 ims |= E1000_IMS_DRSTA;
1005
Alexander Duyck25568a52009-10-27 23:49:59 +00001006 wr32(E1000_IMS, ims);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07001007 } else {
Alexander Duyck55cac242009-11-19 12:42:21 +00001008 wr32(E1000_IMS, IMS_ENABLE_MASK |
1009 E1000_IMS_DRSTA);
1010 wr32(E1000_IAM, IMS_ENABLE_MASK |
1011 E1000_IMS_DRSTA);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07001012 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001013}
1014
1015static void igb_update_mng_vlan(struct igb_adapter *adapter)
1016{
Alexander Duyck51466232009-10-27 23:47:35 +00001017 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08001018 u16 vid = adapter->hw.mng_cookie.vlan_id;
1019 u16 old_vid = adapter->mng_vlan_id;
Auke Kok9d5c8242008-01-24 02:22:38 -08001020
Alexander Duyck51466232009-10-27 23:47:35 +00001021 if (hw->mng_cookie.status & E1000_MNG_DHCP_COOKIE_STATUS_VLAN) {
1022 /* add VID to filter table */
1023 igb_vfta_set(hw, vid, true);
1024 adapter->mng_vlan_id = vid;
1025 } else {
1026 adapter->mng_vlan_id = IGB_MNG_VLAN_NONE;
1027 }
1028
1029 if ((old_vid != (u16)IGB_MNG_VLAN_NONE) &&
1030 (vid != old_vid) &&
1031 !vlan_group_get_device(adapter->vlgrp, old_vid)) {
1032 /* remove VID from filter table */
1033 igb_vfta_set(hw, old_vid, false);
Auke Kok9d5c8242008-01-24 02:22:38 -08001034 }
1035}
1036
1037/**
1038 * igb_release_hw_control - release control of the h/w to f/w
1039 * @adapter: address of board private structure
1040 *
1041 * igb_release_hw_control resets CTRL_EXT:DRV_LOAD bit.
1042 * For ASF and Pass Through versions of f/w this means that the
1043 * driver is no longer loaded.
1044 *
1045 **/
1046static void igb_release_hw_control(struct igb_adapter *adapter)
1047{
1048 struct e1000_hw *hw = &adapter->hw;
1049 u32 ctrl_ext;
1050
1051 /* Let firmware take over control of h/w */
1052 ctrl_ext = rd32(E1000_CTRL_EXT);
1053 wr32(E1000_CTRL_EXT,
1054 ctrl_ext & ~E1000_CTRL_EXT_DRV_LOAD);
1055}
1056
Auke Kok9d5c8242008-01-24 02:22:38 -08001057/**
1058 * igb_get_hw_control - get control of the h/w from f/w
1059 * @adapter: address of board private structure
1060 *
1061 * igb_get_hw_control sets CTRL_EXT:DRV_LOAD bit.
1062 * For ASF and Pass Through versions of f/w this means that
1063 * the driver is loaded.
1064 *
1065 **/
1066static void igb_get_hw_control(struct igb_adapter *adapter)
1067{
1068 struct e1000_hw *hw = &adapter->hw;
1069 u32 ctrl_ext;
1070
1071 /* Let firmware know the driver has taken over */
1072 ctrl_ext = rd32(E1000_CTRL_EXT);
1073 wr32(E1000_CTRL_EXT,
1074 ctrl_ext | E1000_CTRL_EXT_DRV_LOAD);
1075}
1076
Auke Kok9d5c8242008-01-24 02:22:38 -08001077/**
1078 * igb_configure - configure the hardware for RX and TX
1079 * @adapter: private board structure
1080 **/
1081static void igb_configure(struct igb_adapter *adapter)
1082{
1083 struct net_device *netdev = adapter->netdev;
1084 int i;
1085
1086 igb_get_hw_control(adapter);
Alexander Duyckff41f8d2009-09-03 14:48:56 +00001087 igb_set_rx_mode(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001088
1089 igb_restore_vlan(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001090
Alexander Duyck85b430b2009-10-27 15:50:29 +00001091 igb_setup_tctl(adapter);
Alexander Duyck06cf2662009-10-27 15:53:25 +00001092 igb_setup_mrqc(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001093 igb_setup_rctl(adapter);
Alexander Duyck85b430b2009-10-27 15:50:29 +00001094
1095 igb_configure_tx(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001096 igb_configure_rx(adapter);
Alexander Duyck662d7202008-06-27 11:00:29 -07001097
1098 igb_rx_fifo_flush_82575(&adapter->hw);
1099
Alexander Duyckc493ea42009-03-20 00:16:50 +00001100 /* call igb_desc_unused which always leaves
Auke Kok9d5c8242008-01-24 02:22:38 -08001101 * at least 1 descriptor unused to make sure
1102 * next_to_use != next_to_clean */
1103 for (i = 0; i < adapter->num_rx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00001104 struct igb_ring *ring = adapter->rx_ring[i];
Alexander Duyckc493ea42009-03-20 00:16:50 +00001105 igb_alloc_rx_buffers_adv(ring, igb_desc_unused(ring));
Auke Kok9d5c8242008-01-24 02:22:38 -08001106 }
1107
1108
1109 adapter->tx_queue_len = netdev->tx_queue_len;
1110}
1111
Nick Nunley88a268c2010-02-17 01:01:59 +00001112/**
1113 * igb_power_up_link - Power up the phy/serdes link
1114 * @adapter: address of board private structure
1115 **/
1116void igb_power_up_link(struct igb_adapter *adapter)
1117{
1118 if (adapter->hw.phy.media_type == e1000_media_type_copper)
1119 igb_power_up_phy_copper(&adapter->hw);
1120 else
1121 igb_power_up_serdes_link_82575(&adapter->hw);
1122}
1123
1124/**
1125 * igb_power_down_link - Power down the phy/serdes link
1126 * @adapter: address of board private structure
1127 */
1128static void igb_power_down_link(struct igb_adapter *adapter)
1129{
1130 if (adapter->hw.phy.media_type == e1000_media_type_copper)
1131 igb_power_down_phy_copper_82575(&adapter->hw);
1132 else
1133 igb_shutdown_serdes_link_82575(&adapter->hw);
1134}
Auke Kok9d5c8242008-01-24 02:22:38 -08001135
1136/**
1137 * igb_up - Open the interface and prepare it to handle traffic
1138 * @adapter: board private structure
1139 **/
Auke Kok9d5c8242008-01-24 02:22:38 -08001140int igb_up(struct igb_adapter *adapter)
1141{
1142 struct e1000_hw *hw = &adapter->hw;
1143 int i;
1144
1145 /* hardware has been reset, we need to reload some things */
1146 igb_configure(adapter);
1147
1148 clear_bit(__IGB_DOWN, &adapter->state);
1149
Alexander Duyck047e0032009-10-27 15:49:27 +00001150 for (i = 0; i < adapter->num_q_vectors; i++) {
1151 struct igb_q_vector *q_vector = adapter->q_vector[i];
1152 napi_enable(&q_vector->napi);
1153 }
PJ Waskiewicz844290e2008-06-27 11:00:39 -07001154 if (adapter->msix_entries)
Auke Kok9d5c8242008-01-24 02:22:38 -08001155 igb_configure_msix(adapter);
Alexander Duyckfeeb2722010-02-03 21:59:51 +00001156 else
1157 igb_assign_vector(adapter->q_vector[0], 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08001158
1159 /* Clear any pending interrupts. */
1160 rd32(E1000_ICR);
1161 igb_irq_enable(adapter);
1162
Alexander Duyckd4960302009-10-27 15:53:45 +00001163 /* notify VFs that reset has been completed */
1164 if (adapter->vfs_allocated_count) {
1165 u32 reg_data = rd32(E1000_CTRL_EXT);
1166 reg_data |= E1000_CTRL_EXT_PFRSTD;
1167 wr32(E1000_CTRL_EXT, reg_data);
1168 }
1169
Jesse Brandeburg4cb9be72009-04-21 18:42:05 +00001170 netif_tx_start_all_queues(adapter->netdev);
1171
Alexander Duyck25568a52009-10-27 23:49:59 +00001172 /* start the watchdog. */
1173 hw->mac.get_link_status = 1;
1174 schedule_work(&adapter->watchdog_task);
1175
Auke Kok9d5c8242008-01-24 02:22:38 -08001176 return 0;
1177}
1178
1179void igb_down(struct igb_adapter *adapter)
1180{
Auke Kok9d5c8242008-01-24 02:22:38 -08001181 struct net_device *netdev = adapter->netdev;
Alexander Duyck330a6d62009-10-27 23:51:35 +00001182 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08001183 u32 tctl, rctl;
1184 int i;
1185
1186 /* signal that we're down so the interrupt handler does not
1187 * reschedule our watchdog timer */
1188 set_bit(__IGB_DOWN, &adapter->state);
1189
1190 /* disable receives in the hardware */
1191 rctl = rd32(E1000_RCTL);
1192 wr32(E1000_RCTL, rctl & ~E1000_RCTL_EN);
1193 /* flush and sleep below */
1194
David S. Millerfd2ea0a2008-07-17 01:56:23 -07001195 netif_tx_stop_all_queues(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001196
1197 /* disable transmits in the hardware */
1198 tctl = rd32(E1000_TCTL);
1199 tctl &= ~E1000_TCTL_EN;
1200 wr32(E1000_TCTL, tctl);
1201 /* flush both disables and wait for them to finish */
1202 wrfl();
1203 msleep(10);
1204
Alexander Duyck047e0032009-10-27 15:49:27 +00001205 for (i = 0; i < adapter->num_q_vectors; i++) {
1206 struct igb_q_vector *q_vector = adapter->q_vector[i];
1207 napi_disable(&q_vector->napi);
1208 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001209
Auke Kok9d5c8242008-01-24 02:22:38 -08001210 igb_irq_disable(adapter);
1211
1212 del_timer_sync(&adapter->watchdog_timer);
1213 del_timer_sync(&adapter->phy_info_timer);
1214
1215 netdev->tx_queue_len = adapter->tx_queue_len;
1216 netif_carrier_off(netdev);
Alexander Duyck04fe6352009-02-06 23:22:32 +00001217
1218 /* record the stats before reset*/
1219 igb_update_stats(adapter);
1220
Auke Kok9d5c8242008-01-24 02:22:38 -08001221 adapter->link_speed = 0;
1222 adapter->link_duplex = 0;
1223
Jeff Kirsher30236822008-06-24 17:01:15 -07001224 if (!pci_channel_offline(adapter->pdev))
1225 igb_reset(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001226 igb_clean_all_tx_rings(adapter);
1227 igb_clean_all_rx_rings(adapter);
Alexander Duyck7e0e99e2009-05-21 13:06:56 +00001228#ifdef CONFIG_IGB_DCA
1229
1230 /* since we reset the hardware DCA settings were cleared */
1231 igb_setup_dca(adapter);
1232#endif
Auke Kok9d5c8242008-01-24 02:22:38 -08001233}
1234
1235void igb_reinit_locked(struct igb_adapter *adapter)
1236{
1237 WARN_ON(in_interrupt());
1238 while (test_and_set_bit(__IGB_RESETTING, &adapter->state))
1239 msleep(1);
1240 igb_down(adapter);
1241 igb_up(adapter);
1242 clear_bit(__IGB_RESETTING, &adapter->state);
1243}
1244
1245void igb_reset(struct igb_adapter *adapter)
1246{
Alexander Duyck090b1792009-10-27 23:51:55 +00001247 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08001248 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck2d064c02008-07-08 15:10:12 -07001249 struct e1000_mac_info *mac = &hw->mac;
1250 struct e1000_fc_info *fc = &hw->fc;
Auke Kok9d5c8242008-01-24 02:22:38 -08001251 u32 pba = 0, tx_space, min_tx_space, min_rx_space;
1252 u16 hwm;
1253
1254 /* Repartition Pba for greater than 9k mtu
1255 * To take effect CTRL.RST is required.
1256 */
Alexander Duyckfa4dfae2009-02-06 23:21:31 +00001257 switch (mac->type) {
Alexander Duyck55cac242009-11-19 12:42:21 +00001258 case e1000_82580:
1259 pba = rd32(E1000_RXPBS);
1260 pba = igb_rxpbs_adjust_82580(pba);
1261 break;
Alexander Duyckfa4dfae2009-02-06 23:21:31 +00001262 case e1000_82576:
Alexander Duyckd249be52009-10-27 23:46:38 +00001263 pba = rd32(E1000_RXPBS);
1264 pba &= E1000_RXPBS_SIZE_MASK_82576;
Alexander Duyckfa4dfae2009-02-06 23:21:31 +00001265 break;
1266 case e1000_82575:
1267 default:
1268 pba = E1000_PBA_34K;
1269 break;
Alexander Duyck2d064c02008-07-08 15:10:12 -07001270 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001271
Alexander Duyck2d064c02008-07-08 15:10:12 -07001272 if ((adapter->max_frame_size > ETH_FRAME_LEN + ETH_FCS_LEN) &&
1273 (mac->type < e1000_82576)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08001274 /* adjust PBA for jumbo frames */
1275 wr32(E1000_PBA, pba);
1276
1277 /* To maintain wire speed transmits, the Tx FIFO should be
1278 * large enough to accommodate two full transmit packets,
1279 * rounded up to the next 1KB and expressed in KB. Likewise,
1280 * the Rx FIFO should be large enough to accommodate at least
1281 * one full receive packet and is similarly rounded up and
1282 * expressed in KB. */
1283 pba = rd32(E1000_PBA);
1284 /* upper 16 bits has Tx packet buffer allocation size in KB */
1285 tx_space = pba >> 16;
1286 /* lower 16 bits has Rx packet buffer allocation size in KB */
1287 pba &= 0xffff;
1288 /* the tx fifo also stores 16 bytes of information about the tx
1289 * but don't include ethernet FCS because hardware appends it */
1290 min_tx_space = (adapter->max_frame_size +
Alexander Duyck85e8d002009-02-16 00:00:20 -08001291 sizeof(union e1000_adv_tx_desc) -
Auke Kok9d5c8242008-01-24 02:22:38 -08001292 ETH_FCS_LEN) * 2;
1293 min_tx_space = ALIGN(min_tx_space, 1024);
1294 min_tx_space >>= 10;
1295 /* software strips receive CRC, so leave room for it */
1296 min_rx_space = adapter->max_frame_size;
1297 min_rx_space = ALIGN(min_rx_space, 1024);
1298 min_rx_space >>= 10;
1299
1300 /* If current Tx allocation is less than the min Tx FIFO size,
1301 * and the min Tx FIFO size is less than the current Rx FIFO
1302 * allocation, take space away from current Rx allocation */
1303 if (tx_space < min_tx_space &&
1304 ((min_tx_space - tx_space) < pba)) {
1305 pba = pba - (min_tx_space - tx_space);
1306
1307 /* if short on rx space, rx wins and must trump tx
1308 * adjustment */
1309 if (pba < min_rx_space)
1310 pba = min_rx_space;
1311 }
Alexander Duyck2d064c02008-07-08 15:10:12 -07001312 wr32(E1000_PBA, pba);
Auke Kok9d5c8242008-01-24 02:22:38 -08001313 }
Auke Kok9d5c8242008-01-24 02:22:38 -08001314
1315 /* flow control settings */
1316 /* The high water mark must be low enough to fit one full frame
1317 * (or the size used for early receive) above it in the Rx FIFO.
1318 * Set it to the lower of:
1319 * - 90% of the Rx FIFO size, or
1320 * - the full Rx FIFO size minus one full frame */
1321 hwm = min(((pba << 10) * 9 / 10),
Alexander Duyck2d064c02008-07-08 15:10:12 -07001322 ((pba << 10) - 2 * adapter->max_frame_size));
Auke Kok9d5c8242008-01-24 02:22:38 -08001323
Alexander Duyckd405ea32009-12-23 13:21:27 +00001324 fc->high_water = hwm & 0xFFF0; /* 16-byte granularity */
1325 fc->low_water = fc->high_water - 16;
Auke Kok9d5c8242008-01-24 02:22:38 -08001326 fc->pause_time = 0xFFFF;
1327 fc->send_xon = 1;
Alexander Duyck0cce1192009-07-23 18:10:24 +00001328 fc->current_mode = fc->requested_mode;
Auke Kok9d5c8242008-01-24 02:22:38 -08001329
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001330 /* disable receive for all VFs and wait one second */
1331 if (adapter->vfs_allocated_count) {
1332 int i;
1333 for (i = 0 ; i < adapter->vfs_allocated_count; i++)
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00001334 adapter->vf_data[i].flags = 0;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001335
1336 /* ping all the active vfs to let them know we are going down */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00001337 igb_ping_all_vfs(adapter);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08001338
1339 /* disable transmits and receives */
1340 wr32(E1000_VFRE, 0);
1341 wr32(E1000_VFTE, 0);
1342 }
1343
Auke Kok9d5c8242008-01-24 02:22:38 -08001344 /* Allow time for pending master requests to run */
Alexander Duyck330a6d62009-10-27 23:51:35 +00001345 hw->mac.ops.reset_hw(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001346 wr32(E1000_WUC, 0);
1347
Alexander Duyck330a6d62009-10-27 23:51:35 +00001348 if (hw->mac.ops.init_hw(hw))
Alexander Duyck090b1792009-10-27 23:51:55 +00001349 dev_err(&pdev->dev, "Hardware Error\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08001350
Alexander Duyck55cac242009-11-19 12:42:21 +00001351 if (hw->mac.type == e1000_82580) {
1352 u32 reg = rd32(E1000_PCIEMISC);
1353 wr32(E1000_PCIEMISC,
1354 reg & ~E1000_PCIEMISC_LX_DECISION);
1355 }
Nick Nunley88a268c2010-02-17 01:01:59 +00001356 if (!netif_running(adapter->netdev))
1357 igb_power_down_link(adapter);
1358
Auke Kok9d5c8242008-01-24 02:22:38 -08001359 igb_update_mng_vlan(adapter);
1360
1361 /* Enable h/w to recognize an 802.1Q VLAN Ethernet packet */
1362 wr32(E1000_VET, ETHERNET_IEEE_VLAN_TYPE);
1363
Alexander Duyck330a6d62009-10-27 23:51:35 +00001364 igb_get_phy_info(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001365}
1366
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001367static const struct net_device_ops igb_netdev_ops = {
Alexander Duyck559e9c42009-10-27 23:52:50 +00001368 .ndo_open = igb_open,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001369 .ndo_stop = igb_close,
Stephen Hemminger00829822008-11-20 20:14:53 -08001370 .ndo_start_xmit = igb_xmit_frame_adv,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001371 .ndo_get_stats = igb_get_stats,
Alexander Duyckff41f8d2009-09-03 14:48:56 +00001372 .ndo_set_rx_mode = igb_set_rx_mode,
1373 .ndo_set_multicast_list = igb_set_rx_mode,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001374 .ndo_set_mac_address = igb_set_mac,
1375 .ndo_change_mtu = igb_change_mtu,
1376 .ndo_do_ioctl = igb_ioctl,
1377 .ndo_tx_timeout = igb_tx_timeout,
1378 .ndo_validate_addr = eth_validate_addr,
1379 .ndo_vlan_rx_register = igb_vlan_rx_register,
1380 .ndo_vlan_rx_add_vid = igb_vlan_rx_add_vid,
1381 .ndo_vlan_rx_kill_vid = igb_vlan_rx_kill_vid,
Williams, Mitch A8151d292010-02-10 01:44:24 +00001382 .ndo_set_vf_mac = igb_ndo_set_vf_mac,
1383 .ndo_set_vf_vlan = igb_ndo_set_vf_vlan,
1384 .ndo_set_vf_tx_rate = igb_ndo_set_vf_bw,
1385 .ndo_get_vf_config = igb_ndo_get_vf_config,
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001386#ifdef CONFIG_NET_POLL_CONTROLLER
1387 .ndo_poll_controller = igb_netpoll,
1388#endif
1389};
1390
Taku Izumi42bfd33a2008-06-20 12:10:30 +09001391/**
Auke Kok9d5c8242008-01-24 02:22:38 -08001392 * igb_probe - Device Initialization Routine
1393 * @pdev: PCI device information struct
1394 * @ent: entry in igb_pci_tbl
1395 *
1396 * Returns 0 on success, negative on failure
1397 *
1398 * igb_probe initializes an adapter identified by a pci_dev structure.
1399 * The OS initialization, configuring of the adapter private structure,
1400 * and a hardware reset occur.
1401 **/
1402static int __devinit igb_probe(struct pci_dev *pdev,
1403 const struct pci_device_id *ent)
1404{
1405 struct net_device *netdev;
1406 struct igb_adapter *adapter;
1407 struct e1000_hw *hw;
Alexander Duyck4337e992009-10-27 23:48:31 +00001408 u16 eeprom_data = 0;
1409 static int global_quad_port_a; /* global quad port a indication */
Auke Kok9d5c8242008-01-24 02:22:38 -08001410 const struct e1000_info *ei = igb_info_tbl[ent->driver_data];
1411 unsigned long mmio_start, mmio_len;
David S. Miller2d6a5e92009-03-17 15:01:30 -07001412 int err, pci_using_dac;
Auke Kok9d5c8242008-01-24 02:22:38 -08001413 u16 eeprom_apme_mask = IGB_EEPROM_APME;
1414 u32 part_num;
1415
Alexander Duyckaed5dec2009-02-06 23:16:04 +00001416 err = pci_enable_device_mem(pdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001417 if (err)
1418 return err;
1419
1420 pci_using_dac = 0;
Yang Hongyang6a355282009-04-06 19:01:13 -07001421 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
Auke Kok9d5c8242008-01-24 02:22:38 -08001422 if (!err) {
Yang Hongyang6a355282009-04-06 19:01:13 -07001423 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64));
Auke Kok9d5c8242008-01-24 02:22:38 -08001424 if (!err)
1425 pci_using_dac = 1;
1426 } else {
Yang Hongyang284901a2009-04-06 19:01:15 -07001427 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
Auke Kok9d5c8242008-01-24 02:22:38 -08001428 if (err) {
Yang Hongyang284901a2009-04-06 19:01:15 -07001429 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
Auke Kok9d5c8242008-01-24 02:22:38 -08001430 if (err) {
1431 dev_err(&pdev->dev, "No usable DMA "
1432 "configuration, aborting\n");
1433 goto err_dma;
1434 }
1435 }
1436 }
1437
Alexander Duyckaed5dec2009-02-06 23:16:04 +00001438 err = pci_request_selected_regions(pdev, pci_select_bars(pdev,
1439 IORESOURCE_MEM),
1440 igb_driver_name);
Auke Kok9d5c8242008-01-24 02:22:38 -08001441 if (err)
1442 goto err_pci_reg;
1443
Frans Pop19d5afd2009-10-02 10:04:12 -07001444 pci_enable_pcie_error_reporting(pdev);
Alexander Duyck40a914f2008-11-27 00:24:37 -08001445
Auke Kok9d5c8242008-01-24 02:22:38 -08001446 pci_set_master(pdev);
Auke Kokc682fc22008-04-23 11:09:34 -07001447 pci_save_state(pdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001448
1449 err = -ENOMEM;
Alexander Duyck1bfaf072009-02-19 20:39:23 -08001450 netdev = alloc_etherdev_mq(sizeof(struct igb_adapter),
1451 IGB_ABS_MAX_TX_QUEUES);
Auke Kok9d5c8242008-01-24 02:22:38 -08001452 if (!netdev)
1453 goto err_alloc_etherdev;
1454
1455 SET_NETDEV_DEV(netdev, &pdev->dev);
1456
1457 pci_set_drvdata(pdev, netdev);
1458 adapter = netdev_priv(netdev);
1459 adapter->netdev = netdev;
1460 adapter->pdev = pdev;
1461 hw = &adapter->hw;
1462 hw->back = adapter;
1463 adapter->msg_enable = NETIF_MSG_DRV | NETIF_MSG_PROBE;
1464
1465 mmio_start = pci_resource_start(pdev, 0);
1466 mmio_len = pci_resource_len(pdev, 0);
1467
1468 err = -EIO;
Alexander Duyck28b07592009-02-06 23:20:31 +00001469 hw->hw_addr = ioremap(mmio_start, mmio_len);
1470 if (!hw->hw_addr)
Auke Kok9d5c8242008-01-24 02:22:38 -08001471 goto err_ioremap;
1472
Stephen Hemminger2e5c6922008-11-19 22:20:44 -08001473 netdev->netdev_ops = &igb_netdev_ops;
Auke Kok9d5c8242008-01-24 02:22:38 -08001474 igb_set_ethtool_ops(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08001475 netdev->watchdog_timeo = 5 * HZ;
Auke Kok9d5c8242008-01-24 02:22:38 -08001476
1477 strncpy(netdev->name, pci_name(pdev), sizeof(netdev->name) - 1);
1478
1479 netdev->mem_start = mmio_start;
1480 netdev->mem_end = mmio_start + mmio_len;
1481
Auke Kok9d5c8242008-01-24 02:22:38 -08001482 /* PCI config space info */
1483 hw->vendor_id = pdev->vendor;
1484 hw->device_id = pdev->device;
1485 hw->revision_id = pdev->revision;
1486 hw->subsystem_vendor_id = pdev->subsystem_vendor;
1487 hw->subsystem_device_id = pdev->subsystem_device;
1488
Auke Kok9d5c8242008-01-24 02:22:38 -08001489 /* Copy the default MAC, PHY and NVM function pointers */
1490 memcpy(&hw->mac.ops, ei->mac_ops, sizeof(hw->mac.ops));
1491 memcpy(&hw->phy.ops, ei->phy_ops, sizeof(hw->phy.ops));
1492 memcpy(&hw->nvm.ops, ei->nvm_ops, sizeof(hw->nvm.ops));
1493 /* Initialize skew-specific constants */
1494 err = ei->get_invariants(hw);
1495 if (err)
Alexander Duyck450c87c2009-02-06 23:22:11 +00001496 goto err_sw_init;
Auke Kok9d5c8242008-01-24 02:22:38 -08001497
Alexander Duyck450c87c2009-02-06 23:22:11 +00001498 /* setup the private structure */
Auke Kok9d5c8242008-01-24 02:22:38 -08001499 err = igb_sw_init(adapter);
1500 if (err)
1501 goto err_sw_init;
1502
1503 igb_get_bus_info_pcie(hw);
1504
1505 hw->phy.autoneg_wait_to_complete = false;
Auke Kok9d5c8242008-01-24 02:22:38 -08001506
1507 /* Copper options */
1508 if (hw->phy.media_type == e1000_media_type_copper) {
1509 hw->phy.mdix = AUTO_ALL_MODES;
1510 hw->phy.disable_polarity_correction = false;
1511 hw->phy.ms_type = e1000_ms_hw_default;
1512 }
1513
1514 if (igb_check_reset_block(hw))
1515 dev_info(&pdev->dev,
1516 "PHY reset is blocked due to SOL/IDER session.\n");
1517
1518 netdev->features = NETIF_F_SG |
Alexander Duyck7d8eb292009-02-06 23:18:27 +00001519 NETIF_F_IP_CSUM |
Auke Kok9d5c8242008-01-24 02:22:38 -08001520 NETIF_F_HW_VLAN_TX |
1521 NETIF_F_HW_VLAN_RX |
1522 NETIF_F_HW_VLAN_FILTER;
1523
Alexander Duyck7d8eb292009-02-06 23:18:27 +00001524 netdev->features |= NETIF_F_IPV6_CSUM;
Auke Kok9d5c8242008-01-24 02:22:38 -08001525 netdev->features |= NETIF_F_TSO;
Auke Kok9d5c8242008-01-24 02:22:38 -08001526 netdev->features |= NETIF_F_TSO6;
Herbert Xu5c0999b2009-01-19 15:20:57 -08001527 netdev->features |= NETIF_F_GRO;
Alexander Duyckd3352522008-07-08 15:12:13 -07001528
Jeff Kirsher48f29ff2008-06-05 04:06:27 -07001529 netdev->vlan_features |= NETIF_F_TSO;
1530 netdev->vlan_features |= NETIF_F_TSO6;
Alexander Duyck7d8eb292009-02-06 23:18:27 +00001531 netdev->vlan_features |= NETIF_F_IP_CSUM;
Alexander Duyckcd1da502009-08-25 04:47:50 +00001532 netdev->vlan_features |= NETIF_F_IPV6_CSUM;
Jeff Kirsher48f29ff2008-06-05 04:06:27 -07001533 netdev->vlan_features |= NETIF_F_SG;
1534
Auke Kok9d5c8242008-01-24 02:22:38 -08001535 if (pci_using_dac)
1536 netdev->features |= NETIF_F_HIGHDMA;
1537
Alexander Duyck5b043fb2009-10-27 23:52:31 +00001538 if (hw->mac.type >= e1000_82576)
Jesse Brandeburgb9473562009-04-27 22:36:13 +00001539 netdev->features |= NETIF_F_SCTP_CSUM;
1540
Alexander Duyck330a6d62009-10-27 23:51:35 +00001541 adapter->en_mng_pt = igb_enable_mng_pass_thru(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001542
1543 /* before reading the NVM, reset the controller to put the device in a
1544 * known good starting state */
1545 hw->mac.ops.reset_hw(hw);
1546
1547 /* make sure the NVM is good */
1548 if (igb_validate_nvm_checksum(hw) < 0) {
1549 dev_err(&pdev->dev, "The NVM Checksum Is Not Valid\n");
1550 err = -EIO;
1551 goto err_eeprom;
1552 }
1553
1554 /* copy the MAC address out of the NVM */
1555 if (hw->mac.ops.read_mac_addr(hw))
1556 dev_err(&pdev->dev, "NVM Read Error\n");
1557
1558 memcpy(netdev->dev_addr, hw->mac.addr, netdev->addr_len);
1559 memcpy(netdev->perm_addr, hw->mac.addr, netdev->addr_len);
1560
1561 if (!is_valid_ether_addr(netdev->perm_addr)) {
1562 dev_err(&pdev->dev, "Invalid MAC Address\n");
1563 err = -EIO;
1564 goto err_eeprom;
1565 }
1566
Alexander Duyck0e340482009-03-20 00:17:08 +00001567 setup_timer(&adapter->watchdog_timer, &igb_watchdog,
1568 (unsigned long) adapter);
1569 setup_timer(&adapter->phy_info_timer, &igb_update_phy_info,
1570 (unsigned long) adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001571
1572 INIT_WORK(&adapter->reset_task, igb_reset_task);
1573 INIT_WORK(&adapter->watchdog_task, igb_watchdog_task);
1574
Alexander Duyck450c87c2009-02-06 23:22:11 +00001575 /* Initialize link properties that are user-changeable */
Auke Kok9d5c8242008-01-24 02:22:38 -08001576 adapter->fc_autoneg = true;
1577 hw->mac.autoneg = true;
1578 hw->phy.autoneg_advertised = 0x2f;
1579
Alexander Duyck0cce1192009-07-23 18:10:24 +00001580 hw->fc.requested_mode = e1000_fc_default;
1581 hw->fc.current_mode = e1000_fc_default;
Auke Kok9d5c8242008-01-24 02:22:38 -08001582
Auke Kok9d5c8242008-01-24 02:22:38 -08001583 igb_validate_mdi_setting(hw);
1584
Auke Kok9d5c8242008-01-24 02:22:38 -08001585 /* Initial Wake on LAN setting If APM wake is enabled in the EEPROM,
1586 * enable the ACPI Magic Packet filter
1587 */
1588
Alexander Duycka2cf8b62009-03-13 20:41:17 +00001589 if (hw->bus.func == 0)
Alexander Duyck312c75a2009-02-06 23:17:47 +00001590 hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_A, 1, &eeprom_data);
Alexander Duyck55cac242009-11-19 12:42:21 +00001591 else if (hw->mac.type == e1000_82580)
1592 hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_A +
1593 NVM_82580_LAN_FUNC_OFFSET(hw->bus.func), 1,
1594 &eeprom_data);
Alexander Duycka2cf8b62009-03-13 20:41:17 +00001595 else if (hw->bus.func == 1)
1596 hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_B, 1, &eeprom_data);
Auke Kok9d5c8242008-01-24 02:22:38 -08001597
1598 if (eeprom_data & eeprom_apme_mask)
1599 adapter->eeprom_wol |= E1000_WUFC_MAG;
1600
1601 /* now that we have the eeprom settings, apply the special cases where
1602 * the eeprom may be wrong or the board simply won't support wake on
1603 * lan on a particular port */
1604 switch (pdev->device) {
1605 case E1000_DEV_ID_82575GB_QUAD_COPPER:
1606 adapter->eeprom_wol = 0;
1607 break;
1608 case E1000_DEV_ID_82575EB_FIBER_SERDES:
Alexander Duyck2d064c02008-07-08 15:10:12 -07001609 case E1000_DEV_ID_82576_FIBER:
1610 case E1000_DEV_ID_82576_SERDES:
Auke Kok9d5c8242008-01-24 02:22:38 -08001611 /* Wake events only supported on port A for dual fiber
1612 * regardless of eeprom setting */
1613 if (rd32(E1000_STATUS) & E1000_STATUS_FUNC_1)
1614 adapter->eeprom_wol = 0;
1615 break;
Alexander Duyckc8ea5ea92009-03-13 20:42:35 +00001616 case E1000_DEV_ID_82576_QUAD_COPPER:
1617 /* if quad port adapter, disable WoL on all but port A */
1618 if (global_quad_port_a != 0)
1619 adapter->eeprom_wol = 0;
1620 else
1621 adapter->flags |= IGB_FLAG_QUAD_PORT_A;
1622 /* Reset for multiple quad port adapters */
1623 if (++global_quad_port_a == 4)
1624 global_quad_port_a = 0;
1625 break;
Auke Kok9d5c8242008-01-24 02:22:38 -08001626 }
1627
1628 /* initialize the wol settings based on the eeprom settings */
1629 adapter->wol = adapter->eeprom_wol;
\"Rafael J. Wysocki\e1b86d82008-11-07 20:30:37 +00001630 device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);
Auke Kok9d5c8242008-01-24 02:22:38 -08001631
1632 /* reset the hardware with the new settings */
1633 igb_reset(adapter);
1634
1635 /* let the f/w know that the h/w is now under the control of the
1636 * driver. */
1637 igb_get_hw_control(adapter);
1638
Auke Kok9d5c8242008-01-24 02:22:38 -08001639 strcpy(netdev->name, "eth%d");
1640 err = register_netdev(netdev);
1641 if (err)
1642 goto err_register;
1643
Jesse Brandeburgb168dfc2009-04-17 20:44:32 +00001644 /* carrier off reporting is important to ethtool even BEFORE open */
1645 netif_carrier_off(netdev);
1646
Jeff Kirsher421e02f2008-10-17 11:08:31 -07001647#ifdef CONFIG_IGB_DCA
Alexander Duyckbbd98fe2009-01-31 00:52:30 -08001648 if (dca_add_requester(&pdev->dev) == 0) {
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001649 adapter->flags |= IGB_FLAG_DCA_ENABLED;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001650 dev_info(&pdev->dev, "DCA enabled\n");
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001651 igb_setup_dca(adapter);
1652 }
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00001653
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001654#endif
Auke Kok9d5c8242008-01-24 02:22:38 -08001655 dev_info(&pdev->dev, "Intel(R) Gigabit Ethernet Network Connection\n");
1656 /* print bus type/speed/width info */
Johannes Berg7c510e42008-10-27 17:47:26 -07001657 dev_info(&pdev->dev, "%s: (PCIe:%s:%s) %pM\n",
Auke Kok9d5c8242008-01-24 02:22:38 -08001658 netdev->name,
Alexander Duyck559e9c42009-10-27 23:52:50 +00001659 ((hw->bus.speed == e1000_bus_speed_2500) ? "2.5Gb/s" :
1660 "unknown"),
Alexander Duyck59c3de82009-03-31 20:38:00 +00001661 ((hw->bus.width == e1000_bus_width_pcie_x4) ? "Width x4" :
1662 (hw->bus.width == e1000_bus_width_pcie_x2) ? "Width x2" :
1663 (hw->bus.width == e1000_bus_width_pcie_x1) ? "Width x1" :
1664 "unknown"),
Johannes Berg7c510e42008-10-27 17:47:26 -07001665 netdev->dev_addr);
Auke Kok9d5c8242008-01-24 02:22:38 -08001666
1667 igb_read_part_num(hw, &part_num);
1668 dev_info(&pdev->dev, "%s: PBA No: %06x-%03x\n", netdev->name,
1669 (part_num >> 8), (part_num & 0xff));
1670
1671 dev_info(&pdev->dev,
1672 "Using %s interrupts. %d rx queue(s), %d tx queue(s)\n",
1673 adapter->msix_entries ? "MSI-X" :
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001674 (adapter->flags & IGB_FLAG_HAS_MSI) ? "MSI" : "legacy",
Auke Kok9d5c8242008-01-24 02:22:38 -08001675 adapter->num_rx_queues, adapter->num_tx_queues);
1676
Auke Kok9d5c8242008-01-24 02:22:38 -08001677 return 0;
1678
1679err_register:
1680 igb_release_hw_control(adapter);
1681err_eeprom:
1682 if (!igb_check_reset_block(hw))
Alexander Duyckf5f4cf02008-11-21 21:30:24 -08001683 igb_reset_phy(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08001684
1685 if (hw->flash_address)
1686 iounmap(hw->flash_address);
Auke Kok9d5c8242008-01-24 02:22:38 -08001687err_sw_init:
Alexander Duyck047e0032009-10-27 15:49:27 +00001688 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001689 iounmap(hw->hw_addr);
1690err_ioremap:
1691 free_netdev(netdev);
1692err_alloc_etherdev:
Alexander Duyck559e9c42009-10-27 23:52:50 +00001693 pci_release_selected_regions(pdev,
1694 pci_select_bars(pdev, IORESOURCE_MEM));
Auke Kok9d5c8242008-01-24 02:22:38 -08001695err_pci_reg:
1696err_dma:
1697 pci_disable_device(pdev);
1698 return err;
1699}
1700
1701/**
1702 * igb_remove - Device Removal Routine
1703 * @pdev: PCI device information struct
1704 *
1705 * igb_remove is called by the PCI subsystem to alert the driver
1706 * that it should release a PCI device. The could be caused by a
1707 * Hot-Plug event, or because the driver is going to be removed from
1708 * memory.
1709 **/
1710static void __devexit igb_remove(struct pci_dev *pdev)
1711{
1712 struct net_device *netdev = pci_get_drvdata(pdev);
1713 struct igb_adapter *adapter = netdev_priv(netdev);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001714 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08001715
1716 /* flush_scheduled work may reschedule our watchdog task, so
1717 * explicitly disable watchdog tasks from being rescheduled */
1718 set_bit(__IGB_DOWN, &adapter->state);
1719 del_timer_sync(&adapter->watchdog_timer);
1720 del_timer_sync(&adapter->phy_info_timer);
1721
1722 flush_scheduled_work();
1723
Jeff Kirsher421e02f2008-10-17 11:08:31 -07001724#ifdef CONFIG_IGB_DCA
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001725 if (adapter->flags & IGB_FLAG_DCA_ENABLED) {
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001726 dev_info(&pdev->dev, "DCA disabled\n");
1727 dca_remove_requester(&pdev->dev);
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07001728 adapter->flags &= ~IGB_FLAG_DCA_ENABLED;
Alexander Duyckcbd347a2009-02-15 23:59:44 -08001729 wr32(E1000_DCA_CTRL, E1000_DCA_CTRL_DCA_MODE_DISABLE);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07001730 }
1731#endif
1732
Auke Kok9d5c8242008-01-24 02:22:38 -08001733 /* Release control of h/w to f/w. If f/w is AMT enabled, this
1734 * would have already happened in close and is redundant. */
1735 igb_release_hw_control(adapter);
1736
1737 unregister_netdev(netdev);
1738
Alexander Duyck047e0032009-10-27 15:49:27 +00001739 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08001740
Alexander Duyck37680112009-02-19 20:40:30 -08001741#ifdef CONFIG_PCI_IOV
1742 /* reclaim resources allocated to VFs */
1743 if (adapter->vf_data) {
1744 /* disable iov and allow time for transactions to clear */
1745 pci_disable_sriov(pdev);
1746 msleep(500);
1747
1748 kfree(adapter->vf_data);
1749 adapter->vf_data = NULL;
1750 wr32(E1000_IOVCTL, E1000_IOVCTL_REUSE_VFQ);
1751 msleep(100);
1752 dev_info(&pdev->dev, "IOV Disabled\n");
1753 }
1754#endif
Alexander Duyck559e9c42009-10-27 23:52:50 +00001755
Alexander Duyck28b07592009-02-06 23:20:31 +00001756 iounmap(hw->hw_addr);
1757 if (hw->flash_address)
1758 iounmap(hw->flash_address);
Alexander Duyck559e9c42009-10-27 23:52:50 +00001759 pci_release_selected_regions(pdev,
1760 pci_select_bars(pdev, IORESOURCE_MEM));
Auke Kok9d5c8242008-01-24 02:22:38 -08001761
1762 free_netdev(netdev);
1763
Frans Pop19d5afd2009-10-02 10:04:12 -07001764 pci_disable_pcie_error_reporting(pdev);
Alexander Duyck40a914f2008-11-27 00:24:37 -08001765
Auke Kok9d5c8242008-01-24 02:22:38 -08001766 pci_disable_device(pdev);
1767}
1768
1769/**
Alexander Duycka6b623e2009-10-27 23:47:53 +00001770 * igb_probe_vfs - Initialize vf data storage and add VFs to pci config space
1771 * @adapter: board private structure to initialize
1772 *
1773 * This function initializes the vf specific data storage and then attempts to
1774 * allocate the VFs. The reason for ordering it this way is because it is much
1775 * mor expensive time wise to disable SR-IOV than it is to allocate and free
1776 * the memory for the VFs.
1777 **/
1778static void __devinit igb_probe_vfs(struct igb_adapter * adapter)
1779{
1780#ifdef CONFIG_PCI_IOV
1781 struct pci_dev *pdev = adapter->pdev;
1782
1783 if (adapter->vfs_allocated_count > 7)
1784 adapter->vfs_allocated_count = 7;
1785
1786 if (adapter->vfs_allocated_count) {
1787 adapter->vf_data = kcalloc(adapter->vfs_allocated_count,
1788 sizeof(struct vf_data_storage),
1789 GFP_KERNEL);
1790 /* if allocation failed then we do not support SR-IOV */
1791 if (!adapter->vf_data) {
1792 adapter->vfs_allocated_count = 0;
1793 dev_err(&pdev->dev, "Unable to allocate memory for VF "
1794 "Data Storage\n");
1795 }
1796 }
1797
1798 if (pci_enable_sriov(pdev, adapter->vfs_allocated_count)) {
1799 kfree(adapter->vf_data);
1800 adapter->vf_data = NULL;
1801#endif /* CONFIG_PCI_IOV */
1802 adapter->vfs_allocated_count = 0;
1803#ifdef CONFIG_PCI_IOV
1804 } else {
1805 unsigned char mac_addr[ETH_ALEN];
1806 int i;
1807 dev_info(&pdev->dev, "%d vfs allocated\n",
1808 adapter->vfs_allocated_count);
1809 for (i = 0; i < adapter->vfs_allocated_count; i++) {
1810 random_ether_addr(mac_addr);
1811 igb_set_vf_mac(adapter, i, mac_addr);
1812 }
1813 }
1814#endif /* CONFIG_PCI_IOV */
1815}
1816
Alexander Duyck115f4592009-11-12 18:37:00 +00001817
1818/**
1819 * igb_init_hw_timer - Initialize hardware timer used with IEEE 1588 timestamp
1820 * @adapter: board private structure to initialize
1821 *
1822 * igb_init_hw_timer initializes the function pointer and values for the hw
1823 * timer found in hardware.
1824 **/
1825static void igb_init_hw_timer(struct igb_adapter *adapter)
1826{
1827 struct e1000_hw *hw = &adapter->hw;
1828
1829 switch (hw->mac.type) {
Alexander Duyck55cac242009-11-19 12:42:21 +00001830 case e1000_82580:
1831 memset(&adapter->cycles, 0, sizeof(adapter->cycles));
1832 adapter->cycles.read = igb_read_clock;
1833 adapter->cycles.mask = CLOCKSOURCE_MASK(64);
1834 adapter->cycles.mult = 1;
1835 /*
1836 * The 82580 timesync updates the system timer every 8ns by 8ns
1837 * and the value cannot be shifted. Instead we need to shift
1838 * the registers to generate a 64bit timer value. As a result
1839 * SYSTIMR/L/H, TXSTMPL/H, RXSTMPL/H all have to be shifted by
1840 * 24 in order to generate a larger value for synchronization.
1841 */
1842 adapter->cycles.shift = IGB_82580_TSYNC_SHIFT;
1843 /* disable system timer temporarily by setting bit 31 */
1844 wr32(E1000_TSAUXC, 0x80000000);
1845 wrfl();
1846
1847 /* Set registers so that rollover occurs soon to test this. */
1848 wr32(E1000_SYSTIMR, 0x00000000);
1849 wr32(E1000_SYSTIML, 0x80000000);
1850 wr32(E1000_SYSTIMH, 0x000000FF);
1851 wrfl();
1852
1853 /* enable system timer by clearing bit 31 */
1854 wr32(E1000_TSAUXC, 0x0);
1855 wrfl();
1856
1857 timecounter_init(&adapter->clock,
1858 &adapter->cycles,
1859 ktime_to_ns(ktime_get_real()));
1860 /*
1861 * Synchronize our NIC clock against system wall clock. NIC
1862 * time stamp reading requires ~3us per sample, each sample
1863 * was pretty stable even under load => only require 10
1864 * samples for each offset comparison.
1865 */
1866 memset(&adapter->compare, 0, sizeof(adapter->compare));
1867 adapter->compare.source = &adapter->clock;
1868 adapter->compare.target = ktime_get_real;
1869 adapter->compare.num_samples = 10;
1870 timecompare_update(&adapter->compare, 0);
1871 break;
Alexander Duyck115f4592009-11-12 18:37:00 +00001872 case e1000_82576:
1873 /*
1874 * Initialize hardware timer: we keep it running just in case
1875 * that some program needs it later on.
1876 */
1877 memset(&adapter->cycles, 0, sizeof(adapter->cycles));
1878 adapter->cycles.read = igb_read_clock;
1879 adapter->cycles.mask = CLOCKSOURCE_MASK(64);
1880 adapter->cycles.mult = 1;
1881 /**
1882 * Scale the NIC clock cycle by a large factor so that
1883 * relatively small clock corrections can be added or
1884 * substracted at each clock tick. The drawbacks of a large
1885 * factor are a) that the clock register overflows more quickly
1886 * (not such a big deal) and b) that the increment per tick has
1887 * to fit into 24 bits. As a result we need to use a shift of
1888 * 19 so we can fit a value of 16 into the TIMINCA register.
1889 */
1890 adapter->cycles.shift = IGB_82576_TSYNC_SHIFT;
1891 wr32(E1000_TIMINCA,
1892 (1 << E1000_TIMINCA_16NS_SHIFT) |
1893 (16 << IGB_82576_TSYNC_SHIFT));
1894
1895 /* Set registers so that rollover occurs soon to test this. */
1896 wr32(E1000_SYSTIML, 0x00000000);
1897 wr32(E1000_SYSTIMH, 0xFF800000);
1898 wrfl();
1899
1900 timecounter_init(&adapter->clock,
1901 &adapter->cycles,
1902 ktime_to_ns(ktime_get_real()));
1903 /*
1904 * Synchronize our NIC clock against system wall clock. NIC
1905 * time stamp reading requires ~3us per sample, each sample
1906 * was pretty stable even under load => only require 10
1907 * samples for each offset comparison.
1908 */
1909 memset(&adapter->compare, 0, sizeof(adapter->compare));
1910 adapter->compare.source = &adapter->clock;
1911 adapter->compare.target = ktime_get_real;
1912 adapter->compare.num_samples = 10;
1913 timecompare_update(&adapter->compare, 0);
1914 break;
1915 case e1000_82575:
1916 /* 82575 does not support timesync */
1917 default:
1918 break;
1919 }
1920
1921}
1922
Alexander Duycka6b623e2009-10-27 23:47:53 +00001923/**
Auke Kok9d5c8242008-01-24 02:22:38 -08001924 * igb_sw_init - Initialize general software structures (struct igb_adapter)
1925 * @adapter: board private structure to initialize
1926 *
1927 * igb_sw_init initializes the Adapter private data structure.
1928 * Fields are initialized based on PCI device information and
1929 * OS network device settings (MTU size).
1930 **/
1931static int __devinit igb_sw_init(struct igb_adapter *adapter)
1932{
1933 struct e1000_hw *hw = &adapter->hw;
1934 struct net_device *netdev = adapter->netdev;
1935 struct pci_dev *pdev = adapter->pdev;
1936
1937 pci_read_config_word(pdev, PCI_COMMAND, &hw->bus.pci_cmd_word);
1938
Alexander Duyck68fd9912008-11-20 00:48:10 -08001939 adapter->tx_ring_count = IGB_DEFAULT_TXD;
1940 adapter->rx_ring_count = IGB_DEFAULT_RXD;
Alexander Duyck4fc82ad2009-10-27 23:45:42 +00001941 adapter->rx_itr_setting = IGB_DEFAULT_ITR;
1942 adapter->tx_itr_setting = IGB_DEFAULT_ITR;
1943
Auke Kok9d5c8242008-01-24 02:22:38 -08001944 adapter->max_frame_size = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
1945 adapter->min_frame_size = ETH_ZLEN + ETH_FCS_LEN;
1946
Alexander Duycka6b623e2009-10-27 23:47:53 +00001947#ifdef CONFIG_PCI_IOV
1948 if (hw->mac.type == e1000_82576)
1949 adapter->vfs_allocated_count = max_vfs;
1950
1951#endif /* CONFIG_PCI_IOV */
Alexander Duycka99955f2009-11-12 18:37:19 +00001952 adapter->rss_queues = min_t(u32, IGB_MAX_RX_QUEUES, num_online_cpus());
1953
1954 /*
1955 * if rss_queues > 4 or vfs are going to be allocated with rss_queues
1956 * then we should combine the queues into a queue pair in order to
1957 * conserve interrupts due to limited supply
1958 */
1959 if ((adapter->rss_queues > 4) ||
1960 ((adapter->rss_queues > 1) && (adapter->vfs_allocated_count > 6)))
1961 adapter->flags |= IGB_FLAG_QUEUE_PAIRS;
1962
Alexander Duycka6b623e2009-10-27 23:47:53 +00001963 /* This call may decrease the number of queues */
Alexander Duyck047e0032009-10-27 15:49:27 +00001964 if (igb_init_interrupt_scheme(adapter)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08001965 dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
1966 return -ENOMEM;
1967 }
1968
Alexander Duyck115f4592009-11-12 18:37:00 +00001969 igb_init_hw_timer(adapter);
Alexander Duycka6b623e2009-10-27 23:47:53 +00001970 igb_probe_vfs(adapter);
1971
Auke Kok9d5c8242008-01-24 02:22:38 -08001972 /* Explicitly disable IRQ since the NIC can be in any state. */
1973 igb_irq_disable(adapter);
1974
1975 set_bit(__IGB_DOWN, &adapter->state);
1976 return 0;
1977}
1978
1979/**
1980 * igb_open - Called when a network interface is made active
1981 * @netdev: network interface device structure
1982 *
1983 * Returns 0 on success, negative value on failure
1984 *
1985 * The open entry point is called when a network interface is made
1986 * active by the system (IFF_UP). At this point all resources needed
1987 * for transmit and receive operations are allocated, the interrupt
1988 * handler is registered with the OS, the watchdog timer is started,
1989 * and the stack is notified that the interface is ready.
1990 **/
1991static int igb_open(struct net_device *netdev)
1992{
1993 struct igb_adapter *adapter = netdev_priv(netdev);
1994 struct e1000_hw *hw = &adapter->hw;
1995 int err;
1996 int i;
1997
1998 /* disallow open during test */
1999 if (test_bit(__IGB_TESTING, &adapter->state))
2000 return -EBUSY;
2001
Jesse Brandeburgb168dfc2009-04-17 20:44:32 +00002002 netif_carrier_off(netdev);
2003
Auke Kok9d5c8242008-01-24 02:22:38 -08002004 /* allocate transmit descriptors */
2005 err = igb_setup_all_tx_resources(adapter);
2006 if (err)
2007 goto err_setup_tx;
2008
2009 /* allocate receive descriptors */
2010 err = igb_setup_all_rx_resources(adapter);
2011 if (err)
2012 goto err_setup_rx;
2013
Nick Nunley88a268c2010-02-17 01:01:59 +00002014 igb_power_up_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08002015
Auke Kok9d5c8242008-01-24 02:22:38 -08002016 /* before we allocate an interrupt, we must be ready to handle it.
2017 * Setting DEBUG_SHIRQ in the kernel makes it fire an interrupt
2018 * as soon as we call pci_request_irq, so we have to setup our
2019 * clean_rx handler before we do so. */
2020 igb_configure(adapter);
2021
2022 err = igb_request_irq(adapter);
2023 if (err)
2024 goto err_req_irq;
2025
2026 /* From here on the code is the same as igb_up() */
2027 clear_bit(__IGB_DOWN, &adapter->state);
2028
Alexander Duyck047e0032009-10-27 15:49:27 +00002029 for (i = 0; i < adapter->num_q_vectors; i++) {
2030 struct igb_q_vector *q_vector = adapter->q_vector[i];
2031 napi_enable(&q_vector->napi);
2032 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002033
2034 /* Clear any pending interrupts. */
2035 rd32(E1000_ICR);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07002036
2037 igb_irq_enable(adapter);
2038
Alexander Duyckd4960302009-10-27 15:53:45 +00002039 /* notify VFs that reset has been completed */
2040 if (adapter->vfs_allocated_count) {
2041 u32 reg_data = rd32(E1000_CTRL_EXT);
2042 reg_data |= E1000_CTRL_EXT_PFRSTD;
2043 wr32(E1000_CTRL_EXT, reg_data);
2044 }
2045
Jeff Kirsherd55b53f2008-07-18 04:33:03 -07002046 netif_tx_start_all_queues(netdev);
2047
Alexander Duyck25568a52009-10-27 23:49:59 +00002048 /* start the watchdog. */
2049 hw->mac.get_link_status = 1;
2050 schedule_work(&adapter->watchdog_task);
Auke Kok9d5c8242008-01-24 02:22:38 -08002051
2052 return 0;
2053
2054err_req_irq:
2055 igb_release_hw_control(adapter);
Nick Nunley88a268c2010-02-17 01:01:59 +00002056 igb_power_down_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08002057 igb_free_all_rx_resources(adapter);
2058err_setup_rx:
2059 igb_free_all_tx_resources(adapter);
2060err_setup_tx:
2061 igb_reset(adapter);
2062
2063 return err;
2064}
2065
2066/**
2067 * igb_close - Disables a network interface
2068 * @netdev: network interface device structure
2069 *
2070 * Returns 0, this is not allowed to fail
2071 *
2072 * The close entry point is called when an interface is de-activated
2073 * by the OS. The hardware is still under the driver's control, but
2074 * needs to be disabled. A global MAC reset is issued to stop the
2075 * hardware, and all transmit and receive resources are freed.
2076 **/
2077static int igb_close(struct net_device *netdev)
2078{
2079 struct igb_adapter *adapter = netdev_priv(netdev);
2080
2081 WARN_ON(test_bit(__IGB_RESETTING, &adapter->state));
2082 igb_down(adapter);
2083
2084 igb_free_irq(adapter);
2085
2086 igb_free_all_tx_resources(adapter);
2087 igb_free_all_rx_resources(adapter);
2088
Auke Kok9d5c8242008-01-24 02:22:38 -08002089 return 0;
2090}
2091
2092/**
2093 * igb_setup_tx_resources - allocate Tx resources (Descriptors)
Auke Kok9d5c8242008-01-24 02:22:38 -08002094 * @tx_ring: tx descriptor ring (for a specific queue) to setup
2095 *
2096 * Return 0 on success, negative on failure
2097 **/
Alexander Duyck80785292009-10-27 15:51:47 +00002098int igb_setup_tx_resources(struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002099{
Alexander Duyck80785292009-10-27 15:51:47 +00002100 struct pci_dev *pdev = tx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002101 int size;
2102
2103 size = sizeof(struct igb_buffer) * tx_ring->count;
2104 tx_ring->buffer_info = vmalloc(size);
2105 if (!tx_ring->buffer_info)
2106 goto err;
2107 memset(tx_ring->buffer_info, 0, size);
2108
2109 /* round up to nearest 4K */
Alexander Duyck85e8d002009-02-16 00:00:20 -08002110 tx_ring->size = tx_ring->count * sizeof(union e1000_adv_tx_desc);
Auke Kok9d5c8242008-01-24 02:22:38 -08002111 tx_ring->size = ALIGN(tx_ring->size, 4096);
2112
Alexander Duyck439705e2009-10-27 23:49:20 +00002113 tx_ring->desc = pci_alloc_consistent(pdev,
2114 tx_ring->size,
Auke Kok9d5c8242008-01-24 02:22:38 -08002115 &tx_ring->dma);
2116
2117 if (!tx_ring->desc)
2118 goto err;
2119
Auke Kok9d5c8242008-01-24 02:22:38 -08002120 tx_ring->next_to_use = 0;
2121 tx_ring->next_to_clean = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002122 return 0;
2123
2124err:
2125 vfree(tx_ring->buffer_info);
Alexander Duyck047e0032009-10-27 15:49:27 +00002126 dev_err(&pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08002127 "Unable to allocate memory for the transmit descriptor ring\n");
2128 return -ENOMEM;
2129}
2130
2131/**
2132 * igb_setup_all_tx_resources - wrapper to allocate Tx resources
2133 * (Descriptors) for all queues
2134 * @adapter: board private structure
2135 *
2136 * Return 0 on success, negative on failure
2137 **/
2138static int igb_setup_all_tx_resources(struct igb_adapter *adapter)
2139{
Alexander Duyck439705e2009-10-27 23:49:20 +00002140 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002141 int i, err = 0;
2142
2143 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00002144 err = igb_setup_tx_resources(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002145 if (err) {
Alexander Duyck439705e2009-10-27 23:49:20 +00002146 dev_err(&pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08002147 "Allocation for Tx Queue %u failed\n", i);
2148 for (i--; i >= 0; i--)
Alexander Duyck3025a442010-02-17 01:02:39 +00002149 igb_free_tx_resources(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002150 break;
2151 }
2152 }
2153
Alexander Duycka99955f2009-11-12 18:37:19 +00002154 for (i = 0; i < IGB_ABS_MAX_TX_QUEUES; i++) {
Alexander Duyck439705e2009-10-27 23:49:20 +00002155 int r_idx = i % adapter->num_tx_queues;
Alexander Duyck3025a442010-02-17 01:02:39 +00002156 adapter->multi_tx_table[i] = adapter->tx_ring[r_idx];
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00002157 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002158 return err;
2159}
2160
2161/**
Alexander Duyck85b430b2009-10-27 15:50:29 +00002162 * igb_setup_tctl - configure the transmit control registers
2163 * @adapter: Board private structure
Auke Kok9d5c8242008-01-24 02:22:38 -08002164 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002165void igb_setup_tctl(struct igb_adapter *adapter)
Auke Kok9d5c8242008-01-24 02:22:38 -08002166{
Auke Kok9d5c8242008-01-24 02:22:38 -08002167 struct e1000_hw *hw = &adapter->hw;
2168 u32 tctl;
Auke Kok9d5c8242008-01-24 02:22:38 -08002169
Alexander Duyck85b430b2009-10-27 15:50:29 +00002170 /* disable queue 0 which is enabled by default on 82575 and 82576 */
2171 wr32(E1000_TXDCTL(0), 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08002172
2173 /* Program the Transmit Control Register */
Auke Kok9d5c8242008-01-24 02:22:38 -08002174 tctl = rd32(E1000_TCTL);
2175 tctl &= ~E1000_TCTL_CT;
2176 tctl |= E1000_TCTL_PSP | E1000_TCTL_RTLC |
2177 (E1000_COLLISION_THRESHOLD << E1000_CT_SHIFT);
2178
2179 igb_config_collision_dist(hw);
2180
Auke Kok9d5c8242008-01-24 02:22:38 -08002181 /* Enable transmits */
2182 tctl |= E1000_TCTL_EN;
2183
2184 wr32(E1000_TCTL, tctl);
2185}
2186
2187/**
Alexander Duyck85b430b2009-10-27 15:50:29 +00002188 * igb_configure_tx_ring - Configure transmit ring after Reset
2189 * @adapter: board private structure
2190 * @ring: tx ring to configure
2191 *
2192 * Configure a transmit ring after a reset.
2193 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002194void igb_configure_tx_ring(struct igb_adapter *adapter,
2195 struct igb_ring *ring)
Alexander Duyck85b430b2009-10-27 15:50:29 +00002196{
2197 struct e1000_hw *hw = &adapter->hw;
2198 u32 txdctl;
2199 u64 tdba = ring->dma;
2200 int reg_idx = ring->reg_idx;
2201
2202 /* disable the queue */
2203 txdctl = rd32(E1000_TXDCTL(reg_idx));
2204 wr32(E1000_TXDCTL(reg_idx),
2205 txdctl & ~E1000_TXDCTL_QUEUE_ENABLE);
2206 wrfl();
2207 mdelay(10);
2208
2209 wr32(E1000_TDLEN(reg_idx),
2210 ring->count * sizeof(union e1000_adv_tx_desc));
2211 wr32(E1000_TDBAL(reg_idx),
2212 tdba & 0x00000000ffffffffULL);
2213 wr32(E1000_TDBAH(reg_idx), tdba >> 32);
2214
Alexander Duyckfce99e32009-10-27 15:51:27 +00002215 ring->head = hw->hw_addr + E1000_TDH(reg_idx);
2216 ring->tail = hw->hw_addr + E1000_TDT(reg_idx);
2217 writel(0, ring->head);
2218 writel(0, ring->tail);
Alexander Duyck85b430b2009-10-27 15:50:29 +00002219
2220 txdctl |= IGB_TX_PTHRESH;
2221 txdctl |= IGB_TX_HTHRESH << 8;
2222 txdctl |= IGB_TX_WTHRESH << 16;
2223
2224 txdctl |= E1000_TXDCTL_QUEUE_ENABLE;
2225 wr32(E1000_TXDCTL(reg_idx), txdctl);
2226}
2227
2228/**
2229 * igb_configure_tx - Configure transmit Unit after Reset
2230 * @adapter: board private structure
2231 *
2232 * Configure the Tx unit of the MAC after a reset.
2233 **/
2234static void igb_configure_tx(struct igb_adapter *adapter)
2235{
2236 int i;
2237
2238 for (i = 0; i < adapter->num_tx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002239 igb_configure_tx_ring(adapter, adapter->tx_ring[i]);
Alexander Duyck85b430b2009-10-27 15:50:29 +00002240}
2241
2242/**
Auke Kok9d5c8242008-01-24 02:22:38 -08002243 * igb_setup_rx_resources - allocate Rx resources (Descriptors)
Auke Kok9d5c8242008-01-24 02:22:38 -08002244 * @rx_ring: rx descriptor ring (for a specific queue) to setup
2245 *
2246 * Returns 0 on success, negative on failure
2247 **/
Alexander Duyck80785292009-10-27 15:51:47 +00002248int igb_setup_rx_resources(struct igb_ring *rx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002249{
Alexander Duyck80785292009-10-27 15:51:47 +00002250 struct pci_dev *pdev = rx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002251 int size, desc_len;
2252
2253 size = sizeof(struct igb_buffer) * rx_ring->count;
2254 rx_ring->buffer_info = vmalloc(size);
2255 if (!rx_ring->buffer_info)
2256 goto err;
2257 memset(rx_ring->buffer_info, 0, size);
2258
2259 desc_len = sizeof(union e1000_adv_rx_desc);
2260
2261 /* Round up to nearest 4K */
2262 rx_ring->size = rx_ring->count * desc_len;
2263 rx_ring->size = ALIGN(rx_ring->size, 4096);
2264
2265 rx_ring->desc = pci_alloc_consistent(pdev, rx_ring->size,
2266 &rx_ring->dma);
2267
2268 if (!rx_ring->desc)
2269 goto err;
2270
2271 rx_ring->next_to_clean = 0;
2272 rx_ring->next_to_use = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002273
Auke Kok9d5c8242008-01-24 02:22:38 -08002274 return 0;
2275
2276err:
2277 vfree(rx_ring->buffer_info);
Alexander Duyck439705e2009-10-27 23:49:20 +00002278 rx_ring->buffer_info = NULL;
Alexander Duyck80785292009-10-27 15:51:47 +00002279 dev_err(&pdev->dev, "Unable to allocate memory for "
Auke Kok9d5c8242008-01-24 02:22:38 -08002280 "the receive descriptor ring\n");
2281 return -ENOMEM;
2282}
2283
2284/**
2285 * igb_setup_all_rx_resources - wrapper to allocate Rx resources
2286 * (Descriptors) for all queues
2287 * @adapter: board private structure
2288 *
2289 * Return 0 on success, negative on failure
2290 **/
2291static int igb_setup_all_rx_resources(struct igb_adapter *adapter)
2292{
Alexander Duyck439705e2009-10-27 23:49:20 +00002293 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08002294 int i, err = 0;
2295
2296 for (i = 0; i < adapter->num_rx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00002297 err = igb_setup_rx_resources(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002298 if (err) {
Alexander Duyck439705e2009-10-27 23:49:20 +00002299 dev_err(&pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08002300 "Allocation for Rx Queue %u failed\n", i);
2301 for (i--; i >= 0; i--)
Alexander Duyck3025a442010-02-17 01:02:39 +00002302 igb_free_rx_resources(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002303 break;
2304 }
2305 }
2306
2307 return err;
2308}
2309
2310/**
Alexander Duyck06cf2662009-10-27 15:53:25 +00002311 * igb_setup_mrqc - configure the multiple receive queue control registers
2312 * @adapter: Board private structure
2313 **/
2314static void igb_setup_mrqc(struct igb_adapter *adapter)
2315{
2316 struct e1000_hw *hw = &adapter->hw;
2317 u32 mrqc, rxcsum;
2318 u32 j, num_rx_queues, shift = 0, shift2 = 0;
2319 union e1000_reta {
2320 u32 dword;
2321 u8 bytes[4];
2322 } reta;
2323 static const u8 rsshash[40] = {
2324 0x6d, 0x5a, 0x56, 0xda, 0x25, 0x5b, 0x0e, 0xc2, 0x41, 0x67,
2325 0x25, 0x3d, 0x43, 0xa3, 0x8f, 0xb0, 0xd0, 0xca, 0x2b, 0xcb,
2326 0xae, 0x7b, 0x30, 0xb4, 0x77, 0xcb, 0x2d, 0xa3, 0x80, 0x30,
2327 0xf2, 0x0c, 0x6a, 0x42, 0xb7, 0x3b, 0xbe, 0xac, 0x01, 0xfa };
2328
2329 /* Fill out hash function seeds */
2330 for (j = 0; j < 10; j++) {
2331 u32 rsskey = rsshash[(j * 4)];
2332 rsskey |= rsshash[(j * 4) + 1] << 8;
2333 rsskey |= rsshash[(j * 4) + 2] << 16;
2334 rsskey |= rsshash[(j * 4) + 3] << 24;
2335 array_wr32(E1000_RSSRK(0), j, rsskey);
2336 }
2337
Alexander Duycka99955f2009-11-12 18:37:19 +00002338 num_rx_queues = adapter->rss_queues;
Alexander Duyck06cf2662009-10-27 15:53:25 +00002339
2340 if (adapter->vfs_allocated_count) {
2341 /* 82575 and 82576 supports 2 RSS queues for VMDq */
2342 switch (hw->mac.type) {
Alexander Duyck55cac242009-11-19 12:42:21 +00002343 case e1000_82580:
2344 num_rx_queues = 1;
2345 shift = 0;
2346 break;
Alexander Duyck06cf2662009-10-27 15:53:25 +00002347 case e1000_82576:
2348 shift = 3;
2349 num_rx_queues = 2;
2350 break;
2351 case e1000_82575:
2352 shift = 2;
2353 shift2 = 6;
2354 default:
2355 break;
2356 }
2357 } else {
2358 if (hw->mac.type == e1000_82575)
2359 shift = 6;
2360 }
2361
2362 for (j = 0; j < (32 * 4); j++) {
2363 reta.bytes[j & 3] = (j % num_rx_queues) << shift;
2364 if (shift2)
2365 reta.bytes[j & 3] |= num_rx_queues << shift2;
2366 if ((j & 3) == 3)
2367 wr32(E1000_RETA(j >> 2), reta.dword);
2368 }
2369
2370 /*
2371 * Disable raw packet checksumming so that RSS hash is placed in
2372 * descriptor on writeback. No need to enable TCP/UDP/IP checksum
2373 * offloads as they are enabled by default
2374 */
2375 rxcsum = rd32(E1000_RXCSUM);
2376 rxcsum |= E1000_RXCSUM_PCSD;
2377
2378 if (adapter->hw.mac.type >= e1000_82576)
2379 /* Enable Receive Checksum Offload for SCTP */
2380 rxcsum |= E1000_RXCSUM_CRCOFL;
2381
2382 /* Don't need to set TUOFL or IPOFL, they default to 1 */
2383 wr32(E1000_RXCSUM, rxcsum);
2384
2385 /* If VMDq is enabled then we set the appropriate mode for that, else
2386 * we default to RSS so that an RSS hash is calculated per packet even
2387 * if we are only using one queue */
2388 if (adapter->vfs_allocated_count) {
2389 if (hw->mac.type > e1000_82575) {
2390 /* Set the default pool for the PF's first queue */
2391 u32 vtctl = rd32(E1000_VT_CTL);
2392 vtctl &= ~(E1000_VT_CTL_DEFAULT_POOL_MASK |
2393 E1000_VT_CTL_DISABLE_DEF_POOL);
2394 vtctl |= adapter->vfs_allocated_count <<
2395 E1000_VT_CTL_DEFAULT_POOL_SHIFT;
2396 wr32(E1000_VT_CTL, vtctl);
2397 }
Alexander Duycka99955f2009-11-12 18:37:19 +00002398 if (adapter->rss_queues > 1)
Alexander Duyck06cf2662009-10-27 15:53:25 +00002399 mrqc = E1000_MRQC_ENABLE_VMDQ_RSS_2Q;
2400 else
2401 mrqc = E1000_MRQC_ENABLE_VMDQ;
2402 } else {
2403 mrqc = E1000_MRQC_ENABLE_RSS_4Q;
2404 }
2405 igb_vmm_control(adapter);
2406
2407 mrqc |= (E1000_MRQC_RSS_FIELD_IPV4 |
2408 E1000_MRQC_RSS_FIELD_IPV4_TCP);
2409 mrqc |= (E1000_MRQC_RSS_FIELD_IPV6 |
2410 E1000_MRQC_RSS_FIELD_IPV6_TCP);
2411 mrqc |= (E1000_MRQC_RSS_FIELD_IPV4_UDP |
2412 E1000_MRQC_RSS_FIELD_IPV6_UDP);
2413 mrqc |= (E1000_MRQC_RSS_FIELD_IPV6_UDP_EX |
2414 E1000_MRQC_RSS_FIELD_IPV6_TCP_EX);
2415
2416 wr32(E1000_MRQC, mrqc);
2417}
2418
2419/**
Auke Kok9d5c8242008-01-24 02:22:38 -08002420 * igb_setup_rctl - configure the receive control registers
2421 * @adapter: Board private structure
2422 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002423void igb_setup_rctl(struct igb_adapter *adapter)
Auke Kok9d5c8242008-01-24 02:22:38 -08002424{
2425 struct e1000_hw *hw = &adapter->hw;
2426 u32 rctl;
Auke Kok9d5c8242008-01-24 02:22:38 -08002427
2428 rctl = rd32(E1000_RCTL);
2429
2430 rctl &= ~(3 << E1000_RCTL_MO_SHIFT);
Alexander Duyck69d728b2008-11-25 01:04:03 -08002431 rctl &= ~(E1000_RCTL_LBM_TCVR | E1000_RCTL_LBM_MAC);
Auke Kok9d5c8242008-01-24 02:22:38 -08002432
Alexander Duyck69d728b2008-11-25 01:04:03 -08002433 rctl |= E1000_RCTL_EN | E1000_RCTL_BAM | E1000_RCTL_RDMTS_HALF |
Alexander Duyck28b07592009-02-06 23:20:31 +00002434 (hw->mac.mc_filter_type << E1000_RCTL_MO_SHIFT);
Auke Kok9d5c8242008-01-24 02:22:38 -08002435
Auke Kok87cb7e82008-07-08 15:08:29 -07002436 /*
2437 * enable stripping of CRC. It's unlikely this will break BMC
2438 * redirection as it did with e1000. Newer features require
2439 * that the HW strips the CRC.
Alexander Duyck73cd78f2009-02-12 18:16:59 +00002440 */
Auke Kok87cb7e82008-07-08 15:08:29 -07002441 rctl |= E1000_RCTL_SECRC;
Auke Kok9d5c8242008-01-24 02:22:38 -08002442
Alexander Duyck559e9c42009-10-27 23:52:50 +00002443 /* disable store bad packets and clear size bits. */
Alexander Duyckec54d7d2009-01-31 00:52:57 -08002444 rctl &= ~(E1000_RCTL_SBP | E1000_RCTL_SZ_256);
Auke Kok9d5c8242008-01-24 02:22:38 -08002445
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002446 /* enable LPE to prevent packets larger than max_frame_size */
2447 rctl |= E1000_RCTL_LPE;
Auke Kok9d5c8242008-01-24 02:22:38 -08002448
Alexander Duyck952f72a2009-10-27 15:51:07 +00002449 /* disable queue 0 to prevent tail write w/o re-config */
2450 wr32(E1000_RXDCTL(0), 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08002451
Alexander Duycke1739522009-02-19 20:39:44 -08002452 /* Attention!!! For SR-IOV PF driver operations you must enable
2453 * queue drop for all VF and PF queues to prevent head of line blocking
2454 * if an un-trusted VF does not provide descriptors to hardware.
2455 */
2456 if (adapter->vfs_allocated_count) {
Alexander Duycke1739522009-02-19 20:39:44 -08002457 /* set all queue drop enable bits */
2458 wr32(E1000_QDE, ALL_QUEUES);
Alexander Duycke1739522009-02-19 20:39:44 -08002459 }
2460
Auke Kok9d5c8242008-01-24 02:22:38 -08002461 wr32(E1000_RCTL, rctl);
2462}
2463
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002464static inline int igb_set_vf_rlpml(struct igb_adapter *adapter, int size,
2465 int vfn)
2466{
2467 struct e1000_hw *hw = &adapter->hw;
2468 u32 vmolr;
2469
2470 /* if it isn't the PF check to see if VFs are enabled and
2471 * increase the size to support vlan tags */
2472 if (vfn < adapter->vfs_allocated_count &&
2473 adapter->vf_data[vfn].vlans_enabled)
2474 size += VLAN_TAG_SIZE;
2475
2476 vmolr = rd32(E1000_VMOLR(vfn));
2477 vmolr &= ~E1000_VMOLR_RLPML_MASK;
2478 vmolr |= size | E1000_VMOLR_LPE;
2479 wr32(E1000_VMOLR(vfn), vmolr);
2480
2481 return 0;
2482}
2483
Auke Kok9d5c8242008-01-24 02:22:38 -08002484/**
Alexander Duycke1739522009-02-19 20:39:44 -08002485 * igb_rlpml_set - set maximum receive packet size
2486 * @adapter: board private structure
2487 *
2488 * Configure maximum receivable packet size.
2489 **/
2490static void igb_rlpml_set(struct igb_adapter *adapter)
2491{
2492 u32 max_frame_size = adapter->max_frame_size;
2493 struct e1000_hw *hw = &adapter->hw;
2494 u16 pf_id = adapter->vfs_allocated_count;
2495
2496 if (adapter->vlgrp)
2497 max_frame_size += VLAN_TAG_SIZE;
2498
2499 /* if vfs are enabled we set RLPML to the largest possible request
2500 * size and set the VMOLR RLPML to the size we need */
2501 if (pf_id) {
2502 igb_set_vf_rlpml(adapter, max_frame_size, pf_id);
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002503 max_frame_size = MAX_JUMBO_FRAME_SIZE;
Alexander Duycke1739522009-02-19 20:39:44 -08002504 }
2505
2506 wr32(E1000_RLPML, max_frame_size);
2507}
2508
Williams, Mitch A8151d292010-02-10 01:44:24 +00002509static inline void igb_set_vmolr(struct igb_adapter *adapter,
2510 int vfn, bool aupe)
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002511{
2512 struct e1000_hw *hw = &adapter->hw;
2513 u32 vmolr;
2514
2515 /*
2516 * This register exists only on 82576 and newer so if we are older then
2517 * we should exit and do nothing
2518 */
2519 if (hw->mac.type < e1000_82576)
2520 return;
2521
2522 vmolr = rd32(E1000_VMOLR(vfn));
Williams, Mitch A8151d292010-02-10 01:44:24 +00002523 vmolr |= E1000_VMOLR_STRVLAN; /* Strip vlan tags */
2524 if (aupe)
2525 vmolr |= E1000_VMOLR_AUPE; /* Accept untagged packets */
2526 else
2527 vmolr &= ~(E1000_VMOLR_AUPE); /* Tagged packets ONLY */
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002528
2529 /* clear all bits that might not be set */
2530 vmolr &= ~(E1000_VMOLR_BAM | E1000_VMOLR_RSSE);
2531
Alexander Duycka99955f2009-11-12 18:37:19 +00002532 if (adapter->rss_queues > 1 && vfn == adapter->vfs_allocated_count)
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002533 vmolr |= E1000_VMOLR_RSSE; /* enable RSS */
2534 /*
2535 * for VMDq only allow the VFs and pool 0 to accept broadcast and
2536 * multicast packets
2537 */
2538 if (vfn <= adapter->vfs_allocated_count)
2539 vmolr |= E1000_VMOLR_BAM; /* Accept broadcast */
2540
2541 wr32(E1000_VMOLR(vfn), vmolr);
2542}
2543
Alexander Duycke1739522009-02-19 20:39:44 -08002544/**
Alexander Duyck85b430b2009-10-27 15:50:29 +00002545 * igb_configure_rx_ring - Configure a receive ring after Reset
2546 * @adapter: board private structure
2547 * @ring: receive ring to be configured
2548 *
2549 * Configure the Rx unit of the MAC after a reset.
2550 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00002551void igb_configure_rx_ring(struct igb_adapter *adapter,
2552 struct igb_ring *ring)
Alexander Duyck85b430b2009-10-27 15:50:29 +00002553{
2554 struct e1000_hw *hw = &adapter->hw;
2555 u64 rdba = ring->dma;
2556 int reg_idx = ring->reg_idx;
Alexander Duyck952f72a2009-10-27 15:51:07 +00002557 u32 srrctl, rxdctl;
Alexander Duyck85b430b2009-10-27 15:50:29 +00002558
2559 /* disable the queue */
2560 rxdctl = rd32(E1000_RXDCTL(reg_idx));
2561 wr32(E1000_RXDCTL(reg_idx),
2562 rxdctl & ~E1000_RXDCTL_QUEUE_ENABLE);
2563
2564 /* Set DMA base address registers */
2565 wr32(E1000_RDBAL(reg_idx),
2566 rdba & 0x00000000ffffffffULL);
2567 wr32(E1000_RDBAH(reg_idx), rdba >> 32);
2568 wr32(E1000_RDLEN(reg_idx),
2569 ring->count * sizeof(union e1000_adv_rx_desc));
2570
2571 /* initialize head and tail */
Alexander Duyckfce99e32009-10-27 15:51:27 +00002572 ring->head = hw->hw_addr + E1000_RDH(reg_idx);
2573 ring->tail = hw->hw_addr + E1000_RDT(reg_idx);
2574 writel(0, ring->head);
2575 writel(0, ring->tail);
Alexander Duyck85b430b2009-10-27 15:50:29 +00002576
Alexander Duyck952f72a2009-10-27 15:51:07 +00002577 /* set descriptor configuration */
Alexander Duyck4c844852009-10-27 15:52:07 +00002578 if (ring->rx_buffer_len < IGB_RXBUFFER_1024) {
2579 srrctl = ALIGN(ring->rx_buffer_len, 64) <<
Alexander Duyck952f72a2009-10-27 15:51:07 +00002580 E1000_SRRCTL_BSIZEHDRSIZE_SHIFT;
2581#if (PAGE_SIZE / 2) > IGB_RXBUFFER_16384
2582 srrctl |= IGB_RXBUFFER_16384 >>
2583 E1000_SRRCTL_BSIZEPKT_SHIFT;
2584#else
2585 srrctl |= (PAGE_SIZE / 2) >>
2586 E1000_SRRCTL_BSIZEPKT_SHIFT;
2587#endif
2588 srrctl |= E1000_SRRCTL_DESCTYPE_HDR_SPLIT_ALWAYS;
2589 } else {
Alexander Duyck4c844852009-10-27 15:52:07 +00002590 srrctl = ALIGN(ring->rx_buffer_len, 1024) >>
Alexander Duyck952f72a2009-10-27 15:51:07 +00002591 E1000_SRRCTL_BSIZEPKT_SHIFT;
2592 srrctl |= E1000_SRRCTL_DESCTYPE_ADV_ONEBUF;
2593 }
Nick Nunleye6bdb6f2010-02-17 01:03:38 +00002594 /* Only set Drop Enable if we are supporting multiple queues */
2595 if (adapter->vfs_allocated_count || adapter->num_rx_queues > 1)
2596 srrctl |= E1000_SRRCTL_DROP_EN;
Alexander Duyck952f72a2009-10-27 15:51:07 +00002597
2598 wr32(E1000_SRRCTL(reg_idx), srrctl);
2599
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002600 /* set filtering for VMDQ pools */
Williams, Mitch A8151d292010-02-10 01:44:24 +00002601 igb_set_vmolr(adapter, reg_idx & 0x7, true);
Alexander Duyck7d5753f2009-10-27 23:47:16 +00002602
Alexander Duyck85b430b2009-10-27 15:50:29 +00002603 /* enable receive descriptor fetching */
2604 rxdctl = rd32(E1000_RXDCTL(reg_idx));
2605 rxdctl |= E1000_RXDCTL_QUEUE_ENABLE;
2606 rxdctl &= 0xFFF00000;
2607 rxdctl |= IGB_RX_PTHRESH;
2608 rxdctl |= IGB_RX_HTHRESH << 8;
2609 rxdctl |= IGB_RX_WTHRESH << 16;
2610 wr32(E1000_RXDCTL(reg_idx), rxdctl);
2611}
2612
2613/**
Auke Kok9d5c8242008-01-24 02:22:38 -08002614 * igb_configure_rx - Configure receive Unit after Reset
2615 * @adapter: board private structure
2616 *
2617 * Configure the Rx unit of the MAC after a reset.
2618 **/
2619static void igb_configure_rx(struct igb_adapter *adapter)
2620{
Hannes Eder91075842009-02-18 19:36:04 -08002621 int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08002622
Alexander Duyck68d480c2009-10-05 06:33:08 +00002623 /* set UTA to appropriate mode */
2624 igb_set_uta(adapter);
2625
Alexander Duyck26ad9172009-10-05 06:32:49 +00002626 /* set the correct pool for the PF default MAC address in entry 0 */
2627 igb_rar_set_qsel(adapter, adapter->hw.mac.addr, 0,
2628 adapter->vfs_allocated_count);
2629
Alexander Duyck06cf2662009-10-27 15:53:25 +00002630 /* Setup the HW Rx Head and Tail Descriptor Pointers and
2631 * the Base and Length of the Rx Descriptor Ring */
2632 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002633 igb_configure_rx_ring(adapter, adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002634}
2635
2636/**
2637 * igb_free_tx_resources - Free Tx Resources per Queue
Auke Kok9d5c8242008-01-24 02:22:38 -08002638 * @tx_ring: Tx descriptor ring for a specific queue
2639 *
2640 * Free all transmit software resources
2641 **/
Alexander Duyck68fd9912008-11-20 00:48:10 -08002642void igb_free_tx_resources(struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002643{
Mitch Williams3b644cf2008-06-27 10:59:48 -07002644 igb_clean_tx_ring(tx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08002645
2646 vfree(tx_ring->buffer_info);
2647 tx_ring->buffer_info = NULL;
2648
Alexander Duyck439705e2009-10-27 23:49:20 +00002649 /* if not set, then don't free */
2650 if (!tx_ring->desc)
2651 return;
2652
Alexander Duyck80785292009-10-27 15:51:47 +00002653 pci_free_consistent(tx_ring->pdev, tx_ring->size,
2654 tx_ring->desc, tx_ring->dma);
Auke Kok9d5c8242008-01-24 02:22:38 -08002655
2656 tx_ring->desc = NULL;
2657}
2658
2659/**
2660 * igb_free_all_tx_resources - Free Tx Resources for All Queues
2661 * @adapter: board private structure
2662 *
2663 * Free all transmit software resources
2664 **/
2665static void igb_free_all_tx_resources(struct igb_adapter *adapter)
2666{
2667 int i;
2668
2669 for (i = 0; i < adapter->num_tx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002670 igb_free_tx_resources(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002671}
2672
Alexander Duyckb1a436c2009-10-27 15:54:43 +00002673void igb_unmap_and_free_tx_resource(struct igb_ring *tx_ring,
2674 struct igb_buffer *buffer_info)
Auke Kok9d5c8242008-01-24 02:22:38 -08002675{
Alexander Duyck6366ad32009-12-02 16:47:18 +00002676 if (buffer_info->dma) {
2677 if (buffer_info->mapped_as_page)
2678 pci_unmap_page(tx_ring->pdev,
2679 buffer_info->dma,
2680 buffer_info->length,
2681 PCI_DMA_TODEVICE);
2682 else
2683 pci_unmap_single(tx_ring->pdev,
2684 buffer_info->dma,
2685 buffer_info->length,
2686 PCI_DMA_TODEVICE);
2687 buffer_info->dma = 0;
2688 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002689 if (buffer_info->skb) {
2690 dev_kfree_skb_any(buffer_info->skb);
2691 buffer_info->skb = NULL;
2692 }
2693 buffer_info->time_stamp = 0;
Alexander Duyck6366ad32009-12-02 16:47:18 +00002694 buffer_info->length = 0;
2695 buffer_info->next_to_watch = 0;
2696 buffer_info->mapped_as_page = false;
Auke Kok9d5c8242008-01-24 02:22:38 -08002697}
2698
2699/**
2700 * igb_clean_tx_ring - Free Tx Buffers
Auke Kok9d5c8242008-01-24 02:22:38 -08002701 * @tx_ring: ring to be cleaned
2702 **/
Mitch Williams3b644cf2008-06-27 10:59:48 -07002703static void igb_clean_tx_ring(struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002704{
2705 struct igb_buffer *buffer_info;
2706 unsigned long size;
2707 unsigned int i;
2708
2709 if (!tx_ring->buffer_info)
2710 return;
2711 /* Free all the Tx ring sk_buffs */
2712
2713 for (i = 0; i < tx_ring->count; i++) {
2714 buffer_info = &tx_ring->buffer_info[i];
Alexander Duyck80785292009-10-27 15:51:47 +00002715 igb_unmap_and_free_tx_resource(tx_ring, buffer_info);
Auke Kok9d5c8242008-01-24 02:22:38 -08002716 }
2717
2718 size = sizeof(struct igb_buffer) * tx_ring->count;
2719 memset(tx_ring->buffer_info, 0, size);
2720
2721 /* Zero out the descriptor ring */
Auke Kok9d5c8242008-01-24 02:22:38 -08002722 memset(tx_ring->desc, 0, tx_ring->size);
2723
2724 tx_ring->next_to_use = 0;
2725 tx_ring->next_to_clean = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002726}
2727
2728/**
2729 * igb_clean_all_tx_rings - Free Tx Buffers for all queues
2730 * @adapter: board private structure
2731 **/
2732static void igb_clean_all_tx_rings(struct igb_adapter *adapter)
2733{
2734 int i;
2735
2736 for (i = 0; i < adapter->num_tx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002737 igb_clean_tx_ring(adapter->tx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002738}
2739
2740/**
2741 * igb_free_rx_resources - Free Rx Resources
Auke Kok9d5c8242008-01-24 02:22:38 -08002742 * @rx_ring: ring to clean the resources from
2743 *
2744 * Free all receive software resources
2745 **/
Alexander Duyck68fd9912008-11-20 00:48:10 -08002746void igb_free_rx_resources(struct igb_ring *rx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002747{
Mitch Williams3b644cf2008-06-27 10:59:48 -07002748 igb_clean_rx_ring(rx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08002749
2750 vfree(rx_ring->buffer_info);
2751 rx_ring->buffer_info = NULL;
2752
Alexander Duyck439705e2009-10-27 23:49:20 +00002753 /* if not set, then don't free */
2754 if (!rx_ring->desc)
2755 return;
2756
Alexander Duyck80785292009-10-27 15:51:47 +00002757 pci_free_consistent(rx_ring->pdev, rx_ring->size,
2758 rx_ring->desc, rx_ring->dma);
Auke Kok9d5c8242008-01-24 02:22:38 -08002759
2760 rx_ring->desc = NULL;
2761}
2762
2763/**
2764 * igb_free_all_rx_resources - Free Rx Resources for All Queues
2765 * @adapter: board private structure
2766 *
2767 * Free all receive software resources
2768 **/
2769static void igb_free_all_rx_resources(struct igb_adapter *adapter)
2770{
2771 int i;
2772
2773 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002774 igb_free_rx_resources(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002775}
2776
2777/**
2778 * igb_clean_rx_ring - Free Rx Buffers per Queue
Auke Kok9d5c8242008-01-24 02:22:38 -08002779 * @rx_ring: ring to free buffers from
2780 **/
Mitch Williams3b644cf2008-06-27 10:59:48 -07002781static void igb_clean_rx_ring(struct igb_ring *rx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08002782{
2783 struct igb_buffer *buffer_info;
Auke Kok9d5c8242008-01-24 02:22:38 -08002784 unsigned long size;
2785 unsigned int i;
2786
2787 if (!rx_ring->buffer_info)
2788 return;
Alexander Duyck439705e2009-10-27 23:49:20 +00002789
Auke Kok9d5c8242008-01-24 02:22:38 -08002790 /* Free all the Rx ring sk_buffs */
2791 for (i = 0; i < rx_ring->count; i++) {
2792 buffer_info = &rx_ring->buffer_info[i];
2793 if (buffer_info->dma) {
Alexander Duyck80785292009-10-27 15:51:47 +00002794 pci_unmap_single(rx_ring->pdev,
2795 buffer_info->dma,
Alexander Duyck4c844852009-10-27 15:52:07 +00002796 rx_ring->rx_buffer_len,
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002797 PCI_DMA_FROMDEVICE);
Auke Kok9d5c8242008-01-24 02:22:38 -08002798 buffer_info->dma = 0;
2799 }
2800
2801 if (buffer_info->skb) {
2802 dev_kfree_skb(buffer_info->skb);
2803 buffer_info->skb = NULL;
2804 }
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002805 if (buffer_info->page_dma) {
Alexander Duyck80785292009-10-27 15:51:47 +00002806 pci_unmap_page(rx_ring->pdev,
2807 buffer_info->page_dma,
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00002808 PAGE_SIZE / 2,
2809 PCI_DMA_FROMDEVICE);
2810 buffer_info->page_dma = 0;
2811 }
Auke Kok9d5c8242008-01-24 02:22:38 -08002812 if (buffer_info->page) {
Auke Kok9d5c8242008-01-24 02:22:38 -08002813 put_page(buffer_info->page);
2814 buffer_info->page = NULL;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07002815 buffer_info->page_offset = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002816 }
2817 }
2818
Auke Kok9d5c8242008-01-24 02:22:38 -08002819 size = sizeof(struct igb_buffer) * rx_ring->count;
2820 memset(rx_ring->buffer_info, 0, size);
2821
2822 /* Zero out the descriptor ring */
2823 memset(rx_ring->desc, 0, rx_ring->size);
2824
2825 rx_ring->next_to_clean = 0;
2826 rx_ring->next_to_use = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08002827}
2828
2829/**
2830 * igb_clean_all_rx_rings - Free Rx Buffers for all queues
2831 * @adapter: board private structure
2832 **/
2833static void igb_clean_all_rx_rings(struct igb_adapter *adapter)
2834{
2835 int i;
2836
2837 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00002838 igb_clean_rx_ring(adapter->rx_ring[i]);
Auke Kok9d5c8242008-01-24 02:22:38 -08002839}
2840
2841/**
2842 * igb_set_mac - Change the Ethernet Address of the NIC
2843 * @netdev: network interface device structure
2844 * @p: pointer to an address structure
2845 *
2846 * Returns 0 on success, negative on failure
2847 **/
2848static int igb_set_mac(struct net_device *netdev, void *p)
2849{
2850 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyck28b07592009-02-06 23:20:31 +00002851 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08002852 struct sockaddr *addr = p;
2853
2854 if (!is_valid_ether_addr(addr->sa_data))
2855 return -EADDRNOTAVAIL;
2856
2857 memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
Alexander Duyck28b07592009-02-06 23:20:31 +00002858 memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
Auke Kok9d5c8242008-01-24 02:22:38 -08002859
Alexander Duyck26ad9172009-10-05 06:32:49 +00002860 /* set the correct pool for the new PF MAC address in entry 0 */
2861 igb_rar_set_qsel(adapter, hw->mac.addr, 0,
2862 adapter->vfs_allocated_count);
Alexander Duycke1739522009-02-19 20:39:44 -08002863
Auke Kok9d5c8242008-01-24 02:22:38 -08002864 return 0;
2865}
2866
2867/**
Alexander Duyck68d480c2009-10-05 06:33:08 +00002868 * igb_write_mc_addr_list - write multicast addresses to MTA
2869 * @netdev: network interface device structure
2870 *
2871 * Writes multicast address list to the MTA hash table.
2872 * Returns: -ENOMEM on failure
2873 * 0 on no addresses written
2874 * X on writing X addresses to MTA
2875 **/
2876static int igb_write_mc_addr_list(struct net_device *netdev)
2877{
2878 struct igb_adapter *adapter = netdev_priv(netdev);
2879 struct e1000_hw *hw = &adapter->hw;
Jiri Pirko48e2f182010-02-22 09:22:26 +00002880 struct dev_mc_list *mc_ptr;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002881 u8 *mta_list;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002882 int i;
2883
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00002884 if (netdev_mc_empty(netdev)) {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002885 /* nothing to program, so clear mc list */
2886 igb_update_mc_addr_list(hw, NULL, 0);
2887 igb_restore_vf_multicasts(adapter);
2888 return 0;
2889 }
2890
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00002891 mta_list = kzalloc(netdev_mc_count(netdev) * 6, GFP_ATOMIC);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002892 if (!mta_list)
2893 return -ENOMEM;
2894
Alexander Duyck68d480c2009-10-05 06:33:08 +00002895 /* The shared function expects a packed array of only addresses. */
Jiri Pirko48e2f182010-02-22 09:22:26 +00002896 i = 0;
2897 netdev_for_each_mc_addr(mc_ptr, netdev)
2898 memcpy(mta_list + (i++ * ETH_ALEN), mc_ptr->dmi_addr, ETH_ALEN);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002899
Alexander Duyck68d480c2009-10-05 06:33:08 +00002900 igb_update_mc_addr_list(hw, mta_list, i);
2901 kfree(mta_list);
2902
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00002903 return netdev_mc_count(netdev);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002904}
2905
2906/**
2907 * igb_write_uc_addr_list - write unicast addresses to RAR table
2908 * @netdev: network interface device structure
2909 *
2910 * Writes unicast address list to the RAR table.
2911 * Returns: -ENOMEM on failure/insufficient address space
2912 * 0 on no addresses written
2913 * X on writing X addresses to the RAR table
2914 **/
2915static int igb_write_uc_addr_list(struct net_device *netdev)
2916{
2917 struct igb_adapter *adapter = netdev_priv(netdev);
2918 struct e1000_hw *hw = &adapter->hw;
2919 unsigned int vfn = adapter->vfs_allocated_count;
2920 unsigned int rar_entries = hw->mac.rar_entry_count - (vfn + 1);
2921 int count = 0;
2922
2923 /* return ENOMEM indicating insufficient memory for addresses */
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08002924 if (netdev_uc_count(netdev) > rar_entries)
Alexander Duyck68d480c2009-10-05 06:33:08 +00002925 return -ENOMEM;
2926
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08002927 if (!netdev_uc_empty(netdev) && rar_entries) {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002928 struct netdev_hw_addr *ha;
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08002929
2930 netdev_for_each_uc_addr(ha, netdev) {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002931 if (!rar_entries)
2932 break;
2933 igb_rar_set_qsel(adapter, ha->addr,
2934 rar_entries--,
2935 vfn);
2936 count++;
2937 }
2938 }
2939 /* write the addresses in reverse order to avoid write combining */
2940 for (; rar_entries > 0 ; rar_entries--) {
2941 wr32(E1000_RAH(rar_entries), 0);
2942 wr32(E1000_RAL(rar_entries), 0);
2943 }
2944 wrfl();
2945
2946 return count;
2947}
2948
2949/**
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002950 * igb_set_rx_mode - Secondary Unicast, Multicast and Promiscuous mode set
Auke Kok9d5c8242008-01-24 02:22:38 -08002951 * @netdev: network interface device structure
2952 *
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002953 * The set_rx_mode entry point is called whenever the unicast or multicast
2954 * address lists or the network interface flags are updated. This routine is
2955 * responsible for configuring the hardware for proper unicast, multicast,
Auke Kok9d5c8242008-01-24 02:22:38 -08002956 * promiscuous mode, and all-multi behavior.
2957 **/
Alexander Duyckff41f8d2009-09-03 14:48:56 +00002958static void igb_set_rx_mode(struct net_device *netdev)
Auke Kok9d5c8242008-01-24 02:22:38 -08002959{
2960 struct igb_adapter *adapter = netdev_priv(netdev);
2961 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002962 unsigned int vfn = adapter->vfs_allocated_count;
2963 u32 rctl, vmolr = 0;
2964 int count;
Auke Kok9d5c8242008-01-24 02:22:38 -08002965
2966 /* Check for Promiscuous and All Multicast modes */
Auke Kok9d5c8242008-01-24 02:22:38 -08002967 rctl = rd32(E1000_RCTL);
2968
Alexander Duyck68d480c2009-10-05 06:33:08 +00002969 /* clear the effected bits */
2970 rctl &= ~(E1000_RCTL_UPE | E1000_RCTL_MPE | E1000_RCTL_VFE);
2971
Patrick McHardy746b9f02008-07-16 20:15:45 -07002972 if (netdev->flags & IFF_PROMISC) {
Auke Kok9d5c8242008-01-24 02:22:38 -08002973 rctl |= (E1000_RCTL_UPE | E1000_RCTL_MPE);
Alexander Duyck68d480c2009-10-05 06:33:08 +00002974 vmolr |= (E1000_VMOLR_ROPE | E1000_VMOLR_MPME);
Patrick McHardy746b9f02008-07-16 20:15:45 -07002975 } else {
Alexander Duyck68d480c2009-10-05 06:33:08 +00002976 if (netdev->flags & IFF_ALLMULTI) {
Patrick McHardy746b9f02008-07-16 20:15:45 -07002977 rctl |= E1000_RCTL_MPE;
Alexander Duyck68d480c2009-10-05 06:33:08 +00002978 vmolr |= E1000_VMOLR_MPME;
2979 } else {
2980 /*
2981 * Write addresses to the MTA, if the attempt fails
2982 * then we should just turn on promiscous mode so
2983 * that we can at least receive multicast traffic
2984 */
2985 count = igb_write_mc_addr_list(netdev);
2986 if (count < 0) {
2987 rctl |= E1000_RCTL_MPE;
2988 vmolr |= E1000_VMOLR_MPME;
2989 } else if (count) {
2990 vmolr |= E1000_VMOLR_ROMPE;
2991 }
2992 }
2993 /*
2994 * Write addresses to available RAR registers, if there is not
2995 * sufficient space to store all the addresses then enable
2996 * unicast promiscous mode
2997 */
2998 count = igb_write_uc_addr_list(netdev);
2999 if (count < 0) {
Alexander Duyckff41f8d2009-09-03 14:48:56 +00003000 rctl |= E1000_RCTL_UPE;
Alexander Duyck68d480c2009-10-05 06:33:08 +00003001 vmolr |= E1000_VMOLR_ROPE;
3002 }
Patrick McHardy78ed11a2008-07-16 20:16:14 -07003003 rctl |= E1000_RCTL_VFE;
Patrick McHardy746b9f02008-07-16 20:15:45 -07003004 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003005 wr32(E1000_RCTL, rctl);
3006
Alexander Duyck68d480c2009-10-05 06:33:08 +00003007 /*
3008 * In order to support SR-IOV and eventually VMDq it is necessary to set
3009 * the VMOLR to enable the appropriate modes. Without this workaround
3010 * we will have issues with VLAN tag stripping not being done for frames
3011 * that are only arriving because we are the default pool
3012 */
3013 if (hw->mac.type < e1000_82576)
Alexander Duyck28fc06f2009-07-23 18:08:54 +00003014 return;
Alexander Duyck28fc06f2009-07-23 18:08:54 +00003015
Alexander Duyck68d480c2009-10-05 06:33:08 +00003016 vmolr |= rd32(E1000_VMOLR(vfn)) &
3017 ~(E1000_VMOLR_ROPE | E1000_VMOLR_MPME | E1000_VMOLR_ROMPE);
3018 wr32(E1000_VMOLR(vfn), vmolr);
Alexander Duyck28fc06f2009-07-23 18:08:54 +00003019 igb_restore_vf_multicasts(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003020}
3021
3022/* Need to wait a few seconds after link up to get diagnostic information from
3023 * the phy */
3024static void igb_update_phy_info(unsigned long data)
3025{
3026 struct igb_adapter *adapter = (struct igb_adapter *) data;
Alexander Duyckf5f4cf02008-11-21 21:30:24 -08003027 igb_get_phy_info(&adapter->hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08003028}
3029
3030/**
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003031 * igb_has_link - check shared code for link and determine up/down
3032 * @adapter: pointer to driver private info
3033 **/
Nick Nunley31455352010-02-17 01:01:21 +00003034bool igb_has_link(struct igb_adapter *adapter)
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003035{
3036 struct e1000_hw *hw = &adapter->hw;
3037 bool link_active = false;
3038 s32 ret_val = 0;
3039
3040 /* get_link_status is set on LSC (link status) interrupt or
3041 * rx sequence error interrupt. get_link_status will stay
3042 * false until the e1000_check_for_link establishes link
3043 * for copper adapters ONLY
3044 */
3045 switch (hw->phy.media_type) {
3046 case e1000_media_type_copper:
3047 if (hw->mac.get_link_status) {
3048 ret_val = hw->mac.ops.check_for_link(hw);
3049 link_active = !hw->mac.get_link_status;
3050 } else {
3051 link_active = true;
3052 }
3053 break;
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003054 case e1000_media_type_internal_serdes:
3055 ret_val = hw->mac.ops.check_for_link(hw);
3056 link_active = hw->mac.serdes_has_link;
3057 break;
3058 default:
3059 case e1000_media_type_unknown:
3060 break;
3061 }
3062
3063 return link_active;
3064}
3065
3066/**
Auke Kok9d5c8242008-01-24 02:22:38 -08003067 * igb_watchdog - Timer Call-back
3068 * @data: pointer to adapter cast into an unsigned long
3069 **/
3070static void igb_watchdog(unsigned long data)
3071{
3072 struct igb_adapter *adapter = (struct igb_adapter *)data;
3073 /* Do the rest outside of interrupt context */
3074 schedule_work(&adapter->watchdog_task);
3075}
3076
3077static void igb_watchdog_task(struct work_struct *work)
3078{
3079 struct igb_adapter *adapter = container_of(work,
Alexander Duyck559e9c42009-10-27 23:52:50 +00003080 struct igb_adapter,
3081 watchdog_task);
Auke Kok9d5c8242008-01-24 02:22:38 -08003082 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08003083 struct net_device *netdev = adapter->netdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003084 u32 link;
Alexander Duyck7a6ea552008-08-26 04:25:03 -07003085 int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003086
Alexander Duyck4d6b7252009-02-06 23:16:24 +00003087 link = igb_has_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003088 if (link) {
3089 if (!netif_carrier_ok(netdev)) {
3090 u32 ctrl;
Alexander Duyck330a6d62009-10-27 23:51:35 +00003091 hw->mac.ops.get_speed_and_duplex(hw,
3092 &adapter->link_speed,
3093 &adapter->link_duplex);
Auke Kok9d5c8242008-01-24 02:22:38 -08003094
3095 ctrl = rd32(E1000_CTRL);
Alexander Duyck527d47c2008-11-27 00:21:39 -08003096 /* Links status message must follow this format */
3097 printk(KERN_INFO "igb: %s NIC Link is Up %d Mbps %s, "
Auke Kok9d5c8242008-01-24 02:22:38 -08003098 "Flow Control: %s\n",
Alexander Duyck559e9c42009-10-27 23:52:50 +00003099 netdev->name,
3100 adapter->link_speed,
3101 adapter->link_duplex == FULL_DUPLEX ?
Auke Kok9d5c8242008-01-24 02:22:38 -08003102 "Full Duplex" : "Half Duplex",
Alexander Duyck559e9c42009-10-27 23:52:50 +00003103 ((ctrl & E1000_CTRL_TFCE) &&
3104 (ctrl & E1000_CTRL_RFCE)) ? "RX/TX" :
3105 ((ctrl & E1000_CTRL_RFCE) ? "RX" :
3106 ((ctrl & E1000_CTRL_TFCE) ? "TX" : "None")));
Auke Kok9d5c8242008-01-24 02:22:38 -08003107
3108 /* tweak tx_queue_len according to speed/duplex and
3109 * adjust the timeout factor */
3110 netdev->tx_queue_len = adapter->tx_queue_len;
3111 adapter->tx_timeout_factor = 1;
3112 switch (adapter->link_speed) {
3113 case SPEED_10:
3114 netdev->tx_queue_len = 10;
3115 adapter->tx_timeout_factor = 14;
3116 break;
3117 case SPEED_100:
3118 netdev->tx_queue_len = 100;
3119 /* maybe add some timeout factor ? */
3120 break;
3121 }
3122
3123 netif_carrier_on(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08003124
Alexander Duyck4ae196d2009-02-19 20:40:07 -08003125 igb_ping_all_vfs(adapter);
3126
Alexander Duyck4b1a9872009-02-06 23:19:50 +00003127 /* link state has changed, schedule phy info update */
Auke Kok9d5c8242008-01-24 02:22:38 -08003128 if (!test_bit(__IGB_DOWN, &adapter->state))
3129 mod_timer(&adapter->phy_info_timer,
3130 round_jiffies(jiffies + 2 * HZ));
3131 }
3132 } else {
3133 if (netif_carrier_ok(netdev)) {
3134 adapter->link_speed = 0;
3135 adapter->link_duplex = 0;
Alexander Duyck527d47c2008-11-27 00:21:39 -08003136 /* Links status message must follow this format */
3137 printk(KERN_INFO "igb: %s NIC Link is Down\n",
3138 netdev->name);
Auke Kok9d5c8242008-01-24 02:22:38 -08003139 netif_carrier_off(netdev);
Alexander Duyck4b1a9872009-02-06 23:19:50 +00003140
Alexander Duyck4ae196d2009-02-19 20:40:07 -08003141 igb_ping_all_vfs(adapter);
3142
Alexander Duyck4b1a9872009-02-06 23:19:50 +00003143 /* link state has changed, schedule phy info update */
Auke Kok9d5c8242008-01-24 02:22:38 -08003144 if (!test_bit(__IGB_DOWN, &adapter->state))
3145 mod_timer(&adapter->phy_info_timer,
3146 round_jiffies(jiffies + 2 * HZ));
3147 }
3148 }
3149
Auke Kok9d5c8242008-01-24 02:22:38 -08003150 igb_update_stats(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003151
Alexander Duyckdbabb062009-11-12 18:38:16 +00003152 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00003153 struct igb_ring *tx_ring = adapter->tx_ring[i];
Alexander Duyckdbabb062009-11-12 18:38:16 +00003154 if (!netif_carrier_ok(netdev)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003155 /* We've lost link, so the controller stops DMA,
3156 * but we've got queued Tx work that's never going
3157 * to get done, so reset controller to flush Tx.
3158 * (Do the reset outside of interrupt context). */
Alexander Duyckdbabb062009-11-12 18:38:16 +00003159 if (igb_desc_unused(tx_ring) + 1 < tx_ring->count) {
3160 adapter->tx_timeout_count++;
3161 schedule_work(&adapter->reset_task);
3162 /* return immediately since reset is imminent */
3163 return;
3164 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003165 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003166
Alexander Duyckdbabb062009-11-12 18:38:16 +00003167 /* Force detection of hung controller every watchdog period */
3168 tx_ring->detect_tx_hung = true;
3169 }
Alexander Duyckf7ba2052009-10-27 23:48:51 +00003170
Auke Kok9d5c8242008-01-24 02:22:38 -08003171 /* Cause software interrupt to ensure rx ring is cleaned */
Alexander Duyck7a6ea552008-08-26 04:25:03 -07003172 if (adapter->msix_entries) {
Alexander Duyck047e0032009-10-27 15:49:27 +00003173 u32 eics = 0;
3174 for (i = 0; i < adapter->num_q_vectors; i++) {
3175 struct igb_q_vector *q_vector = adapter->q_vector[i];
3176 eics |= q_vector->eims_value;
3177 }
Alexander Duyck7a6ea552008-08-26 04:25:03 -07003178 wr32(E1000_EICS, eics);
3179 } else {
3180 wr32(E1000_ICS, E1000_ICS_RXDMT0);
3181 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003182
Auke Kok9d5c8242008-01-24 02:22:38 -08003183 /* Reset the timer */
3184 if (!test_bit(__IGB_DOWN, &adapter->state))
3185 mod_timer(&adapter->watchdog_timer,
3186 round_jiffies(jiffies + 2 * HZ));
3187}
3188
3189enum latency_range {
3190 lowest_latency = 0,
3191 low_latency = 1,
3192 bulk_latency = 2,
3193 latency_invalid = 255
3194};
3195
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003196/**
3197 * igb_update_ring_itr - update the dynamic ITR value based on packet size
3198 *
3199 * Stores a new ITR value based on strictly on packet size. This
3200 * algorithm is less sophisticated than that used in igb_update_itr,
3201 * due to the difficulty of synchronizing statistics across multiple
3202 * receive rings. The divisors and thresholds used by this fuction
3203 * were determined based on theoretical maximum wire speed and testing
3204 * data, in order to minimize response time while increasing bulk
3205 * throughput.
3206 * This functionality is controlled by the InterruptThrottleRate module
3207 * parameter (see igb_param.c)
3208 * NOTE: This function is called only when operating in a multiqueue
3209 * receive environment.
Alexander Duyck047e0032009-10-27 15:49:27 +00003210 * @q_vector: pointer to q_vector
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003211 **/
Alexander Duyck047e0032009-10-27 15:49:27 +00003212static void igb_update_ring_itr(struct igb_q_vector *q_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -08003213{
Alexander Duyck047e0032009-10-27 15:49:27 +00003214 int new_val = q_vector->itr_val;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003215 int avg_wire_size = 0;
Alexander Duyck047e0032009-10-27 15:49:27 +00003216 struct igb_adapter *adapter = q_vector->adapter;
Auke Kok9d5c8242008-01-24 02:22:38 -08003217
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003218 /* For non-gigabit speeds, just fix the interrupt rate at 4000
3219 * ints/sec - ITR timer value of 120 ticks.
3220 */
3221 if (adapter->link_speed != SPEED_1000) {
Alexander Duyck047e0032009-10-27 15:49:27 +00003222 new_val = 976;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003223 goto set_itr_val;
3224 }
Alexander Duyck047e0032009-10-27 15:49:27 +00003225
3226 if (q_vector->rx_ring && q_vector->rx_ring->total_packets) {
3227 struct igb_ring *ring = q_vector->rx_ring;
3228 avg_wire_size = ring->total_bytes / ring->total_packets;
3229 }
3230
3231 if (q_vector->tx_ring && q_vector->tx_ring->total_packets) {
3232 struct igb_ring *ring = q_vector->tx_ring;
3233 avg_wire_size = max_t(u32, avg_wire_size,
3234 (ring->total_bytes /
3235 ring->total_packets));
3236 }
3237
3238 /* if avg_wire_size isn't set no work was done */
3239 if (!avg_wire_size)
3240 goto clear_counts;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003241
3242 /* Add 24 bytes to size to account for CRC, preamble, and gap */
3243 avg_wire_size += 24;
3244
3245 /* Don't starve jumbo frames */
3246 avg_wire_size = min(avg_wire_size, 3000);
3247
3248 /* Give a little boost to mid-size frames */
3249 if ((avg_wire_size > 300) && (avg_wire_size < 1200))
3250 new_val = avg_wire_size / 3;
3251 else
3252 new_val = avg_wire_size / 2;
3253
Nick Nunleyabe1c362010-02-17 01:03:19 +00003254 /* when in itr mode 3 do not exceed 20K ints/sec */
3255 if (adapter->rx_itr_setting == 3 && new_val < 196)
3256 new_val = 196;
3257
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003258set_itr_val:
Alexander Duyck047e0032009-10-27 15:49:27 +00003259 if (new_val != q_vector->itr_val) {
3260 q_vector->itr_val = new_val;
3261 q_vector->set_itr = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -08003262 }
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003263clear_counts:
Alexander Duyck047e0032009-10-27 15:49:27 +00003264 if (q_vector->rx_ring) {
3265 q_vector->rx_ring->total_bytes = 0;
3266 q_vector->rx_ring->total_packets = 0;
3267 }
3268 if (q_vector->tx_ring) {
3269 q_vector->tx_ring->total_bytes = 0;
3270 q_vector->tx_ring->total_packets = 0;
3271 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003272}
3273
3274/**
3275 * igb_update_itr - update the dynamic ITR value based on statistics
3276 * Stores a new ITR value based on packets and byte
3277 * counts during the last interrupt. The advantage of per interrupt
3278 * computation is faster updates and more accurate ITR for the current
3279 * traffic pattern. Constants in this function were computed
3280 * based on theoretical maximum wire speed and thresholds were set based
3281 * on testing data as well as attempting to minimize response time
3282 * while increasing bulk throughput.
3283 * this functionality is controlled by the InterruptThrottleRate module
3284 * parameter (see igb_param.c)
3285 * NOTE: These calculations are only valid when operating in a single-
3286 * queue environment.
3287 * @adapter: pointer to adapter
Alexander Duyck047e0032009-10-27 15:49:27 +00003288 * @itr_setting: current q_vector->itr_val
Auke Kok9d5c8242008-01-24 02:22:38 -08003289 * @packets: the number of packets during this measurement interval
3290 * @bytes: the number of bytes during this measurement interval
3291 **/
3292static unsigned int igb_update_itr(struct igb_adapter *adapter, u16 itr_setting,
3293 int packets, int bytes)
3294{
3295 unsigned int retval = itr_setting;
3296
3297 if (packets == 0)
3298 goto update_itr_done;
3299
3300 switch (itr_setting) {
3301 case lowest_latency:
3302 /* handle TSO and jumbo frames */
3303 if (bytes/packets > 8000)
3304 retval = bulk_latency;
3305 else if ((packets < 5) && (bytes > 512))
3306 retval = low_latency;
3307 break;
3308 case low_latency: /* 50 usec aka 20000 ints/s */
3309 if (bytes > 10000) {
3310 /* this if handles the TSO accounting */
3311 if (bytes/packets > 8000) {
3312 retval = bulk_latency;
3313 } else if ((packets < 10) || ((bytes/packets) > 1200)) {
3314 retval = bulk_latency;
3315 } else if ((packets > 35)) {
3316 retval = lowest_latency;
3317 }
3318 } else if (bytes/packets > 2000) {
3319 retval = bulk_latency;
3320 } else if (packets <= 2 && bytes < 512) {
3321 retval = lowest_latency;
3322 }
3323 break;
3324 case bulk_latency: /* 250 usec aka 4000 ints/s */
3325 if (bytes > 25000) {
3326 if (packets > 35)
3327 retval = low_latency;
Alexander Duyck1e5c3d22009-02-12 18:17:21 +00003328 } else if (bytes < 1500) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003329 retval = low_latency;
3330 }
3331 break;
3332 }
3333
3334update_itr_done:
3335 return retval;
3336}
3337
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003338static void igb_set_itr(struct igb_adapter *adapter)
Auke Kok9d5c8242008-01-24 02:22:38 -08003339{
Alexander Duyck047e0032009-10-27 15:49:27 +00003340 struct igb_q_vector *q_vector = adapter->q_vector[0];
Auke Kok9d5c8242008-01-24 02:22:38 -08003341 u16 current_itr;
Alexander Duyck047e0032009-10-27 15:49:27 +00003342 u32 new_itr = q_vector->itr_val;
Auke Kok9d5c8242008-01-24 02:22:38 -08003343
3344 /* for non-gigabit speeds, just fix the interrupt rate at 4000 */
3345 if (adapter->link_speed != SPEED_1000) {
3346 current_itr = 0;
3347 new_itr = 4000;
3348 goto set_itr_now;
3349 }
3350
3351 adapter->rx_itr = igb_update_itr(adapter,
3352 adapter->rx_itr,
Alexander Duyck3025a442010-02-17 01:02:39 +00003353 q_vector->rx_ring->total_packets,
3354 q_vector->rx_ring->total_bytes);
Auke Kok9d5c8242008-01-24 02:22:38 -08003355
Alexander Duyck047e0032009-10-27 15:49:27 +00003356 adapter->tx_itr = igb_update_itr(adapter,
3357 adapter->tx_itr,
Alexander Duyck3025a442010-02-17 01:02:39 +00003358 q_vector->tx_ring->total_packets,
3359 q_vector->tx_ring->total_bytes);
Alexander Duyck047e0032009-10-27 15:49:27 +00003360 current_itr = max(adapter->rx_itr, adapter->tx_itr);
Auke Kok9d5c8242008-01-24 02:22:38 -08003361
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003362 /* conservative mode (itr 3) eliminates the lowest_latency setting */
Alexander Duyck4fc82ad2009-10-27 23:45:42 +00003363 if (adapter->rx_itr_setting == 3 && current_itr == lowest_latency)
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003364 current_itr = low_latency;
3365
Auke Kok9d5c8242008-01-24 02:22:38 -08003366 switch (current_itr) {
3367 /* counts and packets in update_itr are dependent on these numbers */
3368 case lowest_latency:
Alexander Duyck78b1f6072009-04-23 11:20:29 +00003369 new_itr = 56; /* aka 70,000 ints/sec */
Auke Kok9d5c8242008-01-24 02:22:38 -08003370 break;
3371 case low_latency:
Alexander Duyck78b1f6072009-04-23 11:20:29 +00003372 new_itr = 196; /* aka 20,000 ints/sec */
Auke Kok9d5c8242008-01-24 02:22:38 -08003373 break;
3374 case bulk_latency:
Alexander Duyck78b1f6072009-04-23 11:20:29 +00003375 new_itr = 980; /* aka 4,000 ints/sec */
Auke Kok9d5c8242008-01-24 02:22:38 -08003376 break;
3377 default:
3378 break;
3379 }
3380
3381set_itr_now:
Alexander Duyck3025a442010-02-17 01:02:39 +00003382 q_vector->rx_ring->total_bytes = 0;
3383 q_vector->rx_ring->total_packets = 0;
3384 q_vector->tx_ring->total_bytes = 0;
3385 q_vector->tx_ring->total_packets = 0;
Alexander Duyck6eb5a7f2008-07-08 15:14:44 -07003386
Alexander Duyck047e0032009-10-27 15:49:27 +00003387 if (new_itr != q_vector->itr_val) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003388 /* this attempts to bias the interrupt rate towards Bulk
3389 * by adding intermediate steps when interrupt rate is
3390 * increasing */
Alexander Duyck047e0032009-10-27 15:49:27 +00003391 new_itr = new_itr > q_vector->itr_val ?
3392 max((new_itr * q_vector->itr_val) /
3393 (new_itr + (q_vector->itr_val >> 2)),
3394 new_itr) :
Auke Kok9d5c8242008-01-24 02:22:38 -08003395 new_itr;
3396 /* Don't write the value here; it resets the adapter's
3397 * internal timer, and causes us to delay far longer than
3398 * we should between interrupts. Instead, we write the ITR
3399 * value at the beginning of the next interrupt so the timing
3400 * ends up being correct.
3401 */
Alexander Duyck047e0032009-10-27 15:49:27 +00003402 q_vector->itr_val = new_itr;
3403 q_vector->set_itr = 1;
Auke Kok9d5c8242008-01-24 02:22:38 -08003404 }
3405
3406 return;
3407}
3408
Auke Kok9d5c8242008-01-24 02:22:38 -08003409#define IGB_TX_FLAGS_CSUM 0x00000001
3410#define IGB_TX_FLAGS_VLAN 0x00000002
3411#define IGB_TX_FLAGS_TSO 0x00000004
3412#define IGB_TX_FLAGS_IPV4 0x00000008
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003413#define IGB_TX_FLAGS_TSTAMP 0x00000010
3414#define IGB_TX_FLAGS_VLAN_MASK 0xffff0000
3415#define IGB_TX_FLAGS_VLAN_SHIFT 16
Auke Kok9d5c8242008-01-24 02:22:38 -08003416
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003417static inline int igb_tso_adv(struct igb_ring *tx_ring,
Auke Kok9d5c8242008-01-24 02:22:38 -08003418 struct sk_buff *skb, u32 tx_flags, u8 *hdr_len)
3419{
3420 struct e1000_adv_tx_context_desc *context_desc;
3421 unsigned int i;
3422 int err;
3423 struct igb_buffer *buffer_info;
3424 u32 info = 0, tu_cmd = 0;
Nick Nunley91d4ee32010-02-17 01:04:56 +00003425 u32 mss_l4len_idx;
3426 u8 l4len;
Auke Kok9d5c8242008-01-24 02:22:38 -08003427
3428 if (skb_header_cloned(skb)) {
3429 err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
3430 if (err)
3431 return err;
3432 }
3433
3434 l4len = tcp_hdrlen(skb);
3435 *hdr_len += l4len;
3436
3437 if (skb->protocol == htons(ETH_P_IP)) {
3438 struct iphdr *iph = ip_hdr(skb);
3439 iph->tot_len = 0;
3440 iph->check = 0;
3441 tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
3442 iph->daddr, 0,
3443 IPPROTO_TCP,
3444 0);
Sridhar Samudrala8e1e8a42010-01-23 02:02:21 -08003445 } else if (skb_is_gso_v6(skb)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003446 ipv6_hdr(skb)->payload_len = 0;
3447 tcp_hdr(skb)->check = ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
3448 &ipv6_hdr(skb)->daddr,
3449 0, IPPROTO_TCP, 0);
3450 }
3451
3452 i = tx_ring->next_to_use;
3453
3454 buffer_info = &tx_ring->buffer_info[i];
3455 context_desc = E1000_TX_CTXTDESC_ADV(*tx_ring, i);
3456 /* VLAN MACLEN IPLEN */
3457 if (tx_flags & IGB_TX_FLAGS_VLAN)
3458 info |= (tx_flags & IGB_TX_FLAGS_VLAN_MASK);
3459 info |= (skb_network_offset(skb) << E1000_ADVTXD_MACLEN_SHIFT);
3460 *hdr_len += skb_network_offset(skb);
3461 info |= skb_network_header_len(skb);
3462 *hdr_len += skb_network_header_len(skb);
3463 context_desc->vlan_macip_lens = cpu_to_le32(info);
3464
3465 /* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
3466 tu_cmd |= (E1000_TXD_CMD_DEXT | E1000_ADVTXD_DTYP_CTXT);
3467
3468 if (skb->protocol == htons(ETH_P_IP))
3469 tu_cmd |= E1000_ADVTXD_TUCMD_IPV4;
3470 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_TCP;
3471
3472 context_desc->type_tucmd_mlhl = cpu_to_le32(tu_cmd);
3473
3474 /* MSS L4LEN IDX */
3475 mss_l4len_idx = (skb_shinfo(skb)->gso_size << E1000_ADVTXD_MSS_SHIFT);
3476 mss_l4len_idx |= (l4len << E1000_ADVTXD_L4LEN_SHIFT);
3477
Alexander Duyck73cd78f2009-02-12 18:16:59 +00003478 /* For 82575, context index must be unique per ring. */
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003479 if (tx_ring->flags & IGB_RING_FLAG_TX_CTX_IDX)
3480 mss_l4len_idx |= tx_ring->reg_idx << 4;
Auke Kok9d5c8242008-01-24 02:22:38 -08003481
3482 context_desc->mss_l4len_idx = cpu_to_le32(mss_l4len_idx);
3483 context_desc->seqnum_seed = 0;
3484
3485 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003486 buffer_info->next_to_watch = i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003487 buffer_info->dma = 0;
3488 i++;
3489 if (i == tx_ring->count)
3490 i = 0;
3491
3492 tx_ring->next_to_use = i;
3493
3494 return true;
3495}
3496
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003497static inline bool igb_tx_csum_adv(struct igb_ring *tx_ring,
3498 struct sk_buff *skb, u32 tx_flags)
Auke Kok9d5c8242008-01-24 02:22:38 -08003499{
3500 struct e1000_adv_tx_context_desc *context_desc;
Alexander Duyck80785292009-10-27 15:51:47 +00003501 struct pci_dev *pdev = tx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003502 struct igb_buffer *buffer_info;
3503 u32 info = 0, tu_cmd = 0;
Alexander Duyck80785292009-10-27 15:51:47 +00003504 unsigned int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003505
3506 if ((skb->ip_summed == CHECKSUM_PARTIAL) ||
3507 (tx_flags & IGB_TX_FLAGS_VLAN)) {
3508 i = tx_ring->next_to_use;
3509 buffer_info = &tx_ring->buffer_info[i];
3510 context_desc = E1000_TX_CTXTDESC_ADV(*tx_ring, i);
3511
3512 if (tx_flags & IGB_TX_FLAGS_VLAN)
3513 info |= (tx_flags & IGB_TX_FLAGS_VLAN_MASK);
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003514
Auke Kok9d5c8242008-01-24 02:22:38 -08003515 info |= (skb_network_offset(skb) << E1000_ADVTXD_MACLEN_SHIFT);
3516 if (skb->ip_summed == CHECKSUM_PARTIAL)
3517 info |= skb_network_header_len(skb);
3518
3519 context_desc->vlan_macip_lens = cpu_to_le32(info);
3520
3521 tu_cmd |= (E1000_TXD_CMD_DEXT | E1000_ADVTXD_DTYP_CTXT);
3522
3523 if (skb->ip_summed == CHECKSUM_PARTIAL) {
Arthur Jonesfa4a7ef2009-03-21 16:55:07 -07003524 __be16 protocol;
3525
3526 if (skb->protocol == cpu_to_be16(ETH_P_8021Q)) {
3527 const struct vlan_ethhdr *vhdr =
3528 (const struct vlan_ethhdr*)skb->data;
3529
3530 protocol = vhdr->h_vlan_encapsulated_proto;
3531 } else {
3532 protocol = skb->protocol;
3533 }
3534
3535 switch (protocol) {
Harvey Harrison09640e632009-02-01 00:45:17 -08003536 case cpu_to_be16(ETH_P_IP):
Auke Kok9d5c8242008-01-24 02:22:38 -08003537 tu_cmd |= E1000_ADVTXD_TUCMD_IPV4;
Mitch Williams44b0cda2008-03-07 10:32:13 -08003538 if (ip_hdr(skb)->protocol == IPPROTO_TCP)
3539 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_TCP;
Jesse Brandeburgb9473562009-04-27 22:36:13 +00003540 else if (ip_hdr(skb)->protocol == IPPROTO_SCTP)
3541 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_SCTP;
Mitch Williams44b0cda2008-03-07 10:32:13 -08003542 break;
Harvey Harrison09640e632009-02-01 00:45:17 -08003543 case cpu_to_be16(ETH_P_IPV6):
Mitch Williams44b0cda2008-03-07 10:32:13 -08003544 /* XXX what about other V6 headers?? */
3545 if (ipv6_hdr(skb)->nexthdr == IPPROTO_TCP)
3546 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_TCP;
Jesse Brandeburgb9473562009-04-27 22:36:13 +00003547 else if (ipv6_hdr(skb)->nexthdr == IPPROTO_SCTP)
3548 tu_cmd |= E1000_ADVTXD_TUCMD_L4T_SCTP;
Mitch Williams44b0cda2008-03-07 10:32:13 -08003549 break;
3550 default:
3551 if (unlikely(net_ratelimit()))
Alexander Duyck80785292009-10-27 15:51:47 +00003552 dev_warn(&pdev->dev,
Mitch Williams44b0cda2008-03-07 10:32:13 -08003553 "partial checksum but proto=%x!\n",
3554 skb->protocol);
3555 break;
3556 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003557 }
3558
3559 context_desc->type_tucmd_mlhl = cpu_to_le32(tu_cmd);
3560 context_desc->seqnum_seed = 0;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003561 if (tx_ring->flags & IGB_RING_FLAG_TX_CTX_IDX)
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07003562 context_desc->mss_l4len_idx =
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003563 cpu_to_le32(tx_ring->reg_idx << 4);
Auke Kok9d5c8242008-01-24 02:22:38 -08003564
3565 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003566 buffer_info->next_to_watch = i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003567 buffer_info->dma = 0;
3568
3569 i++;
3570 if (i == tx_ring->count)
3571 i = 0;
3572 tx_ring->next_to_use = i;
3573
3574 return true;
3575 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003576 return false;
3577}
3578
3579#define IGB_MAX_TXD_PWR 16
3580#define IGB_MAX_DATA_PER_TXD (1<<IGB_MAX_TXD_PWR)
3581
Alexander Duyck80785292009-10-27 15:51:47 +00003582static inline int igb_tx_map_adv(struct igb_ring *tx_ring, struct sk_buff *skb,
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003583 unsigned int first)
Auke Kok9d5c8242008-01-24 02:22:38 -08003584{
3585 struct igb_buffer *buffer_info;
Alexander Duyck80785292009-10-27 15:51:47 +00003586 struct pci_dev *pdev = tx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003587 unsigned int len = skb_headlen(skb);
3588 unsigned int count = 0, i;
3589 unsigned int f;
3590
3591 i = tx_ring->next_to_use;
3592
3593 buffer_info = &tx_ring->buffer_info[i];
3594 BUG_ON(len >= IGB_MAX_DATA_PER_TXD);
3595 buffer_info->length = len;
3596 /* set time_stamp *before* dma to help avoid a possible race */
3597 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003598 buffer_info->next_to_watch = i;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003599 buffer_info->dma = pci_map_single(pdev, skb->data, len,
3600 PCI_DMA_TODEVICE);
3601 if (pci_dma_mapping_error(pdev, buffer_info->dma))
3602 goto dma_error;
Auke Kok9d5c8242008-01-24 02:22:38 -08003603
3604 for (f = 0; f < skb_shinfo(skb)->nr_frags; f++) {
3605 struct skb_frag_struct *frag;
3606
Alexander Duyck85811452010-01-23 01:35:00 -08003607 count++;
Alexander Duyck65689fe2009-03-20 00:17:43 +00003608 i++;
3609 if (i == tx_ring->count)
3610 i = 0;
3611
Auke Kok9d5c8242008-01-24 02:22:38 -08003612 frag = &skb_shinfo(skb)->frags[f];
3613 len = frag->size;
3614
3615 buffer_info = &tx_ring->buffer_info[i];
3616 BUG_ON(len >= IGB_MAX_DATA_PER_TXD);
3617 buffer_info->length = len;
3618 buffer_info->time_stamp = jiffies;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003619 buffer_info->next_to_watch = i;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003620 buffer_info->mapped_as_page = true;
3621 buffer_info->dma = pci_map_page(pdev,
3622 frag->page,
3623 frag->page_offset,
3624 len,
3625 PCI_DMA_TODEVICE);
3626 if (pci_dma_mapping_error(pdev, buffer_info->dma))
3627 goto dma_error;
3628
Auke Kok9d5c8242008-01-24 02:22:38 -08003629 }
3630
Auke Kok9d5c8242008-01-24 02:22:38 -08003631 tx_ring->buffer_info[i].skb = skb;
Nick Nunley40e90c22010-02-17 01:04:37 +00003632 tx_ring->buffer_info[i].gso_segs = skb_shinfo(skb)->gso_segs ?: 1;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003633 tx_ring->buffer_info[first].next_to_watch = i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003634
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003635 return ++count;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003636
3637dma_error:
3638 dev_err(&pdev->dev, "TX DMA map failed\n");
3639
3640 /* clear timestamp and dma mappings for failed buffer_info mapping */
3641 buffer_info->dma = 0;
3642 buffer_info->time_stamp = 0;
3643 buffer_info->length = 0;
3644 buffer_info->next_to_watch = 0;
3645 buffer_info->mapped_as_page = false;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003646
3647 /* clear timestamp and dma mappings for remaining portion of packet */
Nick Nunleya77ff702010-02-17 01:06:16 +00003648 while (count--) {
3649 if (i == 0)
3650 i = tx_ring->count;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003651 i--;
Alexander Duyck6366ad32009-12-02 16:47:18 +00003652 buffer_info = &tx_ring->buffer_info[i];
3653 igb_unmap_and_free_tx_resource(tx_ring, buffer_info);
3654 }
3655
3656 return 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08003657}
3658
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003659static inline void igb_tx_queue_adv(struct igb_ring *tx_ring,
Nick Nunley91d4ee32010-02-17 01:04:56 +00003660 u32 tx_flags, int count, u32 paylen,
Auke Kok9d5c8242008-01-24 02:22:38 -08003661 u8 hdr_len)
3662{
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003663 union e1000_adv_tx_desc *tx_desc;
Auke Kok9d5c8242008-01-24 02:22:38 -08003664 struct igb_buffer *buffer_info;
3665 u32 olinfo_status = 0, cmd_type_len;
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003666 unsigned int i = tx_ring->next_to_use;
Auke Kok9d5c8242008-01-24 02:22:38 -08003667
3668 cmd_type_len = (E1000_ADVTXD_DTYP_DATA | E1000_ADVTXD_DCMD_IFCS |
3669 E1000_ADVTXD_DCMD_DEXT);
3670
3671 if (tx_flags & IGB_TX_FLAGS_VLAN)
3672 cmd_type_len |= E1000_ADVTXD_DCMD_VLE;
3673
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003674 if (tx_flags & IGB_TX_FLAGS_TSTAMP)
3675 cmd_type_len |= E1000_ADVTXD_MAC_TSTAMP;
3676
Auke Kok9d5c8242008-01-24 02:22:38 -08003677 if (tx_flags & IGB_TX_FLAGS_TSO) {
3678 cmd_type_len |= E1000_ADVTXD_DCMD_TSE;
3679
3680 /* insert tcp checksum */
3681 olinfo_status |= E1000_TXD_POPTS_TXSM << 8;
3682
3683 /* insert ip checksum */
3684 if (tx_flags & IGB_TX_FLAGS_IPV4)
3685 olinfo_status |= E1000_TXD_POPTS_IXSM << 8;
3686
3687 } else if (tx_flags & IGB_TX_FLAGS_CSUM) {
3688 olinfo_status |= E1000_TXD_POPTS_TXSM << 8;
3689 }
3690
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003691 if ((tx_ring->flags & IGB_RING_FLAG_TX_CTX_IDX) &&
3692 (tx_flags & (IGB_TX_FLAGS_CSUM |
3693 IGB_TX_FLAGS_TSO |
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07003694 IGB_TX_FLAGS_VLAN)))
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003695 olinfo_status |= tx_ring->reg_idx << 4;
Auke Kok9d5c8242008-01-24 02:22:38 -08003696
3697 olinfo_status |= ((paylen - hdr_len) << E1000_ADVTXD_PAYLEN_SHIFT);
3698
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003699 do {
Auke Kok9d5c8242008-01-24 02:22:38 -08003700 buffer_info = &tx_ring->buffer_info[i];
3701 tx_desc = E1000_TX_DESC_ADV(*tx_ring, i);
3702 tx_desc->read.buffer_addr = cpu_to_le64(buffer_info->dma);
3703 tx_desc->read.cmd_type_len =
3704 cpu_to_le32(cmd_type_len | buffer_info->length);
3705 tx_desc->read.olinfo_status = cpu_to_le32(olinfo_status);
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003706 count--;
Auke Kok9d5c8242008-01-24 02:22:38 -08003707 i++;
3708 if (i == tx_ring->count)
3709 i = 0;
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003710 } while (count > 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08003711
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003712 tx_desc->read.cmd_type_len |= cpu_to_le32(IGB_ADVTXD_DCMD);
Auke Kok9d5c8242008-01-24 02:22:38 -08003713 /* Force memory writes to complete before letting h/w
3714 * know there are new descriptors to fetch. (Only
3715 * applicable for weak-ordered memory model archs,
3716 * such as IA-64). */
3717 wmb();
3718
3719 tx_ring->next_to_use = i;
Alexander Duyckfce99e32009-10-27 15:51:27 +00003720 writel(i, tx_ring->tail);
Auke Kok9d5c8242008-01-24 02:22:38 -08003721 /* we need this if more than one processor can write to our tail
3722 * at a time, it syncronizes IO on IA64/Altix systems */
3723 mmiowb();
3724}
3725
Alexander Duycke694e962009-10-27 15:53:06 +00003726static int __igb_maybe_stop_tx(struct igb_ring *tx_ring, int size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003727{
Alexander Duycke694e962009-10-27 15:53:06 +00003728 struct net_device *netdev = tx_ring->netdev;
3729
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003730 netif_stop_subqueue(netdev, tx_ring->queue_index);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003731
Auke Kok9d5c8242008-01-24 02:22:38 -08003732 /* Herbert's original patch had:
3733 * smp_mb__after_netif_stop_queue();
3734 * but since that doesn't exist yet, just open code it. */
3735 smp_mb();
3736
3737 /* We need to check again in a case another CPU has just
3738 * made room available. */
Alexander Duyckc493ea42009-03-20 00:16:50 +00003739 if (igb_desc_unused(tx_ring) < size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003740 return -EBUSY;
3741
3742 /* A reprieve! */
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003743 netif_wake_subqueue(netdev, tx_ring->queue_index);
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00003744 tx_ring->tx_stats.restart_queue++;
Auke Kok9d5c8242008-01-24 02:22:38 -08003745 return 0;
3746}
3747
Nick Nunley717ba0892010-02-17 01:04:18 +00003748static inline int igb_maybe_stop_tx(struct igb_ring *tx_ring, int size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003749{
Alexander Duyckc493ea42009-03-20 00:16:50 +00003750 if (igb_desc_unused(tx_ring) >= size)
Auke Kok9d5c8242008-01-24 02:22:38 -08003751 return 0;
Alexander Duycke694e962009-10-27 15:53:06 +00003752 return __igb_maybe_stop_tx(tx_ring, size);
Auke Kok9d5c8242008-01-24 02:22:38 -08003753}
3754
Alexander Duyckb1a436c2009-10-27 15:54:43 +00003755netdev_tx_t igb_xmit_frame_ring_adv(struct sk_buff *skb,
3756 struct igb_ring *tx_ring)
Auke Kok9d5c8242008-01-24 02:22:38 -08003757{
Alexander Duycke694e962009-10-27 15:53:06 +00003758 struct igb_adapter *adapter = netdev_priv(tx_ring->netdev);
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003759 int tso = 0, count;
Nick Nunley91d4ee32010-02-17 01:04:56 +00003760 u32 tx_flags = 0;
3761 u16 first;
3762 u8 hdr_len = 0;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00003763 union skb_shared_tx *shtx = skb_tx(skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08003764
Auke Kok9d5c8242008-01-24 02:22:38 -08003765 /* need: 1 descriptor per page,
3766 * + 2 desc gap to keep tail from touching head,
3767 * + 1 desc for skb->data,
3768 * + 1 desc for context descriptor,
3769 * otherwise try next time */
Alexander Duycke694e962009-10-27 15:53:06 +00003770 if (igb_maybe_stop_tx(tx_ring, skb_shinfo(skb)->nr_frags + 4)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003771 /* this is a hard error */
Auke Kok9d5c8242008-01-24 02:22:38 -08003772 return NETDEV_TX_BUSY;
3773 }
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003774
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003775 if (unlikely(shtx->hardware)) {
3776 shtx->in_progress = 1;
3777 tx_flags |= IGB_TX_FLAGS_TSTAMP;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00003778 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003779
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003780 if (vlan_tx_tag_present(skb) && adapter->vlgrp) {
Auke Kok9d5c8242008-01-24 02:22:38 -08003781 tx_flags |= IGB_TX_FLAGS_VLAN;
3782 tx_flags |= (vlan_tx_tag_get(skb) << IGB_TX_FLAGS_VLAN_SHIFT);
3783 }
3784
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003785 if (skb->protocol == htons(ETH_P_IP))
3786 tx_flags |= IGB_TX_FLAGS_IPV4;
3787
Alexander Duyck0e014cb2008-12-26 01:33:18 -08003788 first = tx_ring->next_to_use;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003789 if (skb_is_gso(skb)) {
3790 tso = igb_tso_adv(tx_ring, skb, tx_flags, &hdr_len);
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003791
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003792 if (tso < 0) {
3793 dev_kfree_skb_any(skb);
3794 return NETDEV_TX_OK;
3795 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003796 }
3797
3798 if (tso)
3799 tx_flags |= IGB_TX_FLAGS_TSO;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003800 else if (igb_tx_csum_adv(tx_ring, skb, tx_flags) &&
Alexander Duyckbc1cbd32009-02-13 14:45:17 +00003801 (skb->ip_summed == CHECKSUM_PARTIAL))
3802 tx_flags |= IGB_TX_FLAGS_CSUM;
Auke Kok9d5c8242008-01-24 02:22:38 -08003803
Alexander Duyck65689fe2009-03-20 00:17:43 +00003804 /*
Alexander Duyckcdfd01fc2009-10-27 23:50:57 +00003805 * count reflects descriptors mapped, if 0 or less then mapping error
Alexander Duyck65689fe2009-03-20 00:17:43 +00003806 * has occured and we need to rewind the descriptor queue
3807 */
Alexander Duyck80785292009-10-27 15:51:47 +00003808 count = igb_tx_map_adv(tx_ring, skb, first);
Alexander Duyck6366ad32009-12-02 16:47:18 +00003809 if (!count) {
Alexander Duyck65689fe2009-03-20 00:17:43 +00003810 dev_kfree_skb_any(skb);
3811 tx_ring->buffer_info[first].time_stamp = 0;
3812 tx_ring->next_to_use = first;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003813 return NETDEV_TX_OK;
Alexander Duyck65689fe2009-03-20 00:17:43 +00003814 }
Auke Kok9d5c8242008-01-24 02:22:38 -08003815
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003816 igb_tx_queue_adv(tx_ring, tx_flags, count, skb->len, hdr_len);
3817
3818 /* Make sure there is space in the ring for the next send. */
Alexander Duycke694e962009-10-27 15:53:06 +00003819 igb_maybe_stop_tx(tx_ring, MAX_SKB_FRAGS + 4);
Alexander Duyck85ad76b2009-10-27 15:52:46 +00003820
Auke Kok9d5c8242008-01-24 02:22:38 -08003821 return NETDEV_TX_OK;
3822}
3823
Stephen Hemminger3b29a562009-08-31 19:50:55 +00003824static netdev_tx_t igb_xmit_frame_adv(struct sk_buff *skb,
3825 struct net_device *netdev)
Auke Kok9d5c8242008-01-24 02:22:38 -08003826{
3827 struct igb_adapter *adapter = netdev_priv(netdev);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003828 struct igb_ring *tx_ring;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003829 int r_idx = 0;
Alexander Duyckb1a436c2009-10-27 15:54:43 +00003830
3831 if (test_bit(__IGB_DOWN, &adapter->state)) {
3832 dev_kfree_skb_any(skb);
3833 return NETDEV_TX_OK;
3834 }
3835
3836 if (skb->len <= 0) {
3837 dev_kfree_skb_any(skb);
3838 return NETDEV_TX_OK;
3839 }
3840
Alexander Duyck1bfaf072009-02-19 20:39:23 -08003841 r_idx = skb->queue_mapping & (IGB_ABS_MAX_TX_QUEUES - 1);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07003842 tx_ring = adapter->multi_tx_table[r_idx];
Auke Kok9d5c8242008-01-24 02:22:38 -08003843
3844 /* This goes back to the question of how to logically map a tx queue
3845 * to a flow. Right now, performance is impacted slightly negatively
3846 * if using multiple tx queues. If the stack breaks away from a
3847 * single qdisc implementation, we can look at this again. */
Alexander Duycke694e962009-10-27 15:53:06 +00003848 return igb_xmit_frame_ring_adv(skb, tx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08003849}
3850
3851/**
3852 * igb_tx_timeout - Respond to a Tx Hang
3853 * @netdev: network interface device structure
3854 **/
3855static void igb_tx_timeout(struct net_device *netdev)
3856{
3857 struct igb_adapter *adapter = netdev_priv(netdev);
3858 struct e1000_hw *hw = &adapter->hw;
3859
3860 /* Do the reset outside of interrupt context */
3861 adapter->tx_timeout_count++;
Alexander Duyckf7ba2052009-10-27 23:48:51 +00003862
Alexander Duyck55cac242009-11-19 12:42:21 +00003863 if (hw->mac.type == e1000_82580)
3864 hw->dev_spec._82575.global_device_reset = true;
3865
Auke Kok9d5c8242008-01-24 02:22:38 -08003866 schedule_work(&adapter->reset_task);
Alexander Duyck265de402009-02-06 23:22:52 +00003867 wr32(E1000_EICS,
3868 (adapter->eims_enable_mask & ~adapter->eims_other));
Auke Kok9d5c8242008-01-24 02:22:38 -08003869}
3870
3871static void igb_reset_task(struct work_struct *work)
3872{
3873 struct igb_adapter *adapter;
3874 adapter = container_of(work, struct igb_adapter, reset_task);
3875
3876 igb_reinit_locked(adapter);
3877}
3878
3879/**
3880 * igb_get_stats - Get System Network Statistics
3881 * @netdev: network interface device structure
3882 *
3883 * Returns the address of the device statistics structure.
3884 * The statistics are actually updated from the timer callback.
3885 **/
Alexander Duyck73cd78f2009-02-12 18:16:59 +00003886static struct net_device_stats *igb_get_stats(struct net_device *netdev)
Auke Kok9d5c8242008-01-24 02:22:38 -08003887{
Auke Kok9d5c8242008-01-24 02:22:38 -08003888 /* only return the current stats */
Ajit Khaparde8d24e932009-10-07 02:42:56 +00003889 return &netdev->stats;
Auke Kok9d5c8242008-01-24 02:22:38 -08003890}
3891
3892/**
3893 * igb_change_mtu - Change the Maximum Transfer Unit
3894 * @netdev: network interface device structure
3895 * @new_mtu: new value for maximum frame size
3896 *
3897 * Returns 0 on success, negative on failure
3898 **/
3899static int igb_change_mtu(struct net_device *netdev, int new_mtu)
3900{
3901 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyck090b1792009-10-27 23:51:55 +00003902 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08003903 int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;
Alexander Duyck4c844852009-10-27 15:52:07 +00003904 u32 rx_buffer_len, i;
Auke Kok9d5c8242008-01-24 02:22:38 -08003905
Alexander Duyckc809d222009-10-27 23:52:13 +00003906 if ((new_mtu < 68) || (max_frame > MAX_JUMBO_FRAME_SIZE)) {
Alexander Duyck090b1792009-10-27 23:51:55 +00003907 dev_err(&pdev->dev, "Invalid MTU setting\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08003908 return -EINVAL;
3909 }
3910
Auke Kok9d5c8242008-01-24 02:22:38 -08003911 if (max_frame > MAX_STD_JUMBO_FRAME_SIZE) {
Alexander Duyck090b1792009-10-27 23:51:55 +00003912 dev_err(&pdev->dev, "MTU > 9216 not supported.\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08003913 return -EINVAL;
3914 }
3915
3916 while (test_and_set_bit(__IGB_RESETTING, &adapter->state))
3917 msleep(1);
Alexander Duyck73cd78f2009-02-12 18:16:59 +00003918
Auke Kok9d5c8242008-01-24 02:22:38 -08003919 /* igb_down has a dependency on max_frame_size */
3920 adapter->max_frame_size = max_frame;
Alexander Duyck559e9c42009-10-27 23:52:50 +00003921
Auke Kok9d5c8242008-01-24 02:22:38 -08003922 /* NOTE: netdev_alloc_skb reserves 16 bytes, and typically NET_IP_ALIGN
3923 * means we reserve 2 more, this pushes us to allocate from the next
3924 * larger slab size.
3925 * i.e. RXBUFFER_2048 --> size-4096 slab
3926 */
3927
Alexander Duyck7d95b712009-10-27 15:50:08 +00003928 if (max_frame <= IGB_RXBUFFER_1024)
Alexander Duyck4c844852009-10-27 15:52:07 +00003929 rx_buffer_len = IGB_RXBUFFER_1024;
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00003930 else if (max_frame <= MAXIMUM_ETHERNET_VLAN_SIZE)
Alexander Duyck4c844852009-10-27 15:52:07 +00003931 rx_buffer_len = MAXIMUM_ETHERNET_VLAN_SIZE;
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00003932 else
Alexander Duyck4c844852009-10-27 15:52:07 +00003933 rx_buffer_len = IGB_RXBUFFER_128;
3934
3935 if (netif_running(netdev))
3936 igb_down(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08003937
Alexander Duyck090b1792009-10-27 23:51:55 +00003938 dev_info(&pdev->dev, "changing MTU from %d to %d\n",
Auke Kok9d5c8242008-01-24 02:22:38 -08003939 netdev->mtu, new_mtu);
3940 netdev->mtu = new_mtu;
3941
Alexander Duyck4c844852009-10-27 15:52:07 +00003942 for (i = 0; i < adapter->num_rx_queues; i++)
Alexander Duyck3025a442010-02-17 01:02:39 +00003943 adapter->rx_ring[i]->rx_buffer_len = rx_buffer_len;
Alexander Duyck4c844852009-10-27 15:52:07 +00003944
Auke Kok9d5c8242008-01-24 02:22:38 -08003945 if (netif_running(netdev))
3946 igb_up(adapter);
3947 else
3948 igb_reset(adapter);
3949
3950 clear_bit(__IGB_RESETTING, &adapter->state);
3951
3952 return 0;
3953}
3954
3955/**
3956 * igb_update_stats - Update the board statistics counters
3957 * @adapter: board private structure
3958 **/
3959
3960void igb_update_stats(struct igb_adapter *adapter)
3961{
Alexander Duyck128e45e2009-11-12 18:37:38 +00003962 struct net_device_stats *net_stats = igb_get_stats(adapter->netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08003963 struct e1000_hw *hw = &adapter->hw;
3964 struct pci_dev *pdev = adapter->pdev;
Nick Nunley43915c7c2010-02-17 01:03:58 +00003965 u32 rnbc, reg;
Auke Kok9d5c8242008-01-24 02:22:38 -08003966 u16 phy_tmp;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003967 int i;
3968 u64 bytes, packets;
Auke Kok9d5c8242008-01-24 02:22:38 -08003969
3970#define PHY_IDLE_ERROR_COUNT_MASK 0x00FF
3971
3972 /*
3973 * Prevent stats update while adapter is being reset, or if the pci
3974 * connection is down.
3975 */
3976 if (adapter->link_speed == 0)
3977 return;
3978 if (pci_channel_offline(pdev))
3979 return;
3980
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003981 bytes = 0;
3982 packets = 0;
3983 for (i = 0; i < adapter->num_rx_queues; i++) {
3984 u32 rqdpc_tmp = rd32(E1000_RQDPC(i)) & 0x0FFF;
Alexander Duyck3025a442010-02-17 01:02:39 +00003985 struct igb_ring *ring = adapter->rx_ring[i];
3986 ring->rx_stats.drops += rqdpc_tmp;
Alexander Duyck128e45e2009-11-12 18:37:38 +00003987 net_stats->rx_fifo_errors += rqdpc_tmp;
Alexander Duyck3025a442010-02-17 01:02:39 +00003988 bytes += ring->rx_stats.bytes;
3989 packets += ring->rx_stats.packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003990 }
3991
Alexander Duyck128e45e2009-11-12 18:37:38 +00003992 net_stats->rx_bytes = bytes;
3993 net_stats->rx_packets = packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00003994
3995 bytes = 0;
3996 packets = 0;
3997 for (i = 0; i < adapter->num_tx_queues; i++) {
Alexander Duyck3025a442010-02-17 01:02:39 +00003998 struct igb_ring *ring = adapter->tx_ring[i];
3999 bytes += ring->tx_stats.bytes;
4000 packets += ring->tx_stats.packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00004001 }
Alexander Duyck128e45e2009-11-12 18:37:38 +00004002 net_stats->tx_bytes = bytes;
4003 net_stats->tx_packets = packets;
Alexander Duyck3f9c0162009-10-27 23:48:12 +00004004
4005 /* read stats registers */
Auke Kok9d5c8242008-01-24 02:22:38 -08004006 adapter->stats.crcerrs += rd32(E1000_CRCERRS);
4007 adapter->stats.gprc += rd32(E1000_GPRC);
4008 adapter->stats.gorc += rd32(E1000_GORCL);
4009 rd32(E1000_GORCH); /* clear GORCL */
4010 adapter->stats.bprc += rd32(E1000_BPRC);
4011 adapter->stats.mprc += rd32(E1000_MPRC);
4012 adapter->stats.roc += rd32(E1000_ROC);
4013
4014 adapter->stats.prc64 += rd32(E1000_PRC64);
4015 adapter->stats.prc127 += rd32(E1000_PRC127);
4016 adapter->stats.prc255 += rd32(E1000_PRC255);
4017 adapter->stats.prc511 += rd32(E1000_PRC511);
4018 adapter->stats.prc1023 += rd32(E1000_PRC1023);
4019 adapter->stats.prc1522 += rd32(E1000_PRC1522);
4020 adapter->stats.symerrs += rd32(E1000_SYMERRS);
4021 adapter->stats.sec += rd32(E1000_SEC);
4022
4023 adapter->stats.mpc += rd32(E1000_MPC);
4024 adapter->stats.scc += rd32(E1000_SCC);
4025 adapter->stats.ecol += rd32(E1000_ECOL);
4026 adapter->stats.mcc += rd32(E1000_MCC);
4027 adapter->stats.latecol += rd32(E1000_LATECOL);
4028 adapter->stats.dc += rd32(E1000_DC);
4029 adapter->stats.rlec += rd32(E1000_RLEC);
4030 adapter->stats.xonrxc += rd32(E1000_XONRXC);
4031 adapter->stats.xontxc += rd32(E1000_XONTXC);
4032 adapter->stats.xoffrxc += rd32(E1000_XOFFRXC);
4033 adapter->stats.xofftxc += rd32(E1000_XOFFTXC);
4034 adapter->stats.fcruc += rd32(E1000_FCRUC);
4035 adapter->stats.gptc += rd32(E1000_GPTC);
4036 adapter->stats.gotc += rd32(E1000_GOTCL);
4037 rd32(E1000_GOTCH); /* clear GOTCL */
Alexander Duyck3f9c0162009-10-27 23:48:12 +00004038 rnbc = rd32(E1000_RNBC);
4039 adapter->stats.rnbc += rnbc;
Alexander Duyck128e45e2009-11-12 18:37:38 +00004040 net_stats->rx_fifo_errors += rnbc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004041 adapter->stats.ruc += rd32(E1000_RUC);
4042 adapter->stats.rfc += rd32(E1000_RFC);
4043 adapter->stats.rjc += rd32(E1000_RJC);
4044 adapter->stats.tor += rd32(E1000_TORH);
4045 adapter->stats.tot += rd32(E1000_TOTH);
4046 adapter->stats.tpr += rd32(E1000_TPR);
4047
4048 adapter->stats.ptc64 += rd32(E1000_PTC64);
4049 adapter->stats.ptc127 += rd32(E1000_PTC127);
4050 adapter->stats.ptc255 += rd32(E1000_PTC255);
4051 adapter->stats.ptc511 += rd32(E1000_PTC511);
4052 adapter->stats.ptc1023 += rd32(E1000_PTC1023);
4053 adapter->stats.ptc1522 += rd32(E1000_PTC1522);
4054
4055 adapter->stats.mptc += rd32(E1000_MPTC);
4056 adapter->stats.bptc += rd32(E1000_BPTC);
4057
Nick Nunley2d0b0f62010-02-17 01:02:59 +00004058 adapter->stats.tpt += rd32(E1000_TPT);
4059 adapter->stats.colc += rd32(E1000_COLC);
Auke Kok9d5c8242008-01-24 02:22:38 -08004060
4061 adapter->stats.algnerrc += rd32(E1000_ALGNERRC);
Nick Nunley43915c7c2010-02-17 01:03:58 +00004062 /* read internal phy specific stats */
4063 reg = rd32(E1000_CTRL_EXT);
4064 if (!(reg & E1000_CTRL_EXT_LINK_MODE_MASK)) {
4065 adapter->stats.rxerrc += rd32(E1000_RXERRC);
4066 adapter->stats.tncrs += rd32(E1000_TNCRS);
4067 }
4068
Auke Kok9d5c8242008-01-24 02:22:38 -08004069 adapter->stats.tsctc += rd32(E1000_TSCTC);
4070 adapter->stats.tsctfc += rd32(E1000_TSCTFC);
4071
4072 adapter->stats.iac += rd32(E1000_IAC);
4073 adapter->stats.icrxoc += rd32(E1000_ICRXOC);
4074 adapter->stats.icrxptc += rd32(E1000_ICRXPTC);
4075 adapter->stats.icrxatc += rd32(E1000_ICRXATC);
4076 adapter->stats.ictxptc += rd32(E1000_ICTXPTC);
4077 adapter->stats.ictxatc += rd32(E1000_ICTXATC);
4078 adapter->stats.ictxqec += rd32(E1000_ICTXQEC);
4079 adapter->stats.ictxqmtc += rd32(E1000_ICTXQMTC);
4080 adapter->stats.icrxdmtc += rd32(E1000_ICRXDMTC);
4081
4082 /* Fill out the OS statistics structure */
Alexander Duyck128e45e2009-11-12 18:37:38 +00004083 net_stats->multicast = adapter->stats.mprc;
4084 net_stats->collisions = adapter->stats.colc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004085
4086 /* Rx Errors */
4087
4088 /* RLEC on some newer hardware can be incorrect so build
Jesper Dangaard Brouer8c0ab702009-05-26 13:50:31 +00004089 * our own version based on RUC and ROC */
Alexander Duyck128e45e2009-11-12 18:37:38 +00004090 net_stats->rx_errors = adapter->stats.rxerrc +
Auke Kok9d5c8242008-01-24 02:22:38 -08004091 adapter->stats.crcerrs + adapter->stats.algnerrc +
4092 adapter->stats.ruc + adapter->stats.roc +
4093 adapter->stats.cexterr;
Alexander Duyck128e45e2009-11-12 18:37:38 +00004094 net_stats->rx_length_errors = adapter->stats.ruc +
4095 adapter->stats.roc;
4096 net_stats->rx_crc_errors = adapter->stats.crcerrs;
4097 net_stats->rx_frame_errors = adapter->stats.algnerrc;
4098 net_stats->rx_missed_errors = adapter->stats.mpc;
Auke Kok9d5c8242008-01-24 02:22:38 -08004099
4100 /* Tx Errors */
Alexander Duyck128e45e2009-11-12 18:37:38 +00004101 net_stats->tx_errors = adapter->stats.ecol +
4102 adapter->stats.latecol;
4103 net_stats->tx_aborted_errors = adapter->stats.ecol;
4104 net_stats->tx_window_errors = adapter->stats.latecol;
4105 net_stats->tx_carrier_errors = adapter->stats.tncrs;
Auke Kok9d5c8242008-01-24 02:22:38 -08004106
4107 /* Tx Dropped needs to be maintained elsewhere */
4108
4109 /* Phy Stats */
4110 if (hw->phy.media_type == e1000_media_type_copper) {
4111 if ((adapter->link_speed == SPEED_1000) &&
Alexander Duyck73cd78f2009-02-12 18:16:59 +00004112 (!igb_read_phy_reg(hw, PHY_1000T_STATUS, &phy_tmp))) {
Auke Kok9d5c8242008-01-24 02:22:38 -08004113 phy_tmp &= PHY_IDLE_ERROR_COUNT_MASK;
4114 adapter->phy_stats.idle_errors += phy_tmp;
4115 }
4116 }
4117
4118 /* Management Stats */
4119 adapter->stats.mgptc += rd32(E1000_MGTPTC);
4120 adapter->stats.mgprc += rd32(E1000_MGTPRC);
4121 adapter->stats.mgpdc += rd32(E1000_MGTPDC);
4122}
4123
Auke Kok9d5c8242008-01-24 02:22:38 -08004124static irqreturn_t igb_msix_other(int irq, void *data)
4125{
Alexander Duyck047e0032009-10-27 15:49:27 +00004126 struct igb_adapter *adapter = data;
Auke Kok9d5c8242008-01-24 02:22:38 -08004127 struct e1000_hw *hw = &adapter->hw;
PJ Waskiewicz844290e2008-06-27 11:00:39 -07004128 u32 icr = rd32(E1000_ICR);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07004129 /* reading ICR causes bit 31 of EICR to be cleared */
Alexander Duyckdda0e082009-02-06 23:19:08 +00004130
Alexander Duyck7f081d42010-01-07 17:41:00 +00004131 if (icr & E1000_ICR_DRSTA)
4132 schedule_work(&adapter->reset_task);
4133
Alexander Duyck047e0032009-10-27 15:49:27 +00004134 if (icr & E1000_ICR_DOUTSYNC) {
Alexander Duyckdda0e082009-02-06 23:19:08 +00004135 /* HW is reporting DMA is out of sync */
4136 adapter->stats.doosync++;
4137 }
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00004138
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004139 /* Check for a mailbox event */
4140 if (icr & E1000_ICR_VMMB)
4141 igb_msg_task(adapter);
4142
4143 if (icr & E1000_ICR_LSC) {
4144 hw->mac.get_link_status = 1;
4145 /* guard against interrupt when we're going down */
4146 if (!test_bit(__IGB_DOWN, &adapter->state))
4147 mod_timer(&adapter->watchdog_timer, jiffies + 1);
4148 }
4149
Alexander Duyck25568a52009-10-27 23:49:59 +00004150 if (adapter->vfs_allocated_count)
4151 wr32(E1000_IMS, E1000_IMS_LSC |
4152 E1000_IMS_VMMB |
4153 E1000_IMS_DOUTSYNC);
4154 else
4155 wr32(E1000_IMS, E1000_IMS_LSC | E1000_IMS_DOUTSYNC);
PJ Waskiewicz844290e2008-06-27 11:00:39 -07004156 wr32(E1000_EIMS, adapter->eims_other);
Auke Kok9d5c8242008-01-24 02:22:38 -08004157
4158 return IRQ_HANDLED;
4159}
4160
Alexander Duyck047e0032009-10-27 15:49:27 +00004161static void igb_write_itr(struct igb_q_vector *q_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -08004162{
Alexander Duyck26b39272010-02-17 01:00:41 +00004163 struct igb_adapter *adapter = q_vector->adapter;
Alexander Duyck047e0032009-10-27 15:49:27 +00004164 u32 itr_val = q_vector->itr_val & 0x7FFC;
Auke Kok9d5c8242008-01-24 02:22:38 -08004165
Alexander Duyck047e0032009-10-27 15:49:27 +00004166 if (!q_vector->set_itr)
4167 return;
Alexander Duyck73cd78f2009-02-12 18:16:59 +00004168
Alexander Duyck047e0032009-10-27 15:49:27 +00004169 if (!itr_val)
4170 itr_val = 0x4;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004171
Alexander Duyck26b39272010-02-17 01:00:41 +00004172 if (adapter->hw.mac.type == e1000_82575)
4173 itr_val |= itr_val << 16;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004174 else
Alexander Duyck047e0032009-10-27 15:49:27 +00004175 itr_val |= 0x8000000;
4176
4177 writel(itr_val, q_vector->itr_register);
4178 q_vector->set_itr = 0;
4179}
4180
4181static irqreturn_t igb_msix_ring(int irq, void *data)
4182{
4183 struct igb_q_vector *q_vector = data;
4184
4185 /* Write the ITR value calculated from the previous interrupt. */
4186 igb_write_itr(q_vector);
4187
4188 napi_schedule(&q_vector->napi);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004189
Auke Kok9d5c8242008-01-24 02:22:38 -08004190 return IRQ_HANDLED;
4191}
4192
Jeff Kirsher421e02f2008-10-17 11:08:31 -07004193#ifdef CONFIG_IGB_DCA
Alexander Duyck047e0032009-10-27 15:49:27 +00004194static void igb_update_dca(struct igb_q_vector *q_vector)
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004195{
Alexander Duyck047e0032009-10-27 15:49:27 +00004196 struct igb_adapter *adapter = q_vector->adapter;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004197 struct e1000_hw *hw = &adapter->hw;
4198 int cpu = get_cpu();
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004199
Alexander Duyck047e0032009-10-27 15:49:27 +00004200 if (q_vector->cpu == cpu)
4201 goto out_no_update;
4202
4203 if (q_vector->tx_ring) {
4204 int q = q_vector->tx_ring->reg_idx;
4205 u32 dca_txctrl = rd32(E1000_DCA_TXCTRL(q));
4206 if (hw->mac.type == e1000_82575) {
4207 dca_txctrl &= ~E1000_DCA_TXCTRL_CPUID_MASK;
4208 dca_txctrl |= dca3_get_tag(&adapter->pdev->dev, cpu);
4209 } else {
4210 dca_txctrl &= ~E1000_DCA_TXCTRL_CPUID_MASK_82576;
4211 dca_txctrl |= dca3_get_tag(&adapter->pdev->dev, cpu) <<
4212 E1000_DCA_TXCTRL_CPUID_SHIFT;
4213 }
4214 dca_txctrl |= E1000_DCA_TXCTRL_DESC_DCA_EN;
4215 wr32(E1000_DCA_TXCTRL(q), dca_txctrl);
4216 }
4217 if (q_vector->rx_ring) {
4218 int q = q_vector->rx_ring->reg_idx;
4219 u32 dca_rxctrl = rd32(E1000_DCA_RXCTRL(q));
4220 if (hw->mac.type == e1000_82575) {
4221 dca_rxctrl &= ~E1000_DCA_RXCTRL_CPUID_MASK;
4222 dca_rxctrl |= dca3_get_tag(&adapter->pdev->dev, cpu);
4223 } else {
Alexander Duyck2d064c02008-07-08 15:10:12 -07004224 dca_rxctrl &= ~E1000_DCA_RXCTRL_CPUID_MASK_82576;
Maciej Sosnowski92be7912009-03-13 20:40:21 +00004225 dca_rxctrl |= dca3_get_tag(&adapter->pdev->dev, cpu) <<
Alexander Duyck2d064c02008-07-08 15:10:12 -07004226 E1000_DCA_RXCTRL_CPUID_SHIFT;
Alexander Duyck2d064c02008-07-08 15:10:12 -07004227 }
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004228 dca_rxctrl |= E1000_DCA_RXCTRL_DESC_DCA_EN;
4229 dca_rxctrl |= E1000_DCA_RXCTRL_HEAD_DCA_EN;
4230 dca_rxctrl |= E1000_DCA_RXCTRL_DATA_DCA_EN;
4231 wr32(E1000_DCA_RXCTRL(q), dca_rxctrl);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004232 }
Alexander Duyck047e0032009-10-27 15:49:27 +00004233 q_vector->cpu = cpu;
4234out_no_update:
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004235 put_cpu();
4236}
4237
4238static void igb_setup_dca(struct igb_adapter *adapter)
4239{
Alexander Duyck7e0e99e2009-05-21 13:06:56 +00004240 struct e1000_hw *hw = &adapter->hw;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004241 int i;
4242
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004243 if (!(adapter->flags & IGB_FLAG_DCA_ENABLED))
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004244 return;
4245
Alexander Duyck7e0e99e2009-05-21 13:06:56 +00004246 /* Always use CB2 mode, difference is masked in the CB driver. */
4247 wr32(E1000_DCA_CTRL, E1000_DCA_CTRL_DCA_MODE_CB2);
4248
Alexander Duyck047e0032009-10-27 15:49:27 +00004249 for (i = 0; i < adapter->num_q_vectors; i++) {
Alexander Duyck26b39272010-02-17 01:00:41 +00004250 adapter->q_vector[i]->cpu = -1;
4251 igb_update_dca(adapter->q_vector[i]);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004252 }
4253}
4254
4255static int __igb_notify_dca(struct device *dev, void *data)
4256{
4257 struct net_device *netdev = dev_get_drvdata(dev);
4258 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyck090b1792009-10-27 23:51:55 +00004259 struct pci_dev *pdev = adapter->pdev;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004260 struct e1000_hw *hw = &adapter->hw;
4261 unsigned long event = *(unsigned long *)data;
4262
4263 switch (event) {
4264 case DCA_PROVIDER_ADD:
4265 /* if already enabled, don't do it again */
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004266 if (adapter->flags & IGB_FLAG_DCA_ENABLED)
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004267 break;
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004268 if (dca_add_requester(dev) == 0) {
Alexander Duyckbbd98fe2009-01-31 00:52:30 -08004269 adapter->flags |= IGB_FLAG_DCA_ENABLED;
Alexander Duyck090b1792009-10-27 23:51:55 +00004270 dev_info(&pdev->dev, "DCA enabled\n");
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004271 igb_setup_dca(adapter);
4272 break;
4273 }
4274 /* Fall Through since DCA is disabled. */
4275 case DCA_PROVIDER_REMOVE:
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004276 if (adapter->flags & IGB_FLAG_DCA_ENABLED) {
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004277 /* without this a class_device is left
Alexander Duyck047e0032009-10-27 15:49:27 +00004278 * hanging around in the sysfs model */
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004279 dca_remove_requester(dev);
Alexander Duyck090b1792009-10-27 23:51:55 +00004280 dev_info(&pdev->dev, "DCA disabled\n");
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07004281 adapter->flags &= ~IGB_FLAG_DCA_ENABLED;
Alexander Duyckcbd347a2009-02-15 23:59:44 -08004282 wr32(E1000_DCA_CTRL, E1000_DCA_CTRL_DCA_MODE_DISABLE);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004283 }
4284 break;
4285 }
Alexander Duyckbbd98fe2009-01-31 00:52:30 -08004286
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004287 return 0;
4288}
4289
4290static int igb_notify_dca(struct notifier_block *nb, unsigned long event,
4291 void *p)
4292{
4293 int ret_val;
4294
4295 ret_val = driver_for_each_device(&igb_driver.driver, NULL, &event,
4296 __igb_notify_dca);
4297
4298 return ret_val ? NOTIFY_BAD : NOTIFY_DONE;
4299}
Jeff Kirsher421e02f2008-10-17 11:08:31 -07004300#endif /* CONFIG_IGB_DCA */
Auke Kok9d5c8242008-01-24 02:22:38 -08004301
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004302static void igb_ping_all_vfs(struct igb_adapter *adapter)
4303{
4304 struct e1000_hw *hw = &adapter->hw;
4305 u32 ping;
4306 int i;
4307
4308 for (i = 0 ; i < adapter->vfs_allocated_count; i++) {
4309 ping = E1000_PF_CONTROL_MSG;
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004310 if (adapter->vf_data[i].flags & IGB_VF_FLAG_CTS)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004311 ping |= E1000_VT_MSGTYPE_CTS;
4312 igb_write_mbx(hw, &ping, 1, i);
4313 }
4314}
4315
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004316static int igb_set_vf_promisc(struct igb_adapter *adapter, u32 *msgbuf, u32 vf)
4317{
4318 struct e1000_hw *hw = &adapter->hw;
4319 u32 vmolr = rd32(E1000_VMOLR(vf));
4320 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
4321
4322 vf_data->flags |= ~(IGB_VF_FLAG_UNI_PROMISC |
4323 IGB_VF_FLAG_MULTI_PROMISC);
4324 vmolr &= ~(E1000_VMOLR_ROPE | E1000_VMOLR_ROMPE | E1000_VMOLR_MPME);
4325
4326 if (*msgbuf & E1000_VF_SET_PROMISC_MULTICAST) {
4327 vmolr |= E1000_VMOLR_MPME;
4328 *msgbuf &= ~E1000_VF_SET_PROMISC_MULTICAST;
4329 } else {
4330 /*
4331 * if we have hashes and we are clearing a multicast promisc
4332 * flag we need to write the hashes to the MTA as this step
4333 * was previously skipped
4334 */
4335 if (vf_data->num_vf_mc_hashes > 30) {
4336 vmolr |= E1000_VMOLR_MPME;
4337 } else if (vf_data->num_vf_mc_hashes) {
4338 int j;
4339 vmolr |= E1000_VMOLR_ROMPE;
4340 for (j = 0; j < vf_data->num_vf_mc_hashes; j++)
4341 igb_mta_set(hw, vf_data->vf_mc_hashes[j]);
4342 }
4343 }
4344
4345 wr32(E1000_VMOLR(vf), vmolr);
4346
4347 /* there are flags left unprocessed, likely not supported */
4348 if (*msgbuf & E1000_VT_MSGINFO_MASK)
4349 return -EINVAL;
4350
4351 return 0;
4352
4353}
4354
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004355static int igb_set_vf_multicasts(struct igb_adapter *adapter,
4356 u32 *msgbuf, u32 vf)
4357{
4358 int n = (msgbuf[0] & E1000_VT_MSGINFO_MASK) >> E1000_VT_MSGINFO_SHIFT;
4359 u16 *hash_list = (u16 *)&msgbuf[1];
4360 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
4361 int i;
4362
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004363 /* salt away the number of multicast addresses assigned
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004364 * to this VF for later use to restore when the PF multi cast
4365 * list changes
4366 */
4367 vf_data->num_vf_mc_hashes = n;
4368
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004369 /* only up to 30 hash values supported */
4370 if (n > 30)
4371 n = 30;
4372
4373 /* store the hashes for later use */
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004374 for (i = 0; i < n; i++)
Joe Perchesa419aef2009-08-18 11:18:35 -07004375 vf_data->vf_mc_hashes[i] = hash_list[i];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004376
4377 /* Flush and reset the mta with the new values */
Alexander Duyckff41f8d2009-09-03 14:48:56 +00004378 igb_set_rx_mode(adapter->netdev);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004379
4380 return 0;
4381}
4382
4383static void igb_restore_vf_multicasts(struct igb_adapter *adapter)
4384{
4385 struct e1000_hw *hw = &adapter->hw;
4386 struct vf_data_storage *vf_data;
4387 int i, j;
4388
4389 for (i = 0; i < adapter->vfs_allocated_count; i++) {
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004390 u32 vmolr = rd32(E1000_VMOLR(i));
4391 vmolr &= ~(E1000_VMOLR_ROMPE | E1000_VMOLR_MPME);
4392
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004393 vf_data = &adapter->vf_data[i];
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004394
4395 if ((vf_data->num_vf_mc_hashes > 30) ||
4396 (vf_data->flags & IGB_VF_FLAG_MULTI_PROMISC)) {
4397 vmolr |= E1000_VMOLR_MPME;
4398 } else if (vf_data->num_vf_mc_hashes) {
4399 vmolr |= E1000_VMOLR_ROMPE;
4400 for (j = 0; j < vf_data->num_vf_mc_hashes; j++)
4401 igb_mta_set(hw, vf_data->vf_mc_hashes[j]);
4402 }
4403 wr32(E1000_VMOLR(i), vmolr);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004404 }
4405}
4406
4407static void igb_clear_vf_vfta(struct igb_adapter *adapter, u32 vf)
4408{
4409 struct e1000_hw *hw = &adapter->hw;
4410 u32 pool_mask, reg, vid;
4411 int i;
4412
4413 pool_mask = 1 << (E1000_VLVF_POOLSEL_SHIFT + vf);
4414
4415 /* Find the vlan filter for this id */
4416 for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
4417 reg = rd32(E1000_VLVF(i));
4418
4419 /* remove the vf from the pool */
4420 reg &= ~pool_mask;
4421
4422 /* if pool is empty then remove entry from vfta */
4423 if (!(reg & E1000_VLVF_POOLSEL_MASK) &&
4424 (reg & E1000_VLVF_VLANID_ENABLE)) {
4425 reg = 0;
4426 vid = reg & E1000_VLVF_VLANID_MASK;
4427 igb_vfta_set(hw, vid, false);
4428 }
4429
4430 wr32(E1000_VLVF(i), reg);
4431 }
Alexander Duyckae641bd2009-09-03 14:49:33 +00004432
4433 adapter->vf_data[vf].vlans_enabled = 0;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004434}
4435
4436static s32 igb_vlvf_set(struct igb_adapter *adapter, u32 vid, bool add, u32 vf)
4437{
4438 struct e1000_hw *hw = &adapter->hw;
4439 u32 reg, i;
4440
Alexander Duyck51466232009-10-27 23:47:35 +00004441 /* The vlvf table only exists on 82576 hardware and newer */
4442 if (hw->mac.type < e1000_82576)
4443 return -1;
4444
4445 /* we only need to do this if VMDq is enabled */
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004446 if (!adapter->vfs_allocated_count)
4447 return -1;
4448
4449 /* Find the vlan filter for this id */
4450 for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
4451 reg = rd32(E1000_VLVF(i));
4452 if ((reg & E1000_VLVF_VLANID_ENABLE) &&
4453 vid == (reg & E1000_VLVF_VLANID_MASK))
4454 break;
4455 }
4456
4457 if (add) {
4458 if (i == E1000_VLVF_ARRAY_SIZE) {
4459 /* Did not find a matching VLAN ID entry that was
4460 * enabled. Search for a free filter entry, i.e.
4461 * one without the enable bit set
4462 */
4463 for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
4464 reg = rd32(E1000_VLVF(i));
4465 if (!(reg & E1000_VLVF_VLANID_ENABLE))
4466 break;
4467 }
4468 }
4469 if (i < E1000_VLVF_ARRAY_SIZE) {
4470 /* Found an enabled/available entry */
4471 reg |= 1 << (E1000_VLVF_POOLSEL_SHIFT + vf);
4472
4473 /* if !enabled we need to set this up in vfta */
4474 if (!(reg & E1000_VLVF_VLANID_ENABLE)) {
Alexander Duyck51466232009-10-27 23:47:35 +00004475 /* add VID to filter table */
4476 igb_vfta_set(hw, vid, true);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004477 reg |= E1000_VLVF_VLANID_ENABLE;
4478 }
Alexander Duyckcad6d052009-03-13 20:41:37 +00004479 reg &= ~E1000_VLVF_VLANID_MASK;
4480 reg |= vid;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004481 wr32(E1000_VLVF(i), reg);
Alexander Duyckae641bd2009-09-03 14:49:33 +00004482
4483 /* do not modify RLPML for PF devices */
4484 if (vf >= adapter->vfs_allocated_count)
4485 return 0;
4486
4487 if (!adapter->vf_data[vf].vlans_enabled) {
4488 u32 size;
4489 reg = rd32(E1000_VMOLR(vf));
4490 size = reg & E1000_VMOLR_RLPML_MASK;
4491 size += 4;
4492 reg &= ~E1000_VMOLR_RLPML_MASK;
4493 reg |= size;
4494 wr32(E1000_VMOLR(vf), reg);
4495 }
Alexander Duyckae641bd2009-09-03 14:49:33 +00004496
Alexander Duyck51466232009-10-27 23:47:35 +00004497 adapter->vf_data[vf].vlans_enabled++;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004498 return 0;
4499 }
4500 } else {
4501 if (i < E1000_VLVF_ARRAY_SIZE) {
4502 /* remove vf from the pool */
4503 reg &= ~(1 << (E1000_VLVF_POOLSEL_SHIFT + vf));
4504 /* if pool is empty then remove entry from vfta */
4505 if (!(reg & E1000_VLVF_POOLSEL_MASK)) {
4506 reg = 0;
4507 igb_vfta_set(hw, vid, false);
4508 }
4509 wr32(E1000_VLVF(i), reg);
Alexander Duyckae641bd2009-09-03 14:49:33 +00004510
4511 /* do not modify RLPML for PF devices */
4512 if (vf >= adapter->vfs_allocated_count)
4513 return 0;
4514
4515 adapter->vf_data[vf].vlans_enabled--;
4516 if (!adapter->vf_data[vf].vlans_enabled) {
4517 u32 size;
4518 reg = rd32(E1000_VMOLR(vf));
4519 size = reg & E1000_VMOLR_RLPML_MASK;
4520 size -= 4;
4521 reg &= ~E1000_VMOLR_RLPML_MASK;
4522 reg |= size;
4523 wr32(E1000_VMOLR(vf), reg);
4524 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004525 }
4526 }
Williams, Mitch A8151d292010-02-10 01:44:24 +00004527 return 0;
4528}
4529
4530static void igb_set_vmvir(struct igb_adapter *adapter, u32 vid, u32 vf)
4531{
4532 struct e1000_hw *hw = &adapter->hw;
4533
4534 if (vid)
4535 wr32(E1000_VMVIR(vf), (vid | E1000_VMVIR_VLANA_DEFAULT));
4536 else
4537 wr32(E1000_VMVIR(vf), 0);
4538}
4539
4540static int igb_ndo_set_vf_vlan(struct net_device *netdev,
4541 int vf, u16 vlan, u8 qos)
4542{
4543 int err = 0;
4544 struct igb_adapter *adapter = netdev_priv(netdev);
4545
4546 if ((vf >= adapter->vfs_allocated_count) || (vlan > 4095) || (qos > 7))
4547 return -EINVAL;
4548 if (vlan || qos) {
4549 err = igb_vlvf_set(adapter, vlan, !!vlan, vf);
4550 if (err)
4551 goto out;
4552 igb_set_vmvir(adapter, vlan | (qos << VLAN_PRIO_SHIFT), vf);
4553 igb_set_vmolr(adapter, vf, !vlan);
4554 adapter->vf_data[vf].pf_vlan = vlan;
4555 adapter->vf_data[vf].pf_qos = qos;
4556 dev_info(&adapter->pdev->dev,
4557 "Setting VLAN %d, QOS 0x%x on VF %d\n", vlan, qos, vf);
4558 if (test_bit(__IGB_DOWN, &adapter->state)) {
4559 dev_warn(&adapter->pdev->dev,
4560 "The VF VLAN has been set,"
4561 " but the PF device is not up.\n");
4562 dev_warn(&adapter->pdev->dev,
4563 "Bring the PF device up before"
4564 " attempting to use the VF device.\n");
4565 }
4566 } else {
4567 igb_vlvf_set(adapter, adapter->vf_data[vf].pf_vlan,
4568 false, vf);
4569 igb_set_vmvir(adapter, vlan, vf);
4570 igb_set_vmolr(adapter, vf, true);
4571 adapter->vf_data[vf].pf_vlan = 0;
4572 adapter->vf_data[vf].pf_qos = 0;
4573 }
4574out:
4575 return err;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004576}
4577
4578static int igb_set_vf_vlan(struct igb_adapter *adapter, u32 *msgbuf, u32 vf)
4579{
4580 int add = (msgbuf[0] & E1000_VT_MSGINFO_MASK) >> E1000_VT_MSGINFO_SHIFT;
4581 int vid = (msgbuf[1] & E1000_VLVF_VLANID_MASK);
4582
4583 return igb_vlvf_set(adapter, vid, add, vf);
4584}
4585
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004586static inline void igb_vf_reset(struct igb_adapter *adapter, u32 vf)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004587{
Williams, Mitch A8151d292010-02-10 01:44:24 +00004588 /* clear flags */
4589 adapter->vf_data[vf].flags &= ~(IGB_VF_FLAG_PF_SET_MAC);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004590 adapter->vf_data[vf].last_nack = jiffies;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004591
4592 /* reset offloads to defaults */
Williams, Mitch A8151d292010-02-10 01:44:24 +00004593 igb_set_vmolr(adapter, vf, true);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004594
4595 /* reset vlans for device */
4596 igb_clear_vf_vfta(adapter, vf);
Williams, Mitch A8151d292010-02-10 01:44:24 +00004597 if (adapter->vf_data[vf].pf_vlan)
4598 igb_ndo_set_vf_vlan(adapter->netdev, vf,
4599 adapter->vf_data[vf].pf_vlan,
4600 adapter->vf_data[vf].pf_qos);
4601 else
4602 igb_clear_vf_vfta(adapter, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004603
4604 /* reset multicast table array for vf */
4605 adapter->vf_data[vf].num_vf_mc_hashes = 0;
4606
4607 /* Flush and reset the mta with the new values */
Alexander Duyckff41f8d2009-09-03 14:48:56 +00004608 igb_set_rx_mode(adapter->netdev);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004609}
4610
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004611static void igb_vf_reset_event(struct igb_adapter *adapter, u32 vf)
4612{
4613 unsigned char *vf_mac = adapter->vf_data[vf].vf_mac_addresses;
4614
4615 /* generate a new mac address as we were hotplug removed/added */
Williams, Mitch A8151d292010-02-10 01:44:24 +00004616 if (!(adapter->vf_data[vf].flags & IGB_VF_FLAG_PF_SET_MAC))
4617 random_ether_addr(vf_mac);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004618
4619 /* process remaining reset events */
4620 igb_vf_reset(adapter, vf);
4621}
4622
4623static void igb_vf_reset_msg(struct igb_adapter *adapter, u32 vf)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004624{
4625 struct e1000_hw *hw = &adapter->hw;
4626 unsigned char *vf_mac = adapter->vf_data[vf].vf_mac_addresses;
Alexander Duyckff41f8d2009-09-03 14:48:56 +00004627 int rar_entry = hw->mac.rar_entry_count - (vf + 1);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004628 u32 reg, msgbuf[3];
4629 u8 *addr = (u8 *)(&msgbuf[1]);
4630
4631 /* process all the same items cleared in a function level reset */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004632 igb_vf_reset(adapter, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004633
4634 /* set vf mac address */
Alexander Duyck26ad9172009-10-05 06:32:49 +00004635 igb_rar_set_qsel(adapter, vf_mac, rar_entry, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004636
4637 /* enable transmit and receive for vf */
4638 reg = rd32(E1000_VFTE);
4639 wr32(E1000_VFTE, reg | (1 << vf));
4640 reg = rd32(E1000_VFRE);
4641 wr32(E1000_VFRE, reg | (1 << vf));
4642
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004643 adapter->vf_data[vf].flags = IGB_VF_FLAG_CTS;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004644
4645 /* reply to reset with ack and vf mac address */
4646 msgbuf[0] = E1000_VF_RESET | E1000_VT_MSGTYPE_ACK;
4647 memcpy(addr, vf_mac, 6);
4648 igb_write_mbx(hw, msgbuf, 3, vf);
4649}
4650
4651static int igb_set_vf_mac_addr(struct igb_adapter *adapter, u32 *msg, int vf)
4652{
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004653 unsigned char *addr = (char *)&msg[1];
4654 int err = -1;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004655
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004656 if (is_valid_ether_addr(addr))
4657 err = igb_set_vf_mac(adapter, vf, addr);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004658
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004659 return err;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004660}
4661
4662static void igb_rcv_ack_from_vf(struct igb_adapter *adapter, u32 vf)
4663{
4664 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004665 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004666 u32 msg = E1000_VT_MSGTYPE_NACK;
4667
4668 /* if device isn't clear to send it shouldn't be reading either */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004669 if (!(vf_data->flags & IGB_VF_FLAG_CTS) &&
4670 time_after(jiffies, vf_data->last_nack + (2 * HZ))) {
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004671 igb_write_mbx(hw, &msg, 1, vf);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004672 vf_data->last_nack = jiffies;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004673 }
4674}
4675
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004676static void igb_rcv_msg_from_vf(struct igb_adapter *adapter, u32 vf)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004677{
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004678 struct pci_dev *pdev = adapter->pdev;
4679 u32 msgbuf[E1000_VFMAILBOX_SIZE];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004680 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004681 struct vf_data_storage *vf_data = &adapter->vf_data[vf];
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004682 s32 retval;
4683
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004684 retval = igb_read_mbx(hw, msgbuf, E1000_VFMAILBOX_SIZE, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004685
Alexander Duyckfef45f42009-12-11 22:57:34 -08004686 if (retval) {
4687 /* if receive failed revoke VF CTS stats and restart init */
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004688 dev_err(&pdev->dev, "Error receiving message from VF\n");
Alexander Duyckfef45f42009-12-11 22:57:34 -08004689 vf_data->flags &= ~IGB_VF_FLAG_CTS;
4690 if (!time_after(jiffies, vf_data->last_nack + (2 * HZ)))
4691 return;
4692 goto out;
4693 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004694
4695 /* this is a message we already processed, do nothing */
4696 if (msgbuf[0] & (E1000_VT_MSGTYPE_ACK | E1000_VT_MSGTYPE_NACK))
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004697 return;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004698
4699 /*
4700 * until the vf completes a reset it should not be
4701 * allowed to start any configuration.
4702 */
4703
4704 if (msgbuf[0] == E1000_VF_RESET) {
4705 igb_vf_reset_msg(adapter, vf);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004706 return;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004707 }
4708
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004709 if (!(vf_data->flags & IGB_VF_FLAG_CTS)) {
Alexander Duyckfef45f42009-12-11 22:57:34 -08004710 if (!time_after(jiffies, vf_data->last_nack + (2 * HZ)))
4711 return;
4712 retval = -1;
4713 goto out;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004714 }
4715
4716 switch ((msgbuf[0] & 0xFFFF)) {
4717 case E1000_VF_SET_MAC_ADDR:
4718 retval = igb_set_vf_mac_addr(adapter, msgbuf, vf);
4719 break;
Alexander Duyck7d5753f2009-10-27 23:47:16 +00004720 case E1000_VF_SET_PROMISC:
4721 retval = igb_set_vf_promisc(adapter, msgbuf, vf);
4722 break;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004723 case E1000_VF_SET_MULTICAST:
4724 retval = igb_set_vf_multicasts(adapter, msgbuf, vf);
4725 break;
4726 case E1000_VF_SET_LPE:
4727 retval = igb_set_vf_rlpml(adapter, msgbuf[1], vf);
4728 break;
4729 case E1000_VF_SET_VLAN:
Williams, Mitch A8151d292010-02-10 01:44:24 +00004730 if (adapter->vf_data[vf].pf_vlan)
4731 retval = -1;
4732 else
4733 retval = igb_set_vf_vlan(adapter, msgbuf, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004734 break;
4735 default:
Alexander Duyck090b1792009-10-27 23:51:55 +00004736 dev_err(&pdev->dev, "Unhandled Msg %08x\n", msgbuf[0]);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004737 retval = -1;
4738 break;
4739 }
4740
Alexander Duyckfef45f42009-12-11 22:57:34 -08004741 msgbuf[0] |= E1000_VT_MSGTYPE_CTS;
4742out:
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004743 /* notify the VF of the results of what it sent us */
4744 if (retval)
4745 msgbuf[0] |= E1000_VT_MSGTYPE_NACK;
4746 else
4747 msgbuf[0] |= E1000_VT_MSGTYPE_ACK;
4748
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004749 igb_write_mbx(hw, msgbuf, 1, vf);
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004750}
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004751
Alexander Duyckf2ca0db2009-10-27 23:46:57 +00004752static void igb_msg_task(struct igb_adapter *adapter)
4753{
4754 struct e1000_hw *hw = &adapter->hw;
4755 u32 vf;
4756
4757 for (vf = 0; vf < adapter->vfs_allocated_count; vf++) {
4758 /* process any reset requests */
4759 if (!igb_check_for_rst(hw, vf))
4760 igb_vf_reset_event(adapter, vf);
4761
4762 /* process any messages pending */
4763 if (!igb_check_for_msg(hw, vf))
4764 igb_rcv_msg_from_vf(adapter, vf);
4765
4766 /* process any acks */
4767 if (!igb_check_for_ack(hw, vf))
4768 igb_rcv_ack_from_vf(adapter, vf);
4769 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08004770}
4771
Auke Kok9d5c8242008-01-24 02:22:38 -08004772/**
Alexander Duyck68d480c2009-10-05 06:33:08 +00004773 * igb_set_uta - Set unicast filter table address
4774 * @adapter: board private structure
4775 *
4776 * The unicast table address is a register array of 32-bit registers.
4777 * The table is meant to be used in a way similar to how the MTA is used
4778 * however due to certain limitations in the hardware it is necessary to
4779 * set all the hash bits to 1 and use the VMOLR ROPE bit as a promiscous
4780 * enable bit to allow vlan tag stripping when promiscous mode is enabled
4781 **/
4782static void igb_set_uta(struct igb_adapter *adapter)
4783{
4784 struct e1000_hw *hw = &adapter->hw;
4785 int i;
4786
4787 /* The UTA table only exists on 82576 hardware and newer */
4788 if (hw->mac.type < e1000_82576)
4789 return;
4790
4791 /* we only need to do this if VMDq is enabled */
4792 if (!adapter->vfs_allocated_count)
4793 return;
4794
4795 for (i = 0; i < hw->mac.uta_reg_count; i++)
4796 array_wr32(E1000_UTA, i, ~0);
4797}
4798
4799/**
Auke Kok9d5c8242008-01-24 02:22:38 -08004800 * igb_intr_msi - Interrupt Handler
4801 * @irq: interrupt number
4802 * @data: pointer to a network interface device structure
4803 **/
4804static irqreturn_t igb_intr_msi(int irq, void *data)
4805{
Alexander Duyck047e0032009-10-27 15:49:27 +00004806 struct igb_adapter *adapter = data;
4807 struct igb_q_vector *q_vector = adapter->q_vector[0];
Auke Kok9d5c8242008-01-24 02:22:38 -08004808 struct e1000_hw *hw = &adapter->hw;
4809 /* read ICR disables interrupts using IAM */
4810 u32 icr = rd32(E1000_ICR);
4811
Alexander Duyck047e0032009-10-27 15:49:27 +00004812 igb_write_itr(q_vector);
Auke Kok9d5c8242008-01-24 02:22:38 -08004813
Alexander Duyck7f081d42010-01-07 17:41:00 +00004814 if (icr & E1000_ICR_DRSTA)
4815 schedule_work(&adapter->reset_task);
4816
Alexander Duyck047e0032009-10-27 15:49:27 +00004817 if (icr & E1000_ICR_DOUTSYNC) {
Alexander Duyckdda0e082009-02-06 23:19:08 +00004818 /* HW is reporting DMA is out of sync */
4819 adapter->stats.doosync++;
4820 }
4821
Auke Kok9d5c8242008-01-24 02:22:38 -08004822 if (icr & (E1000_ICR_RXSEQ | E1000_ICR_LSC)) {
4823 hw->mac.get_link_status = 1;
4824 if (!test_bit(__IGB_DOWN, &adapter->state))
4825 mod_timer(&adapter->watchdog_timer, jiffies + 1);
4826 }
4827
Alexander Duyck047e0032009-10-27 15:49:27 +00004828 napi_schedule(&q_vector->napi);
Auke Kok9d5c8242008-01-24 02:22:38 -08004829
4830 return IRQ_HANDLED;
4831}
4832
4833/**
Alexander Duyck4a3c6432009-02-06 23:20:49 +00004834 * igb_intr - Legacy Interrupt Handler
Auke Kok9d5c8242008-01-24 02:22:38 -08004835 * @irq: interrupt number
4836 * @data: pointer to a network interface device structure
4837 **/
4838static irqreturn_t igb_intr(int irq, void *data)
4839{
Alexander Duyck047e0032009-10-27 15:49:27 +00004840 struct igb_adapter *adapter = data;
4841 struct igb_q_vector *q_vector = adapter->q_vector[0];
Auke Kok9d5c8242008-01-24 02:22:38 -08004842 struct e1000_hw *hw = &adapter->hw;
4843 /* Interrupt Auto-Mask...upon reading ICR, interrupts are masked. No
4844 * need for the IMC write */
4845 u32 icr = rd32(E1000_ICR);
Auke Kok9d5c8242008-01-24 02:22:38 -08004846 if (!icr)
4847 return IRQ_NONE; /* Not our interrupt */
4848
Alexander Duyck047e0032009-10-27 15:49:27 +00004849 igb_write_itr(q_vector);
Auke Kok9d5c8242008-01-24 02:22:38 -08004850
4851 /* IMS will not auto-mask if INT_ASSERTED is not set, and if it is
4852 * not set, then the adapter didn't send an interrupt */
4853 if (!(icr & E1000_ICR_INT_ASSERTED))
4854 return IRQ_NONE;
4855
Alexander Duyck7f081d42010-01-07 17:41:00 +00004856 if (icr & E1000_ICR_DRSTA)
4857 schedule_work(&adapter->reset_task);
4858
Alexander Duyck047e0032009-10-27 15:49:27 +00004859 if (icr & E1000_ICR_DOUTSYNC) {
Alexander Duyckdda0e082009-02-06 23:19:08 +00004860 /* HW is reporting DMA is out of sync */
4861 adapter->stats.doosync++;
4862 }
4863
Auke Kok9d5c8242008-01-24 02:22:38 -08004864 if (icr & (E1000_ICR_RXSEQ | E1000_ICR_LSC)) {
4865 hw->mac.get_link_status = 1;
4866 /* guard against interrupt when we're going down */
4867 if (!test_bit(__IGB_DOWN, &adapter->state))
4868 mod_timer(&adapter->watchdog_timer, jiffies + 1);
4869 }
4870
Alexander Duyck047e0032009-10-27 15:49:27 +00004871 napi_schedule(&q_vector->napi);
Auke Kok9d5c8242008-01-24 02:22:38 -08004872
4873 return IRQ_HANDLED;
4874}
4875
Alexander Duyck047e0032009-10-27 15:49:27 +00004876static inline void igb_ring_irq_enable(struct igb_q_vector *q_vector)
Alexander Duyck46544252009-02-19 20:39:04 -08004877{
Alexander Duyck047e0032009-10-27 15:49:27 +00004878 struct igb_adapter *adapter = q_vector->adapter;
Alexander Duyck46544252009-02-19 20:39:04 -08004879 struct e1000_hw *hw = &adapter->hw;
4880
Alexander Duyck4fc82ad2009-10-27 23:45:42 +00004881 if ((q_vector->rx_ring && (adapter->rx_itr_setting & 3)) ||
4882 (!q_vector->rx_ring && (adapter->tx_itr_setting & 3))) {
Alexander Duyck047e0032009-10-27 15:49:27 +00004883 if (!adapter->msix_entries)
Alexander Duyck46544252009-02-19 20:39:04 -08004884 igb_set_itr(adapter);
4885 else
Alexander Duyck047e0032009-10-27 15:49:27 +00004886 igb_update_ring_itr(q_vector);
Alexander Duyck46544252009-02-19 20:39:04 -08004887 }
4888
4889 if (!test_bit(__IGB_DOWN, &adapter->state)) {
4890 if (adapter->msix_entries)
Alexander Duyck047e0032009-10-27 15:49:27 +00004891 wr32(E1000_EIMS, q_vector->eims_value);
Alexander Duyck46544252009-02-19 20:39:04 -08004892 else
4893 igb_irq_enable(adapter);
4894 }
4895}
4896
Auke Kok9d5c8242008-01-24 02:22:38 -08004897/**
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004898 * igb_poll - NAPI Rx polling callback
4899 * @napi: napi polling structure
4900 * @budget: count of how many packets we should handle
Auke Kok9d5c8242008-01-24 02:22:38 -08004901 **/
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07004902static int igb_poll(struct napi_struct *napi, int budget)
Auke Kok9d5c8242008-01-24 02:22:38 -08004903{
Alexander Duyck047e0032009-10-27 15:49:27 +00004904 struct igb_q_vector *q_vector = container_of(napi,
4905 struct igb_q_vector,
4906 napi);
4907 int tx_clean_complete = 1, work_done = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08004908
Jeff Kirsher421e02f2008-10-17 11:08:31 -07004909#ifdef CONFIG_IGB_DCA
Alexander Duyck047e0032009-10-27 15:49:27 +00004910 if (q_vector->adapter->flags & IGB_FLAG_DCA_ENABLED)
4911 igb_update_dca(q_vector);
Jeb Cramerfe4506b2008-07-08 15:07:55 -07004912#endif
Alexander Duyck047e0032009-10-27 15:49:27 +00004913 if (q_vector->tx_ring)
4914 tx_clean_complete = igb_clean_tx_irq(q_vector);
Auke Kok9d5c8242008-01-24 02:22:38 -08004915
Alexander Duyck047e0032009-10-27 15:49:27 +00004916 if (q_vector->rx_ring)
4917 igb_clean_rx_irq_adv(q_vector, &work_done, budget);
4918
4919 if (!tx_clean_complete)
4920 work_done = budget;
Auke Kok9d5c8242008-01-24 02:22:38 -08004921
Alexander Duyck46544252009-02-19 20:39:04 -08004922 /* If not enough Rx work done, exit the polling mode */
Alexander Duyck5e6d5b12009-03-13 20:40:38 +00004923 if (work_done < budget) {
Alexander Duyck46544252009-02-19 20:39:04 -08004924 napi_complete(napi);
Alexander Duyck047e0032009-10-27 15:49:27 +00004925 igb_ring_irq_enable(q_vector);
Alexander Duyck46544252009-02-19 20:39:04 -08004926 }
4927
4928 return work_done;
Auke Kok9d5c8242008-01-24 02:22:38 -08004929}
Al Viro6d8126f2008-03-16 22:23:24 +00004930
Auke Kok9d5c8242008-01-24 02:22:38 -08004931/**
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004932 * igb_systim_to_hwtstamp - convert system time value to hw timestamp
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004933 * @adapter: board private structure
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004934 * @shhwtstamps: timestamp structure to update
4935 * @regval: unsigned 64bit system time value.
4936 *
4937 * We need to convert the system time value stored in the RX/TXSTMP registers
4938 * into a hwtstamp which can be used by the upper level timestamping functions
4939 */
4940static void igb_systim_to_hwtstamp(struct igb_adapter *adapter,
4941 struct skb_shared_hwtstamps *shhwtstamps,
4942 u64 regval)
4943{
4944 u64 ns;
4945
Alexander Duyck55cac242009-11-19 12:42:21 +00004946 /*
4947 * The 82580 starts with 1ns at bit 0 in RX/TXSTMPL, shift this up to
4948 * 24 to match clock shift we setup earlier.
4949 */
4950 if (adapter->hw.mac.type == e1000_82580)
4951 regval <<= IGB_82580_TSYNC_SHIFT;
4952
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004953 ns = timecounter_cyc2time(&adapter->clock, regval);
4954 timecompare_update(&adapter->compare, ns);
4955 memset(shhwtstamps, 0, sizeof(struct skb_shared_hwtstamps));
4956 shhwtstamps->hwtstamp = ns_to_ktime(ns);
4957 shhwtstamps->syststamp = timecompare_transform(&adapter->compare, ns);
4958}
4959
4960/**
4961 * igb_tx_hwtstamp - utility function which checks for TX time stamp
4962 * @q_vector: pointer to q_vector containing needed info
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004963 * @skb: packet that was just sent
4964 *
4965 * If we were asked to do hardware stamping and such a time stamp is
4966 * available, then it must have been for this skb here because we only
4967 * allow only one such packet into the queue.
4968 */
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004969static void igb_tx_hwtstamp(struct igb_q_vector *q_vector, struct sk_buff *skb)
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004970{
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004971 struct igb_adapter *adapter = q_vector->adapter;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004972 union skb_shared_tx *shtx = skb_tx(skb);
4973 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004974 struct skb_shared_hwtstamps shhwtstamps;
4975 u64 regval;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004976
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004977 /* if skb does not support hw timestamp or TX stamp not valid exit */
4978 if (likely(!shtx->hardware) ||
4979 !(rd32(E1000_TSYNCTXCTL) & E1000_TSYNCTXCTL_VALID))
4980 return;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004981
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00004982 regval = rd32(E1000_TXSTMPL);
4983 regval |= (u64)rd32(E1000_TXSTMPH) << 32;
4984
4985 igb_systim_to_hwtstamp(adapter, &shhwtstamps, regval);
4986 skb_tstamp_tx(skb, &shhwtstamps);
Patrick Ohly33af6bc2009-02-12 05:03:43 +00004987}
4988
4989/**
Auke Kok9d5c8242008-01-24 02:22:38 -08004990 * igb_clean_tx_irq - Reclaim resources after transmit completes
Alexander Duyck047e0032009-10-27 15:49:27 +00004991 * @q_vector: pointer to q_vector containing needed info
Auke Kok9d5c8242008-01-24 02:22:38 -08004992 * returns true if ring is completely cleaned
4993 **/
Alexander Duyck047e0032009-10-27 15:49:27 +00004994static bool igb_clean_tx_irq(struct igb_q_vector *q_vector)
Auke Kok9d5c8242008-01-24 02:22:38 -08004995{
Alexander Duyck047e0032009-10-27 15:49:27 +00004996 struct igb_adapter *adapter = q_vector->adapter;
4997 struct igb_ring *tx_ring = q_vector->tx_ring;
Alexander Duycke694e962009-10-27 15:53:06 +00004998 struct net_device *netdev = tx_ring->netdev;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08004999 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08005000 struct igb_buffer *buffer_info;
5001 struct sk_buff *skb;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005002 union e1000_adv_tx_desc *tx_desc, *eop_desc;
Auke Kok9d5c8242008-01-24 02:22:38 -08005003 unsigned int total_bytes = 0, total_packets = 0;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005004 unsigned int i, eop, count = 0;
5005 bool cleaned = false;
Auke Kok9d5c8242008-01-24 02:22:38 -08005006
Auke Kok9d5c8242008-01-24 02:22:38 -08005007 i = tx_ring->next_to_clean;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005008 eop = tx_ring->buffer_info[i].next_to_watch;
5009 eop_desc = E1000_TX_DESC_ADV(*tx_ring, eop);
5010
5011 while ((eop_desc->wb.status & cpu_to_le32(E1000_TXD_STAT_DD)) &&
5012 (count < tx_ring->count)) {
5013 for (cleaned = false; !cleaned; count++) {
5014 tx_desc = E1000_TX_DESC_ADV(*tx_ring, i);
Auke Kok9d5c8242008-01-24 02:22:38 -08005015 buffer_info = &tx_ring->buffer_info[i];
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005016 cleaned = (i == eop);
Auke Kok9d5c8242008-01-24 02:22:38 -08005017 skb = buffer_info->skb;
5018
5019 if (skb) {
5020 unsigned int segs, bytecount;
5021 /* gso_segs is currently only valid for tcp */
Nick Nunley40e90c22010-02-17 01:04:37 +00005022 segs = buffer_info->gso_segs;
Auke Kok9d5c8242008-01-24 02:22:38 -08005023 /* multiply data chunks by size of headers */
5024 bytecount = ((segs - 1) * skb_headlen(skb)) +
5025 skb->len;
5026 total_packets += segs;
5027 total_bytes += bytecount;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005028
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005029 igb_tx_hwtstamp(q_vector, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005030 }
5031
Alexander Duyck80785292009-10-27 15:51:47 +00005032 igb_unmap_and_free_tx_resource(tx_ring, buffer_info);
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005033 tx_desc->wb.status = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08005034
5035 i++;
5036 if (i == tx_ring->count)
5037 i = 0;
Auke Kok9d5c8242008-01-24 02:22:38 -08005038 }
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005039 eop = tx_ring->buffer_info[i].next_to_watch;
5040 eop_desc = E1000_TX_DESC_ADV(*tx_ring, eop);
5041 }
5042
Auke Kok9d5c8242008-01-24 02:22:38 -08005043 tx_ring->next_to_clean = i;
5044
Alexander Duyckfc7d3452008-08-26 04:25:08 -07005045 if (unlikely(count &&
Auke Kok9d5c8242008-01-24 02:22:38 -08005046 netif_carrier_ok(netdev) &&
Alexander Duyckc493ea42009-03-20 00:16:50 +00005047 igb_desc_unused(tx_ring) >= IGB_TX_QUEUE_WAKE)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005048 /* Make sure that anybody stopping the queue after this
5049 * sees the new next_to_clean.
5050 */
5051 smp_mb();
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07005052 if (__netif_subqueue_stopped(netdev, tx_ring->queue_index) &&
5053 !(test_bit(__IGB_DOWN, &adapter->state))) {
5054 netif_wake_subqueue(netdev, tx_ring->queue_index);
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005055 tx_ring->tx_stats.restart_queue++;
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07005056 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005057 }
5058
5059 if (tx_ring->detect_tx_hung) {
5060 /* Detect a transmit hang in hardware, this serializes the
5061 * check with the clearing of time_stamp and movement of i */
5062 tx_ring->detect_tx_hung = false;
5063 if (tx_ring->buffer_info[i].time_stamp &&
5064 time_after(jiffies, tx_ring->buffer_info[i].time_stamp +
Joe Perches8e95a202009-12-03 07:58:21 +00005065 (adapter->tx_timeout_factor * HZ)) &&
5066 !(rd32(E1000_STATUS) & E1000_STATUS_TXOFF)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005067
Auke Kok9d5c8242008-01-24 02:22:38 -08005068 /* detected Tx unit hang */
Alexander Duyck80785292009-10-27 15:51:47 +00005069 dev_err(&tx_ring->pdev->dev,
Auke Kok9d5c8242008-01-24 02:22:38 -08005070 "Detected Tx Unit Hang\n"
Alexander Duyck2d064c02008-07-08 15:10:12 -07005071 " Tx Queue <%d>\n"
Auke Kok9d5c8242008-01-24 02:22:38 -08005072 " TDH <%x>\n"
5073 " TDT <%x>\n"
5074 " next_to_use <%x>\n"
5075 " next_to_clean <%x>\n"
Auke Kok9d5c8242008-01-24 02:22:38 -08005076 "buffer_info[next_to_clean]\n"
5077 " time_stamp <%lx>\n"
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005078 " next_to_watch <%x>\n"
Auke Kok9d5c8242008-01-24 02:22:38 -08005079 " jiffies <%lx>\n"
5080 " desc.status <%x>\n",
Alexander Duyck2d064c02008-07-08 15:10:12 -07005081 tx_ring->queue_index,
Alexander Duyckfce99e32009-10-27 15:51:27 +00005082 readl(tx_ring->head),
5083 readl(tx_ring->tail),
Auke Kok9d5c8242008-01-24 02:22:38 -08005084 tx_ring->next_to_use,
5085 tx_ring->next_to_clean,
Alexander Duyckf7ba2052009-10-27 23:48:51 +00005086 tx_ring->buffer_info[eop].time_stamp,
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005087 eop,
Auke Kok9d5c8242008-01-24 02:22:38 -08005088 jiffies,
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005089 eop_desc->wb.status);
Peter P Waskiewicz Jr661086d2008-07-08 15:06:51 -07005090 netif_stop_subqueue(netdev, tx_ring->queue_index);
Auke Kok9d5c8242008-01-24 02:22:38 -08005091 }
5092 }
5093 tx_ring->total_bytes += total_bytes;
5094 tx_ring->total_packets += total_packets;
Alexander Duycke21ed352008-07-08 15:07:24 -07005095 tx_ring->tx_stats.bytes += total_bytes;
5096 tx_ring->tx_stats.packets += total_packets;
Alexander Duyck0e014cb2008-12-26 01:33:18 -08005097 return (count < tx_ring->count);
Auke Kok9d5c8242008-01-24 02:22:38 -08005098}
5099
Auke Kok9d5c8242008-01-24 02:22:38 -08005100/**
5101 * igb_receive_skb - helper function to handle rx indications
Alexander Duyck047e0032009-10-27 15:49:27 +00005102 * @q_vector: structure containing interrupt and ring information
5103 * @skb: packet to send up
5104 * @vlan_tag: vlan tag for packet
Auke Kok9d5c8242008-01-24 02:22:38 -08005105 **/
Alexander Duyck047e0032009-10-27 15:49:27 +00005106static void igb_receive_skb(struct igb_q_vector *q_vector,
5107 struct sk_buff *skb,
5108 u16 vlan_tag)
Auke Kok9d5c8242008-01-24 02:22:38 -08005109{
Alexander Duyck047e0032009-10-27 15:49:27 +00005110 struct igb_adapter *adapter = q_vector->adapter;
Alexander Duyckd3352522008-07-08 15:12:13 -07005111
Alexander Duyck047e0032009-10-27 15:49:27 +00005112 if (vlan_tag)
5113 vlan_gro_receive(&q_vector->napi, adapter->vlgrp,
5114 vlan_tag, skb);
Alexander Duyck182ff8d2009-04-27 22:35:33 +00005115 else
Alexander Duyck047e0032009-10-27 15:49:27 +00005116 napi_gro_receive(&q_vector->napi, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005117}
5118
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005119static inline void igb_rx_checksum_adv(struct igb_ring *ring,
Auke Kok9d5c8242008-01-24 02:22:38 -08005120 u32 status_err, struct sk_buff *skb)
5121{
5122 skb->ip_summed = CHECKSUM_NONE;
5123
5124 /* Ignore Checksum bit is set or checksum is disabled through ethtool */
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005125 if (!(ring->flags & IGB_RING_FLAG_RX_CSUM) ||
5126 (status_err & E1000_RXD_STAT_IXSM))
Auke Kok9d5c8242008-01-24 02:22:38 -08005127 return;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005128
Auke Kok9d5c8242008-01-24 02:22:38 -08005129 /* TCP/UDP checksum error bit is set */
5130 if (status_err &
5131 (E1000_RXDEXT_STATERR_TCPE | E1000_RXDEXT_STATERR_IPE)) {
Jesse Brandeburgb9473562009-04-27 22:36:13 +00005132 /*
5133 * work around errata with sctp packets where the TCPE aka
5134 * L4E bit is set incorrectly on 64 byte (60 byte w/o crc)
5135 * packets, (aka let the stack check the crc32c)
5136 */
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005137 if ((skb->len == 60) &&
5138 (ring->flags & IGB_RING_FLAG_RX_SCTP_CSUM))
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005139 ring->rx_stats.csum_err++;
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005140
Auke Kok9d5c8242008-01-24 02:22:38 -08005141 /* let the stack verify checksum errors */
Auke Kok9d5c8242008-01-24 02:22:38 -08005142 return;
5143 }
5144 /* It must be a TCP or UDP packet with a valid checksum */
5145 if (status_err & (E1000_RXD_STAT_TCPCS | E1000_RXD_STAT_UDPCS))
5146 skb->ip_summed = CHECKSUM_UNNECESSARY;
5147
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005148 dev_dbg(&ring->pdev->dev, "cksum success: bits %08X\n", status_err);
Auke Kok9d5c8242008-01-24 02:22:38 -08005149}
5150
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005151static inline void igb_rx_hwtstamp(struct igb_q_vector *q_vector, u32 staterr,
5152 struct sk_buff *skb)
5153{
5154 struct igb_adapter *adapter = q_vector->adapter;
5155 struct e1000_hw *hw = &adapter->hw;
5156 u64 regval;
5157
5158 /*
5159 * If this bit is set, then the RX registers contain the time stamp. No
5160 * other packet will be time stamped until we read these registers, so
5161 * read the registers to make them available again. Because only one
5162 * packet can be time stamped at a time, we know that the register
5163 * values must belong to this one here and therefore we don't need to
5164 * compare any of the additional attributes stored for it.
5165 *
5166 * If nothing went wrong, then it should have a skb_shared_tx that we
5167 * can turn into a skb_shared_hwtstamps.
5168 */
5169 if (likely(!(staterr & E1000_RXDADV_STAT_TS)))
5170 return;
5171 if (!(rd32(E1000_TSYNCRXCTL) & E1000_TSYNCRXCTL_VALID))
5172 return;
5173
5174 regval = rd32(E1000_RXSTMPL);
5175 regval |= (u64)rd32(E1000_RXSTMPH) << 32;
5176
5177 igb_systim_to_hwtstamp(adapter, skb_hwtstamps(skb), regval);
5178}
Alexander Duyck4c844852009-10-27 15:52:07 +00005179static inline u16 igb_get_hlen(struct igb_ring *rx_ring,
Alexander Duyck2d94d8a2009-07-23 18:10:06 +00005180 union e1000_adv_rx_desc *rx_desc)
5181{
5182 /* HW will not DMA in data larger than the given buffer, even if it
5183 * parses the (NFS, of course) header to be larger. In that case, it
5184 * fills the header buffer and spills the rest into the page.
5185 */
5186 u16 hlen = (le16_to_cpu(rx_desc->wb.lower.lo_dword.hdr_info) &
5187 E1000_RXDADV_HDRBUFLEN_MASK) >> E1000_RXDADV_HDRBUFLEN_SHIFT;
Alexander Duyck4c844852009-10-27 15:52:07 +00005188 if (hlen > rx_ring->rx_buffer_len)
5189 hlen = rx_ring->rx_buffer_len;
Alexander Duyck2d94d8a2009-07-23 18:10:06 +00005190 return hlen;
5191}
5192
Alexander Duyck047e0032009-10-27 15:49:27 +00005193static bool igb_clean_rx_irq_adv(struct igb_q_vector *q_vector,
5194 int *work_done, int budget)
Auke Kok9d5c8242008-01-24 02:22:38 -08005195{
Alexander Duyck047e0032009-10-27 15:49:27 +00005196 struct igb_ring *rx_ring = q_vector->rx_ring;
Alexander Duycke694e962009-10-27 15:53:06 +00005197 struct net_device *netdev = rx_ring->netdev;
Alexander Duyck80785292009-10-27 15:51:47 +00005198 struct pci_dev *pdev = rx_ring->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08005199 union e1000_adv_rx_desc *rx_desc , *next_rxd;
5200 struct igb_buffer *buffer_info , *next_buffer;
5201 struct sk_buff *skb;
Auke Kok9d5c8242008-01-24 02:22:38 -08005202 bool cleaned = false;
5203 int cleaned_count = 0;
Alexander Duyckd1eff352009-11-12 18:38:35 +00005204 int current_node = numa_node_id();
Auke Kok9d5c8242008-01-24 02:22:38 -08005205 unsigned int total_bytes = 0, total_packets = 0;
Alexander Duyck73cd78f2009-02-12 18:16:59 +00005206 unsigned int i;
Alexander Duyck2d94d8a2009-07-23 18:10:06 +00005207 u32 staterr;
5208 u16 length;
Alexander Duyck047e0032009-10-27 15:49:27 +00005209 u16 vlan_tag;
Auke Kok9d5c8242008-01-24 02:22:38 -08005210
5211 i = rx_ring->next_to_clean;
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005212 buffer_info = &rx_ring->buffer_info[i];
Auke Kok9d5c8242008-01-24 02:22:38 -08005213 rx_desc = E1000_RX_DESC_ADV(*rx_ring, i);
5214 staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
5215
5216 while (staterr & E1000_RXD_STAT_DD) {
5217 if (*work_done >= budget)
5218 break;
5219 (*work_done)++;
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005220
5221 skb = buffer_info->skb;
5222 prefetch(skb->data - NET_IP_ALIGN);
5223 buffer_info->skb = NULL;
5224
5225 i++;
5226 if (i == rx_ring->count)
5227 i = 0;
Alexander Duyck42d07812009-10-27 23:51:16 +00005228
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005229 next_rxd = E1000_RX_DESC_ADV(*rx_ring, i);
5230 prefetch(next_rxd);
5231 next_buffer = &rx_ring->buffer_info[i];
5232
5233 length = le16_to_cpu(rx_desc->wb.upper.length);
5234 cleaned = true;
5235 cleaned_count++;
5236
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005237 if (buffer_info->dma) {
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005238 pci_unmap_single(pdev, buffer_info->dma,
Alexander Duyck4c844852009-10-27 15:52:07 +00005239 rx_ring->rx_buffer_len,
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005240 PCI_DMA_FROMDEVICE);
Jesse Brandeburg91615f72009-06-30 12:45:15 +00005241 buffer_info->dma = 0;
Alexander Duyck4c844852009-10-27 15:52:07 +00005242 if (rx_ring->rx_buffer_len >= IGB_RXBUFFER_1024) {
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005243 skb_put(skb, length);
5244 goto send_up;
5245 }
Alexander Duyck4c844852009-10-27 15:52:07 +00005246 skb_put(skb, igb_get_hlen(rx_ring, rx_desc));
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005247 }
5248
5249 if (length) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005250 pci_unmap_page(pdev, buffer_info->page_dma,
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005251 PAGE_SIZE / 2, PCI_DMA_FROMDEVICE);
Auke Kok9d5c8242008-01-24 02:22:38 -08005252 buffer_info->page_dma = 0;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005253
5254 skb_fill_page_desc(skb, skb_shinfo(skb)->nr_frags++,
5255 buffer_info->page,
5256 buffer_info->page_offset,
5257 length);
5258
Alexander Duyckd1eff352009-11-12 18:38:35 +00005259 if ((page_count(buffer_info->page) != 1) ||
5260 (page_to_nid(buffer_info->page) != current_node))
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005261 buffer_info->page = NULL;
5262 else
5263 get_page(buffer_info->page);
Auke Kok9d5c8242008-01-24 02:22:38 -08005264
5265 skb->len += length;
5266 skb->data_len += length;
5267 skb->truesize += length;
Auke Kok9d5c8242008-01-24 02:22:38 -08005268 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005269
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005270 if (!(staterr & E1000_RXD_STAT_EOP)) {
Alexander Duyckb2d56532008-11-20 00:47:34 -08005271 buffer_info->skb = next_buffer->skb;
5272 buffer_info->dma = next_buffer->dma;
5273 next_buffer->skb = skb;
5274 next_buffer->dma = 0;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005275 goto next_desc;
5276 }
Alexander Duyck69d3ca52009-02-06 23:15:04 +00005277send_up:
Auke Kok9d5c8242008-01-24 02:22:38 -08005278 if (staterr & E1000_RXDEXT_ERR_FRAME_ERR_MASK) {
5279 dev_kfree_skb_irq(skb);
5280 goto next_desc;
5281 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005282
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005283 igb_rx_hwtstamp(q_vector, staterr, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005284 total_bytes += skb->len;
5285 total_packets++;
5286
Alexander Duyck85ad76b2009-10-27 15:52:46 +00005287 igb_rx_checksum_adv(rx_ring, staterr, skb);
Auke Kok9d5c8242008-01-24 02:22:38 -08005288
5289 skb->protocol = eth_type_trans(skb, netdev);
Alexander Duyck047e0032009-10-27 15:49:27 +00005290 skb_record_rx_queue(skb, rx_ring->queue_index);
Auke Kok9d5c8242008-01-24 02:22:38 -08005291
Alexander Duyck047e0032009-10-27 15:49:27 +00005292 vlan_tag = ((staterr & E1000_RXD_STAT_VP) ?
5293 le16_to_cpu(rx_desc->wb.upper.vlan) : 0);
5294
5295 igb_receive_skb(q_vector, skb, vlan_tag);
Auke Kok9d5c8242008-01-24 02:22:38 -08005296
Auke Kok9d5c8242008-01-24 02:22:38 -08005297next_desc:
5298 rx_desc->wb.upper.status_error = 0;
5299
5300 /* return some buffers to hardware, one at a time is too slow */
5301 if (cleaned_count >= IGB_RX_BUFFER_WRITE) {
Mitch Williams3b644cf2008-06-27 10:59:48 -07005302 igb_alloc_rx_buffers_adv(rx_ring, cleaned_count);
Auke Kok9d5c8242008-01-24 02:22:38 -08005303 cleaned_count = 0;
5304 }
5305
5306 /* use prefetched values */
5307 rx_desc = next_rxd;
5308 buffer_info = next_buffer;
Auke Kok9d5c8242008-01-24 02:22:38 -08005309 staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
5310 }
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005311
Auke Kok9d5c8242008-01-24 02:22:38 -08005312 rx_ring->next_to_clean = i;
Alexander Duyckc493ea42009-03-20 00:16:50 +00005313 cleaned_count = igb_desc_unused(rx_ring);
Auke Kok9d5c8242008-01-24 02:22:38 -08005314
5315 if (cleaned_count)
Mitch Williams3b644cf2008-06-27 10:59:48 -07005316 igb_alloc_rx_buffers_adv(rx_ring, cleaned_count);
Auke Kok9d5c8242008-01-24 02:22:38 -08005317
5318 rx_ring->total_packets += total_packets;
5319 rx_ring->total_bytes += total_bytes;
5320 rx_ring->rx_stats.packets += total_packets;
5321 rx_ring->rx_stats.bytes += total_bytes;
Auke Kok9d5c8242008-01-24 02:22:38 -08005322 return cleaned;
5323}
5324
Auke Kok9d5c8242008-01-24 02:22:38 -08005325/**
5326 * igb_alloc_rx_buffers_adv - Replace used receive buffers; packet split
5327 * @adapter: address of board private structure
5328 **/
Alexander Duyckd7ee5b32009-10-27 15:54:23 +00005329void igb_alloc_rx_buffers_adv(struct igb_ring *rx_ring, int cleaned_count)
Auke Kok9d5c8242008-01-24 02:22:38 -08005330{
Alexander Duycke694e962009-10-27 15:53:06 +00005331 struct net_device *netdev = rx_ring->netdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08005332 union e1000_adv_rx_desc *rx_desc;
5333 struct igb_buffer *buffer_info;
5334 struct sk_buff *skb;
5335 unsigned int i;
Alexander Duyckdb761762009-02-06 23:15:25 +00005336 int bufsz;
Auke Kok9d5c8242008-01-24 02:22:38 -08005337
5338 i = rx_ring->next_to_use;
5339 buffer_info = &rx_ring->buffer_info[i];
5340
Alexander Duyck4c844852009-10-27 15:52:07 +00005341 bufsz = rx_ring->rx_buffer_len;
Alexander Duyckdb761762009-02-06 23:15:25 +00005342
Auke Kok9d5c8242008-01-24 02:22:38 -08005343 while (cleaned_count--) {
5344 rx_desc = E1000_RX_DESC_ADV(*rx_ring, i);
5345
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005346 if ((bufsz < IGB_RXBUFFER_1024) && !buffer_info->page_dma) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005347 if (!buffer_info->page) {
Alexander Duyck42d07812009-10-27 23:51:16 +00005348 buffer_info->page = netdev_alloc_page(netdev);
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005349 if (!buffer_info->page) {
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005350 rx_ring->rx_stats.alloc_failed++;
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005351 goto no_buffers;
5352 }
5353 buffer_info->page_offset = 0;
5354 } else {
5355 buffer_info->page_offset ^= PAGE_SIZE / 2;
Auke Kok9d5c8242008-01-24 02:22:38 -08005356 }
5357 buffer_info->page_dma =
Alexander Duyck80785292009-10-27 15:51:47 +00005358 pci_map_page(rx_ring->pdev, buffer_info->page,
Alexander Duyckbf36c1a2008-07-08 15:11:40 -07005359 buffer_info->page_offset,
5360 PAGE_SIZE / 2,
Auke Kok9d5c8242008-01-24 02:22:38 -08005361 PCI_DMA_FROMDEVICE);
Alexander Duyck42d07812009-10-27 23:51:16 +00005362 if (pci_dma_mapping_error(rx_ring->pdev,
5363 buffer_info->page_dma)) {
5364 buffer_info->page_dma = 0;
5365 rx_ring->rx_stats.alloc_failed++;
5366 goto no_buffers;
5367 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005368 }
5369
Alexander Duyck42d07812009-10-27 23:51:16 +00005370 skb = buffer_info->skb;
5371 if (!skb) {
Eric Dumazet89d71a62009-10-13 05:34:20 +00005372 skb = netdev_alloc_skb_ip_align(netdev, bufsz);
Auke Kok9d5c8242008-01-24 02:22:38 -08005373 if (!skb) {
Alexander Duyck04a5fcaa2009-10-27 15:52:27 +00005374 rx_ring->rx_stats.alloc_failed++;
Auke Kok9d5c8242008-01-24 02:22:38 -08005375 goto no_buffers;
5376 }
5377
Auke Kok9d5c8242008-01-24 02:22:38 -08005378 buffer_info->skb = skb;
Alexander Duyck42d07812009-10-27 23:51:16 +00005379 }
5380 if (!buffer_info->dma) {
Alexander Duyck80785292009-10-27 15:51:47 +00005381 buffer_info->dma = pci_map_single(rx_ring->pdev,
5382 skb->data,
Auke Kok9d5c8242008-01-24 02:22:38 -08005383 bufsz,
5384 PCI_DMA_FROMDEVICE);
Alexander Duyck42d07812009-10-27 23:51:16 +00005385 if (pci_dma_mapping_error(rx_ring->pdev,
5386 buffer_info->dma)) {
5387 buffer_info->dma = 0;
5388 rx_ring->rx_stats.alloc_failed++;
5389 goto no_buffers;
5390 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005391 }
5392 /* Refresh the desc even if buffer_addrs didn't change because
5393 * each write-back erases this info. */
Alexander Duyck6ec43fe2009-10-27 15:50:48 +00005394 if (bufsz < IGB_RXBUFFER_1024) {
Auke Kok9d5c8242008-01-24 02:22:38 -08005395 rx_desc->read.pkt_addr =
5396 cpu_to_le64(buffer_info->page_dma);
5397 rx_desc->read.hdr_addr = cpu_to_le64(buffer_info->dma);
5398 } else {
Alexander Duyck42d07812009-10-27 23:51:16 +00005399 rx_desc->read.pkt_addr = cpu_to_le64(buffer_info->dma);
Auke Kok9d5c8242008-01-24 02:22:38 -08005400 rx_desc->read.hdr_addr = 0;
5401 }
5402
5403 i++;
5404 if (i == rx_ring->count)
5405 i = 0;
5406 buffer_info = &rx_ring->buffer_info[i];
5407 }
5408
5409no_buffers:
5410 if (rx_ring->next_to_use != i) {
5411 rx_ring->next_to_use = i;
5412 if (i == 0)
5413 i = (rx_ring->count - 1);
5414 else
5415 i--;
5416
5417 /* Force memory writes to complete before letting h/w
5418 * know there are new descriptors to fetch. (Only
5419 * applicable for weak-ordered memory model archs,
5420 * such as IA-64). */
5421 wmb();
Alexander Duyckfce99e32009-10-27 15:51:27 +00005422 writel(i, rx_ring->tail);
Auke Kok9d5c8242008-01-24 02:22:38 -08005423 }
5424}
5425
5426/**
5427 * igb_mii_ioctl -
5428 * @netdev:
5429 * @ifreq:
5430 * @cmd:
5431 **/
5432static int igb_mii_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
5433{
5434 struct igb_adapter *adapter = netdev_priv(netdev);
5435 struct mii_ioctl_data *data = if_mii(ifr);
5436
5437 if (adapter->hw.phy.media_type != e1000_media_type_copper)
5438 return -EOPNOTSUPP;
5439
5440 switch (cmd) {
5441 case SIOCGMIIPHY:
5442 data->phy_id = adapter->hw.phy.addr;
5443 break;
5444 case SIOCGMIIREG:
Alexander Duyckf5f4cf02008-11-21 21:30:24 -08005445 if (igb_read_phy_reg(&adapter->hw, data->reg_num & 0x1F,
5446 &data->val_out))
Auke Kok9d5c8242008-01-24 02:22:38 -08005447 return -EIO;
5448 break;
5449 case SIOCSMIIREG:
5450 default:
5451 return -EOPNOTSUPP;
5452 }
5453 return 0;
5454}
5455
5456/**
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005457 * igb_hwtstamp_ioctl - control hardware time stamping
5458 * @netdev:
5459 * @ifreq:
5460 * @cmd:
5461 *
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005462 * Outgoing time stamping can be enabled and disabled. Play nice and
5463 * disable it when requested, although it shouldn't case any overhead
5464 * when no packet needs it. At most one packet in the queue may be
5465 * marked for time stamping, otherwise it would be impossible to tell
5466 * for sure to which packet the hardware time stamp belongs.
5467 *
5468 * Incoming time stamping has to be configured via the hardware
5469 * filters. Not all combinations are supported, in particular event
5470 * type has to be specified. Matching the kind of event packet is
5471 * not supported, with the exception of "all V2 events regardless of
5472 * level 2 or 4".
5473 *
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005474 **/
5475static int igb_hwtstamp_ioctl(struct net_device *netdev,
5476 struct ifreq *ifr, int cmd)
5477{
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005478 struct igb_adapter *adapter = netdev_priv(netdev);
5479 struct e1000_hw *hw = &adapter->hw;
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005480 struct hwtstamp_config config;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005481 u32 tsync_tx_ctl = E1000_TSYNCTXCTL_ENABLED;
5482 u32 tsync_rx_ctl = E1000_TSYNCRXCTL_ENABLED;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005483 u32 tsync_rx_cfg = 0;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005484 bool is_l4 = false;
5485 bool is_l2 = false;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005486 u32 regval;
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005487
5488 if (copy_from_user(&config, ifr->ifr_data, sizeof(config)))
5489 return -EFAULT;
5490
5491 /* reserved for future extensions */
5492 if (config.flags)
5493 return -EINVAL;
5494
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005495 switch (config.tx_type) {
5496 case HWTSTAMP_TX_OFF:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005497 tsync_tx_ctl = 0;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005498 case HWTSTAMP_TX_ON:
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005499 break;
5500 default:
5501 return -ERANGE;
5502 }
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005503
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005504 switch (config.rx_filter) {
5505 case HWTSTAMP_FILTER_NONE:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005506 tsync_rx_ctl = 0;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005507 break;
5508 case HWTSTAMP_FILTER_PTP_V1_L4_EVENT:
5509 case HWTSTAMP_FILTER_PTP_V2_L4_EVENT:
5510 case HWTSTAMP_FILTER_PTP_V2_L2_EVENT:
5511 case HWTSTAMP_FILTER_ALL:
5512 /*
5513 * register TSYNCRXCFG must be set, therefore it is not
5514 * possible to time stamp both Sync and Delay_Req messages
5515 * => fall back to time stamping all packets
5516 */
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005517 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_ALL;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005518 config.rx_filter = HWTSTAMP_FILTER_ALL;
5519 break;
5520 case HWTSTAMP_FILTER_PTP_V1_L4_SYNC:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005521 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L4_V1;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005522 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V1_SYNC_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005523 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005524 break;
5525 case HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005526 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L4_V1;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005527 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V1_DELAY_REQ_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005528 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005529 break;
5530 case HWTSTAMP_FILTER_PTP_V2_L2_SYNC:
5531 case HWTSTAMP_FILTER_PTP_V2_L4_SYNC:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005532 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L2_L4_V2;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005533 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V2_SYNC_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005534 is_l2 = true;
5535 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005536 config.rx_filter = HWTSTAMP_FILTER_SOME;
5537 break;
5538 case HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ:
5539 case HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005540 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_L2_L4_V2;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005541 tsync_rx_cfg = E1000_TSYNCRXCFG_PTP_V2_DELAY_REQ_MESSAGE;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005542 is_l2 = true;
5543 is_l4 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005544 config.rx_filter = HWTSTAMP_FILTER_SOME;
5545 break;
5546 case HWTSTAMP_FILTER_PTP_V2_EVENT:
5547 case HWTSTAMP_FILTER_PTP_V2_SYNC:
5548 case HWTSTAMP_FILTER_PTP_V2_DELAY_REQ:
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005549 tsync_rx_ctl |= E1000_TSYNCRXCTL_TYPE_EVENT_V2;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005550 config.rx_filter = HWTSTAMP_FILTER_PTP_V2_EVENT;
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005551 is_l2 = true;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005552 break;
5553 default:
5554 return -ERANGE;
5555 }
5556
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005557 if (hw->mac.type == e1000_82575) {
5558 if (tsync_rx_ctl | tsync_tx_ctl)
5559 return -EINVAL;
5560 return 0;
5561 }
5562
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005563 /* enable/disable TX */
5564 regval = rd32(E1000_TSYNCTXCTL);
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005565 regval &= ~E1000_TSYNCTXCTL_ENABLED;
5566 regval |= tsync_tx_ctl;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005567 wr32(E1000_TSYNCTXCTL, regval);
5568
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005569 /* enable/disable RX */
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005570 regval = rd32(E1000_TSYNCRXCTL);
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005571 regval &= ~(E1000_TSYNCRXCTL_ENABLED | E1000_TSYNCRXCTL_TYPE_MASK);
5572 regval |= tsync_rx_ctl;
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005573 wr32(E1000_TSYNCRXCTL, regval);
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005574
5575 /* define which PTP packets are time stamped */
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005576 wr32(E1000_TSYNCRXCFG, tsync_rx_cfg);
5577
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005578 /* define ethertype filter for timestamped packets */
5579 if (is_l2)
5580 wr32(E1000_ETQF(3),
5581 (E1000_ETQF_FILTER_ENABLE | /* enable filter */
5582 E1000_ETQF_1588 | /* enable timestamping */
5583 ETH_P_1588)); /* 1588 eth protocol type */
5584 else
5585 wr32(E1000_ETQF(3), 0);
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005586
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005587#define PTP_PORT 319
5588 /* L4 Queue Filter[3]: filter by destination port and protocol */
5589 if (is_l4) {
5590 u32 ftqf = (IPPROTO_UDP /* UDP */
5591 | E1000_FTQF_VF_BP /* VF not compared */
5592 | E1000_FTQF_1588_TIME_STAMP /* Enable Timestamping */
5593 | E1000_FTQF_MASK); /* mask all inputs */
5594 ftqf &= ~E1000_FTQF_MASK_PROTO_BP; /* enable protocol check */
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005595
Alexander Duyckc5b9bd52009-10-27 23:46:01 +00005596 wr32(E1000_IMIR(3), htons(PTP_PORT));
5597 wr32(E1000_IMIREXT(3),
5598 (E1000_IMIREXT_SIZE_BP | E1000_IMIREXT_CTRL_BP));
5599 if (hw->mac.type == e1000_82576) {
5600 /* enable source port check */
5601 wr32(E1000_SPQF(3), htons(PTP_PORT));
5602 ftqf &= ~E1000_FTQF_MASK_SOURCE_PORT_BP;
5603 }
5604 wr32(E1000_FTQF(3), ftqf);
5605 } else {
5606 wr32(E1000_FTQF(3), E1000_FTQF_MASK);
5607 }
Patrick Ohly33af6bc2009-02-12 05:03:43 +00005608 wrfl();
5609
5610 adapter->hwtstamp_config = config;
5611
5612 /* clear TX/RX time stamp registers, just to be sure */
5613 regval = rd32(E1000_TXSTMPH);
5614 regval = rd32(E1000_RXSTMPH);
5615
5616 return copy_to_user(ifr->ifr_data, &config, sizeof(config)) ?
5617 -EFAULT : 0;
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005618}
5619
5620/**
Auke Kok9d5c8242008-01-24 02:22:38 -08005621 * igb_ioctl -
5622 * @netdev:
5623 * @ifreq:
5624 * @cmd:
5625 **/
5626static int igb_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
5627{
5628 switch (cmd) {
5629 case SIOCGMIIPHY:
5630 case SIOCGMIIREG:
5631 case SIOCSMIIREG:
5632 return igb_mii_ioctl(netdev, ifr, cmd);
Patrick Ohlyc6cb0902009-02-12 05:03:42 +00005633 case SIOCSHWTSTAMP:
5634 return igb_hwtstamp_ioctl(netdev, ifr, cmd);
Auke Kok9d5c8242008-01-24 02:22:38 -08005635 default:
5636 return -EOPNOTSUPP;
5637 }
5638}
5639
Alexander Duyck009bc062009-07-23 18:08:35 +00005640s32 igb_read_pcie_cap_reg(struct e1000_hw *hw, u32 reg, u16 *value)
5641{
5642 struct igb_adapter *adapter = hw->back;
5643 u16 cap_offset;
5644
5645 cap_offset = pci_find_capability(adapter->pdev, PCI_CAP_ID_EXP);
5646 if (!cap_offset)
5647 return -E1000_ERR_CONFIG;
5648
5649 pci_read_config_word(adapter->pdev, cap_offset + reg, value);
5650
5651 return 0;
5652}
5653
5654s32 igb_write_pcie_cap_reg(struct e1000_hw *hw, u32 reg, u16 *value)
5655{
5656 struct igb_adapter *adapter = hw->back;
5657 u16 cap_offset;
5658
5659 cap_offset = pci_find_capability(adapter->pdev, PCI_CAP_ID_EXP);
5660 if (!cap_offset)
5661 return -E1000_ERR_CONFIG;
5662
5663 pci_write_config_word(adapter->pdev, cap_offset + reg, *value);
5664
5665 return 0;
5666}
5667
Auke Kok9d5c8242008-01-24 02:22:38 -08005668static void igb_vlan_rx_register(struct net_device *netdev,
5669 struct vlan_group *grp)
5670{
5671 struct igb_adapter *adapter = netdev_priv(netdev);
5672 struct e1000_hw *hw = &adapter->hw;
5673 u32 ctrl, rctl;
5674
5675 igb_irq_disable(adapter);
5676 adapter->vlgrp = grp;
5677
5678 if (grp) {
5679 /* enable VLAN tag insert/strip */
5680 ctrl = rd32(E1000_CTRL);
5681 ctrl |= E1000_CTRL_VME;
5682 wr32(E1000_CTRL, ctrl);
5683
Alexander Duyck51466232009-10-27 23:47:35 +00005684 /* Disable CFI check */
Auke Kok9d5c8242008-01-24 02:22:38 -08005685 rctl = rd32(E1000_RCTL);
Auke Kok9d5c8242008-01-24 02:22:38 -08005686 rctl &= ~E1000_RCTL_CFIEN;
5687 wr32(E1000_RCTL, rctl);
Auke Kok9d5c8242008-01-24 02:22:38 -08005688 } else {
5689 /* disable VLAN tag insert/strip */
5690 ctrl = rd32(E1000_CTRL);
5691 ctrl &= ~E1000_CTRL_VME;
5692 wr32(E1000_CTRL, ctrl);
Auke Kok9d5c8242008-01-24 02:22:38 -08005693 }
5694
Alexander Duycke1739522009-02-19 20:39:44 -08005695 igb_rlpml_set(adapter);
5696
Auke Kok9d5c8242008-01-24 02:22:38 -08005697 if (!test_bit(__IGB_DOWN, &adapter->state))
5698 igb_irq_enable(adapter);
5699}
5700
5701static void igb_vlan_rx_add_vid(struct net_device *netdev, u16 vid)
5702{
5703 struct igb_adapter *adapter = netdev_priv(netdev);
5704 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005705 int pf_id = adapter->vfs_allocated_count;
Auke Kok9d5c8242008-01-24 02:22:38 -08005706
Alexander Duyck51466232009-10-27 23:47:35 +00005707 /* attempt to add filter to vlvf array */
5708 igb_vlvf_set(adapter, vid, true, pf_id);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005709
Alexander Duyck51466232009-10-27 23:47:35 +00005710 /* add the filter since PF can receive vlans w/o entry in vlvf */
5711 igb_vfta_set(hw, vid, true);
Auke Kok9d5c8242008-01-24 02:22:38 -08005712}
5713
5714static void igb_vlan_rx_kill_vid(struct net_device *netdev, u16 vid)
5715{
5716 struct igb_adapter *adapter = netdev_priv(netdev);
5717 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005718 int pf_id = adapter->vfs_allocated_count;
Alexander Duyck51466232009-10-27 23:47:35 +00005719 s32 err;
Auke Kok9d5c8242008-01-24 02:22:38 -08005720
5721 igb_irq_disable(adapter);
5722 vlan_group_set_device(adapter->vlgrp, vid, NULL);
5723
5724 if (!test_bit(__IGB_DOWN, &adapter->state))
5725 igb_irq_enable(adapter);
5726
Alexander Duyck51466232009-10-27 23:47:35 +00005727 /* remove vlan from VLVF table array */
5728 err = igb_vlvf_set(adapter, vid, false, pf_id);
Auke Kok9d5c8242008-01-24 02:22:38 -08005729
Alexander Duyck51466232009-10-27 23:47:35 +00005730 /* if vid was not present in VLVF just remove it from table */
5731 if (err)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08005732 igb_vfta_set(hw, vid, false);
Auke Kok9d5c8242008-01-24 02:22:38 -08005733}
5734
5735static void igb_restore_vlan(struct igb_adapter *adapter)
5736{
5737 igb_vlan_rx_register(adapter->netdev, adapter->vlgrp);
5738
5739 if (adapter->vlgrp) {
5740 u16 vid;
5741 for (vid = 0; vid < VLAN_GROUP_ARRAY_LEN; vid++) {
5742 if (!vlan_group_get_device(adapter->vlgrp, vid))
5743 continue;
5744 igb_vlan_rx_add_vid(adapter->netdev, vid);
5745 }
5746 }
5747}
5748
5749int igb_set_spd_dplx(struct igb_adapter *adapter, u16 spddplx)
5750{
Alexander Duyck090b1792009-10-27 23:51:55 +00005751 struct pci_dev *pdev = adapter->pdev;
Auke Kok9d5c8242008-01-24 02:22:38 -08005752 struct e1000_mac_info *mac = &adapter->hw.mac;
5753
5754 mac->autoneg = 0;
5755
Auke Kok9d5c8242008-01-24 02:22:38 -08005756 switch (spddplx) {
5757 case SPEED_10 + DUPLEX_HALF:
5758 mac->forced_speed_duplex = ADVERTISE_10_HALF;
5759 break;
5760 case SPEED_10 + DUPLEX_FULL:
5761 mac->forced_speed_duplex = ADVERTISE_10_FULL;
5762 break;
5763 case SPEED_100 + DUPLEX_HALF:
5764 mac->forced_speed_duplex = ADVERTISE_100_HALF;
5765 break;
5766 case SPEED_100 + DUPLEX_FULL:
5767 mac->forced_speed_duplex = ADVERTISE_100_FULL;
5768 break;
5769 case SPEED_1000 + DUPLEX_FULL:
5770 mac->autoneg = 1;
5771 adapter->hw.phy.autoneg_advertised = ADVERTISE_1000_FULL;
5772 break;
5773 case SPEED_1000 + DUPLEX_HALF: /* not supported */
5774 default:
Alexander Duyck090b1792009-10-27 23:51:55 +00005775 dev_err(&pdev->dev, "Unsupported Speed/Duplex configuration\n");
Auke Kok9d5c8242008-01-24 02:22:38 -08005776 return -EINVAL;
5777 }
5778 return 0;
5779}
5780
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005781static int __igb_shutdown(struct pci_dev *pdev, bool *enable_wake)
Auke Kok9d5c8242008-01-24 02:22:38 -08005782{
5783 struct net_device *netdev = pci_get_drvdata(pdev);
5784 struct igb_adapter *adapter = netdev_priv(netdev);
5785 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck2d064c02008-07-08 15:10:12 -07005786 u32 ctrl, rctl, status;
Auke Kok9d5c8242008-01-24 02:22:38 -08005787 u32 wufc = adapter->wol;
5788#ifdef CONFIG_PM
5789 int retval = 0;
5790#endif
5791
5792 netif_device_detach(netdev);
5793
Alexander Duycka88f10e2008-07-08 15:13:38 -07005794 if (netif_running(netdev))
5795 igb_close(netdev);
5796
Alexander Duyck047e0032009-10-27 15:49:27 +00005797 igb_clear_interrupt_scheme(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08005798
5799#ifdef CONFIG_PM
5800 retval = pci_save_state(pdev);
5801 if (retval)
5802 return retval;
5803#endif
5804
5805 status = rd32(E1000_STATUS);
5806 if (status & E1000_STATUS_LU)
5807 wufc &= ~E1000_WUFC_LNKC;
5808
5809 if (wufc) {
5810 igb_setup_rctl(adapter);
Alexander Duyckff41f8d2009-09-03 14:48:56 +00005811 igb_set_rx_mode(netdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08005812
5813 /* turn on all-multi mode if wake on multicast is enabled */
5814 if (wufc & E1000_WUFC_MC) {
5815 rctl = rd32(E1000_RCTL);
5816 rctl |= E1000_RCTL_MPE;
5817 wr32(E1000_RCTL, rctl);
5818 }
5819
5820 ctrl = rd32(E1000_CTRL);
5821 /* advertise wake from D3Cold */
5822 #define E1000_CTRL_ADVD3WUC 0x00100000
5823 /* phy power management enable */
5824 #define E1000_CTRL_EN_PHY_PWR_MGMT 0x00200000
5825 ctrl |= E1000_CTRL_ADVD3WUC;
5826 wr32(E1000_CTRL, ctrl);
5827
Auke Kok9d5c8242008-01-24 02:22:38 -08005828 /* Allow time for pending master requests to run */
Alexander Duyck330a6d62009-10-27 23:51:35 +00005829 igb_disable_pcie_master(hw);
Auke Kok9d5c8242008-01-24 02:22:38 -08005830
5831 wr32(E1000_WUC, E1000_WUC_PME_EN);
5832 wr32(E1000_WUFC, wufc);
Auke Kok9d5c8242008-01-24 02:22:38 -08005833 } else {
5834 wr32(E1000_WUC, 0);
5835 wr32(E1000_WUFC, 0);
Auke Kok9d5c8242008-01-24 02:22:38 -08005836 }
5837
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005838 *enable_wake = wufc || adapter->en_mng_pt;
5839 if (!*enable_wake)
Nick Nunley88a268c2010-02-17 01:01:59 +00005840 igb_power_down_link(adapter);
5841 else
5842 igb_power_up_link(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08005843
5844 /* Release control of h/w to f/w. If f/w is AMT enabled, this
5845 * would have already happened in close and is redundant. */
5846 igb_release_hw_control(adapter);
5847
5848 pci_disable_device(pdev);
5849
Auke Kok9d5c8242008-01-24 02:22:38 -08005850 return 0;
5851}
5852
5853#ifdef CONFIG_PM
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005854static int igb_suspend(struct pci_dev *pdev, pm_message_t state)
5855{
5856 int retval;
5857 bool wake;
5858
5859 retval = __igb_shutdown(pdev, &wake);
5860 if (retval)
5861 return retval;
5862
5863 if (wake) {
5864 pci_prepare_to_sleep(pdev);
5865 } else {
5866 pci_wake_from_d3(pdev, false);
5867 pci_set_power_state(pdev, PCI_D3hot);
5868 }
5869
5870 return 0;
5871}
5872
Auke Kok9d5c8242008-01-24 02:22:38 -08005873static int igb_resume(struct pci_dev *pdev)
5874{
5875 struct net_device *netdev = pci_get_drvdata(pdev);
5876 struct igb_adapter *adapter = netdev_priv(netdev);
5877 struct e1000_hw *hw = &adapter->hw;
5878 u32 err;
5879
5880 pci_set_power_state(pdev, PCI_D0);
5881 pci_restore_state(pdev);
Nick Nunleyb94f2d72010-02-17 01:02:19 +00005882 pci_save_state(pdev);
Taku Izumi42bfd33a2008-06-20 12:10:30 +09005883
Alexander Duyckaed5dec2009-02-06 23:16:04 +00005884 err = pci_enable_device_mem(pdev);
Auke Kok9d5c8242008-01-24 02:22:38 -08005885 if (err) {
5886 dev_err(&pdev->dev,
5887 "igb: Cannot enable PCI device from suspend\n");
5888 return err;
5889 }
5890 pci_set_master(pdev);
5891
5892 pci_enable_wake(pdev, PCI_D3hot, 0);
5893 pci_enable_wake(pdev, PCI_D3cold, 0);
5894
Alexander Duyck047e0032009-10-27 15:49:27 +00005895 if (igb_init_interrupt_scheme(adapter)) {
Alexander Duycka88f10e2008-07-08 15:13:38 -07005896 dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
5897 return -ENOMEM;
Auke Kok9d5c8242008-01-24 02:22:38 -08005898 }
5899
Auke Kok9d5c8242008-01-24 02:22:38 -08005900 igb_reset(adapter);
Alexander Duycka8564f02009-02-06 23:21:10 +00005901
5902 /* let the f/w know that the h/w is now under the control of the
5903 * driver. */
5904 igb_get_hw_control(adapter);
5905
Auke Kok9d5c8242008-01-24 02:22:38 -08005906 wr32(E1000_WUS, ~0);
5907
Alexander Duycka88f10e2008-07-08 15:13:38 -07005908 if (netif_running(netdev)) {
5909 err = igb_open(netdev);
5910 if (err)
5911 return err;
5912 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005913
5914 netif_device_attach(netdev);
5915
Auke Kok9d5c8242008-01-24 02:22:38 -08005916 return 0;
5917}
5918#endif
5919
5920static void igb_shutdown(struct pci_dev *pdev)
5921{
Rafael J. Wysocki3fe7c4c2009-03-31 21:23:50 +00005922 bool wake;
5923
5924 __igb_shutdown(pdev, &wake);
5925
5926 if (system_state == SYSTEM_POWER_OFF) {
5927 pci_wake_from_d3(pdev, wake);
5928 pci_set_power_state(pdev, PCI_D3hot);
5929 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005930}
5931
5932#ifdef CONFIG_NET_POLL_CONTROLLER
5933/*
5934 * Polling 'interrupt' - used by things like netconsole to send skbs
5935 * without having to re-enable interrupts. It's not called while
5936 * the interrupt routine is executing.
5937 */
5938static void igb_netpoll(struct net_device *netdev)
5939{
5940 struct igb_adapter *adapter = netdev_priv(netdev);
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005941 struct e1000_hw *hw = &adapter->hw;
Auke Kok9d5c8242008-01-24 02:22:38 -08005942 int i;
Auke Kok9d5c8242008-01-24 02:22:38 -08005943
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005944 if (!adapter->msix_entries) {
Alexander Duyck047e0032009-10-27 15:49:27 +00005945 struct igb_q_vector *q_vector = adapter->q_vector[0];
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005946 igb_irq_disable(adapter);
Alexander Duyck047e0032009-10-27 15:49:27 +00005947 napi_schedule(&q_vector->napi);
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005948 return;
5949 }
Alexander Duyck7dfc16f2008-07-08 15:10:46 -07005950
Alexander Duyck047e0032009-10-27 15:49:27 +00005951 for (i = 0; i < adapter->num_q_vectors; i++) {
5952 struct igb_q_vector *q_vector = adapter->q_vector[i];
5953 wr32(E1000_EIMC, q_vector->eims_value);
5954 napi_schedule(&q_vector->napi);
Alexander Duyckeebbbdb2009-02-06 23:19:29 +00005955 }
Auke Kok9d5c8242008-01-24 02:22:38 -08005956}
5957#endif /* CONFIG_NET_POLL_CONTROLLER */
5958
5959/**
5960 * igb_io_error_detected - called when PCI error is detected
5961 * @pdev: Pointer to PCI device
5962 * @state: The current pci connection state
5963 *
5964 * This function is called after a PCI bus error affecting
5965 * this device has been detected.
5966 */
5967static pci_ers_result_t igb_io_error_detected(struct pci_dev *pdev,
5968 pci_channel_state_t state)
5969{
5970 struct net_device *netdev = pci_get_drvdata(pdev);
5971 struct igb_adapter *adapter = netdev_priv(netdev);
5972
5973 netif_device_detach(netdev);
5974
Alexander Duyck59ed6ee2009-06-30 12:46:34 +00005975 if (state == pci_channel_io_perm_failure)
5976 return PCI_ERS_RESULT_DISCONNECT;
5977
Auke Kok9d5c8242008-01-24 02:22:38 -08005978 if (netif_running(netdev))
5979 igb_down(adapter);
5980 pci_disable_device(pdev);
5981
5982 /* Request a slot slot reset. */
5983 return PCI_ERS_RESULT_NEED_RESET;
5984}
5985
5986/**
5987 * igb_io_slot_reset - called after the pci bus has been reset.
5988 * @pdev: Pointer to PCI device
5989 *
5990 * Restart the card from scratch, as if from a cold-boot. Implementation
5991 * resembles the first-half of the igb_resume routine.
5992 */
5993static pci_ers_result_t igb_io_slot_reset(struct pci_dev *pdev)
5994{
5995 struct net_device *netdev = pci_get_drvdata(pdev);
5996 struct igb_adapter *adapter = netdev_priv(netdev);
5997 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck40a914f2008-11-27 00:24:37 -08005998 pci_ers_result_t result;
Taku Izumi42bfd33a2008-06-20 12:10:30 +09005999 int err;
Auke Kok9d5c8242008-01-24 02:22:38 -08006000
Alexander Duyckaed5dec2009-02-06 23:16:04 +00006001 if (pci_enable_device_mem(pdev)) {
Auke Kok9d5c8242008-01-24 02:22:38 -08006002 dev_err(&pdev->dev,
6003 "Cannot re-enable PCI device after reset.\n");
Alexander Duyck40a914f2008-11-27 00:24:37 -08006004 result = PCI_ERS_RESULT_DISCONNECT;
6005 } else {
6006 pci_set_master(pdev);
6007 pci_restore_state(pdev);
Nick Nunleyb94f2d72010-02-17 01:02:19 +00006008 pci_save_state(pdev);
Alexander Duyck40a914f2008-11-27 00:24:37 -08006009
6010 pci_enable_wake(pdev, PCI_D3hot, 0);
6011 pci_enable_wake(pdev, PCI_D3cold, 0);
6012
6013 igb_reset(adapter);
6014 wr32(E1000_WUS, ~0);
6015 result = PCI_ERS_RESULT_RECOVERED;
Auke Kok9d5c8242008-01-24 02:22:38 -08006016 }
Auke Kok9d5c8242008-01-24 02:22:38 -08006017
Jeff Kirsherea943d42008-12-11 20:34:19 -08006018 err = pci_cleanup_aer_uncorrect_error_status(pdev);
6019 if (err) {
6020 dev_err(&pdev->dev, "pci_cleanup_aer_uncorrect_error_status "
6021 "failed 0x%0x\n", err);
6022 /* non-fatal, continue */
6023 }
Auke Kok9d5c8242008-01-24 02:22:38 -08006024
Alexander Duyck40a914f2008-11-27 00:24:37 -08006025 return result;
Auke Kok9d5c8242008-01-24 02:22:38 -08006026}
6027
6028/**
6029 * igb_io_resume - called when traffic can start flowing again.
6030 * @pdev: Pointer to PCI device
6031 *
6032 * This callback is called when the error recovery driver tells us that
6033 * its OK to resume normal operation. Implementation resembles the
6034 * second-half of the igb_resume routine.
6035 */
6036static void igb_io_resume(struct pci_dev *pdev)
6037{
6038 struct net_device *netdev = pci_get_drvdata(pdev);
6039 struct igb_adapter *adapter = netdev_priv(netdev);
6040
Auke Kok9d5c8242008-01-24 02:22:38 -08006041 if (netif_running(netdev)) {
6042 if (igb_up(adapter)) {
6043 dev_err(&pdev->dev, "igb_up failed after reset\n");
6044 return;
6045 }
6046 }
6047
6048 netif_device_attach(netdev);
6049
6050 /* let the f/w know that the h/w is now under the control of the
6051 * driver. */
6052 igb_get_hw_control(adapter);
Auke Kok9d5c8242008-01-24 02:22:38 -08006053}
6054
Alexander Duyck26ad9172009-10-05 06:32:49 +00006055static void igb_rar_set_qsel(struct igb_adapter *adapter, u8 *addr, u32 index,
6056 u8 qsel)
6057{
6058 u32 rar_low, rar_high;
6059 struct e1000_hw *hw = &adapter->hw;
6060
6061 /* HW expects these in little endian so we reverse the byte order
6062 * from network order (big endian) to little endian
6063 */
6064 rar_low = ((u32) addr[0] | ((u32) addr[1] << 8) |
6065 ((u32) addr[2] << 16) | ((u32) addr[3] << 24));
6066 rar_high = ((u32) addr[4] | ((u32) addr[5] << 8));
6067
6068 /* Indicate to hardware the Address is Valid. */
6069 rar_high |= E1000_RAH_AV;
6070
6071 if (hw->mac.type == e1000_82575)
6072 rar_high |= E1000_RAH_POOL_1 * qsel;
6073 else
6074 rar_high |= E1000_RAH_POOL_1 << qsel;
6075
6076 wr32(E1000_RAL(index), rar_low);
6077 wrfl();
6078 wr32(E1000_RAH(index), rar_high);
6079 wrfl();
6080}
6081
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006082static int igb_set_vf_mac(struct igb_adapter *adapter,
6083 int vf, unsigned char *mac_addr)
6084{
6085 struct e1000_hw *hw = &adapter->hw;
Alexander Duyckff41f8d2009-09-03 14:48:56 +00006086 /* VF MAC addresses start at end of receive addresses and moves
6087 * torwards the first, as a result a collision should not be possible */
6088 int rar_entry = hw->mac.rar_entry_count - (vf + 1);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006089
Alexander Duyck37680112009-02-19 20:40:30 -08006090 memcpy(adapter->vf_data[vf].vf_mac_addresses, mac_addr, ETH_ALEN);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006091
Alexander Duyck26ad9172009-10-05 06:32:49 +00006092 igb_rar_set_qsel(adapter, mac_addr, rar_entry, vf);
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006093
6094 return 0;
6095}
6096
Williams, Mitch A8151d292010-02-10 01:44:24 +00006097static int igb_ndo_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
6098{
6099 struct igb_adapter *adapter = netdev_priv(netdev);
6100 if (!is_valid_ether_addr(mac) || (vf >= adapter->vfs_allocated_count))
6101 return -EINVAL;
6102 adapter->vf_data[vf].flags |= IGB_VF_FLAG_PF_SET_MAC;
6103 dev_info(&adapter->pdev->dev, "setting MAC %pM on VF %d\n", mac, vf);
6104 dev_info(&adapter->pdev->dev, "Reload the VF driver to make this"
6105 " change effective.");
6106 if (test_bit(__IGB_DOWN, &adapter->state)) {
6107 dev_warn(&adapter->pdev->dev, "The VF MAC address has been set,"
6108 " but the PF device is not up.\n");
6109 dev_warn(&adapter->pdev->dev, "Bring the PF device up before"
6110 " attempting to use the VF device.\n");
6111 }
6112 return igb_set_vf_mac(adapter, vf, mac);
6113}
6114
6115static int igb_ndo_set_vf_bw(struct net_device *netdev, int vf, int tx_rate)
6116{
6117 return -EOPNOTSUPP;
6118}
6119
6120static int igb_ndo_get_vf_config(struct net_device *netdev,
6121 int vf, struct ifla_vf_info *ivi)
6122{
6123 struct igb_adapter *adapter = netdev_priv(netdev);
6124 if (vf >= adapter->vfs_allocated_count)
6125 return -EINVAL;
6126 ivi->vf = vf;
6127 memcpy(&ivi->mac, adapter->vf_data[vf].vf_mac_addresses, ETH_ALEN);
6128 ivi->tx_rate = 0;
6129 ivi->vlan = adapter->vf_data[vf].pf_vlan;
6130 ivi->qos = adapter->vf_data[vf].pf_qos;
6131 return 0;
6132}
6133
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006134static void igb_vmm_control(struct igb_adapter *adapter)
6135{
6136 struct e1000_hw *hw = &adapter->hw;
Alexander Duyck10d8e902009-10-27 15:54:04 +00006137 u32 reg;
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006138
Alexander Duyckd4960302009-10-27 15:53:45 +00006139 /* replication is not supported for 82575 */
6140 if (hw->mac.type == e1000_82575)
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006141 return;
6142
Alexander Duyck10d8e902009-10-27 15:54:04 +00006143 /* enable replication vlan tag stripping */
6144 reg = rd32(E1000_RPLOLR);
6145 reg |= E1000_RPLOLR_STRVLAN;
6146 wr32(E1000_RPLOLR, reg);
6147
6148 /* notify HW that the MAC is adding vlan tags */
6149 reg = rd32(E1000_DTXCTL);
6150 reg |= E1000_DTXCTL_VLAN_ADDED;
6151 wr32(E1000_DTXCTL, reg);
6152
Alexander Duyckd4960302009-10-27 15:53:45 +00006153 if (adapter->vfs_allocated_count) {
6154 igb_vmdq_set_loopback_pf(hw, true);
6155 igb_vmdq_set_replication_pf(hw, true);
6156 } else {
6157 igb_vmdq_set_loopback_pf(hw, false);
6158 igb_vmdq_set_replication_pf(hw, false);
6159 }
Alexander Duyck4ae196d2009-02-19 20:40:07 -08006160}
6161
Auke Kok9d5c8242008-01-24 02:22:38 -08006162/* igb_main.c */