e1000_main.c 148.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*******************************************************************************

3 4 5 6 7 8 9 10 11 12
  Intel PRO/1000 Linux driver
  Copyright(c) 1999 - 2006 Intel Corporation.

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

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

L
Linus Torvalds 已提交
15
  You should have received a copy of the GNU General Public License along with
16 17 18 19 20 21
  this program; if not, write to the Free Software Foundation, Inc.,
  51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.

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

L
Linus Torvalds 已提交
22 23
  Contact Information:
  Linux NICS <linux.nics@intel.com>
24
  e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
L
Linus Torvalds 已提交
25 26 27 28 29
  Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497

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

#include "e1000.h"
A
Andrew Morton 已提交
30
#include <net/ip6_checksum.h>
L
Linus Torvalds 已提交
31 32

char e1000_driver_name[] = "e1000";
33
static char e1000_driver_string[] = "Intel(R) PRO/1000 Network Driver";
L
Linus Torvalds 已提交
34 35 36 37 38
#ifndef CONFIG_E1000_NAPI
#define DRIVERNAPI
#else
#define DRIVERNAPI "-NAPI"
#endif
A
Auke Kok 已提交
39
#define DRV_VERSION "7.3.20-k2"DRIVERNAPI
S
Stephen Hemminger 已提交
40 41
const char e1000_driver_version[] = DRV_VERSION;
static const char e1000_copyright[] = "Copyright (c) 1999-2006 Intel Corporation.";
L
Linus Torvalds 已提交
42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69

/* e1000_pci_tbl - PCI Device ID Table
 *
 * Last entry must be all 0s
 *
 * Macro expands to...
 *   {PCI_DEVICE(PCI_VENDOR_ID_INTEL, device_id)}
 */
static struct pci_device_id e1000_pci_tbl[] = {
	INTEL_E1000_ETHERNET_DEVICE(0x1000),
	INTEL_E1000_ETHERNET_DEVICE(0x1001),
	INTEL_E1000_ETHERNET_DEVICE(0x1004),
	INTEL_E1000_ETHERNET_DEVICE(0x1008),
	INTEL_E1000_ETHERNET_DEVICE(0x1009),
	INTEL_E1000_ETHERNET_DEVICE(0x100C),
	INTEL_E1000_ETHERNET_DEVICE(0x100D),
	INTEL_E1000_ETHERNET_DEVICE(0x100E),
	INTEL_E1000_ETHERNET_DEVICE(0x100F),
	INTEL_E1000_ETHERNET_DEVICE(0x1010),
	INTEL_E1000_ETHERNET_DEVICE(0x1011),
	INTEL_E1000_ETHERNET_DEVICE(0x1012),
	INTEL_E1000_ETHERNET_DEVICE(0x1013),
	INTEL_E1000_ETHERNET_DEVICE(0x1014),
	INTEL_E1000_ETHERNET_DEVICE(0x1015),
	INTEL_E1000_ETHERNET_DEVICE(0x1016),
	INTEL_E1000_ETHERNET_DEVICE(0x1017),
	INTEL_E1000_ETHERNET_DEVICE(0x1018),
	INTEL_E1000_ETHERNET_DEVICE(0x1019),
70
	INTEL_E1000_ETHERNET_DEVICE(0x101A),
L
Linus Torvalds 已提交
71 72 73 74 75 76 77 78 79 80 81 82 83 84
	INTEL_E1000_ETHERNET_DEVICE(0x101D),
	INTEL_E1000_ETHERNET_DEVICE(0x101E),
	INTEL_E1000_ETHERNET_DEVICE(0x1026),
	INTEL_E1000_ETHERNET_DEVICE(0x1027),
	INTEL_E1000_ETHERNET_DEVICE(0x1028),
	INTEL_E1000_ETHERNET_DEVICE(0x1075),
	INTEL_E1000_ETHERNET_DEVICE(0x1076),
	INTEL_E1000_ETHERNET_DEVICE(0x1077),
	INTEL_E1000_ETHERNET_DEVICE(0x1078),
	INTEL_E1000_ETHERNET_DEVICE(0x1079),
	INTEL_E1000_ETHERNET_DEVICE(0x107A),
	INTEL_E1000_ETHERNET_DEVICE(0x107B),
	INTEL_E1000_ETHERNET_DEVICE(0x107C),
	INTEL_E1000_ETHERNET_DEVICE(0x108A),
85 86
	INTEL_E1000_ETHERNET_DEVICE(0x1099),
	INTEL_E1000_ETHERNET_DEVICE(0x10B5),
L
Linus Torvalds 已提交
87 88 89 90 91 92
	/* required last entry */
	{0,}
};

MODULE_DEVICE_TABLE(pci, e1000_pci_tbl);

93 94 95 96
int e1000_up(struct e1000_adapter *adapter);
void e1000_down(struct e1000_adapter *adapter);
void e1000_reinit_locked(struct e1000_adapter *adapter);
void e1000_reset(struct e1000_adapter *adapter);
97
int e1000_set_spd_dplx(struct e1000_adapter *adapter, u16 spddplx);
98 99 100 101
int e1000_setup_all_tx_resources(struct e1000_adapter *adapter);
int e1000_setup_all_rx_resources(struct e1000_adapter *adapter);
void e1000_free_all_tx_resources(struct e1000_adapter *adapter);
void e1000_free_all_rx_resources(struct e1000_adapter *adapter);
102
static int e1000_setup_tx_resources(struct e1000_adapter *adapter,
103
                             struct e1000_tx_ring *txdr);
104
static int e1000_setup_rx_resources(struct e1000_adapter *adapter,
105
                             struct e1000_rx_ring *rxdr);
106
static void e1000_free_tx_resources(struct e1000_adapter *adapter,
107
                             struct e1000_tx_ring *tx_ring);
108
static void e1000_free_rx_resources(struct e1000_adapter *adapter,
109 110
                             struct e1000_rx_ring *rx_ring);
void e1000_update_stats(struct e1000_adapter *adapter);
L
Linus Torvalds 已提交
111 112 113 114 115

static int e1000_init_module(void);
static void e1000_exit_module(void);
static int e1000_probe(struct pci_dev *pdev, const struct pci_device_id *ent);
static void __devexit e1000_remove(struct pci_dev *pdev);
116
static int e1000_alloc_queues(struct e1000_adapter *adapter);
L
Linus Torvalds 已提交
117 118 119 120 121 122
static int e1000_sw_init(struct e1000_adapter *adapter);
static int e1000_open(struct net_device *netdev);
static int e1000_close(struct net_device *netdev);
static void e1000_configure_tx(struct e1000_adapter *adapter);
static void e1000_configure_rx(struct e1000_adapter *adapter);
static void e1000_setup_rctl(struct e1000_adapter *adapter);
123 124 125 126 127 128
static void e1000_clean_all_tx_rings(struct e1000_adapter *adapter);
static void e1000_clean_all_rx_rings(struct e1000_adapter *adapter);
static void e1000_clean_tx_ring(struct e1000_adapter *adapter,
                                struct e1000_tx_ring *tx_ring);
static void e1000_clean_rx_ring(struct e1000_adapter *adapter,
                                struct e1000_rx_ring *rx_ring);
129
static void e1000_set_rx_mode(struct net_device *netdev);
L
Linus Torvalds 已提交
130 131 132 133 134 135 136
static void e1000_update_phy_info(unsigned long data);
static void e1000_watchdog(unsigned long data);
static void e1000_82547_tx_fifo_stall(unsigned long data);
static int e1000_xmit_frame(struct sk_buff *skb, struct net_device *netdev);
static struct net_device_stats * e1000_get_stats(struct net_device *netdev);
static int e1000_change_mtu(struct net_device *netdev, int new_mtu);
static int e1000_set_mac(struct net_device *netdev, void *p);
137
static irqreturn_t e1000_intr(int irq, void *data);
138
static irqreturn_t e1000_intr_msi(int irq, void *data);
J
Joe Perches 已提交
139 140
static bool e1000_clean_tx_irq(struct e1000_adapter *adapter,
			       struct e1000_tx_ring *tx_ring);
L
Linus Torvalds 已提交
141
#ifdef CONFIG_E1000_NAPI
142
static int e1000_clean(struct napi_struct *napi, int budget);
J
Joe Perches 已提交
143 144 145 146 147 148
static bool e1000_clean_rx_irq(struct e1000_adapter *adapter,
			       struct e1000_rx_ring *rx_ring,
			       int *work_done, int work_to_do);
static bool e1000_clean_rx_irq_ps(struct e1000_adapter *adapter,
				  struct e1000_rx_ring *rx_ring,
				  int *work_done, int work_to_do);
L
Linus Torvalds 已提交
149
#else
J
Joe Perches 已提交
150 151 152 153
static bool e1000_clean_rx_irq(struct e1000_adapter *adapter,
			       struct e1000_rx_ring *rx_ring);
static bool e1000_clean_rx_irq_ps(struct e1000_adapter *adapter,
				  struct e1000_rx_ring *rx_ring);
L
Linus Torvalds 已提交
154
#endif
155
static void e1000_alloc_rx_buffers(struct e1000_adapter *adapter,
156 157
                                   struct e1000_rx_ring *rx_ring,
				   int cleaned_count);
158
static void e1000_alloc_rx_buffers_ps(struct e1000_adapter *adapter,
159 160
                                      struct e1000_rx_ring *rx_ring,
				      int cleaned_count);
L
Linus Torvalds 已提交
161 162 163 164 165 166
static int e1000_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd);
static int e1000_mii_ioctl(struct net_device *netdev, struct ifreq *ifr,
			   int cmd);
static void e1000_enter_82542_rst(struct e1000_adapter *adapter);
static void e1000_leave_82542_rst(struct e1000_adapter *adapter);
static void e1000_tx_timeout(struct net_device *dev);
167
static void e1000_reset_task(struct work_struct *work);
L
Linus Torvalds 已提交
168
static void e1000_smartspeed(struct e1000_adapter *adapter);
169 170
static int e1000_82547_fifo_workaround(struct e1000_adapter *adapter,
                                       struct sk_buff *skb);
L
Linus Torvalds 已提交
171 172

static void e1000_vlan_rx_register(struct net_device *netdev, struct vlan_group *grp);
173 174
static void e1000_vlan_rx_add_vid(struct net_device *netdev, u16 vid);
static void e1000_vlan_rx_kill_vid(struct net_device *netdev, u16 vid);
L
Linus Torvalds 已提交
175 176
static void e1000_restore_vlan(struct e1000_adapter *adapter);

177
static int e1000_suspend(struct pci_dev *pdev, pm_message_t state);
A
Auke Kok 已提交
178
#ifdef CONFIG_PM
L
Linus Torvalds 已提交
179 180
static int e1000_resume(struct pci_dev *pdev);
#endif
181
static void e1000_shutdown(struct pci_dev *pdev);
L
Linus Torvalds 已提交
182 183 184 185 186 187

#ifdef CONFIG_NET_POLL_CONTROLLER
/* for netdump / net console */
static void e1000_netpoll (struct net_device *netdev);
#endif

188 189 190 191 192 193
#define COPYBREAK_DEFAULT 256
static unsigned int copybreak __read_mostly = COPYBREAK_DEFAULT;
module_param(copybreak, uint, 0644);
MODULE_PARM_DESC(copybreak,
	"Maximum size of packet that is copied to a new buffer on receive");

A
Auke Kok 已提交
194 195 196 197 198 199 200 201 202 203
static pci_ers_result_t e1000_io_error_detected(struct pci_dev *pdev,
                     pci_channel_state_t state);
static pci_ers_result_t e1000_io_slot_reset(struct pci_dev *pdev);
static void e1000_io_resume(struct pci_dev *pdev);

static struct pci_error_handlers e1000_err_handler = {
	.error_detected = e1000_io_error_detected,
	.slot_reset = e1000_io_slot_reset,
	.resume = e1000_io_resume,
};
204

L
Linus Torvalds 已提交
205 206 207 208 209
static struct pci_driver e1000_driver = {
	.name     = e1000_driver_name,
	.id_table = e1000_pci_tbl,
	.probe    = e1000_probe,
	.remove   = __devexit_p(e1000_remove),
210
#ifdef CONFIG_PM
L
Linus Torvalds 已提交
211 212
	/* Power Managment Hooks */
	.suspend  = e1000_suspend,
213
	.resume   = e1000_resume,
L
Linus Torvalds 已提交
214
#endif
A
Auke Kok 已提交
215 216
	.shutdown = e1000_shutdown,
	.err_handler = &e1000_err_handler
L
Linus Torvalds 已提交
217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234
};

MODULE_AUTHOR("Intel Corporation, <linux.nics@intel.com>");
MODULE_DESCRIPTION("Intel(R) PRO/1000 Network Driver");
MODULE_LICENSE("GPL");
MODULE_VERSION(DRV_VERSION);

static int debug = NETIF_MSG_DRV | NETIF_MSG_PROBE;
module_param(debug, int, 0);
MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");

/**
 * e1000_init_module - Driver Registration Routine
 *
 * e1000_init_module is the first routine called when the driver is
 * loaded. All it does is register with the PCI subsystem.
 **/

235
static int __init e1000_init_module(void)
L
Linus Torvalds 已提交
236 237 238 239 240 241 242
{
	int ret;
	printk(KERN_INFO "%s - version %s\n",
	       e1000_driver_string, e1000_driver_version);

	printk(KERN_INFO "%s\n", e1000_copyright);

243
	ret = pci_register_driver(&e1000_driver);
244 245 246 247 248 249 250
	if (copybreak != COPYBREAK_DEFAULT) {
		if (copybreak == 0)
			printk(KERN_INFO "e1000: copybreak disabled\n");
		else
			printk(KERN_INFO "e1000: copybreak enabled for "
			       "packets <= %u bytes\n", copybreak);
	}
L
Linus Torvalds 已提交
251 252 253 254 255 256 257 258 259 260 261 262
	return ret;
}

module_init(e1000_init_module);

/**
 * e1000_exit_module - Driver Exit Cleanup Routine
 *
 * e1000_exit_module is called just before the driver is removed
 * from memory.
 **/

263
static void __exit e1000_exit_module(void)
L
Linus Torvalds 已提交
264 265 266 267 268 269
{
	pci_unregister_driver(&e1000_driver);
}

module_exit(e1000_exit_module);

270 271
static int e1000_request_irq(struct e1000_adapter *adapter)
{
J
Joe Perches 已提交
272
	struct e1000_hw *hw = &adapter->hw;
273
	struct net_device *netdev = adapter->netdev;
A
Al Viro 已提交
274
	irq_handler_t handler = e1000_intr;
275 276
	int irq_flags = IRQF_SHARED;
	int err;
277

J
Joe Perches 已提交
278
	if (hw->mac_type >= e1000_82571) {
279 280
		adapter->have_msi = !pci_enable_msi(adapter->pdev);
		if (adapter->have_msi) {
A
Al Viro 已提交
281
			handler = e1000_intr_msi;
282
			irq_flags = 0;
283 284
		}
	}
285 286 287 288 289 290

	err = request_irq(adapter->pdev->irq, handler, irq_flags, netdev->name,
	                  netdev);
	if (err) {
		if (adapter->have_msi)
			pci_disable_msi(adapter->pdev);
291 292
		DPRINTK(PROBE, ERR,
		        "Unable to allocate interrupt Error: %d\n", err);
293
	}
294 295 296 297 298 299 300 301 302 303 304 305 306 307

	return err;
}

static void e1000_free_irq(struct e1000_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;

	free_irq(adapter->pdev->irq, netdev);

	if (adapter->have_msi)
		pci_disable_msi(adapter->pdev);
}

L
Linus Torvalds 已提交
308 309 310 311 312
/**
 * e1000_irq_disable - Mask off interrupt generation on the NIC
 * @adapter: board private structure
 **/

313
static void e1000_irq_disable(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
314
{
J
Joe Perches 已提交
315 316 317 318
	struct e1000_hw *hw = &adapter->hw;

	ew32(IMC, ~0);
	E1000_WRITE_FLUSH();
L
Linus Torvalds 已提交
319 320 321 322 323 324 325 326
	synchronize_irq(adapter->pdev->irq);
}

/**
 * e1000_irq_enable - Enable default interrupt generation settings
 * @adapter: board private structure
 **/

327
static void e1000_irq_enable(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
328
{
J
Joe Perches 已提交
329 330 331 332
	struct e1000_hw *hw = &adapter->hw;

	ew32(IMS, IMS_ENABLE_MASK);
	E1000_WRITE_FLUSH();
L
Linus Torvalds 已提交
333
}
334

335
static void e1000_update_mng_vlan(struct e1000_adapter *adapter)
336
{
J
Joe Perches 已提交
337
	struct e1000_hw *hw = &adapter->hw;
338
	struct net_device *netdev = adapter->netdev;
J
Joe Perches 已提交
339
	u16 vid = hw->mng_cookie.vlan_id;
340
	u16 old_vid = adapter->mng_vlan_id;
J
Jesse Brandeburg 已提交
341
	if (adapter->vlgrp) {
D
Dan Aloni 已提交
342
		if (!vlan_group_get_device(adapter->vlgrp, vid)) {
J
Joe Perches 已提交
343
			if (hw->mng_cookie.status &
344 345 346 347 348
				E1000_MNG_DHCP_COOKIE_STATUS_VLAN_SUPPORT) {
				e1000_vlan_rx_add_vid(netdev, vid);
				adapter->mng_vlan_id = vid;
			} else
				adapter->mng_vlan_id = E1000_MNG_VLAN_NONE;
J
Jesse Brandeburg 已提交
349

350
			if ((old_vid != (u16)E1000_MNG_VLAN_NONE) &&
J
Jesse Brandeburg 已提交
351
					(vid != old_vid) &&
D
Dan Aloni 已提交
352
			    !vlan_group_get_device(adapter->vlgrp, old_vid))
353
				e1000_vlan_rx_kill_vid(netdev, old_vid);
354 355
		} else
			adapter->mng_vlan_id = vid;
356 357
	}
}
358 359 360 361 362 363 364 365

/**
 * e1000_release_hw_control - release control of the h/w to f/w
 * @adapter: address of board private structure
 *
 * e1000_release_hw_control resets {CTRL_EXT|FWSM}:DRV_LOAD bit.
 * For ASF and Pass Through versions of f/w this means that the
 * driver is no longer loaded. For AMT version (only with 82573) i
366
 * of the f/w this means that the network i/f is closed.
367
 *
368 369
 **/

370
static void e1000_release_hw_control(struct e1000_adapter *adapter)
371
{
372 373
	u32 ctrl_ext;
	u32 swsm;
J
Joe Perches 已提交
374
	struct e1000_hw *hw = &adapter->hw;
375 376

	/* Let firmware taken over control of h/w */
J
Joe Perches 已提交
377
	switch (hw->mac_type) {
378
	case e1000_82573:
J
Joe Perches 已提交
379 380
		swsm = er32(SWSM);
		ew32(SWSM, swsm & ~E1000_SWSM_DRV_LOAD);
B
Bruce Allan 已提交
381 382 383 384
		break;
	case e1000_82571:
	case e1000_82572:
	case e1000_80003es2lan:
385
	case e1000_ich8lan:
J
Joe Perches 已提交
386 387
		ctrl_ext = er32(CTRL_EXT);
		ew32(CTRL_EXT, ctrl_ext & ~E1000_CTRL_EXT_DRV_LOAD);
388
		break;
389 390 391 392 393 394 395 396 397 398
	default:
		break;
	}
}

/**
 * e1000_get_hw_control - get control of the h/w from f/w
 * @adapter: address of board private structure
 *
 * e1000_get_hw_control sets {CTRL_EXT|FWSM}:DRV_LOAD bit.
399 400
 * For ASF and Pass Through versions of f/w this means that
 * the driver is loaded. For AMT version (only with 82573)
401
 * of the f/w this means that the network i/f is open.
402
 *
403 404
 **/

405
static void e1000_get_hw_control(struct e1000_adapter *adapter)
406
{
407 408
	u32 ctrl_ext;
	u32 swsm;
J
Joe Perches 已提交
409
	struct e1000_hw *hw = &adapter->hw;
410

411
	/* Let firmware know the driver has taken over */
J
Joe Perches 已提交
412
	switch (hw->mac_type) {
413
	case e1000_82573:
J
Joe Perches 已提交
414 415
		swsm = er32(SWSM);
		ew32(SWSM, swsm | E1000_SWSM_DRV_LOAD);
416
		break;
B
Bruce Allan 已提交
417 418 419
	case e1000_82571:
	case e1000_82572:
	case e1000_80003es2lan:
420
	case e1000_ich8lan:
J
Joe Perches 已提交
421 422
		ctrl_ext = er32(CTRL_EXT);
		ew32(CTRL_EXT, ctrl_ext | E1000_CTRL_EXT_DRV_LOAD);
423
		break;
424 425 426 427 428
	default:
		break;
	}
}

429
static void e1000_init_manageability(struct e1000_adapter *adapter)
430
{
J
Joe Perches 已提交
431 432
	struct e1000_hw *hw = &adapter->hw;

433
	if (adapter->en_mng_pt) {
J
Joe Perches 已提交
434
		u32 manc = er32(MANC);
435 436 437 438 439 440 441

		/* disable hardware interception of ARP */
		manc &= ~(E1000_MANC_ARP_EN);

		/* enable receiving management packets to the host */
		/* this will probably generate destination unreachable messages
		 * from the host OS, but the packets will be handled on SMBUS */
J
Joe Perches 已提交
442 443
		if (hw->has_manc2h) {
			u32 manc2h = er32(MANC2H);
444 445 446 447 448 449

			manc |= E1000_MANC_EN_MNG2HOST;
#define E1000_MNG2HOST_PORT_623 (1 << 5)
#define E1000_MNG2HOST_PORT_664 (1 << 6)
			manc2h |= E1000_MNG2HOST_PORT_623;
			manc2h |= E1000_MNG2HOST_PORT_664;
J
Joe Perches 已提交
450
			ew32(MANC2H, manc2h);
451 452
		}

J
Joe Perches 已提交
453
		ew32(MANC, manc);
454 455 456
	}
}

457
static void e1000_release_manageability(struct e1000_adapter *adapter)
458
{
J
Joe Perches 已提交
459 460
	struct e1000_hw *hw = &adapter->hw;

461
	if (adapter->en_mng_pt) {
J
Joe Perches 已提交
462
		u32 manc = er32(MANC);
463 464 465 466

		/* re-enable hardware interception of ARP */
		manc |= E1000_MANC_ARP_EN;

J
Joe Perches 已提交
467
		if (hw->has_manc2h)
468 469 470 471 472
			manc &= ~E1000_MANC_EN_MNG2HOST;

		/* don't explicitly have to mess with MANC2H since
		 * MANC has an enable disable that gates MANC2H */

J
Joe Perches 已提交
473
		ew32(MANC, manc);
474 475 476
	}
}

477 478 479 480 481
/**
 * e1000_configure - configure the hardware for RX and TX
 * @adapter = private board structure
 **/
static void e1000_configure(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
482 483
{
	struct net_device *netdev = adapter->netdev;
484
	int i;
L
Linus Torvalds 已提交
485

486
	e1000_set_rx_mode(netdev);
L
Linus Torvalds 已提交
487 488

	e1000_restore_vlan(adapter);
489
	e1000_init_manageability(adapter);
L
Linus Torvalds 已提交
490 491 492 493

	e1000_configure_tx(adapter);
	e1000_setup_rctl(adapter);
	e1000_configure_rx(adapter);
494 495 496
	/* call E1000_DESC_UNUSED which always leaves
	 * at least 1 descriptor unused to make sure
	 * next_to_use != next_to_clean */
497
	for (i = 0; i < adapter->num_rx_queues; i++) {
498
		struct e1000_rx_ring *ring = &adapter->rx_ring[i];
499 500
		adapter->alloc_rx_buf(adapter, ring,
		                      E1000_DESC_UNUSED(ring));
501
	}
L
Linus Torvalds 已提交
502

503
	adapter->tx_queue_len = netdev->tx_queue_len;
504 505 506 507
}

int e1000_up(struct e1000_adapter *adapter)
{
J
Joe Perches 已提交
508 509
	struct e1000_hw *hw = &adapter->hw;

510 511 512 513
	/* hardware has been reset, we need to reload some things */
	e1000_configure(adapter);

	clear_bit(__E1000_DOWN, &adapter->flags);
514

L
Linus Torvalds 已提交
515
#ifdef CONFIG_E1000_NAPI
516
	napi_enable(&adapter->napi);
L
Linus Torvalds 已提交
517
#endif
518 519
	e1000_irq_enable(adapter);

520
	/* fire a link change interrupt to start the watchdog */
J
Joe Perches 已提交
521
	ew32(ICS, E1000_ICS_LSC);
L
Linus Torvalds 已提交
522 523 524
	return 0;
}

525 526 527 528 529 530 531 532 533 534
/**
 * e1000_power_up_phy - restore link in case the phy was powered down
 * @adapter: address of board private structure
 *
 * The phy may be powered down to save power and turn off link when the
 * driver is unloaded and wake on lan is not enabled (among others)
 * *** this routine MUST be followed by a call to e1000_reset ***
 *
 **/

535
void e1000_power_up_phy(struct e1000_adapter *adapter)
536
{
J
Joe Perches 已提交
537
	struct e1000_hw *hw = &adapter->hw;
538
	u16 mii_reg = 0;
539 540

	/* Just clear the power down bit to wake the phy back up */
J
Joe Perches 已提交
541
	if (hw->media_type == e1000_media_type_copper) {
542 543
		/* according to the manual, the phy will retain its
		 * settings across a power-down/up cycle */
J
Joe Perches 已提交
544
		e1000_read_phy_reg(hw, PHY_CTRL, &mii_reg);
545
		mii_reg &= ~MII_CR_POWER_DOWN;
J
Joe Perches 已提交
546
		e1000_write_phy_reg(hw, PHY_CTRL, mii_reg);
547 548 549 550 551
	}
}

static void e1000_power_down_phy(struct e1000_adapter *adapter)
{
J
Joe Perches 已提交
552 553
	struct e1000_hw *hw = &adapter->hw;

554
	/* Power down the PHY so no link is implied when interface is down *
J
Joe Perches 已提交
555
	 * The PHY cannot be powered down if any of the following is true *
556 557 558
	 * (a) WoL is enabled
	 * (b) AMT is active
	 * (c) SoL/IDER session is active */
J
Joe Perches 已提交
559 560
	if (!adapter->wol && hw->mac_type >= e1000_82540 &&
	   hw->media_type == e1000_media_type_copper) {
561
		u16 mii_reg = 0;
562

J
Joe Perches 已提交
563
		switch (hw->mac_type) {
564 565 566 567 568 569 570 571 572
		case e1000_82540:
		case e1000_82545:
		case e1000_82545_rev_3:
		case e1000_82546:
		case e1000_82546_rev_3:
		case e1000_82541:
		case e1000_82541_rev_2:
		case e1000_82547:
		case e1000_82547_rev_2:
J
Joe Perches 已提交
573
			if (er32(MANC) & E1000_MANC_SMBUS_EN)
574 575 576 577 578 579 580
				goto out;
			break;
		case e1000_82571:
		case e1000_82572:
		case e1000_82573:
		case e1000_80003es2lan:
		case e1000_ich8lan:
J
Joe Perches 已提交
581 582
			if (e1000_check_mng_mode(hw) ||
			    e1000_check_phy_reset_block(hw))
583 584 585 586 587
				goto out;
			break;
		default:
			goto out;
		}
J
Joe Perches 已提交
588
		e1000_read_phy_reg(hw, PHY_CTRL, &mii_reg);
589
		mii_reg |= MII_CR_POWER_DOWN;
J
Joe Perches 已提交
590
		e1000_write_phy_reg(hw, PHY_CTRL, mii_reg);
591 592
		mdelay(1);
	}
593 594
out:
	return;
595 596
}

597
void e1000_down(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
598 599 600
{
	struct net_device *netdev = adapter->netdev;

A
Auke Kok 已提交
601 602 603 604
	/* signal that we're down so the interrupt handler does not
	 * reschedule our watchdog timer */
	set_bit(__E1000_DOWN, &adapter->flags);

605
#ifdef CONFIG_E1000_NAPI
606
	napi_disable(&adapter->napi);
607
#endif
L
Linus Torvalds 已提交
608
	e1000_irq_disable(adapter);
609

L
Linus Torvalds 已提交
610 611 612 613
	del_timer_sync(&adapter->tx_fifo_stall_timer);
	del_timer_sync(&adapter->watchdog_timer);
	del_timer_sync(&adapter->phy_info_timer);

614
	netdev->tx_queue_len = adapter->tx_queue_len;
L
Linus Torvalds 已提交
615 616 617 618 619 620
	adapter->link_speed = 0;
	adapter->link_duplex = 0;
	netif_carrier_off(netdev);
	netif_stop_queue(netdev);

	e1000_reset(adapter);
621 622
	e1000_clean_all_tx_rings(adapter);
	e1000_clean_all_rx_rings(adapter);
L
Linus Torvalds 已提交
623 624
}

625
void e1000_reinit_locked(struct e1000_adapter *adapter)
626 627 628 629 630 631 632
{
	WARN_ON(in_interrupt());
	while (test_and_set_bit(__E1000_RESETTING, &adapter->flags))
		msleep(1);
	e1000_down(adapter);
	e1000_up(adapter);
	clear_bit(__E1000_RESETTING, &adapter->flags);
L
Linus Torvalds 已提交
633 634
}

635
void e1000_reset(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
636
{
J
Joe Perches 已提交
637
	struct e1000_hw *hw = &adapter->hw;
638 639
	u32 pba = 0, tx_space, min_tx_space, min_rx_space;
	u16 fc_high_water_mark = E1000_FC_HIGH_DIFF;
J
Joe Perches 已提交
640
	bool legacy_pba_adjust = false;
L
Linus Torvalds 已提交
641 642 643 644 645

	/* Repartition Pba for greater than 9k mtu
	 * To take effect CTRL.RST is required.
	 */

J
Joe Perches 已提交
646
	switch (hw->mac_type) {
647 648 649 650 651 652 653
	case e1000_82542_rev2_0:
	case e1000_82542_rev2_1:
	case e1000_82543:
	case e1000_82544:
	case e1000_82540:
	case e1000_82541:
	case e1000_82541_rev_2:
J
Joe Perches 已提交
654
		legacy_pba_adjust = true;
655 656 657 658 659 660 661 662
		pba = E1000_PBA_48K;
		break;
	case e1000_82545:
	case e1000_82545_rev_3:
	case e1000_82546:
	case e1000_82546_rev_3:
		pba = E1000_PBA_48K;
		break;
663
	case e1000_82547:
664
	case e1000_82547_rev_2:
J
Joe Perches 已提交
665
		legacy_pba_adjust = true;
666 667
		pba = E1000_PBA_30K;
		break;
668 669
	case e1000_82571:
	case e1000_82572:
670
	case e1000_80003es2lan:
671 672
		pba = E1000_PBA_38K;
		break;
673
	case e1000_82573:
674
		pba = E1000_PBA_20K;
675
		break;
676 677
	case e1000_ich8lan:
		pba = E1000_PBA_8K;
678 679
	case e1000_undefined:
	case e1000_num_macs:
680 681 682
		break;
	}

J
Joe Perches 已提交
683
	if (legacy_pba_adjust) {
684 685
		if (adapter->netdev->mtu > E1000_RXBUFFER_8192)
			pba -= 8; /* allocate more FIFO for Tx */
686

J
Joe Perches 已提交
687
		if (hw->mac_type == e1000_82547) {
688 689 690 691 692 693
			adapter->tx_fifo_head = 0;
			adapter->tx_head_addr = pba << E1000_TX_HEAD_ADDR_SHIFT;
			adapter->tx_fifo_size =
				(E1000_PBA_40K - pba) << E1000_PBA_BYTES_SHIFT;
			atomic_set(&adapter->tx_fifo_stall, 0);
		}
J
Joe Perches 已提交
694
	} else if (hw->max_frame_size > MAXIMUM_ETHERNET_FRAME_SIZE) {
695
		/* adjust PBA for jumbo frames */
J
Joe Perches 已提交
696
		ew32(PBA, pba);
697 698 699 700 701 702 703

		/* To maintain wire speed transmits, the Tx FIFO should be
		 * large enough to accomodate two full transmit packets,
		 * rounded up to the next 1KB and expressed in KB.  Likewise,
		 * the Rx FIFO should be large enough to accomodate at least
		 * one full receive packet and is similarly rounded up and
		 * expressed in KB. */
J
Joe Perches 已提交
704
		pba = er32(PBA);
705 706 707 708 709 710 711 712 713
		/* upper 16 bits has Tx packet buffer allocation size in KB */
		tx_space = pba >> 16;
		/* lower 16 bits has Rx packet buffer allocation size in KB */
		pba &= 0xffff;
		/* don't include ethernet FCS because hardware appends/strips */
		min_rx_space = adapter->netdev->mtu + ENET_HEADER_SIZE +
		               VLAN_TAG_SIZE;
		min_tx_space = min_rx_space;
		min_tx_space *= 2;
714
		min_tx_space = ALIGN(min_tx_space, 1024);
715
		min_tx_space >>= 10;
716
		min_rx_space = ALIGN(min_rx_space, 1024);
717 718 719 720 721 722 723 724 725 726
		min_rx_space >>= 10;

		/* If current Tx allocation is less than the min Tx FIFO size,
		 * and the min Tx FIFO size is less than the current Rx FIFO
		 * allocation, take space away from current Rx allocation */
		if (tx_space < min_tx_space &&
		    ((min_tx_space - tx_space) < pba)) {
			pba = pba - (min_tx_space - tx_space);

			/* PCI/PCIx hardware has PBA alignment constraints */
J
Joe Perches 已提交
727
			switch (hw->mac_type) {
728 729 730 731 732 733 734 735 736 737
			case e1000_82545 ... e1000_82546_rev_3:
				pba &= ~(E1000_PBA_8K - 1);
				break;
			default:
				break;
			}

			/* if short on rx space, rx wins and must trump tx
			 * adjustment or use Early Receive if available */
			if (pba < min_rx_space) {
J
Joe Perches 已提交
738
				switch (hw->mac_type) {
739 740 741 742 743 744 745 746 747
				case e1000_82573:
					/* ERT enabled in e1000_configure_rx */
					break;
				default:
					pba = min_rx_space;
					break;
				}
			}
		}
L
Linus Torvalds 已提交
748
	}
749

J
Joe Perches 已提交
750
	ew32(PBA, pba);
L
Linus Torvalds 已提交
751 752

	/* flow control settings */
753 754 755
	/* Set the FC high water mark to 90% of the FIFO size.
	 * Required to clear last 3 LSB */
	fc_high_water_mark = ((pba * 9216)/10) & 0xFFF8;
756 757 758 759 760 761
	/* We can't use 90% on small FIFOs because the remainder
	 * would be less than 1 full frame.  In this case, we size
	 * it to allow at least a full frame above the high water
	 *  mark. */
	if (pba < E1000_PBA_16K)
		fc_high_water_mark = (pba * 1024) - 1600;
762

J
Joe Perches 已提交
763 764 765 766
	hw->fc_high_water = fc_high_water_mark;
	hw->fc_low_water = fc_high_water_mark - 8;
	if (hw->mac_type == e1000_80003es2lan)
		hw->fc_pause_time = 0xFFFF;
767
	else
J
Joe Perches 已提交
768 769 770
		hw->fc_pause_time = E1000_FC_PAUSE_TIME;
	hw->fc_send_xon = 1;
	hw->fc = hw->original_fc;
L
Linus Torvalds 已提交
771

772
	/* Allow time for pending master requests to run */
J
Joe Perches 已提交
773 774 775
	e1000_reset_hw(hw);
	if (hw->mac_type >= e1000_82544)
		ew32(WUC, 0);
776

J
Joe Perches 已提交
777
	if (e1000_init_hw(hw))
L
Linus Torvalds 已提交
778
		DPRINTK(PROBE, ERR, "Hardware Error\n");
779
	e1000_update_mng_vlan(adapter);
780 781

	/* if (adapter->hwflags & HWFLAGS_PHY_PWR_BIT) { */
J
Joe Perches 已提交
782 783 784 785 786
	if (hw->mac_type >= e1000_82544 &&
	    hw->mac_type <= e1000_82547_rev_2 &&
	    hw->autoneg == 1 &&
	    hw->autoneg_advertised == ADVERTISE_1000_FULL) {
		u32 ctrl = er32(CTRL);
787 788 789 790
		/* clear phy power management bit if we are in gig only mode,
		 * which if enabled will attempt negotiation to 100Mb, which
		 * can cause a loss of link at power off or driver unload */
		ctrl &= ~E1000_CTRL_SWDPIN3;
J
Joe Perches 已提交
791
		ew32(CTRL, ctrl);
792 793
	}

L
Linus Torvalds 已提交
794
	/* Enable h/w to recognize an 802.1Q VLAN Ethernet packet */
J
Joe Perches 已提交
795
	ew32(VET, ETHERNET_IEEE_VLAN_TYPE);
L
Linus Torvalds 已提交
796

J
Joe Perches 已提交
797 798
	e1000_reset_adaptive(hw);
	e1000_phy_get_info(hw, &adapter->phy_info);
A
Auke Kok 已提交
799 800

	if (!adapter->smart_power_down &&
J
Joe Perches 已提交
801 802
	    (hw->mac_type == e1000_82571 ||
	     hw->mac_type == e1000_82572)) {
803
		u16 phy_data = 0;
A
Auke Kok 已提交
804 805 806
		/* speed up time to link by disabling smart power down, ignore
		 * the return value of this function because there is nothing
		 * different we would do if it failed */
J
Joe Perches 已提交
807
		e1000_read_phy_reg(hw, IGP02E1000_PHY_POWER_MGMT,
A
Auke Kok 已提交
808 809
		                   &phy_data);
		phy_data &= ~IGP02E1000_PM_SPD;
J
Joe Perches 已提交
810
		e1000_write_phy_reg(hw, IGP02E1000_PHY_POWER_MGMT,
A
Auke Kok 已提交
811 812 813
		                    phy_data);
	}

814
	e1000_release_manageability(adapter);
L
Linus Torvalds 已提交
815 816
}

817 818 819
/**
 *  Dump the eeprom for users having checksum issues
 **/
820
static void e1000_dump_eeprom(struct e1000_adapter *adapter)
821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868
{
	struct net_device *netdev = adapter->netdev;
	struct ethtool_eeprom eeprom;
	const struct ethtool_ops *ops = netdev->ethtool_ops;
	u8 *data;
	int i;
	u16 csum_old, csum_new = 0;

	eeprom.len = ops->get_eeprom_len(netdev);
	eeprom.offset = 0;

	data = kmalloc(eeprom.len, GFP_KERNEL);
	if (!data) {
		printk(KERN_ERR "Unable to allocate memory to dump EEPROM"
		       " data\n");
		return;
	}

	ops->get_eeprom(netdev, &eeprom, data);

	csum_old = (data[EEPROM_CHECKSUM_REG * 2]) +
		   (data[EEPROM_CHECKSUM_REG * 2 + 1] << 8);
	for (i = 0; i < EEPROM_CHECKSUM_REG * 2; i += 2)
		csum_new += data[i] + (data[i + 1] << 8);
	csum_new = EEPROM_SUM - csum_new;

	printk(KERN_ERR "/*********************/\n");
	printk(KERN_ERR "Current EEPROM Checksum : 0x%04x\n", csum_old);
	printk(KERN_ERR "Calculated              : 0x%04x\n", csum_new);

	printk(KERN_ERR "Offset    Values\n");
	printk(KERN_ERR "========  ======\n");
	print_hex_dump(KERN_ERR, "", DUMP_PREFIX_OFFSET, 16, 1, data, 128, 0);

	printk(KERN_ERR "Include this output when contacting your support "
	       "provider.\n");
	printk(KERN_ERR "This is not a software error! Something bad "
	       "happened to your hardware or\n");
	printk(KERN_ERR "EEPROM image. Ignoring this "
	       "problem could result in further problems,\n");
	printk(KERN_ERR "possibly loss of data, corruption or system hangs!\n");
	printk(KERN_ERR "The MAC Address will be reset to 00:00:00:00:00:00, "
	       "which is invalid\n");
	printk(KERN_ERR "and requires you to set the proper MAC "
	       "address manually before continuing\n");
	printk(KERN_ERR "to enable this network device.\n");
	printk(KERN_ERR "Please inspect the EEPROM dump and report the issue "
	       "to your hardware vendor\n");
J
Jeff Kirsher 已提交
869
	printk(KERN_ERR "or Intel Customer Support.\n");
870 871 872 873 874
	printk(KERN_ERR "/*********************/\n");

	kfree(data);
}

L
Linus Torvalds 已提交
875 876 877 878 879 880 881 882 883 884 885 886
/**
 * e1000_probe - Device Initialization Routine
 * @pdev: PCI device information struct
 * @ent: entry in e1000_pci_tbl
 *
 * Returns 0 on success, negative on failure
 *
 * e1000_probe initializes an adapter identified by a pci_dev structure.
 * The OS initialization, configuring of the adapter private structure,
 * and a hardware reset occur.
 **/

J
Joe Perches 已提交
887 888
static int __devinit e1000_probe(struct pci_dev *pdev,
				 const struct pci_device_id *ent)
L
Linus Torvalds 已提交
889 890 891
{
	struct net_device *netdev;
	struct e1000_adapter *adapter;
J
Joe Perches 已提交
892
	struct e1000_hw *hw;
893

L
Linus Torvalds 已提交
894
	static int cards_found = 0;
895
	static int global_quad_port_a = 0; /* global ksp3 port a indication */
896
	int i, err, pci_using_dac;
897 898
	u16 eeprom_data = 0;
	u16 eeprom_apme_mask = E1000_EEPROM_APME;
899 900
	DECLARE_MAC_BUF(mac);

901 902
	err = pci_enable_device(pdev);
	if (err)
L
Linus Torvalds 已提交
903 904
		return err;

905 906
	if (!pci_set_dma_mask(pdev, DMA_64BIT_MASK) &&
	    !pci_set_consistent_dma_mask(pdev, DMA_64BIT_MASK)) {
L
Linus Torvalds 已提交
907 908
		pci_using_dac = 1;
	} else {
909 910 911 912 913 914 915 916
		err = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
		if (err) {
			err = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
			if (err) {
				E1000_ERR("No usable DMA configuration, "
					  "aborting\n");
				goto err_dma;
			}
L
Linus Torvalds 已提交
917 918 919 920
		}
		pci_using_dac = 0;
	}

921 922
	err = pci_request_regions(pdev, e1000_driver_name);
	if (err)
923
		goto err_pci_reg;
L
Linus Torvalds 已提交
924 925 926

	pci_set_master(pdev);

927
	err = -ENOMEM;
L
Linus Torvalds 已提交
928
	netdev = alloc_etherdev(sizeof(struct e1000_adapter));
929
	if (!netdev)
L
Linus Torvalds 已提交
930 931 932 933 934
		goto err_alloc_etherdev;

	SET_NETDEV_DEV(netdev, &pdev->dev);

	pci_set_drvdata(pdev, netdev);
935
	adapter = netdev_priv(netdev);
L
Linus Torvalds 已提交
936 937 938 939
	adapter->netdev = netdev;
	adapter->pdev = pdev;
	adapter->msg_enable = (1 << debug) - 1;

J
Joe Perches 已提交
940 941 942
	hw = &adapter->hw;
	hw->back = adapter;

943
	err = -EIO;
J
Joe Perches 已提交
944 945 946
	hw->hw_addr = ioremap(pci_resource_start(pdev, BAR_0),
			      pci_resource_len(pdev, BAR_0));
	if (!hw->hw_addr)
L
Linus Torvalds 已提交
947 948
		goto err_ioremap;

J
Jesse Brandeburg 已提交
949 950
	for (i = BAR_1; i <= BAR_5; i++) {
		if (pci_resource_len(pdev, i) == 0)
L
Linus Torvalds 已提交
951
			continue;
J
Jesse Brandeburg 已提交
952
		if (pci_resource_flags(pdev, i) & IORESOURCE_IO) {
J
Joe Perches 已提交
953
			hw->io_base = pci_resource_start(pdev, i);
L
Linus Torvalds 已提交
954 955 956 957 958 959 960 961
			break;
		}
	}

	netdev->open = &e1000_open;
	netdev->stop = &e1000_close;
	netdev->hard_start_xmit = &e1000_xmit_frame;
	netdev->get_stats = &e1000_get_stats;
962
	netdev->set_rx_mode = &e1000_set_rx_mode;
L
Linus Torvalds 已提交
963 964 965 966 967 968 969
	netdev->set_mac_address = &e1000_set_mac;
	netdev->change_mtu = &e1000_change_mtu;
	netdev->do_ioctl = &e1000_ioctl;
	e1000_set_ethtool_ops(netdev);
	netdev->tx_timeout = &e1000_tx_timeout;
	netdev->watchdog_timeo = 5 * HZ;
#ifdef CONFIG_E1000_NAPI
970
	netif_napi_add(netdev, &adapter->napi, e1000_clean, 64);
L
Linus Torvalds 已提交
971 972 973 974 975 976 977
#endif
	netdev->vlan_rx_register = e1000_vlan_rx_register;
	netdev->vlan_rx_add_vid = e1000_vlan_rx_add_vid;
	netdev->vlan_rx_kill_vid = e1000_vlan_rx_kill_vid;
#ifdef CONFIG_NET_POLL_CONTROLLER
	netdev->poll_controller = e1000_netpoll;
#endif
978
	strncpy(netdev->name, pci_name(pdev), sizeof(netdev->name) - 1);
L
Linus Torvalds 已提交
979 980 981 982 983

	adapter->bd_number = cards_found;

	/* setup the private structure */

984 985
	err = e1000_sw_init(adapter);
	if (err)
L
Linus Torvalds 已提交
986 987
		goto err_sw_init;

988
	err = -EIO;
989 990
	/* Flash BAR mapping must happen after e1000_sw_init
	 * because it depends on mac_type */
J
Joe Perches 已提交
991
	if ((hw->mac_type == e1000_ich8lan) &&
992
	   (pci_resource_flags(pdev, 1) & IORESOURCE_MEM)) {
J
Joe Perches 已提交
993
		hw->flash_address =
994 995
			ioremap(pci_resource_start(pdev, 1),
				pci_resource_len(pdev, 1));
J
Joe Perches 已提交
996
		if (!hw->flash_address)
997 998 999
			goto err_flashmap;
	}

J
Joe Perches 已提交
1000
	if (e1000_check_phy_reset_block(hw))
1001 1002
		DPRINTK(PROBE, INFO, "PHY reset is blocked due to SOL/IDER session.\n");

J
Joe Perches 已提交
1003
	if (hw->mac_type >= e1000_82543) {
L
Linus Torvalds 已提交
1004 1005 1006 1007 1008
		netdev->features = NETIF_F_SG |
				   NETIF_F_HW_CSUM |
				   NETIF_F_HW_VLAN_TX |
				   NETIF_F_HW_VLAN_RX |
				   NETIF_F_HW_VLAN_FILTER;
J
Joe Perches 已提交
1009
		if (hw->mac_type == e1000_ich8lan)
1010
			netdev->features &= ~NETIF_F_HW_VLAN_FILTER;
L
Linus Torvalds 已提交
1011 1012
	}

J
Joe Perches 已提交
1013 1014
	if ((hw->mac_type >= e1000_82544) &&
	   (hw->mac_type != e1000_82547))
L
Linus Torvalds 已提交
1015
		netdev->features |= NETIF_F_TSO;
1016

J
Joe Perches 已提交
1017
	if (hw->mac_type > e1000_82547_rev_2)
A
Auke Kok 已提交
1018
		netdev->features |= NETIF_F_TSO6;
J
Jesse Brandeburg 已提交
1019
	if (pci_using_dac)
L
Linus Torvalds 已提交
1020 1021
		netdev->features |= NETIF_F_HIGHDMA;

1022 1023
	netdev->features |= NETIF_F_LLTX;

J
Joe Perches 已提交
1024
	adapter->en_mng_pt = e1000_enable_mng_pass_thru(hw);
1025

1026
	/* initialize eeprom parameters */
J
Joe Perches 已提交
1027
	if (e1000_init_eeprom_params(hw)) {
1028
		E1000_ERR("EEPROM initialization failed\n");
1029
		goto err_eeprom;
1030 1031
	}

J
Jesse Brandeburg 已提交
1032
	/* before reading the EEPROM, reset the controller to
L
Linus Torvalds 已提交
1033
	 * put the device in a known good starting state */
J
Jesse Brandeburg 已提交
1034

J
Joe Perches 已提交
1035
	e1000_reset_hw(hw);
L
Linus Torvalds 已提交
1036 1037

	/* make sure the EEPROM is good */
J
Joe Perches 已提交
1038
	if (e1000_validate_eeprom_checksum(hw) < 0) {
L
Linus Torvalds 已提交
1039
		DPRINTK(PROBE, ERR, "The EEPROM Checksum Is Not Valid\n");
1040 1041 1042 1043 1044 1045 1046 1047 1048
		e1000_dump_eeprom(adapter);
		/*
		 * set MAC address to all zeroes to invalidate and temporary
		 * disable this device for the user. This blocks regular
		 * traffic while still permitting ethtool ioctls from reaching
		 * the hardware as well as allowing the user to run the
		 * interface after manually setting a hw addr using
		 * `ip set address`
		 */
J
Joe Perches 已提交
1049
		memset(hw->mac_addr, 0, netdev->addr_len);
1050 1051
	} else {
		/* copy the MAC address out of the EEPROM */
J
Joe Perches 已提交
1052
		if (e1000_read_mac_addr(hw))
1053
			DPRINTK(PROBE, ERR, "EEPROM Read Error\n");
L
Linus Torvalds 已提交
1054
	}
1055
	/* don't block initalization here due to bad MAC address */
J
Joe Perches 已提交
1056 1057
	memcpy(netdev->dev_addr, hw->mac_addr, netdev->addr_len);
	memcpy(netdev->perm_addr, hw->mac_addr, netdev->addr_len);
L
Linus Torvalds 已提交
1058

1059
	if (!is_valid_ether_addr(netdev->perm_addr))
L
Linus Torvalds 已提交
1060 1061
		DPRINTK(PROBE, ERR, "Invalid MAC Address\n");

J
Joe Perches 已提交
1062
	e1000_get_bus_info(hw);
L
Linus Torvalds 已提交
1063 1064 1065

	init_timer(&adapter->tx_fifo_stall_timer);
	adapter->tx_fifo_stall_timer.function = &e1000_82547_tx_fifo_stall;
1066
	adapter->tx_fifo_stall_timer.data = (unsigned long)adapter;
L
Linus Torvalds 已提交
1067 1068 1069 1070 1071 1072 1073

	init_timer(&adapter->watchdog_timer);
	adapter->watchdog_timer.function = &e1000_watchdog;
	adapter->watchdog_timer.data = (unsigned long) adapter;

	init_timer(&adapter->phy_info_timer);
	adapter->phy_info_timer.function = &e1000_update_phy_info;
1074
	adapter->phy_info_timer.data = (unsigned long)adapter;
L
Linus Torvalds 已提交
1075

1076
	INIT_WORK(&adapter->reset_task, e1000_reset_task);
L
Linus Torvalds 已提交
1077 1078 1079 1080 1081 1082 1083 1084

	e1000_check_options(adapter);

	/* Initial Wake on LAN setting
	 * If APM wake is enabled in the EEPROM,
	 * enable the ACPI Magic Packet filter
	 */

J
Joe Perches 已提交
1085
	switch (hw->mac_type) {
L
Linus Torvalds 已提交
1086 1087 1088 1089 1090
	case e1000_82542_rev2_0:
	case e1000_82542_rev2_1:
	case e1000_82543:
		break;
	case e1000_82544:
J
Joe Perches 已提交
1091
		e1000_read_eeprom(hw,
L
Linus Torvalds 已提交
1092 1093 1094
			EEPROM_INIT_CONTROL2_REG, 1, &eeprom_data);
		eeprom_apme_mask = E1000_EEPROM_82544_APM;
		break;
1095
	case e1000_ich8lan:
J
Joe Perches 已提交
1096
		e1000_read_eeprom(hw,
1097 1098 1099
			EEPROM_INIT_CONTROL1_REG, 1, &eeprom_data);
		eeprom_apme_mask = E1000_EEPROM_ICH8_APME;
		break;
L
Linus Torvalds 已提交
1100 1101
	case e1000_82546:
	case e1000_82546_rev_3:
J
Jeff Kirsher 已提交
1102
	case e1000_82571:
1103
	case e1000_80003es2lan:
J
Joe Perches 已提交
1104 1105
		if (er32(STATUS) & E1000_STATUS_FUNC_1){
			e1000_read_eeprom(hw,
L
Linus Torvalds 已提交
1106 1107 1108 1109 1110
				EEPROM_INIT_CONTROL3_PORT_B, 1, &eeprom_data);
			break;
		}
		/* Fall Through */
	default:
J
Joe Perches 已提交
1111
		e1000_read_eeprom(hw,
L
Linus Torvalds 已提交
1112 1113 1114
			EEPROM_INIT_CONTROL3_PORT_A, 1, &eeprom_data);
		break;
	}
J
Jesse Brandeburg 已提交
1115
	if (eeprom_data & eeprom_apme_mask)
1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129
		adapter->eeprom_wol |= E1000_WUFC_MAG;

	/* now that we have the eeprom settings, apply the special cases
	 * where the eeprom may be wrong or the board simply won't support
	 * wake on lan on a particular port */
	switch (pdev->device) {
	case E1000_DEV_ID_82546GB_PCIE:
		adapter->eeprom_wol = 0;
		break;
	case E1000_DEV_ID_82546EB_FIBER:
	case E1000_DEV_ID_82546GB_FIBER:
	case E1000_DEV_ID_82571EB_FIBER:
		/* Wake events only supported on port A for dual fiber
		 * regardless of eeprom setting */
J
Joe Perches 已提交
1130
		if (er32(STATUS) & E1000_STATUS_FUNC_1)
1131 1132 1133
			adapter->eeprom_wol = 0;
		break;
	case E1000_DEV_ID_82546GB_QUAD_COPPER_KSP3:
1134
	case E1000_DEV_ID_82571EB_QUAD_COPPER:
1135
	case E1000_DEV_ID_82571EB_QUAD_FIBER:
A
Auke Kok 已提交
1136
	case E1000_DEV_ID_82571EB_QUAD_COPPER_LOWPROFILE:
1137
	case E1000_DEV_ID_82571PT_QUAD_COPPER:
1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150
		/* if quad port adapter, disable WoL on all but port A */
		if (global_quad_port_a != 0)
			adapter->eeprom_wol = 0;
		else
			adapter->quad_port_a = 1;
		/* Reset for multiple quad port adapters */
		if (++global_quad_port_a == 4)
			global_quad_port_a = 0;
		break;
	}

	/* initialize the wol settings based on the eeprom settings */
	adapter->wol = adapter->eeprom_wol;
L
Linus Torvalds 已提交
1151

1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165
	/* print bus type/speed/width info */
	DPRINTK(PROBE, INFO, "(PCI%s:%s:%s) ",
		((hw->bus_type == e1000_bus_type_pcix) ? "-X" :
		 (hw->bus_type == e1000_bus_type_pci_express ? " Express":"")),
		((hw->bus_speed == e1000_bus_speed_2500) ? "2.5Gb/s" :
		 (hw->bus_speed == e1000_bus_speed_133) ? "133MHz" :
		 (hw->bus_speed == e1000_bus_speed_120) ? "120MHz" :
		 (hw->bus_speed == e1000_bus_speed_100) ? "100MHz" :
		 (hw->bus_speed == e1000_bus_speed_66) ? "66MHz" : "33MHz"),
		((hw->bus_width == e1000_bus_width_64) ? "64-bit" :
		 (hw->bus_width == e1000_bus_width_pciex_4) ? "Width x4" :
		 (hw->bus_width == e1000_bus_width_pciex_1) ? "Width x1" :
		 "32-bit"));

1166
	printk("%s\n", print_mac(mac, netdev->dev_addr));
1167

J
Joe Perches 已提交
1168
	if (hw->bus_type == e1000_bus_type_pci_express) {
1169 1170 1171 1172 1173 1174 1175
		DPRINTK(PROBE, WARNING, "This device (id %04x:%04x) will no "
			"longer be supported by this driver in the future.\n",
			pdev->vendor, pdev->device);
		DPRINTK(PROBE, WARNING, "please use the \"e1000e\" "
			"driver instead.\n");
	}

L
Linus Torvalds 已提交
1176 1177 1178
	/* reset the hardware with the new settings */
	e1000_reset(adapter);

1179 1180 1181 1182
	/* If the controller is 82573 and f/w is AMT, do not set
	 * DRV_LOAD until the interface is up.  For all other cases,
	 * let the f/w know that the h/w is now under the control
	 * of the driver. */
J
Joe Perches 已提交
1183 1184
	if (hw->mac_type != e1000_82573 ||
	    !e1000_check_mng_mode(hw))
1185
		e1000_get_hw_control(adapter);
1186

A
Auke Kok 已提交
1187 1188 1189
	/* tell the stack to leave us alone until e1000_open() is called */
	netif_carrier_off(netdev);
	netif_stop_queue(netdev);
1190 1191

	strcpy(netdev->name, "eth%d");
1192 1193
	err = register_netdev(netdev);
	if (err)
1194
		goto err_register;
A
Auke Kok 已提交
1195

L
Linus Torvalds 已提交
1196 1197 1198 1199 1200 1201
	DPRINTK(PROBE, INFO, "Intel(R) PRO/1000 Network Connection\n");

	cards_found++;
	return 0;

err_register:
1202 1203
	e1000_release_hw_control(adapter);
err_eeprom:
J
Joe Perches 已提交
1204 1205
	if (!e1000_check_phy_reset_block(hw))
		e1000_phy_hw_reset(hw);
1206

J
Joe Perches 已提交
1207 1208
	if (hw->flash_address)
		iounmap(hw->flash_address);
1209
err_flashmap:
1210 1211 1212 1213 1214 1215 1216 1217 1218 1219
#ifdef CONFIG_E1000_NAPI
	for (i = 0; i < adapter->num_rx_queues; i++)
		dev_put(&adapter->polling_netdev[i]);
#endif

	kfree(adapter->tx_ring);
	kfree(adapter->rx_ring);
#ifdef CONFIG_E1000_NAPI
	kfree(adapter->polling_netdev);
#endif
L
Linus Torvalds 已提交
1220
err_sw_init:
J
Joe Perches 已提交
1221
	iounmap(hw->hw_addr);
L
Linus Torvalds 已提交
1222 1223 1224 1225
err_ioremap:
	free_netdev(netdev);
err_alloc_etherdev:
	pci_release_regions(pdev);
1226 1227 1228
err_pci_reg:
err_dma:
	pci_disable_device(pdev);
L
Linus Torvalds 已提交
1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241
	return err;
}

/**
 * e1000_remove - Device Removal Routine
 * @pdev: PCI device information struct
 *
 * e1000_remove is called by the PCI subsystem to alert the driver
 * that it should release a PCI device.  The could be caused by a
 * Hot-Plug event, or because the driver is going to be removed from
 * memory.
 **/

1242
static void __devexit e1000_remove(struct pci_dev *pdev)
L
Linus Torvalds 已提交
1243 1244
{
	struct net_device *netdev = pci_get_drvdata(pdev);
1245
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
1246
	struct e1000_hw *hw = &adapter->hw;
1247 1248 1249
#ifdef CONFIG_E1000_NAPI
	int i;
#endif
L
Linus Torvalds 已提交
1250

1251
	cancel_work_sync(&adapter->reset_task);
J
Jeff Garzik 已提交
1252

1253
	e1000_release_manageability(adapter);
L
Linus Torvalds 已提交
1254

1255 1256 1257
	/* Release control of h/w to f/w.  If f/w is AMT enabled, this
	 * would have already happened in close and is redundant. */
	e1000_release_hw_control(adapter);
1258

1259
#ifdef CONFIG_E1000_NAPI
1260
	for (i = 0; i < adapter->num_rx_queues; i++)
1261
		dev_put(&adapter->polling_netdev[i]);
1262
#endif
L
Linus Torvalds 已提交
1263

1264 1265
	unregister_netdev(netdev);

J
Joe Perches 已提交
1266 1267
	if (!e1000_check_phy_reset_block(hw))
		e1000_phy_hw_reset(hw);
L
Linus Torvalds 已提交
1268

1269 1270 1271 1272 1273 1274
	kfree(adapter->tx_ring);
	kfree(adapter->rx_ring);
#ifdef CONFIG_E1000_NAPI
	kfree(adapter->polling_netdev);
#endif

J
Joe Perches 已提交
1275 1276 1277
	iounmap(hw->hw_addr);
	if (hw->flash_address)
		iounmap(hw->flash_address);
L
Linus Torvalds 已提交
1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293
	pci_release_regions(pdev);

	free_netdev(netdev);

	pci_disable_device(pdev);
}

/**
 * e1000_sw_init - Initialize general software structures (struct e1000_adapter)
 * @adapter: board private structure to initialize
 *
 * e1000_sw_init initializes the Adapter private data structure.
 * Fields are initialized based on PCI device information and
 * OS network device settings (MTU size).
 **/

1294
static int __devinit e1000_sw_init(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
1295 1296 1297 1298
{
	struct e1000_hw *hw = &adapter->hw;
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
1299 1300 1301
#ifdef CONFIG_E1000_NAPI
	int i;
#endif
L
Linus Torvalds 已提交
1302 1303 1304 1305 1306 1307 1308

	/* PCI config space info */

	hw->vendor_id = pdev->vendor;
	hw->device_id = pdev->device;
	hw->subsystem_vendor_id = pdev->subsystem_vendor;
	hw->subsystem_id = pdev->subsystem_device;
1309
	hw->revision_id = pdev->revision;
L
Linus Torvalds 已提交
1310 1311 1312

	pci_read_config_word(pdev, PCI_COMMAND, &hw->pci_cmd_word);

1313
	adapter->rx_buffer_len = MAXIMUM_ETHERNET_VLAN_SIZE;
1314
	adapter->rx_ps_bsize0 = E1000_RXBUFFER_128;
L
Linus Torvalds 已提交
1315 1316 1317 1318 1319 1320
	hw->max_frame_size = netdev->mtu +
			     ENET_HEADER_SIZE + ETHERNET_FCS_SIZE;
	hw->min_frame_size = MINIMUM_ETHERNET_FRAME_SIZE;

	/* identify the MAC */

J
Jesse Brandeburg 已提交
1321
	if (e1000_set_mac_type(hw)) {
L
Linus Torvalds 已提交
1322 1323 1324 1325
		DPRINTK(PROBE, ERR, "Unknown MAC Type\n");
		return -EIO;
	}

J
Jesse Brandeburg 已提交
1326
	switch (hw->mac_type) {
L
Linus Torvalds 已提交
1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338
	default:
		break;
	case e1000_82541:
	case e1000_82547:
	case e1000_82541_rev_2:
	case e1000_82547_rev_2:
		hw->phy_init_script = 1;
		break;
	}

	e1000_set_media_type(hw);

J
Joe Perches 已提交
1339 1340 1341
	hw->wait_autoneg_complete = false;
	hw->tbi_compatibility_en = true;
	hw->adaptive_ifs = true;
L
Linus Torvalds 已提交
1342 1343 1344

	/* Copper options */

J
Jesse Brandeburg 已提交
1345
	if (hw->media_type == e1000_media_type_copper) {
L
Linus Torvalds 已提交
1346
		hw->mdix = AUTO_ALL_MODES;
J
Joe Perches 已提交
1347
		hw->disable_polarity_correction = false;
L
Linus Torvalds 已提交
1348 1349 1350
		hw->master_slave = E1000_MASTER_SLAVE;
	}

1351 1352
	adapter->num_tx_queues = 1;
	adapter->num_rx_queues = 1;
1353 1354 1355 1356 1357 1358 1359

	if (e1000_alloc_queues(adapter)) {
		DPRINTK(PROBE, ERR, "Unable to allocate memory for queues\n");
		return -ENOMEM;
	}

#ifdef CONFIG_E1000_NAPI
1360
	for (i = 0; i < adapter->num_rx_queues; i++) {
1361 1362 1363 1364
		adapter->polling_netdev[i].priv = adapter;
		dev_hold(&adapter->polling_netdev[i]);
		set_bit(__LINK_STATE_START, &adapter->polling_netdev[i].state);
	}
1365
	spin_lock_init(&adapter->tx_queue_lock);
1366 1367
#endif

1368 1369 1370
	/* Explicitly disable IRQ since the NIC can be in any state. */
	e1000_irq_disable(adapter);

L
Linus Torvalds 已提交
1371 1372
	spin_lock_init(&adapter->stats_lock);

A
Auke Kok 已提交
1373 1374
	set_bit(__E1000_DOWN, &adapter->flags);

L
Linus Torvalds 已提交
1375 1376 1377
	return 0;
}

1378 1379 1380 1381 1382 1383 1384 1385 1386
/**
 * e1000_alloc_queues - Allocate memory for all rings
 * @adapter: board private structure to initialize
 *
 * We allocate one ring per queue at run-time since we don't know the
 * number of queues at compile-time.  The polling_netdev array is
 * intended for Multiqueue, but should work fine with a single queue.
 **/

1387
static int __devinit e1000_alloc_queues(struct e1000_adapter *adapter)
1388
{
Y
Yan Burman 已提交
1389 1390
	adapter->tx_ring = kcalloc(adapter->num_tx_queues,
	                           sizeof(struct e1000_tx_ring), GFP_KERNEL);
1391 1392 1393
	if (!adapter->tx_ring)
		return -ENOMEM;

Y
Yan Burman 已提交
1394 1395
	adapter->rx_ring = kcalloc(adapter->num_rx_queues,
	                           sizeof(struct e1000_rx_ring), GFP_KERNEL);
1396 1397 1398 1399 1400 1401
	if (!adapter->rx_ring) {
		kfree(adapter->tx_ring);
		return -ENOMEM;
	}

#ifdef CONFIG_E1000_NAPI
Y
Yan Burman 已提交
1402 1403 1404
	adapter->polling_netdev = kcalloc(adapter->num_rx_queues,
	                                  sizeof(struct net_device),
	                                  GFP_KERNEL);
1405 1406 1407 1408 1409 1410 1411 1412 1413 1414
	if (!adapter->polling_netdev) {
		kfree(adapter->tx_ring);
		kfree(adapter->rx_ring);
		return -ENOMEM;
	}
#endif

	return E1000_SUCCESS;
}

L
Linus Torvalds 已提交
1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427
/**
 * e1000_open - Called when a network interface is made active
 * @netdev: network interface device structure
 *
 * Returns 0 on success, negative value on failure
 *
 * The open entry point is called when a network interface is made
 * active by the system (IFF_UP).  At this point all resources needed
 * for transmit and receive operations are allocated, the interrupt
 * handler is registered with the OS, the watchdog timer is started,
 * and the stack is notified that the interface is ready.
 **/

1428
static int e1000_open(struct net_device *netdev)
L
Linus Torvalds 已提交
1429
{
1430
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
1431
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
1432 1433
	int err;

1434
	/* disallow open during test */
A
Auke Kok 已提交
1435
	if (test_bit(__E1000_TESTING, &adapter->flags))
1436 1437
		return -EBUSY;

L
Linus Torvalds 已提交
1438
	/* allocate transmit descriptors */
1439 1440
	err = e1000_setup_all_tx_resources(adapter);
	if (err)
L
Linus Torvalds 已提交
1441 1442 1443
		goto err_setup_tx;

	/* allocate receive descriptors */
1444
	err = e1000_setup_all_rx_resources(adapter);
1445
	if (err)
1446
		goto err_setup_rx;
1447

1448 1449
	e1000_power_up_phy(adapter);

1450
	adapter->mng_vlan_id = E1000_MNG_VLAN_NONE;
J
Joe Perches 已提交
1451
	if ((hw->mng_cookie.status &
1452 1453 1454
			  E1000_MNG_DHCP_COOKIE_STATUS_VLAN_SUPPORT)) {
		e1000_update_mng_vlan(adapter);
	}
L
Linus Torvalds 已提交
1455

1456 1457
	/* If AMT is enabled, let the firmware know that the network
	 * interface is now open */
J
Joe Perches 已提交
1458 1459
	if (hw->mac_type == e1000_82573 &&
	    e1000_check_mng_mode(hw))
1460 1461
		e1000_get_hw_control(adapter);

1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474
	/* before we allocate an interrupt, we must be ready to handle it.
	 * Setting DEBUG_SHIRQ in the kernel makes it fire an interrupt
	 * as soon as we call pci_request_irq, so we have to setup our
	 * clean_rx handler before we do so.  */
	e1000_configure(adapter);

	err = e1000_request_irq(adapter);
	if (err)
		goto err_req_irq;

	/* From here on the code is the same as e1000_up() */
	clear_bit(__E1000_DOWN, &adapter->flags);

1475
#ifdef CONFIG_E1000_NAPI
1476
	napi_enable(&adapter->napi);
1477 1478
#endif

1479 1480
	e1000_irq_enable(adapter);

B
Ben Hutchings 已提交
1481 1482
	netif_start_queue(netdev);

1483
	/* fire a link status change interrupt to start the watchdog */
J
Joe Perches 已提交
1484
	ew32(ICS, E1000_ICS_LSC);
1485

L
Linus Torvalds 已提交
1486 1487
	return E1000_SUCCESS;

1488
err_req_irq:
1489 1490
	e1000_release_hw_control(adapter);
	e1000_power_down_phy(adapter);
1491
	e1000_free_all_rx_resources(adapter);
L
Linus Torvalds 已提交
1492
err_setup_rx:
1493
	e1000_free_all_tx_resources(adapter);
L
Linus Torvalds 已提交
1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511
err_setup_tx:
	e1000_reset(adapter);

	return err;
}

/**
 * e1000_close - Disables a network interface
 * @netdev: network interface device structure
 *
 * Returns 0, this is not allowed to fail
 *
 * The close entry point is called when an interface is de-activated
 * by the OS.  The hardware is still under the drivers control, but
 * needs to be disabled.  A global MAC reset is issued to stop the
 * hardware, and all transmit and receive resources are freed.
 **/

1512
static int e1000_close(struct net_device *netdev)
L
Linus Torvalds 已提交
1513
{
1514
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
1515
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
1516

1517
	WARN_ON(test_bit(__E1000_RESETTING, &adapter->flags));
L
Linus Torvalds 已提交
1518
	e1000_down(adapter);
1519
	e1000_power_down_phy(adapter);
1520
	e1000_free_irq(adapter);
L
Linus Torvalds 已提交
1521

1522 1523
	e1000_free_all_tx_resources(adapter);
	e1000_free_all_rx_resources(adapter);
L
Linus Torvalds 已提交
1524

1525 1526
	/* kill manageability vlan ID if supported, but not if a vlan with
	 * the same ID is registered on the host OS (let 8021q kill it) */
J
Joe Perches 已提交
1527
	if ((hw->mng_cookie.status &
1528 1529
			  E1000_MNG_DHCP_COOKIE_STATUS_VLAN_SUPPORT) &&
	     !(adapter->vlgrp &&
D
Dan Aloni 已提交
1530
	       vlan_group_get_device(adapter->vlgrp, adapter->mng_vlan_id))) {
1531 1532
		e1000_vlan_rx_kill_vid(netdev, adapter->mng_vlan_id);
	}
1533 1534 1535

	/* If AMT is enabled, let the firmware know that the network
	 * interface is now closed */
J
Joe Perches 已提交
1536 1537
	if (hw->mac_type == e1000_82573 &&
	    e1000_check_mng_mode(hw))
1538 1539
		e1000_release_hw_control(adapter);

L
Linus Torvalds 已提交
1540 1541 1542 1543 1544 1545
	return 0;
}

/**
 * e1000_check_64k_bound - check that memory doesn't cross 64kB boundary
 * @adapter: address of board private structure
1546 1547
 * @start: address of beginning of memory
 * @len: length of memory
L
Linus Torvalds 已提交
1548
 **/
1549 1550
static bool e1000_check_64k_bound(struct e1000_adapter *adapter, void *start,
				  unsigned long len)
L
Linus Torvalds 已提交
1551
{
J
Joe Perches 已提交
1552
	struct e1000_hw *hw = &adapter->hw;
1553
	unsigned long begin = (unsigned long)start;
L
Linus Torvalds 已提交
1554 1555
	unsigned long end = begin + len;

1556 1557
	/* First rev 82545 and 82546 need to not allow any memory
	 * write location to cross 64k boundary due to errata 23 */
J
Joe Perches 已提交
1558 1559
	if (hw->mac_type == e1000_82545 ||
	    hw->mac_type == e1000_82546) {
J
Joe Perches 已提交
1560
		return ((begin ^ (end - 1)) >> 16) != 0 ? false : true;
L
Linus Torvalds 已提交
1561 1562
	}

J
Joe Perches 已提交
1563
	return true;
L
Linus Torvalds 已提交
1564 1565 1566 1567 1568
}

/**
 * e1000_setup_tx_resources - allocate Tx resources (Descriptors)
 * @adapter: board private structure
1569
 * @txdr:    tx descriptor ring (for a specific queue) to setup
L
Linus Torvalds 已提交
1570 1571 1572 1573
 *
 * Return 0 on success, negative on failure
 **/

1574 1575
static int e1000_setup_tx_resources(struct e1000_adapter *adapter,
				    struct e1000_tx_ring *txdr)
L
Linus Torvalds 已提交
1576 1577 1578 1579 1580
{
	struct pci_dev *pdev = adapter->pdev;
	int size;

	size = sizeof(struct e1000_buffer) * txdr->count;
1581
	txdr->buffer_info = vmalloc(size);
J
Jesse Brandeburg 已提交
1582
	if (!txdr->buffer_info) {
1583 1584
		DPRINTK(PROBE, ERR,
		"Unable to allocate memory for the transmit descriptor ring\n");
L
Linus Torvalds 已提交
1585 1586 1587 1588 1589 1590 1591
		return -ENOMEM;
	}
	memset(txdr->buffer_info, 0, size);

	/* round up to nearest 4K */

	txdr->size = txdr->count * sizeof(struct e1000_tx_desc);
1592
	txdr->size = ALIGN(txdr->size, 4096);
L
Linus Torvalds 已提交
1593 1594

	txdr->desc = pci_alloc_consistent(pdev, txdr->size, &txdr->dma);
J
Jesse Brandeburg 已提交
1595
	if (!txdr->desc) {
L
Linus Torvalds 已提交
1596 1597
setup_tx_desc_die:
		vfree(txdr->buffer_info);
1598 1599
		DPRINTK(PROBE, ERR,
		"Unable to allocate memory for the transmit descriptor ring\n");
L
Linus Torvalds 已提交
1600 1601 1602
		return -ENOMEM;
	}

1603
	/* Fix for errata 23, can't cross 64kB boundary */
L
Linus Torvalds 已提交
1604 1605 1606
	if (!e1000_check_64k_bound(adapter, txdr->desc, txdr->size)) {
		void *olddesc = txdr->desc;
		dma_addr_t olddma = txdr->dma;
1607 1608 1609
		DPRINTK(TX_ERR, ERR, "txdr align check failed: %u bytes "
				     "at %p\n", txdr->size, txdr->desc);
		/* Try again, without freeing the previous */
L
Linus Torvalds 已提交
1610
		txdr->desc = pci_alloc_consistent(pdev, txdr->size, &txdr->dma);
1611
		/* Failed allocation, critical failure */
J
Jesse Brandeburg 已提交
1612
		if (!txdr->desc) {
L
Linus Torvalds 已提交
1613 1614 1615 1616 1617 1618
			pci_free_consistent(pdev, txdr->size, olddesc, olddma);
			goto setup_tx_desc_die;
		}

		if (!e1000_check_64k_bound(adapter, txdr->desc, txdr->size)) {
			/* give up */
1619 1620
			pci_free_consistent(pdev, txdr->size, txdr->desc,
					    txdr->dma);
L
Linus Torvalds 已提交
1621 1622
			pci_free_consistent(pdev, txdr->size, olddesc, olddma);
			DPRINTK(PROBE, ERR,
1623 1624
				"Unable to allocate aligned memory "
				"for the transmit descriptor ring\n");
L
Linus Torvalds 已提交
1625 1626 1627
			vfree(txdr->buffer_info);
			return -ENOMEM;
		} else {
1628
			/* Free old allocation, new allocation was successful */
L
Linus Torvalds 已提交
1629 1630 1631 1632 1633 1634 1635
			pci_free_consistent(pdev, txdr->size, olddesc, olddma);
		}
	}
	memset(txdr->desc, 0, txdr->size);

	txdr->next_to_use = 0;
	txdr->next_to_clean = 0;
1636
	spin_lock_init(&txdr->tx_lock);
L
Linus Torvalds 已提交
1637 1638 1639 1640

	return 0;
}

1641 1642 1643 1644 1645 1646 1647 1648
/**
 * e1000_setup_all_tx_resources - wrapper to allocate Tx resources
 * 				  (Descriptors) for all queues
 * @adapter: board private structure
 *
 * Return 0 on success, negative on failure
 **/

1649
int e1000_setup_all_tx_resources(struct e1000_adapter *adapter)
1650 1651 1652
{
	int i, err = 0;

1653
	for (i = 0; i < adapter->num_tx_queues; i++) {
1654 1655 1656 1657
		err = e1000_setup_tx_resources(adapter, &adapter->tx_ring[i]);
		if (err) {
			DPRINTK(PROBE, ERR,
				"Allocation for Tx Queue %u failed\n", i);
1658 1659 1660
			for (i-- ; i >= 0; i--)
				e1000_free_tx_resources(adapter,
							&adapter->tx_ring[i]);
1661 1662 1663 1664 1665 1666 1667
			break;
		}
	}

	return err;
}

L
Linus Torvalds 已提交
1668 1669 1670 1671 1672 1673 1674
/**
 * e1000_configure_tx - Configure 8254x Transmit Unit after Reset
 * @adapter: board private structure
 *
 * Configure the Tx unit of the MAC after a reset.
 **/

1675
static void e1000_configure_tx(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
1676
{
1677
	u64 tdba;
1678
	struct e1000_hw *hw = &adapter->hw;
1679 1680
	u32 tdlen, tctl, tipg, tarc;
	u32 ipgr1, ipgr2;
L
Linus Torvalds 已提交
1681 1682 1683

	/* Setup the HW Tx Head and Tail descriptor pointers */

1684
	switch (adapter->num_tx_queues) {
1685 1686
	case 1:
	default:
1687 1688 1689
		tdba = adapter->tx_ring[0].dma;
		tdlen = adapter->tx_ring[0].count *
			sizeof(struct e1000_tx_desc);
J
Joe Perches 已提交
1690 1691 1692 1693 1694
		ew32(TDLEN, tdlen);
		ew32(TDBAH, (tdba >> 32));
		ew32(TDBAL, (tdba & 0x00000000ffffffffULL));
		ew32(TDT, 0);
		ew32(TDH, 0);
1695 1696
		adapter->tx_ring[0].tdh = ((hw->mac_type >= e1000_82543) ? E1000_TDH : E1000_82542_TDH);
		adapter->tx_ring[0].tdt = ((hw->mac_type >= e1000_82543) ? E1000_TDT : E1000_82542_TDT);
1697 1698
		break;
	}
L
Linus Torvalds 已提交
1699 1700

	/* Set the default values for the Tx Inter Packet Gap timer */
J
Joe Perches 已提交
1701
	if (hw->mac_type <= e1000_82547_rev_2 &&
1702 1703
	    (hw->media_type == e1000_media_type_fiber ||
	     hw->media_type == e1000_media_type_internal_serdes))
1704 1705 1706 1707
		tipg = DEFAULT_82543_TIPG_IPGT_FIBER;
	else
		tipg = DEFAULT_82543_TIPG_IPGT_COPPER;

1708
	switch (hw->mac_type) {
L
Linus Torvalds 已提交
1709 1710 1711
	case e1000_82542_rev2_0:
	case e1000_82542_rev2_1:
		tipg = DEFAULT_82542_TIPG_IPGT;
1712 1713
		ipgr1 = DEFAULT_82542_TIPG_IPGR1;
		ipgr2 = DEFAULT_82542_TIPG_IPGR2;
L
Linus Torvalds 已提交
1714
		break;
1715 1716 1717 1718
	case e1000_80003es2lan:
		ipgr1 = DEFAULT_82543_TIPG_IPGR1;
		ipgr2 = DEFAULT_80003ES2LAN_TIPG_IPGR2;
		break;
L
Linus Torvalds 已提交
1719
	default:
1720 1721 1722
		ipgr1 = DEFAULT_82543_TIPG_IPGR1;
		ipgr2 = DEFAULT_82543_TIPG_IPGR2;
		break;
L
Linus Torvalds 已提交
1723
	}
1724 1725
	tipg |= ipgr1 << E1000_TIPG_IPGR1_SHIFT;
	tipg |= ipgr2 << E1000_TIPG_IPGR2_SHIFT;
J
Joe Perches 已提交
1726
	ew32(TIPG, tipg);
L
Linus Torvalds 已提交
1727 1728 1729

	/* Set the Tx Interrupt Delay register */

J
Joe Perches 已提交
1730
	ew32(TIDV, adapter->tx_int_delay);
1731
	if (hw->mac_type >= e1000_82540)
J
Joe Perches 已提交
1732
		ew32(TADV, adapter->tx_abs_int_delay);
L
Linus Torvalds 已提交
1733 1734 1735

	/* Program the Transmit Control Register */

J
Joe Perches 已提交
1736
	tctl = er32(TCTL);
L
Linus Torvalds 已提交
1737
	tctl &= ~E1000_TCTL_CT;
1738
	tctl |= E1000_TCTL_PSP | E1000_TCTL_RTLC |
L
Linus Torvalds 已提交
1739 1740
		(E1000_COLLISION_THRESHOLD << E1000_CT_SHIFT);

1741
	if (hw->mac_type == e1000_82571 || hw->mac_type == e1000_82572) {
J
Joe Perches 已提交
1742
		tarc = er32(TARC0);
1743 1744
		/* set the speed mode bit, we'll clear it if we're not at
		 * gigabit link later */
1745
		tarc |= (1 << 21);
J
Joe Perches 已提交
1746
		ew32(TARC0, tarc);
1747
	} else if (hw->mac_type == e1000_80003es2lan) {
J
Joe Perches 已提交
1748
		tarc = er32(TARC0);
1749
		tarc |= 1;
J
Joe Perches 已提交
1750 1751
		ew32(TARC0, tarc);
		tarc = er32(TARC1);
1752
		tarc |= 1;
J
Joe Perches 已提交
1753
		ew32(TARC1, tarc);
1754 1755
	}

1756
	e1000_config_collision_dist(hw);
L
Linus Torvalds 已提交
1757 1758

	/* Setup Transmit Descriptor Settings for eop descriptor */
1759 1760 1761 1762 1763
	adapter->txd_cmd = E1000_TXD_CMD_EOP | E1000_TXD_CMD_IFCS;

	/* only set IDE if we are delaying interrupts using the timers */
	if (adapter->tx_int_delay)
		adapter->txd_cmd |= E1000_TXD_CMD_IDE;
L
Linus Torvalds 已提交
1764

1765
	if (hw->mac_type < e1000_82543)
L
Linus Torvalds 已提交
1766 1767 1768 1769 1770 1771
		adapter->txd_cmd |= E1000_TXD_CMD_RPS;
	else
		adapter->txd_cmd |= E1000_TXD_CMD_RS;

	/* Cache if we're 82544 running in PCI-X because we'll
	 * need this to apply a workaround later in the send path. */
1772 1773
	if (hw->mac_type == e1000_82544 &&
	    hw->bus_type == e1000_bus_type_pcix)
L
Linus Torvalds 已提交
1774
		adapter->pcix_82544 = 1;
1775

J
Joe Perches 已提交
1776
	ew32(TCTL, tctl);
1777

L
Linus Torvalds 已提交
1778 1779 1780 1781 1782
}

/**
 * e1000_setup_rx_resources - allocate Rx resources (Descriptors)
 * @adapter: board private structure
1783
 * @rxdr:    rx descriptor ring (for a specific queue) to setup
L
Linus Torvalds 已提交
1784 1785 1786 1787
 *
 * Returns 0 on success, negative on failure
 **/

1788 1789
static int e1000_setup_rx_resources(struct e1000_adapter *adapter,
				    struct e1000_rx_ring *rxdr)
L
Linus Torvalds 已提交
1790
{
J
Joe Perches 已提交
1791
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
1792
	struct pci_dev *pdev = adapter->pdev;
1793
	int size, desc_len;
L
Linus Torvalds 已提交
1794 1795

	size = sizeof(struct e1000_buffer) * rxdr->count;
1796
	rxdr->buffer_info = vmalloc(size);
1797
	if (!rxdr->buffer_info) {
1798 1799
		DPRINTK(PROBE, ERR,
		"Unable to allocate memory for the receive descriptor ring\n");
L
Linus Torvalds 已提交
1800 1801 1802 1803
		return -ENOMEM;
	}
	memset(rxdr->buffer_info, 0, size);

Y
Yan Burman 已提交
1804 1805
	rxdr->ps_page = kcalloc(rxdr->count, sizeof(struct e1000_ps_page),
	                        GFP_KERNEL);
J
Jesse Brandeburg 已提交
1806
	if (!rxdr->ps_page) {
1807 1808 1809 1810 1811 1812
		vfree(rxdr->buffer_info);
		DPRINTK(PROBE, ERR,
		"Unable to allocate memory for the receive descriptor ring\n");
		return -ENOMEM;
	}

Y
Yan Burman 已提交
1813 1814 1815
	rxdr->ps_page_dma = kcalloc(rxdr->count,
	                            sizeof(struct e1000_ps_page_dma),
	                            GFP_KERNEL);
J
Jesse Brandeburg 已提交
1816
	if (!rxdr->ps_page_dma) {
1817 1818 1819 1820 1821 1822 1823
		vfree(rxdr->buffer_info);
		kfree(rxdr->ps_page);
		DPRINTK(PROBE, ERR,
		"Unable to allocate memory for the receive descriptor ring\n");
		return -ENOMEM;
	}

J
Joe Perches 已提交
1824
	if (hw->mac_type <= e1000_82547_rev_2)
1825 1826 1827 1828
		desc_len = sizeof(struct e1000_rx_desc);
	else
		desc_len = sizeof(union e1000_rx_desc_packet_split);

L
Linus Torvalds 已提交
1829 1830
	/* Round up to nearest 4K */

1831
	rxdr->size = rxdr->count * desc_len;
1832
	rxdr->size = ALIGN(rxdr->size, 4096);
L
Linus Torvalds 已提交
1833 1834 1835

	rxdr->desc = pci_alloc_consistent(pdev, rxdr->size, &rxdr->dma);

1836 1837 1838
	if (!rxdr->desc) {
		DPRINTK(PROBE, ERR,
		"Unable to allocate memory for the receive descriptor ring\n");
L
Linus Torvalds 已提交
1839 1840
setup_rx_desc_die:
		vfree(rxdr->buffer_info);
1841 1842
		kfree(rxdr->ps_page);
		kfree(rxdr->ps_page_dma);
L
Linus Torvalds 已提交
1843 1844 1845
		return -ENOMEM;
	}

1846
	/* Fix for errata 23, can't cross 64kB boundary */
L
Linus Torvalds 已提交
1847 1848 1849
	if (!e1000_check_64k_bound(adapter, rxdr->desc, rxdr->size)) {
		void *olddesc = rxdr->desc;
		dma_addr_t olddma = rxdr->dma;
1850 1851 1852
		DPRINTK(RX_ERR, ERR, "rxdr align check failed: %u bytes "
				     "at %p\n", rxdr->size, rxdr->desc);
		/* Try again, without freeing the previous */
L
Linus Torvalds 已提交
1853
		rxdr->desc = pci_alloc_consistent(pdev, rxdr->size, &rxdr->dma);
1854
		/* Failed allocation, critical failure */
1855
		if (!rxdr->desc) {
L
Linus Torvalds 已提交
1856
			pci_free_consistent(pdev, rxdr->size, olddesc, olddma);
1857 1858 1859
			DPRINTK(PROBE, ERR,
				"Unable to allocate memory "
				"for the receive descriptor ring\n");
L
Linus Torvalds 已提交
1860 1861 1862 1863 1864
			goto setup_rx_desc_die;
		}

		if (!e1000_check_64k_bound(adapter, rxdr->desc, rxdr->size)) {
			/* give up */
1865 1866
			pci_free_consistent(pdev, rxdr->size, rxdr->desc,
					    rxdr->dma);
L
Linus Torvalds 已提交
1867
			pci_free_consistent(pdev, rxdr->size, olddesc, olddma);
1868 1869 1870
			DPRINTK(PROBE, ERR,
				"Unable to allocate aligned memory "
				"for the receive descriptor ring\n");
1871
			goto setup_rx_desc_die;
L
Linus Torvalds 已提交
1872
		} else {
1873
			/* Free old allocation, new allocation was successful */
L
Linus Torvalds 已提交
1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884
			pci_free_consistent(pdev, rxdr->size, olddesc, olddma);
		}
	}
	memset(rxdr->desc, 0, rxdr->size);

	rxdr->next_to_clean = 0;
	rxdr->next_to_use = 0;

	return 0;
}

1885 1886 1887 1888 1889 1890 1891 1892
/**
 * e1000_setup_all_rx_resources - wrapper to allocate Rx resources
 * 				  (Descriptors) for all queues
 * @adapter: board private structure
 *
 * Return 0 on success, negative on failure
 **/

1893
int e1000_setup_all_rx_resources(struct e1000_adapter *adapter)
1894 1895 1896
{
	int i, err = 0;

1897
	for (i = 0; i < adapter->num_rx_queues; i++) {
1898 1899 1900 1901
		err = e1000_setup_rx_resources(adapter, &adapter->rx_ring[i]);
		if (err) {
			DPRINTK(PROBE, ERR,
				"Allocation for Rx Queue %u failed\n", i);
1902 1903 1904
			for (i-- ; i >= 0; i--)
				e1000_free_rx_resources(adapter,
							&adapter->rx_ring[i]);
1905 1906 1907 1908 1909 1910 1911
			break;
		}
	}

	return err;
}

L
Linus Torvalds 已提交
1912
/**
1913
 * e1000_setup_rctl - configure the receive control registers
L
Linus Torvalds 已提交
1914 1915
 * @adapter: Board private structure
 **/
1916 1917
#define PAGE_USE_COUNT(S) (((S) >> PAGE_SHIFT) + \
			(((S) & (PAGE_SIZE - 1)) ? 1 : 0))
1918
static void e1000_setup_rctl(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
1919
{
J
Joe Perches 已提交
1920
	struct e1000_hw *hw = &adapter->hw;
1921 1922
	u32 rctl, rfctl;
	u32 psrctl = 0;
1923
#ifndef CONFIG_E1000_DISABLE_PACKET_SPLIT
1924
	u32 pages = 0;
1925
#endif
L
Linus Torvalds 已提交
1926

J
Joe Perches 已提交
1927
	rctl = er32(RCTL);
L
Linus Torvalds 已提交
1928 1929 1930 1931 1932

	rctl &= ~(3 << E1000_RCTL_MO_SHIFT);

	rctl |= E1000_RCTL_EN | E1000_RCTL_BAM |
		E1000_RCTL_LBM_NO | E1000_RCTL_RDMTS_HALF |
J
Joe Perches 已提交
1933
		(hw->mc_filter_type << E1000_RCTL_MO_SHIFT);
L
Linus Torvalds 已提交
1934

J
Joe Perches 已提交
1935
	if (hw->tbi_compatibility_on == 1)
L
Linus Torvalds 已提交
1936 1937 1938 1939
		rctl |= E1000_RCTL_SBP;
	else
		rctl &= ~E1000_RCTL_SBP;

1940 1941 1942 1943 1944
	if (adapter->netdev->mtu <= ETH_DATA_LEN)
		rctl &= ~E1000_RCTL_LPE;
	else
		rctl |= E1000_RCTL_LPE;

L
Linus Torvalds 已提交
1945
	/* Setup buffer sizes */
1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960
	rctl &= ~E1000_RCTL_SZ_4096;
	rctl |= E1000_RCTL_BSEX;
	switch (adapter->rx_buffer_len) {
		case E1000_RXBUFFER_256:
			rctl |= E1000_RCTL_SZ_256;
			rctl &= ~E1000_RCTL_BSEX;
			break;
		case E1000_RXBUFFER_512:
			rctl |= E1000_RCTL_SZ_512;
			rctl &= ~E1000_RCTL_BSEX;
			break;
		case E1000_RXBUFFER_1024:
			rctl |= E1000_RCTL_SZ_1024;
			rctl &= ~E1000_RCTL_BSEX;
			break;
1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974
		case E1000_RXBUFFER_2048:
		default:
			rctl |= E1000_RCTL_SZ_2048;
			rctl &= ~E1000_RCTL_BSEX;
			break;
		case E1000_RXBUFFER_4096:
			rctl |= E1000_RCTL_SZ_4096;
			break;
		case E1000_RXBUFFER_8192:
			rctl |= E1000_RCTL_SZ_8192;
			break;
		case E1000_RXBUFFER_16384:
			rctl |= E1000_RCTL_SZ_16384;
			break;
1975 1976
	}

1977
#ifndef CONFIG_E1000_DISABLE_PACKET_SPLIT
1978 1979 1980 1981 1982 1983 1984
	/* 82571 and greater support packet-split where the protocol
	 * header is placed in skb->data and the packet data is
	 * placed in pages hanging off of skb_shinfo(skb)->nr_frags.
	 * In the case of a non-split, skb->data is linearly filled,
	 * followed by the page buffers.  Therefore, skb->data is
	 * sized to hold the largest protocol header.
	 */
1985 1986
	/* allocations using alloc_page take too long for regular MTU
	 * so only enable packet split for jumbo frames */
1987
	pages = PAGE_USE_COUNT(adapter->netdev->mtu);
J
Joe Perches 已提交
1988
	if ((hw->mac_type >= e1000_82571) && (pages <= 3) &&
1989
	    PAGE_SIZE <= 16384 && (rctl & E1000_RCTL_LPE))
1990 1991 1992
		adapter->rx_ps_pages = pages;
	else
		adapter->rx_ps_pages = 0;
1993
#endif
1994
	if (adapter->rx_ps_pages) {
1995
		/* Configure extra packet-split registers */
J
Joe Perches 已提交
1996
		rfctl = er32(RFCTL);
1997
		rfctl |= E1000_RFCTL_EXTEN;
A
Auke Kok 已提交
1998 1999 2000 2001 2002
		/* disable packet split support for IPv6 extension headers,
		 * because some malformed IPv6 headers can hang the RX */
		rfctl |= (E1000_RFCTL_IPV6_EX_DIS |
		          E1000_RFCTL_NEW_IPV6_EXT_DIS);

J
Joe Perches 已提交
2003
		ew32(RFCTL, rfctl);
2004

2005
		rctl |= E1000_RCTL_DTYP_PS;
J
Jesse Brandeburg 已提交
2006

2007 2008
		psrctl |= adapter->rx_ps_bsize0 >>
			E1000_PSRCTL_BSIZE0_SHIFT;
2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021

		switch (adapter->rx_ps_pages) {
		case 3:
			psrctl |= PAGE_SIZE <<
				E1000_PSRCTL_BSIZE3_SHIFT;
		case 2:
			psrctl |= PAGE_SIZE <<
				E1000_PSRCTL_BSIZE2_SHIFT;
		case 1:
			psrctl |= PAGE_SIZE >>
				E1000_PSRCTL_BSIZE1_SHIFT;
			break;
		}
2022

J
Joe Perches 已提交
2023
		ew32(PSRCTL, psrctl);
L
Linus Torvalds 已提交
2024 2025
	}

J
Joe Perches 已提交
2026
	ew32(RCTL, rctl);
L
Linus Torvalds 已提交
2027 2028 2029 2030 2031 2032 2033 2034 2035
}

/**
 * e1000_configure_rx - Configure 8254x Receive Unit after Reset
 * @adapter: board private structure
 *
 * Configure the Rx unit of the MAC after a reset.
 **/

2036
static void e1000_configure_rx(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
2037
{
2038
	u64 rdba;
2039
	struct e1000_hw *hw = &adapter->hw;
2040
	u32 rdlen, rctl, rxcsum, ctrl_ext;
2041

2042
	if (adapter->rx_ps_pages) {
2043
		/* this is a 32 byte descriptor */
2044
		rdlen = adapter->rx_ring[0].count *
2045 2046 2047 2048
			sizeof(union e1000_rx_desc_packet_split);
		adapter->clean_rx = e1000_clean_rx_irq_ps;
		adapter->alloc_rx_buf = e1000_alloc_rx_buffers_ps;
	} else {
2049 2050
		rdlen = adapter->rx_ring[0].count *
			sizeof(struct e1000_rx_desc);
2051 2052 2053
		adapter->clean_rx = e1000_clean_rx_irq;
		adapter->alloc_rx_buf = e1000_alloc_rx_buffers;
	}
L
Linus Torvalds 已提交
2054 2055

	/* disable receives while setting up the descriptors */
J
Joe Perches 已提交
2056 2057
	rctl = er32(RCTL);
	ew32(RCTL, rctl & ~E1000_RCTL_EN);
L
Linus Torvalds 已提交
2058 2059

	/* set the Receive Delay Timer Register */
J
Joe Perches 已提交
2060
	ew32(RDTR, adapter->rx_int_delay);
L
Linus Torvalds 已提交
2061

2062
	if (hw->mac_type >= e1000_82540) {
J
Joe Perches 已提交
2063
		ew32(RADV, adapter->rx_abs_int_delay);
J
Jesse Brandeburg 已提交
2064
		if (adapter->itr_setting != 0)
J
Joe Perches 已提交
2065
			ew32(ITR, 1000000000 / (adapter->itr * 256));
L
Linus Torvalds 已提交
2066 2067
	}

2068
	if (hw->mac_type >= e1000_82571) {
J
Joe Perches 已提交
2069
		ctrl_ext = er32(CTRL_EXT);
2070
		/* Reset delay timers after every interrupt */
A
Auke Kok 已提交
2071
		ctrl_ext |= E1000_CTRL_EXT_INT_TIMER_CLR;
2072
#ifdef CONFIG_E1000_NAPI
J
Jesse Brandeburg 已提交
2073
		/* Auto-Mask interrupts upon ICR access */
2074
		ctrl_ext |= E1000_CTRL_EXT_IAME;
J
Joe Perches 已提交
2075
		ew32(IAM, 0xffffffff);
2076
#endif
J
Joe Perches 已提交
2077 2078
		ew32(CTRL_EXT, ctrl_ext);
		E1000_WRITE_FLUSH();
2079 2080
	}

2081 2082
	/* Setup the HW Rx Head and Tail Descriptor Pointers and
	 * the Base and Length of the Rx Descriptor Ring */
2083
	switch (adapter->num_rx_queues) {
2084 2085
	case 1:
	default:
2086
		rdba = adapter->rx_ring[0].dma;
J
Joe Perches 已提交
2087 2088 2089 2090 2091
		ew32(RDLEN, rdlen);
		ew32(RDBAH, (rdba >> 32));
		ew32(RDBAL, (rdba & 0x00000000ffffffffULL));
		ew32(RDT, 0);
		ew32(RDH, 0);
2092 2093
		adapter->rx_ring[0].rdh = ((hw->mac_type >= e1000_82543) ? E1000_RDH : E1000_82542_RDH);
		adapter->rx_ring[0].rdt = ((hw->mac_type >= e1000_82543) ? E1000_RDT : E1000_82542_RDT);
2094
		break;
2095 2096
	}

L
Linus Torvalds 已提交
2097
	/* Enable 82543 Receive Checksum Offload for TCP and UDP */
2098
	if (hw->mac_type >= e1000_82543) {
J
Joe Perches 已提交
2099
		rxcsum = er32(RXCSUM);
J
Joe Perches 已提交
2100
		if (adapter->rx_csum) {
2101 2102
			rxcsum |= E1000_RXCSUM_TUOFL;

2103
			/* Enable 82571 IPv4 payload checksum for UDP fragments
2104
			 * Must be used in conjunction with packet-split. */
J
Jesse Brandeburg 已提交
2105 2106
			if ((hw->mac_type >= e1000_82571) &&
			    (adapter->rx_ps_pages)) {
2107 2108 2109 2110 2111 2112
				rxcsum |= E1000_RXCSUM_IPPCSE;
			}
		} else {
			rxcsum &= ~E1000_RXCSUM_TUOFL;
			/* don't need to clear IPPCSE as it defaults to 0 */
		}
J
Joe Perches 已提交
2113
		ew32(RXCSUM, rxcsum);
L
Linus Torvalds 已提交
2114 2115
	}

2116 2117 2118 2119
	/* enable early receives on 82573, only takes effect if using > 2048
	 * byte total frame size.  for example only for jumbo frames */
#define E1000_ERT_2048 0x100
	if (hw->mac_type == e1000_82573)
J
Joe Perches 已提交
2120
		ew32(ERT, E1000_ERT_2048);
2121

L
Linus Torvalds 已提交
2122
	/* Enable Receives */
J
Joe Perches 已提交
2123
	ew32(RCTL, rctl);
L
Linus Torvalds 已提交
2124 2125 2126
}

/**
2127
 * e1000_free_tx_resources - Free Tx Resources per Queue
L
Linus Torvalds 已提交
2128
 * @adapter: board private structure
2129
 * @tx_ring: Tx descriptor ring for a specific queue
L
Linus Torvalds 已提交
2130 2131 2132 2133
 *
 * Free all transmit software resources
 **/

2134 2135
static void e1000_free_tx_resources(struct e1000_adapter *adapter,
				    struct e1000_tx_ring *tx_ring)
L
Linus Torvalds 已提交
2136 2137 2138
{
	struct pci_dev *pdev = adapter->pdev;

2139
	e1000_clean_tx_ring(adapter, tx_ring);
L
Linus Torvalds 已提交
2140

2141 2142
	vfree(tx_ring->buffer_info);
	tx_ring->buffer_info = NULL;
L
Linus Torvalds 已提交
2143

2144
	pci_free_consistent(pdev, tx_ring->size, tx_ring->desc, tx_ring->dma);
L
Linus Torvalds 已提交
2145

2146 2147 2148 2149 2150 2151 2152 2153 2154 2155
	tx_ring->desc = NULL;
}

/**
 * e1000_free_all_tx_resources - Free Tx Resources for All Queues
 * @adapter: board private structure
 *
 * Free all transmit software resources
 **/

2156
void e1000_free_all_tx_resources(struct e1000_adapter *adapter)
2157 2158 2159
{
	int i;

2160
	for (i = 0; i < adapter->num_tx_queues; i++)
2161
		e1000_free_tx_resources(adapter, &adapter->tx_ring[i]);
L
Linus Torvalds 已提交
2162 2163
}

2164 2165
static void e1000_unmap_and_free_tx_resource(struct e1000_adapter *adapter,
					     struct e1000_buffer *buffer_info)
L
Linus Torvalds 已提交
2166
{
J
Jesse Brandeburg 已提交
2167
	if (buffer_info->dma) {
2168 2169 2170 2171
		pci_unmap_page(adapter->pdev,
				buffer_info->dma,
				buffer_info->length,
				PCI_DMA_TODEVICE);
2172
		buffer_info->dma = 0;
L
Linus Torvalds 已提交
2173
	}
2174
	if (buffer_info->skb) {
L
Linus Torvalds 已提交
2175
		dev_kfree_skb_any(buffer_info->skb);
2176 2177 2178
		buffer_info->skb = NULL;
	}
	/* buffer_info must be completely set up in the transmit path */
L
Linus Torvalds 已提交
2179 2180 2181 2182 2183
}

/**
 * e1000_clean_tx_ring - Free Tx Buffers
 * @adapter: board private structure
2184
 * @tx_ring: ring to be cleaned
L
Linus Torvalds 已提交
2185 2186
 **/

2187 2188
static void e1000_clean_tx_ring(struct e1000_adapter *adapter,
				struct e1000_tx_ring *tx_ring)
L
Linus Torvalds 已提交
2189
{
J
Joe Perches 已提交
2190
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
2191 2192 2193 2194 2195 2196
	struct e1000_buffer *buffer_info;
	unsigned long size;
	unsigned int i;

	/* Free all the Tx ring sk_buffs */

J
Jesse Brandeburg 已提交
2197
	for (i = 0; i < tx_ring->count; i++) {
L
Linus Torvalds 已提交
2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210
		buffer_info = &tx_ring->buffer_info[i];
		e1000_unmap_and_free_tx_resource(adapter, buffer_info);
	}

	size = sizeof(struct e1000_buffer) * tx_ring->count;
	memset(tx_ring->buffer_info, 0, size);

	/* Zero out the descriptor ring */

	memset(tx_ring->desc, 0, tx_ring->size);

	tx_ring->next_to_use = 0;
	tx_ring->next_to_clean = 0;
J
Jeff Kirsher 已提交
2211
	tx_ring->last_tx_tso = 0;
L
Linus Torvalds 已提交
2212

J
Joe Perches 已提交
2213 2214
	writel(0, hw->hw_addr + tx_ring->tdh);
	writel(0, hw->hw_addr + tx_ring->tdt);
2215 2216 2217 2218 2219 2220 2221
}

/**
 * e1000_clean_all_tx_rings - Free Tx Buffers for all queues
 * @adapter: board private structure
 **/

2222
static void e1000_clean_all_tx_rings(struct e1000_adapter *adapter)
2223 2224 2225
{
	int i;

2226
	for (i = 0; i < adapter->num_tx_queues; i++)
2227
		e1000_clean_tx_ring(adapter, &adapter->tx_ring[i]);
L
Linus Torvalds 已提交
2228 2229 2230 2231 2232
}

/**
 * e1000_free_rx_resources - Free Rx Resources
 * @adapter: board private structure
2233
 * @rx_ring: ring to clean the resources from
L
Linus Torvalds 已提交
2234 2235 2236 2237
 *
 * Free all receive software resources
 **/

2238 2239
static void e1000_free_rx_resources(struct e1000_adapter *adapter,
				    struct e1000_rx_ring *rx_ring)
L
Linus Torvalds 已提交
2240 2241 2242
{
	struct pci_dev *pdev = adapter->pdev;

2243
	e1000_clean_rx_ring(adapter, rx_ring);
L
Linus Torvalds 已提交
2244 2245 2246

	vfree(rx_ring->buffer_info);
	rx_ring->buffer_info = NULL;
2247 2248 2249 2250
	kfree(rx_ring->ps_page);
	rx_ring->ps_page = NULL;
	kfree(rx_ring->ps_page_dma);
	rx_ring->ps_page_dma = NULL;
L
Linus Torvalds 已提交
2251 2252 2253 2254 2255 2256 2257

	pci_free_consistent(pdev, rx_ring->size, rx_ring->desc, rx_ring->dma);

	rx_ring->desc = NULL;
}

/**
2258
 * e1000_free_all_rx_resources - Free Rx Resources for All Queues
L
Linus Torvalds 已提交
2259
 * @adapter: board private structure
2260 2261 2262 2263
 *
 * Free all receive software resources
 **/

2264
void e1000_free_all_rx_resources(struct e1000_adapter *adapter)
2265 2266 2267
{
	int i;

2268
	for (i = 0; i < adapter->num_rx_queues; i++)
2269 2270 2271 2272 2273 2274 2275
		e1000_free_rx_resources(adapter, &adapter->rx_ring[i]);
}

/**
 * e1000_clean_rx_ring - Free Rx Buffers per Queue
 * @adapter: board private structure
 * @rx_ring: ring to free buffers from
L
Linus Torvalds 已提交
2276 2277
 **/

2278 2279
static void e1000_clean_rx_ring(struct e1000_adapter *adapter,
				struct e1000_rx_ring *rx_ring)
L
Linus Torvalds 已提交
2280
{
J
Joe Perches 已提交
2281
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
2282
	struct e1000_buffer *buffer_info;
2283 2284
	struct e1000_ps_page *ps_page;
	struct e1000_ps_page_dma *ps_page_dma;
L
Linus Torvalds 已提交
2285 2286
	struct pci_dev *pdev = adapter->pdev;
	unsigned long size;
2287
	unsigned int i, j;
L
Linus Torvalds 已提交
2288 2289

	/* Free all the Rx ring sk_buffs */
J
Jesse Brandeburg 已提交
2290
	for (i = 0; i < rx_ring->count; i++) {
L
Linus Torvalds 已提交
2291
		buffer_info = &rx_ring->buffer_info[i];
J
Jesse Brandeburg 已提交
2292
		if (buffer_info->skb) {
L
Linus Torvalds 已提交
2293 2294 2295 2296 2297 2298 2299
			pci_unmap_single(pdev,
					 buffer_info->dma,
					 buffer_info->length,
					 PCI_DMA_FROMDEVICE);

			dev_kfree_skb(buffer_info->skb);
			buffer_info->skb = NULL;
2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310
		}
		ps_page = &rx_ring->ps_page[i];
		ps_page_dma = &rx_ring->ps_page_dma[i];
		for (j = 0; j < adapter->rx_ps_pages; j++) {
			if (!ps_page->ps_page[j]) break;
			pci_unmap_page(pdev,
				       ps_page_dma->ps_page_dma[j],
				       PAGE_SIZE, PCI_DMA_FROMDEVICE);
			ps_page_dma->ps_page_dma[j] = 0;
			put_page(ps_page->ps_page[j]);
			ps_page->ps_page[j] = NULL;
L
Linus Torvalds 已提交
2311 2312 2313 2314 2315
		}
	}

	size = sizeof(struct e1000_buffer) * rx_ring->count;
	memset(rx_ring->buffer_info, 0, size);
2316 2317 2318 2319
	size = sizeof(struct e1000_ps_page) * rx_ring->count;
	memset(rx_ring->ps_page, 0, size);
	size = sizeof(struct e1000_ps_page_dma) * rx_ring->count;
	memset(rx_ring->ps_page_dma, 0, size);
L
Linus Torvalds 已提交
2320 2321 2322 2323 2324 2325 2326 2327

	/* Zero out the descriptor ring */

	memset(rx_ring->desc, 0, rx_ring->size);

	rx_ring->next_to_clean = 0;
	rx_ring->next_to_use = 0;

J
Joe Perches 已提交
2328 2329
	writel(0, hw->hw_addr + rx_ring->rdh);
	writel(0, hw->hw_addr + rx_ring->rdt);
2330 2331 2332 2333 2334 2335 2336
}

/**
 * e1000_clean_all_rx_rings - Free Rx Buffers for all queues
 * @adapter: board private structure
 **/

2337
static void e1000_clean_all_rx_rings(struct e1000_adapter *adapter)
2338 2339 2340
{
	int i;

2341
	for (i = 0; i < adapter->num_rx_queues; i++)
2342
		e1000_clean_rx_ring(adapter, &adapter->rx_ring[i]);
L
Linus Torvalds 已提交
2343 2344 2345 2346 2347
}

/* The 82542 2.0 (revision 2) needs to have the receive unit in reset
 * and memory write and invalidate disabled for certain operations
 */
2348
static void e1000_enter_82542_rst(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
2349
{
J
Joe Perches 已提交
2350
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
2351
	struct net_device *netdev = adapter->netdev;
2352
	u32 rctl;
L
Linus Torvalds 已提交
2353

J
Joe Perches 已提交
2354
	e1000_pci_clear_mwi(hw);
L
Linus Torvalds 已提交
2355

J
Joe Perches 已提交
2356
	rctl = er32(RCTL);
L
Linus Torvalds 已提交
2357
	rctl |= E1000_RCTL_RST;
J
Joe Perches 已提交
2358 2359
	ew32(RCTL, rctl);
	E1000_WRITE_FLUSH();
L
Linus Torvalds 已提交
2360 2361
	mdelay(5);

J
Jesse Brandeburg 已提交
2362
	if (netif_running(netdev))
2363
		e1000_clean_all_rx_rings(adapter);
L
Linus Torvalds 已提交
2364 2365
}

2366
static void e1000_leave_82542_rst(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
2367
{
J
Joe Perches 已提交
2368
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
2369
	struct net_device *netdev = adapter->netdev;
2370
	u32 rctl;
L
Linus Torvalds 已提交
2371

J
Joe Perches 已提交
2372
	rctl = er32(RCTL);
L
Linus Torvalds 已提交
2373
	rctl &= ~E1000_RCTL_RST;
J
Joe Perches 已提交
2374 2375
	ew32(RCTL, rctl);
	E1000_WRITE_FLUSH();
L
Linus Torvalds 已提交
2376 2377
	mdelay(5);

J
Joe Perches 已提交
2378 2379
	if (hw->pci_cmd_word & PCI_COMMAND_INVALIDATE)
		e1000_pci_set_mwi(hw);
L
Linus Torvalds 已提交
2380

J
Jesse Brandeburg 已提交
2381
	if (netif_running(netdev)) {
2382 2383
		/* No need to loop, because 82542 supports only 1 queue */
		struct e1000_rx_ring *ring = &adapter->rx_ring[0];
2384
		e1000_configure_rx(adapter);
2385
		adapter->alloc_rx_buf(adapter, ring, E1000_DESC_UNUSED(ring));
L
Linus Torvalds 已提交
2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396
	}
}

/**
 * e1000_set_mac - Change the Ethernet Address of the NIC
 * @netdev: network interface device structure
 * @p: pointer to an address structure
 *
 * Returns 0 on success, negative on failure
 **/

2397
static int e1000_set_mac(struct net_device *netdev, void *p)
L
Linus Torvalds 已提交
2398
{
2399
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
2400
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
2401 2402
	struct sockaddr *addr = p;

J
Jesse Brandeburg 已提交
2403
	if (!is_valid_ether_addr(addr->sa_data))
L
Linus Torvalds 已提交
2404 2405 2406 2407
		return -EADDRNOTAVAIL;

	/* 82542 2.0 needs to be in reset to write receive address registers */

J
Joe Perches 已提交
2408
	if (hw->mac_type == e1000_82542_rev2_0)
L
Linus Torvalds 已提交
2409 2410 2411
		e1000_enter_82542_rst(adapter);

	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
J
Joe Perches 已提交
2412
	memcpy(hw->mac_addr, addr->sa_data, netdev->addr_len);
L
Linus Torvalds 已提交
2413

J
Joe Perches 已提交
2414
	e1000_rar_set(hw, hw->mac_addr, 0);
L
Linus Torvalds 已提交
2415

2416 2417
	/* With 82571 controllers, LAA may be overwritten (with the default)
	 * due to controller reset from the other port. */
J
Joe Perches 已提交
2418
	if (hw->mac_type == e1000_82571) {
2419
		/* activate the work around */
J
Joe Perches 已提交
2420
		hw->laa_is_present = 1;
2421

J
Jesse Brandeburg 已提交
2422 2423 2424
		/* Hold a copy of the LAA in RAR[14] This is done so that
		 * between the time RAR[0] gets clobbered  and the time it
		 * gets fixed (in e1000_watchdog), the actual LAA is in one
2425
		 * of the RARs and no incoming packets directed to this port
J
Jesse Brandeburg 已提交
2426
		 * are dropped. Eventaully the LAA will be in RAR[0] and
2427
		 * RAR[14] */
J
Joe Perches 已提交
2428
		e1000_rar_set(hw, hw->mac_addr,
2429 2430 2431
					E1000_RAR_ENTRIES - 1);
	}

J
Joe Perches 已提交
2432
	if (hw->mac_type == e1000_82542_rev2_0)
L
Linus Torvalds 已提交
2433 2434 2435 2436 2437 2438
		e1000_leave_82542_rst(adapter);

	return 0;
}

/**
2439
 * e1000_set_rx_mode - Secondary Unicast, Multicast and Promiscuous mode set
L
Linus Torvalds 已提交
2440 2441
 * @netdev: network interface device structure
 *
2442 2443 2444
 * The set_rx_mode entry point is called whenever the unicast or multicast
 * address lists or the network interface flags are updated. This routine is
 * responsible for configuring the hardware for proper unicast, multicast,
L
Linus Torvalds 已提交
2445 2446 2447
 * promiscuous mode, and all-multi behavior.
 **/

2448
static void e1000_set_rx_mode(struct net_device *netdev)
L
Linus Torvalds 已提交
2449
{
2450
	struct e1000_adapter *adapter = netdev_priv(netdev);
L
Linus Torvalds 已提交
2451
	struct e1000_hw *hw = &adapter->hw;
2452 2453
	struct dev_addr_list *uc_ptr;
	struct dev_addr_list *mc_ptr;
2454 2455
	u32 rctl;
	u32 hash_value;
2456
	int i, rar_entries = E1000_RAR_ENTRIES;
2457 2458 2459 2460
	int mta_reg_count = (hw->mac_type == e1000_ich8lan) ?
				E1000_NUM_MTA_REGISTERS_ICH8LAN :
				E1000_NUM_MTA_REGISTERS;

J
Joe Perches 已提交
2461
	if (hw->mac_type == e1000_ich8lan)
2462
		rar_entries = E1000_RAR_ENTRIES_ICH8LAN;
L
Linus Torvalds 已提交
2463

2464
	/* reserve RAR[14] for LAA over-write work-around */
J
Joe Perches 已提交
2465
	if (hw->mac_type == e1000_82571)
2466
		rar_entries--;
L
Linus Torvalds 已提交
2467

2468 2469
	/* Check for Promiscuous and All Multicast modes */

J
Joe Perches 已提交
2470
	rctl = er32(RCTL);
L
Linus Torvalds 已提交
2471

J
Jesse Brandeburg 已提交
2472
	if (netdev->flags & IFF_PROMISC) {
L
Linus Torvalds 已提交
2473
		rctl |= (E1000_RCTL_UPE | E1000_RCTL_MPE);
2474
		rctl &= ~E1000_RCTL_VFE;
L
Linus Torvalds 已提交
2475
	} else {
2476 2477 2478 2479 2480
		if (netdev->flags & IFF_ALLMULTI) {
			rctl |= E1000_RCTL_MPE;
		} else {
			rctl &= ~E1000_RCTL_MPE;
		}
2481
		if (adapter->hw.mac_type != e1000_ich8lan)
2482
			rctl |= E1000_RCTL_VFE;
2483 2484 2485 2486 2487 2488 2489 2490
	}

	uc_ptr = NULL;
	if (netdev->uc_count > rar_entries - 1) {
		rctl |= E1000_RCTL_UPE;
	} else if (!(netdev->flags & IFF_PROMISC)) {
		rctl &= ~E1000_RCTL_UPE;
		uc_ptr = netdev->uc_list;
L
Linus Torvalds 已提交
2491 2492
	}

J
Joe Perches 已提交
2493
	ew32(RCTL, rctl);
L
Linus Torvalds 已提交
2494 2495 2496

	/* 82542 2.0 needs to be in reset to write receive address registers */

J
Jesse Brandeburg 已提交
2497
	if (hw->mac_type == e1000_82542_rev2_0)
L
Linus Torvalds 已提交
2498 2499
		e1000_enter_82542_rst(adapter);

2500 2501 2502 2503
	/* load the first 14 addresses into the exact filters 1-14. Unicast
	 * addresses take precedence to avoid disabling unicast filtering
	 * when possible.
	 *
L
Linus Torvalds 已提交
2504 2505
	 * RAR 0 is used for the station MAC adddress
	 * if there are not 14 addresses, go ahead and clear the filters
2506
	 * -- with 82571 controllers only 0-13 entries are filled here
L
Linus Torvalds 已提交
2507 2508 2509
	 */
	mc_ptr = netdev->mc_list;

J
Jesse Brandeburg 已提交
2510
	for (i = 1; i < rar_entries; i++) {
2511 2512 2513 2514 2515
		if (uc_ptr) {
			e1000_rar_set(hw, uc_ptr->da_addr, i);
			uc_ptr = uc_ptr->next;
		} else if (mc_ptr) {
			e1000_rar_set(hw, mc_ptr->da_addr, i);
L
Linus Torvalds 已提交
2516 2517 2518
			mc_ptr = mc_ptr->next;
		} else {
			E1000_WRITE_REG_ARRAY(hw, RA, i << 1, 0);
J
Joe Perches 已提交
2519
			E1000_WRITE_FLUSH();
L
Linus Torvalds 已提交
2520
			E1000_WRITE_REG_ARRAY(hw, RA, (i << 1) + 1, 0);
J
Joe Perches 已提交
2521
			E1000_WRITE_FLUSH();
L
Linus Torvalds 已提交
2522 2523
		}
	}
2524
	WARN_ON(uc_ptr != NULL);
L
Linus Torvalds 已提交
2525 2526 2527

	/* clear the old settings from the multicast hash table */

2528
	for (i = 0; i < mta_reg_count; i++) {
L
Linus Torvalds 已提交
2529
		E1000_WRITE_REG_ARRAY(hw, MTA, i, 0);
J
Joe Perches 已提交
2530
		E1000_WRITE_FLUSH();
2531
	}
L
Linus Torvalds 已提交
2532 2533 2534

	/* load any remaining addresses into the hash table */

J
Jesse Brandeburg 已提交
2535
	for (; mc_ptr; mc_ptr = mc_ptr->next) {
2536
		hash_value = e1000_hash_mc_addr(hw, mc_ptr->da_addr);
L
Linus Torvalds 已提交
2537 2538 2539
		e1000_mta_set(hw, hash_value);
	}

J
Jesse Brandeburg 已提交
2540
	if (hw->mac_type == e1000_82542_rev2_0)
L
Linus Torvalds 已提交
2541 2542 2543 2544 2545 2546
		e1000_leave_82542_rst(adapter);
}

/* Need to wait a few seconds after link up to get diagnostic information from
 * the phy */

2547
static void e1000_update_phy_info(unsigned long data)
L
Linus Torvalds 已提交
2548
{
2549
	struct e1000_adapter *adapter = (struct e1000_adapter *)data;
J
Joe Perches 已提交
2550 2551
	struct e1000_hw *hw = &adapter->hw;
	e1000_phy_get_info(hw, &adapter->phy_info);
L
Linus Torvalds 已提交
2552 2553 2554 2555 2556 2557 2558
}

/**
 * e1000_82547_tx_fifo_stall - Timer Call-back
 * @data: pointer to adapter cast into an unsigned long
 **/

2559
static void e1000_82547_tx_fifo_stall(unsigned long data)
L
Linus Torvalds 已提交
2560
{
2561
	struct e1000_adapter *adapter = (struct e1000_adapter *)data;
J
Joe Perches 已提交
2562
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
2563
	struct net_device *netdev = adapter->netdev;
2564
	u32 tctl;
L
Linus Torvalds 已提交
2565

J
Jesse Brandeburg 已提交
2566
	if (atomic_read(&adapter->tx_fifo_stall)) {
J
Joe Perches 已提交
2567 2568 2569 2570 2571 2572 2573 2574 2575 2576 2577
		if ((er32(TDT) == er32(TDH)) &&
		   (er32(TDFT) == er32(TDFH)) &&
		   (er32(TDFTS) == er32(TDFHS))) {
			tctl = er32(TCTL);
			ew32(TCTL, tctl & ~E1000_TCTL_EN);
			ew32(TDFT, adapter->tx_head_addr);
			ew32(TDFH, adapter->tx_head_addr);
			ew32(TDFTS, adapter->tx_head_addr);
			ew32(TDFHS, adapter->tx_head_addr);
			ew32(TCTL, tctl);
			E1000_WRITE_FLUSH();
L
Linus Torvalds 已提交
2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591

			adapter->tx_fifo_head = 0;
			atomic_set(&adapter->tx_fifo_stall, 0);
			netif_wake_queue(netdev);
		} else {
			mod_timer(&adapter->tx_fifo_stall_timer, jiffies + 1);
		}
	}
}

/**
 * e1000_watchdog - Timer Call-back
 * @data: pointer to adapter cast into an unsigned long
 **/
2592
static void e1000_watchdog(unsigned long data)
L
Linus Torvalds 已提交
2593
{
2594
	struct e1000_adapter *adapter = (struct e1000_adapter *)data;
J
Joe Perches 已提交
2595
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
2596
	struct net_device *netdev = adapter->netdev;
J
Jeff Kirsher 已提交
2597
	struct e1000_tx_ring *txdr = adapter->tx_ring;
2598 2599
	u32 link, tctl;
	s32 ret_val;
2600

J
Joe Perches 已提交
2601
	ret_val = e1000_check_for_link(hw);
2602
	if ((ret_val == E1000_ERR_PHY) &&
J
Joe Perches 已提交
2603 2604
	    (hw->phy_type == e1000_phy_igp_3) &&
	    (er32(CTRL) & E1000_PHY_CTRL_GBE_DISABLE)) {
2605 2606 2607 2608
		/* See e1000_kumeran_lock_loss_workaround() */
		DPRINTK(LINK, INFO,
			"Gigabit has been disabled, downgrading speed\n");
	}
2609

J
Joe Perches 已提交
2610 2611 2612
	if (hw->mac_type == e1000_82573) {
		e1000_enable_tx_pkt_filtering(hw);
		if (adapter->mng_vlan_id != hw->mng_cookie.vlan_id)
2613
			e1000_update_mng_vlan(adapter);
J
Jesse Brandeburg 已提交
2614
	}
L
Linus Torvalds 已提交
2615

J
Joe Perches 已提交
2616 2617 2618
	if ((hw->media_type == e1000_media_type_internal_serdes) &&
	   !(er32(TXCW) & E1000_TXCW_ANE))
		link = !hw->serdes_link_down;
L
Linus Torvalds 已提交
2619
	else
J
Joe Perches 已提交
2620
		link = er32(STATUS) & E1000_STATUS_LU;
L
Linus Torvalds 已提交
2621

J
Jesse Brandeburg 已提交
2622 2623
	if (link) {
		if (!netif_carrier_ok(netdev)) {
2624
			u32 ctrl;
J
Joe Perches 已提交
2625
			bool txb2b = true;
J
Joe Perches 已提交
2626
			e1000_get_speed_and_duplex(hw,
L
Linus Torvalds 已提交
2627 2628 2629
			                           &adapter->link_speed,
			                           &adapter->link_duplex);

J
Joe Perches 已提交
2630
			ctrl = er32(CTRL);
2631 2632 2633 2634 2635 2636 2637 2638 2639
			DPRINTK(LINK, INFO, "NIC Link is Up %d Mbps %s, "
			        "Flow Control: %s\n",
			        adapter->link_speed,
			        adapter->link_duplex == FULL_DUPLEX ?
			        "Full Duplex" : "Half Duplex",
			        ((ctrl & E1000_CTRL_TFCE) && (ctrl &
			        E1000_CTRL_RFCE)) ? "RX/TX" : ((ctrl &
			        E1000_CTRL_RFCE) ? "RX" : ((ctrl &
			        E1000_CTRL_TFCE) ? "TX" : "None" )));
L
Linus Torvalds 已提交
2640

2641 2642
			/* tweak tx_queue_len according to speed/duplex
			 * and adjust the timeout factor */
2643 2644
			netdev->tx_queue_len = adapter->tx_queue_len;
			adapter->tx_timeout_factor = 1;
2645 2646
			switch (adapter->link_speed) {
			case SPEED_10:
J
Joe Perches 已提交
2647
				txb2b = false;
2648 2649 2650 2651
				netdev->tx_queue_len = 10;
				adapter->tx_timeout_factor = 8;
				break;
			case SPEED_100:
J
Joe Perches 已提交
2652
				txb2b = false;
2653 2654 2655 2656 2657
				netdev->tx_queue_len = 100;
				/* maybe add some timeout factor ? */
				break;
			}

J
Joe Perches 已提交
2658 2659
			if ((hw->mac_type == e1000_82571 ||
			     hw->mac_type == e1000_82572) &&
J
Joe Perches 已提交
2660
			    !txb2b) {
2661
				u32 tarc0;
J
Joe Perches 已提交
2662
				tarc0 = er32(TARC0);
2663
				tarc0 &= ~(1 << 21);
J
Joe Perches 已提交
2664
				ew32(TARC0, tarc0);
2665
			}
2666

2667 2668 2669
			/* disable TSO for pcie and 10/100 speeds, to avoid
			 * some hardware issues */
			if (!adapter->tso_force &&
J
Joe Perches 已提交
2670
			    hw->bus_type == e1000_bus_type_pci_express){
2671 2672 2673
				switch (adapter->link_speed) {
				case SPEED_10:
				case SPEED_100:
2674 2675 2676
					DPRINTK(PROBE,INFO,
				        "10/100 speed: disabling TSO\n");
					netdev->features &= ~NETIF_F_TSO;
A
Auke Kok 已提交
2677
					netdev->features &= ~NETIF_F_TSO6;
2678 2679 2680
					break;
				case SPEED_1000:
					netdev->features |= NETIF_F_TSO;
A
Auke Kok 已提交
2681
					netdev->features |= NETIF_F_TSO6;
2682 2683 2684
					break;
				default:
					/* oops */
2685 2686 2687
					break;
				}
			}
2688 2689 2690

			/* enable transmits in the hardware, need to do this
			 * after setting TARC0 */
J
Joe Perches 已提交
2691
			tctl = er32(TCTL);
2692
			tctl |= E1000_TCTL_EN;
J
Joe Perches 已提交
2693
			ew32(TCTL, tctl);
2694

L
Linus Torvalds 已提交
2695 2696
			netif_carrier_on(netdev);
			netif_wake_queue(netdev);
2697
			mod_timer(&adapter->phy_info_timer, round_jiffies(jiffies + 2 * HZ));
L
Linus Torvalds 已提交
2698
			adapter->smartspeed = 0;
2699 2700
		} else {
			/* make sure the receive unit is started */
J
Joe Perches 已提交
2701 2702 2703
			if (hw->rx_needs_kicking) {
				u32 rctl = er32(RCTL);
				ew32(RCTL, rctl | E1000_RCTL_EN);
2704
			}
L
Linus Torvalds 已提交
2705 2706
		}
	} else {
J
Jesse Brandeburg 已提交
2707
		if (netif_carrier_ok(netdev)) {
L
Linus Torvalds 已提交
2708 2709 2710 2711 2712
			adapter->link_speed = 0;
			adapter->link_duplex = 0;
			DPRINTK(LINK, INFO, "NIC Link is Down\n");
			netif_carrier_off(netdev);
			netif_stop_queue(netdev);
2713
			mod_timer(&adapter->phy_info_timer, round_jiffies(jiffies + 2 * HZ));
2714 2715 2716 2717 2718 2719

			/* 80003ES2LAN workaround--
			 * For packet buffer work-around on link down event;
			 * disable receives in the ISR and
			 * reset device here in the watchdog
			 */
J
Joe Perches 已提交
2720
			if (hw->mac_type == e1000_80003es2lan)
2721 2722
				/* reset device */
				schedule_work(&adapter->reset_task);
L
Linus Torvalds 已提交
2723 2724 2725 2726 2727 2728 2729
		}

		e1000_smartspeed(adapter);
	}

	e1000_update_stats(adapter);

J
Joe Perches 已提交
2730
	hw->tx_packet_delta = adapter->stats.tpt - adapter->tpt_old;
L
Linus Torvalds 已提交
2731
	adapter->tpt_old = adapter->stats.tpt;
J
Joe Perches 已提交
2732
	hw->collision_delta = adapter->stats.colc - adapter->colc_old;
L
Linus Torvalds 已提交
2733 2734 2735 2736 2737 2738 2739
	adapter->colc_old = adapter->stats.colc;

	adapter->gorcl = adapter->stats.gorcl - adapter->gorcl_old;
	adapter->gorcl_old = adapter->stats.gorcl;
	adapter->gotcl = adapter->stats.gotcl - adapter->gotcl_old;
	adapter->gotcl_old = adapter->stats.gotcl;

J
Joe Perches 已提交
2740
	e1000_update_adaptive(hw);
L
Linus Torvalds 已提交
2741

2742
	if (!netif_carrier_ok(netdev)) {
2743
		if (E1000_DESC_UNUSED(txdr) + 1 < txdr->count) {
L
Linus Torvalds 已提交
2744 2745 2746 2747
			/* We've lost link, so the controller stops DMA,
			 * but we've got queued Tx work that's never going
			 * to get done, so reset controller to flush Tx.
			 * (Do the reset outside of interrupt context). */
2748 2749
			adapter->tx_timeout_count++;
			schedule_work(&adapter->reset_task);
L
Linus Torvalds 已提交
2750 2751 2752 2753
		}
	}

	/* Cause software interrupt to ensure rx ring is cleaned */
J
Joe Perches 已提交
2754
	ew32(ICS, E1000_ICS_RXDMT0);
L
Linus Torvalds 已提交
2755

2756
	/* Force detection of hung controller every watchdog period */
J
Joe Perches 已提交
2757
	adapter->detect_tx_hung = true;
L
Linus Torvalds 已提交
2758

J
Jesse Brandeburg 已提交
2759
	/* With 82571 controllers, LAA may be overwritten due to controller
2760
	 * reset from the other port. Set the appropriate LAA in RAR[0] */
J
Joe Perches 已提交
2761 2762
	if (hw->mac_type == e1000_82571 && hw->laa_is_present)
		e1000_rar_set(hw, hw->mac_addr, 0);
2763

L
Linus Torvalds 已提交
2764
	/* Reset the timer */
2765
	mod_timer(&adapter->watchdog_timer, round_jiffies(jiffies + 2 * HZ));
L
Linus Torvalds 已提交
2766 2767
}

J
Jesse Brandeburg 已提交
2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791
enum latency_range {
	lowest_latency = 0,
	low_latency = 1,
	bulk_latency = 2,
	latency_invalid = 255
};

/**
 * e1000_update_itr - update the dynamic ITR value based on statistics
 *      Stores a new ITR value based on packets and byte
 *      counts during the last interrupt.  The advantage of per interrupt
 *      computation is faster updates and more accurate ITR for the current
 *      traffic pattern.  Constants in this function were computed
 *      based on theoretical maximum wire speed and thresholds were set based
 *      on testing data as well as attempting to minimize response time
 *      while increasing bulk throughput.
 *      this functionality is controlled by the InterruptThrottleRate module
 *      parameter (see e1000_param.c)
 * @adapter: pointer to adapter
 * @itr_setting: current adapter->itr
 * @packets: the number of packets during this measurement interval
 * @bytes: the number of bytes during this measurement interval
 **/
static unsigned int e1000_update_itr(struct e1000_adapter *adapter,
2792
				     u16 itr_setting, int packets, int bytes)
J
Jesse Brandeburg 已提交
2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804
{
	unsigned int retval = itr_setting;
	struct e1000_hw *hw = &adapter->hw;

	if (unlikely(hw->mac_type < e1000_82540))
		goto update_itr_done;

	if (packets == 0)
		goto update_itr_done;

	switch (itr_setting) {
	case lowest_latency:
2805 2806 2807 2808
		/* jumbo frames get bulk treatment*/
		if (bytes/packets > 8000)
			retval = bulk_latency;
		else if ((packets < 5) && (bytes > 512))
J
Jesse Brandeburg 已提交
2809 2810 2811 2812
			retval = low_latency;
		break;
	case low_latency:  /* 50 usec aka 20000 ints/s */
		if (bytes > 10000) {
2813 2814 2815 2816
			/* jumbo frames need bulk latency setting */
			if (bytes/packets > 8000)
				retval = bulk_latency;
			else if ((packets < 10) || ((bytes/packets) > 1200))
J
Jesse Brandeburg 已提交
2817 2818 2819
				retval = bulk_latency;
			else if ((packets > 35))
				retval = lowest_latency;
2820 2821 2822
		} else if (bytes/packets > 2000)
			retval = bulk_latency;
		else if (packets <= 2 && bytes < 512)
J
Jesse Brandeburg 已提交
2823 2824 2825 2826 2827 2828
			retval = lowest_latency;
		break;
	case bulk_latency: /* 250 usec aka 4000 ints/s */
		if (bytes > 25000) {
			if (packets > 35)
				retval = low_latency;
2829 2830
		} else if (bytes < 6000) {
			retval = low_latency;
J
Jesse Brandeburg 已提交
2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841
		}
		break;
	}

update_itr_done:
	return retval;
}

static void e1000_set_itr(struct e1000_adapter *adapter)
{
	struct e1000_hw *hw = &adapter->hw;
2842 2843
	u16 current_itr;
	u32 new_itr = adapter->itr;
J
Jesse Brandeburg 已提交
2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858

	if (unlikely(hw->mac_type < e1000_82540))
		return;

	/* for non-gigabit speeds, just fix the interrupt rate at 4000 */
	if (unlikely(adapter->link_speed != SPEED_1000)) {
		current_itr = 0;
		new_itr = 4000;
		goto set_itr_now;
	}

	adapter->tx_itr = e1000_update_itr(adapter,
	                            adapter->tx_itr,
	                            adapter->total_tx_packets,
	                            adapter->total_tx_bytes);
2859 2860 2861 2862
	/* conservative mode (itr 3) eliminates the lowest_latency setting */
	if (adapter->itr_setting == 3 && adapter->tx_itr == lowest_latency)
		adapter->tx_itr = low_latency;

J
Jesse Brandeburg 已提交
2863 2864 2865 2866
	adapter->rx_itr = e1000_update_itr(adapter,
	                            adapter->rx_itr,
	                            adapter->total_rx_packets,
	                            adapter->total_rx_bytes);
2867 2868 2869
	/* conservative mode (itr 3) eliminates the lowest_latency setting */
	if (adapter->itr_setting == 3 && adapter->rx_itr == lowest_latency)
		adapter->rx_itr = low_latency;
J
Jesse Brandeburg 已提交
2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896

	current_itr = max(adapter->rx_itr, adapter->tx_itr);

	switch (current_itr) {
	/* counts and packets in update_itr are dependent on these numbers */
	case lowest_latency:
		new_itr = 70000;
		break;
	case low_latency:
		new_itr = 20000; /* aka hwitr = ~200 */
		break;
	case bulk_latency:
		new_itr = 4000;
		break;
	default:
		break;
	}

set_itr_now:
	if (new_itr != adapter->itr) {
		/* this attempts to bias the interrupt rate towards Bulk
		 * by adding intermediate steps when interrupt rate is
		 * increasing */
		new_itr = new_itr > adapter->itr ?
		             min(adapter->itr + (new_itr >> 2), new_itr) :
		             new_itr;
		adapter->itr = new_itr;
J
Joe Perches 已提交
2897
		ew32(ITR, 1000000000 / (new_itr * 256));
J
Jesse Brandeburg 已提交
2898 2899 2900 2901 2902
	}

	return;
}

L
Linus Torvalds 已提交
2903 2904 2905
#define E1000_TX_FLAGS_CSUM		0x00000001
#define E1000_TX_FLAGS_VLAN		0x00000002
#define E1000_TX_FLAGS_TSO		0x00000004
2906
#define E1000_TX_FLAGS_IPV4		0x00000008
L
Linus Torvalds 已提交
2907 2908 2909
#define E1000_TX_FLAGS_VLAN_MASK	0xffff0000
#define E1000_TX_FLAGS_VLAN_SHIFT	16

2910 2911
static int e1000_tso(struct e1000_adapter *adapter,
		     struct e1000_tx_ring *tx_ring, struct sk_buff *skb)
L
Linus Torvalds 已提交
2912 2913
{
	struct e1000_context_desc *context_desc;
J
Jeff Kirsher 已提交
2914
	struct e1000_buffer *buffer_info;
L
Linus Torvalds 已提交
2915
	unsigned int i;
2916 2917 2918
	u32 cmd_length = 0;
	u16 ipcse = 0, tucse, mss;
	u8 ipcss, ipcso, tucss, tucso, hdr_len;
L
Linus Torvalds 已提交
2919 2920
	int err;

H
Herbert Xu 已提交
2921
	if (skb_is_gso(skb)) {
L
Linus Torvalds 已提交
2922 2923 2924 2925 2926 2927
		if (skb_header_cloned(skb)) {
			err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
			if (err)
				return err;
		}

2928
		hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
2929
		mss = skb_shinfo(skb)->gso_size;
A
Alexey Dobriyan 已提交
2930
		if (skb->protocol == htons(ETH_P_IP)) {
2931 2932 2933
			struct iphdr *iph = ip_hdr(skb);
			iph->tot_len = 0;
			iph->check = 0;
2934 2935 2936 2937
			tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
								 iph->daddr, 0,
								 IPPROTO_TCP,
								 0);
2938
			cmd_length = E1000_TXD_CMD_IP;
2939
			ipcse = skb_transport_offset(skb) - 1;
2940
		} else if (skb->protocol == htons(ETH_P_IPV6)) {
2941
			ipv6_hdr(skb)->payload_len = 0;
2942
			tcp_hdr(skb)->check =
2943 2944 2945
				~csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
						 &ipv6_hdr(skb)->daddr,
						 0, IPPROTO_TCP, 0);
2946 2947
			ipcse = 0;
		}
2948
		ipcss = skb_network_offset(skb);
2949
		ipcso = (void *)&(ip_hdr(skb)->check) - (void *)skb->data;
2950
		tucss = skb_transport_offset(skb);
2951
		tucso = (void *)&(tcp_hdr(skb)->check) - (void *)skb->data;
L
Linus Torvalds 已提交
2952 2953 2954
		tucse = 0;

		cmd_length |= (E1000_TXD_CMD_DEXT | E1000_TXD_CMD_TSE |
2955
			       E1000_TXD_CMD_TCP | (skb->len - (hdr_len)));
L
Linus Torvalds 已提交
2956

2957 2958
		i = tx_ring->next_to_use;
		context_desc = E1000_CONTEXT_DESC(*tx_ring, i);
J
Jeff Kirsher 已提交
2959
		buffer_info = &tx_ring->buffer_info[i];
L
Linus Torvalds 已提交
2960 2961 2962 2963 2964 2965 2966 2967 2968 2969 2970

		context_desc->lower_setup.ip_fields.ipcss  = ipcss;
		context_desc->lower_setup.ip_fields.ipcso  = ipcso;
		context_desc->lower_setup.ip_fields.ipcse  = cpu_to_le16(ipcse);
		context_desc->upper_setup.tcp_fields.tucss = tucss;
		context_desc->upper_setup.tcp_fields.tucso = tucso;
		context_desc->upper_setup.tcp_fields.tucse = cpu_to_le16(tucse);
		context_desc->tcp_seg_setup.fields.mss     = cpu_to_le16(mss);
		context_desc->tcp_seg_setup.fields.hdr_len = hdr_len;
		context_desc->cmd_and_length = cpu_to_le32(cmd_length);

J
Jeff Kirsher 已提交
2971
		buffer_info->time_stamp = jiffies;
2972
		buffer_info->next_to_watch = i;
J
Jeff Kirsher 已提交
2973

2974 2975
		if (++i == tx_ring->count) i = 0;
		tx_ring->next_to_use = i;
L
Linus Torvalds 已提交
2976

J
Joe Perches 已提交
2977
		return true;
L
Linus Torvalds 已提交
2978
	}
J
Joe Perches 已提交
2979
	return false;
L
Linus Torvalds 已提交
2980 2981
}

2982 2983
static bool e1000_tx_csum(struct e1000_adapter *adapter,
			  struct e1000_tx_ring *tx_ring, struct sk_buff *skb)
L
Linus Torvalds 已提交
2984 2985
{
	struct e1000_context_desc *context_desc;
J
Jeff Kirsher 已提交
2986
	struct e1000_buffer *buffer_info;
L
Linus Torvalds 已提交
2987
	unsigned int i;
2988
	u8 css;
L
Linus Torvalds 已提交
2989

2990
	if (likely(skb->ip_summed == CHECKSUM_PARTIAL)) {
2991
		css = skb_transport_offset(skb);
L
Linus Torvalds 已提交
2992

2993
		i = tx_ring->next_to_use;
J
Jeff Kirsher 已提交
2994
		buffer_info = &tx_ring->buffer_info[i];
2995
		context_desc = E1000_CONTEXT_DESC(*tx_ring, i);
L
Linus Torvalds 已提交
2996

2997
		context_desc->lower_setup.ip_config = 0;
L
Linus Torvalds 已提交
2998
		context_desc->upper_setup.tcp_fields.tucss = css;
2999 3000
		context_desc->upper_setup.tcp_fields.tucso =
			css + skb->csum_offset;
L
Linus Torvalds 已提交
3001 3002 3003 3004
		context_desc->upper_setup.tcp_fields.tucse = 0;
		context_desc->tcp_seg_setup.data = 0;
		context_desc->cmd_and_length = cpu_to_le32(E1000_TXD_CMD_DEXT);

J
Jeff Kirsher 已提交
3005
		buffer_info->time_stamp = jiffies;
3006
		buffer_info->next_to_watch = i;
J
Jeff Kirsher 已提交
3007

3008 3009
		if (unlikely(++i == tx_ring->count)) i = 0;
		tx_ring->next_to_use = i;
L
Linus Torvalds 已提交
3010

J
Joe Perches 已提交
3011
		return true;
L
Linus Torvalds 已提交
3012 3013
	}

J
Joe Perches 已提交
3014
	return false;
L
Linus Torvalds 已提交
3015 3016 3017 3018 3019
}

#define E1000_MAX_TXD_PWR	12
#define E1000_MAX_DATA_PER_TXD	(1<<E1000_MAX_TXD_PWR)

3020 3021 3022 3023 3024
static int e1000_tx_map(struct e1000_adapter *adapter,
			struct e1000_tx_ring *tx_ring,
			struct sk_buff *skb, unsigned int first,
			unsigned int max_per_txd, unsigned int nr_frags,
			unsigned int mss)
L
Linus Torvalds 已提交
3025
{
J
Joe Perches 已提交
3026
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
3027 3028 3029 3030 3031 3032 3033 3034
	struct e1000_buffer *buffer_info;
	unsigned int len = skb->len;
	unsigned int offset = 0, size, count = 0, i;
	unsigned int f;
	len -= skb->data_len;

	i = tx_ring->next_to_use;

J
Jesse Brandeburg 已提交
3035
	while (len) {
L
Linus Torvalds 已提交
3036 3037
		buffer_info = &tx_ring->buffer_info[i];
		size = min(len, max_per_txd);
J
Jeff Kirsher 已提交
3038 3039 3040
		/* Workaround for Controller erratum --
		 * descriptor for non-tso packet in a linear SKB that follows a
		 * tso gets written back prematurely before the data is fully
3041
		 * DMA'd to the controller */
J
Jeff Kirsher 已提交
3042
		if (!skb->data_len && tx_ring->last_tx_tso &&
H
Herbert Xu 已提交
3043
		    !skb_is_gso(skb)) {
J
Jeff Kirsher 已提交
3044 3045 3046 3047
			tx_ring->last_tx_tso = 0;
			size -= 4;
		}

L
Linus Torvalds 已提交
3048 3049
		/* Workaround for premature desc write-backs
		 * in TSO mode.  Append 4-byte sentinel desc */
J
Jesse Brandeburg 已提交
3050
		if (unlikely(mss && !nr_frags && size == len && size > 8))
L
Linus Torvalds 已提交
3051
			size -= 4;
3052 3053 3054 3055 3056
		/* work-around for errata 10 and it applies
		 * to all controllers in PCI-X mode
		 * The fix is to make sure that the first descriptor of a
		 * packet is smaller than 2048 - 16 - 16 (or 2016) bytes
		 */
J
Joe Perches 已提交
3057
		if (unlikely((hw->bus_type == e1000_bus_type_pcix) &&
3058 3059
		                (size > 2015) && count == 0))
		        size = 2015;
J
Jesse Brandeburg 已提交
3060

L
Linus Torvalds 已提交
3061 3062
		/* Workaround for potential 82544 hang in PCI-X.  Avoid
		 * terminating buffers within evenly-aligned dwords. */
J
Jesse Brandeburg 已提交
3063
		if (unlikely(adapter->pcix_82544 &&
L
Linus Torvalds 已提交
3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074
		   !((unsigned long)(skb->data + offset + size - 1) & 4) &&
		   size > 4))
			size -= 4;

		buffer_info->length = size;
		buffer_info->dma =
			pci_map_single(adapter->pdev,
				skb->data + offset,
				size,
				PCI_DMA_TODEVICE);
		buffer_info->time_stamp = jiffies;
3075
		buffer_info->next_to_watch = i;
L
Linus Torvalds 已提交
3076 3077 3078 3079

		len -= size;
		offset += size;
		count++;
J
Jesse Brandeburg 已提交
3080
		if (unlikely(++i == tx_ring->count)) i = 0;
L
Linus Torvalds 已提交
3081 3082
	}

J
Jesse Brandeburg 已提交
3083
	for (f = 0; f < nr_frags; f++) {
L
Linus Torvalds 已提交
3084 3085 3086 3087 3088 3089
		struct skb_frag_struct *frag;

		frag = &skb_shinfo(skb)->frags[f];
		len = frag->size;
		offset = frag->page_offset;

J
Jesse Brandeburg 已提交
3090
		while (len) {
L
Linus Torvalds 已提交
3091 3092 3093 3094
			buffer_info = &tx_ring->buffer_info[i];
			size = min(len, max_per_txd);
			/* Workaround for premature desc write-backs
			 * in TSO mode.  Append 4-byte sentinel desc */
J
Jesse Brandeburg 已提交
3095
			if (unlikely(mss && f == (nr_frags-1) && size == len && size > 8))
L
Linus Torvalds 已提交
3096 3097 3098 3099
				size -= 4;
			/* Workaround for potential 82544 hang in PCI-X.
			 * Avoid terminating buffers within evenly-aligned
			 * dwords. */
J
Jesse Brandeburg 已提交
3100
			if (unlikely(adapter->pcix_82544 &&
L
Linus Torvalds 已提交
3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 3111 3112
			   !((unsigned long)(frag->page+offset+size-1) & 4) &&
			   size > 4))
				size -= 4;

			buffer_info->length = size;
			buffer_info->dma =
				pci_map_page(adapter->pdev,
					frag->page,
					offset,
					size,
					PCI_DMA_TODEVICE);
			buffer_info->time_stamp = jiffies;
3113
			buffer_info->next_to_watch = i;
L
Linus Torvalds 已提交
3114 3115 3116 3117

			len -= size;
			offset += size;
			count++;
J
Jesse Brandeburg 已提交
3118
			if (unlikely(++i == tx_ring->count)) i = 0;
L
Linus Torvalds 已提交
3119 3120 3121 3122 3123 3124 3125 3126 3127 3128
		}
	}

	i = (i == 0) ? tx_ring->count - 1 : i - 1;
	tx_ring->buffer_info[i].skb = skb;
	tx_ring->buffer_info[first].next_to_watch = i;

	return count;
}

3129 3130 3131
static void e1000_tx_queue(struct e1000_adapter *adapter,
			   struct e1000_tx_ring *tx_ring, int tx_flags,
			   int count)
L
Linus Torvalds 已提交
3132
{
J
Joe Perches 已提交
3133
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
3134 3135
	struct e1000_tx_desc *tx_desc = NULL;
	struct e1000_buffer *buffer_info;
3136
	u32 txd_upper = 0, txd_lower = E1000_TXD_CMD_IFCS;
L
Linus Torvalds 已提交
3137 3138
	unsigned int i;

J
Jesse Brandeburg 已提交
3139
	if (likely(tx_flags & E1000_TX_FLAGS_TSO)) {
L
Linus Torvalds 已提交
3140 3141
		txd_lower |= E1000_TXD_CMD_DEXT | E1000_TXD_DTYP_D |
		             E1000_TXD_CMD_TSE;
3142 3143
		txd_upper |= E1000_TXD_POPTS_TXSM << 8;

J
Jesse Brandeburg 已提交
3144
		if (likely(tx_flags & E1000_TX_FLAGS_IPV4))
3145
			txd_upper |= E1000_TXD_POPTS_IXSM << 8;
L
Linus Torvalds 已提交
3146 3147
	}

J
Jesse Brandeburg 已提交
3148
	if (likely(tx_flags & E1000_TX_FLAGS_CSUM)) {
L
Linus Torvalds 已提交
3149 3150 3151 3152
		txd_lower |= E1000_TXD_CMD_DEXT | E1000_TXD_DTYP_D;
		txd_upper |= E1000_TXD_POPTS_TXSM << 8;
	}

J
Jesse Brandeburg 已提交
3153
	if (unlikely(tx_flags & E1000_TX_FLAGS_VLAN)) {
L
Linus Torvalds 已提交
3154 3155 3156 3157 3158 3159
		txd_lower |= E1000_TXD_CMD_VLE;
		txd_upper |= (tx_flags & E1000_TX_FLAGS_VLAN_MASK);
	}

	i = tx_ring->next_to_use;

J
Jesse Brandeburg 已提交
3160
	while (count--) {
L
Linus Torvalds 已提交
3161 3162 3163 3164 3165 3166
		buffer_info = &tx_ring->buffer_info[i];
		tx_desc = E1000_TX_DESC(*tx_ring, i);
		tx_desc->buffer_addr = cpu_to_le64(buffer_info->dma);
		tx_desc->lower.data =
			cpu_to_le32(txd_lower | buffer_info->length);
		tx_desc->upper.data = cpu_to_le32(txd_upper);
J
Jesse Brandeburg 已提交
3167
		if (unlikely(++i == tx_ring->count)) i = 0;
L
Linus Torvalds 已提交
3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178
	}

	tx_desc->lower.data |= cpu_to_le32(adapter->txd_cmd);

	/* Force memory writes to complete before letting h/w
	 * know there are new descriptors to fetch.  (Only
	 * applicable for weak-ordered memory model archs,
	 * such as IA-64). */
	wmb();

	tx_ring->next_to_use = i;
J
Joe Perches 已提交
3179
	writel(i, hw->hw_addr + tx_ring->tdt);
3180 3181 3182
	/* we need this if more than one processor can write to our tail
	 * at a time, it syncronizes IO on IA64/Altix systems */
	mmiowb();
L
Linus Torvalds 已提交
3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193 3194 3195 3196
}

/**
 * 82547 workaround to avoid controller hang in half-duplex environment.
 * The workaround is to avoid queuing a large packet that would span
 * the internal Tx FIFO ring boundary by notifying the stack to resend
 * the packet at a later time.  This gives the Tx FIFO an opportunity to
 * flush all packets.  When that occurs, we reset the Tx FIFO pointers
 * to the beginning of the Tx FIFO.
 **/

#define E1000_FIFO_HDR			0x10
#define E1000_82547_PAD_LEN		0x3E0

3197 3198
static int e1000_82547_fifo_workaround(struct e1000_adapter *adapter,
				       struct sk_buff *skb)
L
Linus Torvalds 已提交
3199
{
3200 3201
	u32 fifo_space = adapter->tx_fifo_size - adapter->tx_fifo_head;
	u32 skb_fifo_len = skb->len + E1000_FIFO_HDR;
L
Linus Torvalds 已提交
3202

3203
	skb_fifo_len = ALIGN(skb_fifo_len, E1000_FIFO_HDR);
L
Linus Torvalds 已提交
3204

J
Jesse Brandeburg 已提交
3205
	if (adapter->link_duplex != HALF_DUPLEX)
L
Linus Torvalds 已提交
3206 3207
		goto no_fifo_stall_required;

J
Jesse Brandeburg 已提交
3208
	if (atomic_read(&adapter->tx_fifo_stall))
L
Linus Torvalds 已提交
3209 3210
		return 1;

J
Jesse Brandeburg 已提交
3211
	if (skb_fifo_len >= (E1000_82547_PAD_LEN + fifo_space)) {
L
Linus Torvalds 已提交
3212 3213 3214 3215 3216 3217
		atomic_set(&adapter->tx_fifo_stall, 1);
		return 1;
	}

no_fifo_stall_required:
	adapter->tx_fifo_head += skb_fifo_len;
J
Jesse Brandeburg 已提交
3218
	if (adapter->tx_fifo_head >= adapter->tx_fifo_size)
L
Linus Torvalds 已提交
3219 3220 3221 3222
		adapter->tx_fifo_head -= adapter->tx_fifo_size;
	return 0;
}

3223
#define MINIMUM_DHCP_PACKET_SIZE 282
3224 3225
static int e1000_transfer_dhcp_info(struct e1000_adapter *adapter,
				    struct sk_buff *skb)
3226 3227
{
	struct e1000_hw *hw =  &adapter->hw;
3228
	u16 length, offset;
J
Jesse Brandeburg 已提交
3229
	if (vlan_tx_tag_present(skb)) {
J
Joe Perches 已提交
3230 3231
		if (!((vlan_tx_tag_get(skb) == hw->mng_cookie.vlan_id) &&
			( hw->mng_cookie.status &
3232 3233 3234
			  E1000_MNG_DHCP_COOKIE_STATUS_VLAN_SUPPORT)) )
			return 0;
	}
3235
	if (skb->len > MINIMUM_DHCP_PACKET_SIZE) {
3236
		struct ethhdr *eth = (struct ethhdr *)skb->data;
J
Jesse Brandeburg 已提交
3237 3238
		if ((htons(ETH_P_IP) == eth->h_proto)) {
			const struct iphdr *ip =
3239
				(struct iphdr *)((u8 *)skb->data+14);
J
Jesse Brandeburg 已提交
3240 3241
			if (IPPROTO_UDP == ip->protocol) {
				struct udphdr *udp =
3242
					(struct udphdr *)((u8 *)ip +
3243
						(ip->ihl << 2));
J
Jesse Brandeburg 已提交
3244
				if (ntohs(udp->dest) == 67) {
3245
					offset = (u8 *)udp + 8 - skb->data;
3246 3247 3248
					length = skb->len - offset;

					return e1000_mng_write_dhcp_info(hw,
3249
							(u8 *)udp + 8,
3250 3251 3252 3253 3254 3255 3256 3257
							length);
				}
			}
		}
	}
	return 0;
}

3258 3259 3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275
static int __e1000_maybe_stop_tx(struct net_device *netdev, int size)
{
	struct e1000_adapter *adapter = netdev_priv(netdev);
	struct e1000_tx_ring *tx_ring = adapter->tx_ring;

	netif_stop_queue(netdev);
	/* Herbert's original patch had:
	 *  smp_mb__after_netif_stop_queue();
	 * but since that doesn't exist yet, just open code it. */
	smp_mb();

	/* We need to check again in a case another CPU has just
	 * made room available. */
	if (likely(E1000_DESC_UNUSED(tx_ring) < size))
		return -EBUSY;

	/* A reprieve! */
	netif_start_queue(netdev);
3276
	++adapter->restart_queue;
3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287
	return 0;
}

static int e1000_maybe_stop_tx(struct net_device *netdev,
                               struct e1000_tx_ring *tx_ring, int size)
{
	if (likely(E1000_DESC_UNUSED(tx_ring) >= size))
		return 0;
	return __e1000_maybe_stop_tx(netdev, size);
}

L
Linus Torvalds 已提交
3288
#define TXD_USE_COUNT(S, X) (((S) >> (X)) + 1 )
3289
static int e1000_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
L
Linus Torvalds 已提交
3290
{
3291
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
3292
	struct e1000_hw *hw = &adapter->hw;
3293
	struct e1000_tx_ring *tx_ring;
L
Linus Torvalds 已提交
3294 3295 3296
	unsigned int first, max_per_txd = E1000_MAX_DATA_PER_TXD;
	unsigned int max_txd_pwr = E1000_MAX_TXD_PWR;
	unsigned int tx_flags = 0;
3297
	unsigned int len = skb->len - skb->data_len;
L
Linus Torvalds 已提交
3298
	unsigned long flags;
3299 3300
	unsigned int nr_frags;
	unsigned int mss;
L
Linus Torvalds 已提交
3301
	int count = 0;
3302
	int tso;
L
Linus Torvalds 已提交
3303 3304
	unsigned int f;

3305 3306 3307 3308
	/* This goes back to the question of how to logically map a tx queue
	 * to a flow.  Right now, performance is impacted slightly negatively
	 * if using multiple tx queues.  If the stack breaks away from a
	 * single qdisc implementation, we can look at this again. */
3309
	tx_ring = adapter->tx_ring;
3310

3311
	if (unlikely(skb->len <= 0)) {
L
Linus Torvalds 已提交
3312 3313 3314 3315
		dev_kfree_skb_any(skb);
		return NETDEV_TX_OK;
	}

3316 3317
	/* 82571 and newer doesn't need the workaround that limited descriptor
	 * length to 4kB */
J
Joe Perches 已提交
3318
	if (hw->mac_type >= e1000_82571)
3319 3320
		max_per_txd = 8192;

3321
	mss = skb_shinfo(skb)->gso_size;
3322
	/* The controller does a simple calculation to
L
Linus Torvalds 已提交
3323 3324 3325 3326 3327
	 * make sure there is enough room in the FIFO before
	 * initiating the DMA for each buffer.  The calc is:
	 * 4 = ceil(buffer len/mss).  To make sure we don't
	 * overrun the FIFO, adjust the max buffer len if mss
	 * drops. */
J
Jesse Brandeburg 已提交
3328
	if (mss) {
3329
		u8 hdr_len;
L
Linus Torvalds 已提交
3330 3331
		max_per_txd = min(mss << 2, max_per_txd);
		max_txd_pwr = fls(max_per_txd) - 1;
J
Jeff Kirsher 已提交
3332

3333 3334 3335
		/* TSO Workaround for 82571/2/3 Controllers -- if skb->data
		* points to just header, pull a few bytes of payload from
		* frags into skb->data */
3336
		hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
3337
		if (skb->data_len && hdr_len == len) {
J
Joe Perches 已提交
3338
			switch (hw->mac_type) {
3339
				unsigned int pull_size;
3340 3341 3342 3343 3344 3345 3346
			case e1000_82544:
				/* Make sure we have room to chop off 4 bytes,
				 * and that the end alignment will work out to
				 * this hardware's requirements
				 * NOTE: this is a TSO only workaround
				 * if end byte alignment not correct move us
				 * into the next dword */
3347
				if ((unsigned long)(skb_tail_pointer(skb) - 1) & 4)
3348 3349
					break;
				/* fall through */
3350 3351 3352
			case e1000_82571:
			case e1000_82572:
			case e1000_82573:
3353
			case e1000_ich8lan:
3354 3355
				pull_size = min((unsigned int)4, skb->data_len);
				if (!__pskb_pull_tail(skb, pull_size)) {
A
Auke Kok 已提交
3356
					DPRINTK(DRV, ERR,
3357 3358
						"__pskb_pull_tail failed.\n");
					dev_kfree_skb_any(skb);
J
Jeff Garzik 已提交
3359
					return NETDEV_TX_OK;
3360 3361 3362 3363 3364 3365
				}
				len = skb->len - skb->data_len;
				break;
			default:
				/* do nothing */
				break;
3366
			}
J
Jeff Kirsher 已提交
3367
		}
L
Linus Torvalds 已提交
3368 3369
	}

J
Jeff Kirsher 已提交
3370
	/* reserve a descriptor for the offload context */
3371
	if ((mss) || (skb->ip_summed == CHECKSUM_PARTIAL))
L
Linus Torvalds 已提交
3372
		count++;
3373
	count++;
J
Jeff Kirsher 已提交
3374 3375

	/* Controller Erratum workaround */
H
Herbert Xu 已提交
3376
	if (!skb->data_len && tx_ring->last_tx_tso && !skb_is_gso(skb))
J
Jeff Kirsher 已提交
3377 3378
		count++;

L
Linus Torvalds 已提交
3379 3380
	count += TXD_USE_COUNT(len, max_txd_pwr);

J
Jesse Brandeburg 已提交
3381
	if (adapter->pcix_82544)
L
Linus Torvalds 已提交
3382 3383
		count++;

J
Jesse Brandeburg 已提交
3384
	/* work-around for errata 10 and it applies to all controllers
3385 3386
	 * in PCI-X mode, so add one more descriptor to the count
	 */
J
Joe Perches 已提交
3387
	if (unlikely((hw->bus_type == e1000_bus_type_pcix) &&
3388 3389 3390
			(len > 2015)))
		count++;

L
Linus Torvalds 已提交
3391
	nr_frags = skb_shinfo(skb)->nr_frags;
J
Jesse Brandeburg 已提交
3392
	for (f = 0; f < nr_frags; f++)
L
Linus Torvalds 已提交
3393 3394
		count += TXD_USE_COUNT(skb_shinfo(skb)->frags[f].size,
				       max_txd_pwr);
J
Jesse Brandeburg 已提交
3395
	if (adapter->pcix_82544)
L
Linus Torvalds 已提交
3396 3397
		count += nr_frags;

3398

J
Joe Perches 已提交
3399 3400
	if (hw->tx_pkt_filtering &&
	    (hw->mac_type == e1000_82573))
3401 3402
		e1000_transfer_dhcp_info(adapter, skb);

3403
	if (!spin_trylock_irqsave(&tx_ring->tx_lock, flags))
3404 3405
		/* Collision - tell upper layer to requeue */
		return NETDEV_TX_LOCKED;
L
Linus Torvalds 已提交
3406 3407 3408

	/* need: count + 2 desc gap to keep tail from touching
	 * head, otherwise try next time */
3409
	if (unlikely(e1000_maybe_stop_tx(netdev, tx_ring, count + 2))) {
3410
		spin_unlock_irqrestore(&tx_ring->tx_lock, flags);
L
Linus Torvalds 已提交
3411 3412 3413
		return NETDEV_TX_BUSY;
	}

J
Joe Perches 已提交
3414
	if (unlikely(hw->mac_type == e1000_82547)) {
J
Jesse Brandeburg 已提交
3415
		if (unlikely(e1000_82547_fifo_workaround(adapter, skb))) {
L
Linus Torvalds 已提交
3416
			netif_stop_queue(netdev);
A
Auke Kok 已提交
3417
			mod_timer(&adapter->tx_fifo_stall_timer, jiffies + 1);
3418
			spin_unlock_irqrestore(&tx_ring->tx_lock, flags);
L
Linus Torvalds 已提交
3419 3420 3421 3422
			return NETDEV_TX_BUSY;
		}
	}

J
Jesse Brandeburg 已提交
3423
	if (unlikely(adapter->vlgrp && vlan_tx_tag_present(skb))) {
L
Linus Torvalds 已提交
3424 3425 3426 3427
		tx_flags |= E1000_TX_FLAGS_VLAN;
		tx_flags |= (vlan_tx_tag_get(skb) << E1000_TX_FLAGS_VLAN_SHIFT);
	}

3428
	first = tx_ring->next_to_use;
J
Jesse Brandeburg 已提交
3429

3430
	tso = e1000_tso(adapter, tx_ring, skb);
L
Linus Torvalds 已提交
3431 3432
	if (tso < 0) {
		dev_kfree_skb_any(skb);
3433
		spin_unlock_irqrestore(&tx_ring->tx_lock, flags);
L
Linus Torvalds 已提交
3434 3435 3436
		return NETDEV_TX_OK;
	}

J
Jeff Kirsher 已提交
3437 3438
	if (likely(tso)) {
		tx_ring->last_tx_tso = 1;
L
Linus Torvalds 已提交
3439
		tx_flags |= E1000_TX_FLAGS_TSO;
J
Jeff Kirsher 已提交
3440
	} else if (likely(e1000_tx_csum(adapter, tx_ring, skb)))
L
Linus Torvalds 已提交
3441 3442
		tx_flags |= E1000_TX_FLAGS_CSUM;

3443
	/* Old method was to assume IPv4 packet by default if TSO was enabled.
3444
	 * 82571 hardware supports TSO capabilities for IPv6 as well...
3445
	 * no longer assume, we must. */
A
Alexey Dobriyan 已提交
3446
	if (likely(skb->protocol == htons(ETH_P_IP)))
3447 3448
		tx_flags |= E1000_TX_FLAGS_IPV4;

3449 3450 3451
	e1000_tx_queue(adapter, tx_ring, tx_flags,
	               e1000_tx_map(adapter, tx_ring, skb, first,
	                            max_per_txd, nr_frags, mss));
L
Linus Torvalds 已提交
3452 3453 3454 3455

	netdev->trans_start = jiffies;

	/* Make sure there is space in the ring for the next send. */
3456
	e1000_maybe_stop_tx(netdev, tx_ring, MAX_SKB_FRAGS + 2);
L
Linus Torvalds 已提交
3457

3458
	spin_unlock_irqrestore(&tx_ring->tx_lock, flags);
L
Linus Torvalds 已提交
3459 3460 3461 3462 3463 3464 3465 3466
	return NETDEV_TX_OK;
}

/**
 * e1000_tx_timeout - Respond to a Tx Hang
 * @netdev: network interface device structure
 **/

3467
static void e1000_tx_timeout(struct net_device *netdev)
L
Linus Torvalds 已提交
3468
{
3469
	struct e1000_adapter *adapter = netdev_priv(netdev);
L
Linus Torvalds 已提交
3470 3471

	/* Do the reset outside of interrupt context */
3472 3473
	adapter->tx_timeout_count++;
	schedule_work(&adapter->reset_task);
L
Linus Torvalds 已提交
3474 3475
}

3476
static void e1000_reset_task(struct work_struct *work)
L
Linus Torvalds 已提交
3477
{
3478 3479
	struct e1000_adapter *adapter =
		container_of(work, struct e1000_adapter, reset_task);
L
Linus Torvalds 已提交
3480

3481
	e1000_reinit_locked(adapter);
L
Linus Torvalds 已提交
3482 3483 3484 3485 3486 3487 3488 3489 3490 3491
}

/**
 * e1000_get_stats - Get System Network Statistics
 * @netdev: network interface device structure
 *
 * Returns the address of the device statistics structure.
 * The statistics are actually updated from the timer callback.
 **/

3492
static struct net_device_stats *e1000_get_stats(struct net_device *netdev)
L
Linus Torvalds 已提交
3493
{
3494
	struct e1000_adapter *adapter = netdev_priv(netdev);
L
Linus Torvalds 已提交
3495

J
Jeff Kirsher 已提交
3496
	/* only return the current stats */
L
Linus Torvalds 已提交
3497 3498 3499 3500 3501 3502 3503 3504 3505 3506 3507
	return &adapter->net_stats;
}

/**
 * e1000_change_mtu - Change the Maximum Transfer Unit
 * @netdev: network interface device structure
 * @new_mtu: new value for maximum frame size
 *
 * Returns 0 on success, negative on failure
 **/

3508
static int e1000_change_mtu(struct net_device *netdev, int new_mtu)
L
Linus Torvalds 已提交
3509
{
3510
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
3511
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
3512
	int max_frame = new_mtu + ENET_HEADER_SIZE + ETHERNET_FCS_SIZE;
3513
	u16 eeprom_data = 0;
L
Linus Torvalds 已提交
3514

J
Jesse Brandeburg 已提交
3515 3516 3517
	if ((max_frame < MINIMUM_ETHERNET_FRAME_SIZE) ||
	    (max_frame > MAX_JUMBO_FRAME_SIZE)) {
		DPRINTK(PROBE, ERR, "Invalid MTU setting\n");
L
Linus Torvalds 已提交
3518
		return -EINVAL;
3519
	}
L
Linus Torvalds 已提交
3520

3521
	/* Adapter-specific max frame size limits. */
J
Joe Perches 已提交
3522
	switch (hw->mac_type) {
3523
	case e1000_undefined ... e1000_82542_rev2_1:
3524
	case e1000_ich8lan:
3525 3526
		if (max_frame > MAXIMUM_ETHERNET_FRAME_SIZE) {
			DPRINTK(PROBE, ERR, "Jumbo Frames not supported.\n");
3527 3528
			return -EINVAL;
		}
3529
		break;
3530
	case e1000_82573:
3531 3532 3533
		/* Jumbo Frames not supported if:
		 * - this is not an 82573L device
		 * - ASPM is enabled in any way (0x1A bits 3:2) */
J
Joe Perches 已提交
3534
		e1000_read_eeprom(hw, EEPROM_INIT_3GIO_3, 1,
3535
		                  &eeprom_data);
J
Joe Perches 已提交
3536
		if ((hw->device_id != E1000_DEV_ID_82573L) ||
3537
		    (eeprom_data & EEPROM_WORD1A_ASPM_MASK)) {
3538 3539 3540 3541 3542 3543 3544
			if (max_frame > MAXIMUM_ETHERNET_FRAME_SIZE) {
				DPRINTK(PROBE, ERR,
			            	"Jumbo Frames not supported.\n");
				return -EINVAL;
			}
			break;
		}
3545 3546
		/* ERT will be enabled later to enable wire speed receives */

3547
		/* fall through to get support */
3548 3549
	case e1000_82571:
	case e1000_82572:
3550
	case e1000_80003es2lan:
3551 3552 3553 3554 3555 3556 3557 3558 3559
#define MAX_STD_JUMBO_FRAME_SIZE 9234
		if (max_frame > MAX_STD_JUMBO_FRAME_SIZE) {
			DPRINTK(PROBE, ERR, "MTU > 9216 not supported.\n");
			return -EINVAL;
		}
		break;
	default:
		/* Capable of supporting up to MAX_JUMBO_FRAME_SIZE limit. */
		break;
L
Linus Torvalds 已提交
3560 3561
	}

3562
	/* NOTE: netdev_alloc_skb reserves 16 bytes, and typically NET_IP_ALIGN
3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577 3578 3579 3580 3581 3582
	 * means we reserve 2 more, this pushes us to allocate from the next
	 * larger slab size
	 * i.e. RXBUFFER_2048 --> size-4096 slab */

	if (max_frame <= E1000_RXBUFFER_256)
		adapter->rx_buffer_len = E1000_RXBUFFER_256;
	else if (max_frame <= E1000_RXBUFFER_512)
		adapter->rx_buffer_len = E1000_RXBUFFER_512;
	else if (max_frame <= E1000_RXBUFFER_1024)
		adapter->rx_buffer_len = E1000_RXBUFFER_1024;
	else if (max_frame <= E1000_RXBUFFER_2048)
		adapter->rx_buffer_len = E1000_RXBUFFER_2048;
	else if (max_frame <= E1000_RXBUFFER_4096)
		adapter->rx_buffer_len = E1000_RXBUFFER_4096;
	else if (max_frame <= E1000_RXBUFFER_8192)
		adapter->rx_buffer_len = E1000_RXBUFFER_8192;
	else if (max_frame <= E1000_RXBUFFER_16384)
		adapter->rx_buffer_len = E1000_RXBUFFER_16384;

	/* adjust allocation if LPE protects us, and we aren't using SBP */
J
Joe Perches 已提交
3583
	if (!hw->tbi_compatibility_on &&
3584 3585 3586
	    ((max_frame == MAXIMUM_ETHERNET_FRAME_SIZE) ||
	     (max_frame == MAXIMUM_ETHERNET_VLAN_SIZE)))
		adapter->rx_buffer_len = MAXIMUM_ETHERNET_VLAN_SIZE;
3587

3588
	netdev->mtu = new_mtu;
J
Joe Perches 已提交
3589
	hw->max_frame_size = max_frame;
3590

3591 3592
	if (netif_running(netdev))
		e1000_reinit_locked(adapter);
L
Linus Torvalds 已提交
3593 3594 3595 3596 3597 3598 3599 3600 3601

	return 0;
}

/**
 * e1000_update_stats - Update the board statistics counters
 * @adapter: board private structure
 **/

3602
void e1000_update_stats(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
3603 3604
{
	struct e1000_hw *hw = &adapter->hw;
3605
	struct pci_dev *pdev = adapter->pdev;
L
Linus Torvalds 已提交
3606
	unsigned long flags;
3607
	u16 phy_tmp;
L
Linus Torvalds 已提交
3608 3609 3610

#define PHY_IDLE_ERROR_COUNT_MASK 0x00FF

3611 3612 3613 3614
	/*
	 * Prevent stats update while adapter is being reset, or if the pci
	 * connection is down.
	 */
A
Auke Kok 已提交
3615
	if (adapter->link_speed == 0)
3616
		return;
3617
	if (pci_channel_offline(pdev))
A
Auke Kok 已提交
3618 3619
		return;

L
Linus Torvalds 已提交
3620 3621
	spin_lock_irqsave(&adapter->stats_lock, flags);

3622
	/* these counters are modified from e1000_tbi_adjust_stats,
L
Linus Torvalds 已提交
3623 3624 3625 3626
	 * called from the interrupt context, so they must only
	 * be written while holding adapter->stats_lock
	 */

J
Joe Perches 已提交
3627 3628 3629 3630 3631 3632 3633 3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645 3646 3647 3648 3649 3650 3651 3652 3653 3654 3655 3656 3657 3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677 3678 3679 3680 3681
	adapter->stats.crcerrs += er32(CRCERRS);
	adapter->stats.gprc += er32(GPRC);
	adapter->stats.gorcl += er32(GORCL);
	adapter->stats.gorch += er32(GORCH);
	adapter->stats.bprc += er32(BPRC);
	adapter->stats.mprc += er32(MPRC);
	adapter->stats.roc += er32(ROC);

	if (hw->mac_type != e1000_ich8lan) {
		adapter->stats.prc64 += er32(PRC64);
		adapter->stats.prc127 += er32(PRC127);
		adapter->stats.prc255 += er32(PRC255);
		adapter->stats.prc511 += er32(PRC511);
		adapter->stats.prc1023 += er32(PRC1023);
		adapter->stats.prc1522 += er32(PRC1522);
	}

	adapter->stats.symerrs += er32(SYMERRS);
	adapter->stats.mpc += er32(MPC);
	adapter->stats.scc += er32(SCC);
	adapter->stats.ecol += er32(ECOL);
	adapter->stats.mcc += er32(MCC);
	adapter->stats.latecol += er32(LATECOL);
	adapter->stats.dc += er32(DC);
	adapter->stats.sec += er32(SEC);
	adapter->stats.rlec += er32(RLEC);
	adapter->stats.xonrxc += er32(XONRXC);
	adapter->stats.xontxc += er32(XONTXC);
	adapter->stats.xoffrxc += er32(XOFFRXC);
	adapter->stats.xofftxc += er32(XOFFTXC);
	adapter->stats.fcruc += er32(FCRUC);
	adapter->stats.gptc += er32(GPTC);
	adapter->stats.gotcl += er32(GOTCL);
	adapter->stats.gotch += er32(GOTCH);
	adapter->stats.rnbc += er32(RNBC);
	adapter->stats.ruc += er32(RUC);
	adapter->stats.rfc += er32(RFC);
	adapter->stats.rjc += er32(RJC);
	adapter->stats.torl += er32(TORL);
	adapter->stats.torh += er32(TORH);
	adapter->stats.totl += er32(TOTL);
	adapter->stats.toth += er32(TOTH);
	adapter->stats.tpr += er32(TPR);

	if (hw->mac_type != e1000_ich8lan) {
		adapter->stats.ptc64 += er32(PTC64);
		adapter->stats.ptc127 += er32(PTC127);
		adapter->stats.ptc255 += er32(PTC255);
		adapter->stats.ptc511 += er32(PTC511);
		adapter->stats.ptc1023 += er32(PTC1023);
		adapter->stats.ptc1522 += er32(PTC1522);
	}

	adapter->stats.mptc += er32(MPTC);
	adapter->stats.bptc += er32(BPTC);
L
Linus Torvalds 已提交
3682 3683 3684

	/* used for adaptive IFS */

J
Joe Perches 已提交
3685
	hw->tx_packet_delta = er32(TPT);
L
Linus Torvalds 已提交
3686
	adapter->stats.tpt += hw->tx_packet_delta;
J
Joe Perches 已提交
3687
	hw->collision_delta = er32(COLC);
L
Linus Torvalds 已提交
3688 3689
	adapter->stats.colc += hw->collision_delta;

J
Jesse Brandeburg 已提交
3690
	if (hw->mac_type >= e1000_82543) {
J
Joe Perches 已提交
3691 3692 3693 3694 3695 3696
		adapter->stats.algnerrc += er32(ALGNERRC);
		adapter->stats.rxerrc += er32(RXERRC);
		adapter->stats.tncrs += er32(TNCRS);
		adapter->stats.cexterr += er32(CEXTERR);
		adapter->stats.tsctc += er32(TSCTC);
		adapter->stats.tsctfc += er32(TSCTFC);
L
Linus Torvalds 已提交
3697
	}
J
Jesse Brandeburg 已提交
3698
	if (hw->mac_type > e1000_82547_rev_2) {
J
Joe Perches 已提交
3699 3700 3701 3702 3703 3704 3705 3706 3707 3708 3709
		adapter->stats.iac += er32(IAC);
		adapter->stats.icrxoc += er32(ICRXOC);

		if (hw->mac_type != e1000_ich8lan) {
			adapter->stats.icrxptc += er32(ICRXPTC);
			adapter->stats.icrxatc += er32(ICRXATC);
			adapter->stats.ictxptc += er32(ICTXPTC);
			adapter->stats.ictxatc += er32(ICTXATC);
			adapter->stats.ictxqec += er32(ICTXQEC);
			adapter->stats.ictxqmtc += er32(ICTXQMTC);
			adapter->stats.icrxdmtc += er32(ICRXDMTC);
3710
		}
3711
	}
L
Linus Torvalds 已提交
3712 3713 3714 3715 3716 3717 3718

	/* Fill out the OS statistics structure */
	adapter->net_stats.multicast = adapter->stats.mprc;
	adapter->net_stats.collisions = adapter->stats.colc;

	/* Rx Errors */

3719 3720
	/* RLEC on some newer hardware can be incorrect so build
	* our own version based on RUC and ROC */
L
Linus Torvalds 已提交
3721 3722
	adapter->net_stats.rx_errors = adapter->stats.rxerrc +
		adapter->stats.crcerrs + adapter->stats.algnerrc +
3723 3724
		adapter->stats.ruc + adapter->stats.roc +
		adapter->stats.cexterr;
3725 3726
	adapter->stats.rlerrc = adapter->stats.ruc + adapter->stats.roc;
	adapter->net_stats.rx_length_errors = adapter->stats.rlerrc;
L
Linus Torvalds 已提交
3727 3728 3729 3730 3731
	adapter->net_stats.rx_crc_errors = adapter->stats.crcerrs;
	adapter->net_stats.rx_frame_errors = adapter->stats.algnerrc;
	adapter->net_stats.rx_missed_errors = adapter->stats.mpc;

	/* Tx Errors */
3732 3733
	adapter->stats.txerrc = adapter->stats.ecol + adapter->stats.latecol;
	adapter->net_stats.tx_errors = adapter->stats.txerrc;
L
Linus Torvalds 已提交
3734 3735 3736
	adapter->net_stats.tx_aborted_errors = adapter->stats.ecol;
	adapter->net_stats.tx_window_errors = adapter->stats.latecol;
	adapter->net_stats.tx_carrier_errors = adapter->stats.tncrs;
J
Joe Perches 已提交
3737
	if (hw->bad_tx_carr_stats_fd &&
3738 3739 3740 3741
	    adapter->link_duplex == FULL_DUPLEX) {
		adapter->net_stats.tx_carrier_errors = 0;
		adapter->stats.tncrs = 0;
	}
L
Linus Torvalds 已提交
3742 3743 3744 3745

	/* Tx Dropped needs to be maintained elsewhere */

	/* Phy Stats */
J
Jesse Brandeburg 已提交
3746 3747
	if (hw->media_type == e1000_media_type_copper) {
		if ((adapter->link_speed == SPEED_1000) &&
L
Linus Torvalds 已提交
3748 3749 3750 3751 3752
		   (!e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_tmp))) {
			phy_tmp &= PHY_IDLE_ERROR_COUNT_MASK;
			adapter->phy_stats.idle_errors += phy_tmp;
		}

J
Jesse Brandeburg 已提交
3753
		if ((hw->mac_type <= e1000_82546) &&
L
Linus Torvalds 已提交
3754 3755 3756 3757 3758
		   (hw->phy_type == e1000_phy_m88) &&
		   !e1000_read_phy_reg(hw, M88E1000_RX_ERR_CNTR, &phy_tmp))
			adapter->phy_stats.receive_errors += phy_tmp;
	}

3759
	/* Management Stats */
J
Joe Perches 已提交
3760 3761 3762 3763
	if (hw->has_smbus) {
		adapter->stats.mgptc += er32(MGTPTC);
		adapter->stats.mgprc += er32(MGTPRC);
		adapter->stats.mgpdc += er32(MGTPDC);
3764 3765
	}

L
Linus Torvalds 已提交
3766 3767
	spin_unlock_irqrestore(&adapter->stats_lock, flags);
}
3768 3769 3770 3771 3772 3773 3774

/**
 * e1000_intr_msi - Interrupt Handler
 * @irq: interrupt number
 * @data: pointer to a network interface device structure
 **/

3775
static irqreturn_t e1000_intr_msi(int irq, void *data)
3776 3777 3778 3779 3780 3781 3782
{
	struct net_device *netdev = data;
	struct e1000_adapter *adapter = netdev_priv(netdev);
	struct e1000_hw *hw = &adapter->hw;
#ifndef CONFIG_E1000_NAPI
	int i;
#endif
J
Joe Perches 已提交
3783
	u32 icr = er32(ICR);
3784

J
Jesse Brandeburg 已提交
3785 3786
	/* in NAPI mode read ICR disables interrupts using IAM */

3787 3788 3789 3790 3791 3792
	if (icr & (E1000_ICR_RXSEQ | E1000_ICR_LSC)) {
		hw->get_link_status = 1;
		/* 80003ES2LAN workaround-- For packet buffer work-around on
		 * link down event; disable receives here in the ISR and reset
		 * adapter in watchdog */
		if (netif_carrier_ok(netdev) &&
J
Joe Perches 已提交
3793
		    (hw->mac_type == e1000_80003es2lan)) {
3794
			/* disable receives */
J
Joe Perches 已提交
3795 3796
			u32 rctl = er32(RCTL);
			ew32(RCTL, rctl & ~E1000_RCTL_EN);
3797
		}
3798 3799 3800
		/* guard against interrupt when we're going down */
		if (!test_bit(__E1000_DOWN, &adapter->flags))
			mod_timer(&adapter->watchdog_timer, jiffies + 1);
3801 3802 3803
	}

#ifdef CONFIG_E1000_NAPI
3804
	if (likely(netif_rx_schedule_prep(netdev, &adapter->napi))) {
J
Jesse Brandeburg 已提交
3805 3806 3807 3808
		adapter->total_tx_bytes = 0;
		adapter->total_tx_packets = 0;
		adapter->total_rx_bytes = 0;
		adapter->total_rx_packets = 0;
3809
		__netif_rx_schedule(netdev, &adapter->napi);
J
Jesse Brandeburg 已提交
3810
	} else
3811 3812
		e1000_irq_enable(adapter);
#else
J
Jesse Brandeburg 已提交
3813 3814 3815 3816 3817
	adapter->total_tx_bytes = 0;
	adapter->total_rx_bytes = 0;
	adapter->total_tx_packets = 0;
	adapter->total_rx_packets = 0;

3818 3819
	for (i = 0; i < E1000_MAX_INTR; i++)
		if (unlikely(!adapter->clean_rx(adapter, adapter->rx_ring) &
3820
		   !e1000_clean_tx_irq(adapter, adapter->tx_ring)))
3821
			break;
J
Jesse Brandeburg 已提交
3822 3823 3824

	if (likely(adapter->itr_setting & 3))
		e1000_set_itr(adapter);
3825 3826 3827 3828
#endif

	return IRQ_HANDLED;
}
L
Linus Torvalds 已提交
3829 3830 3831 3832 3833 3834 3835

/**
 * e1000_intr - Interrupt Handler
 * @irq: interrupt number
 * @data: pointer to a network interface device structure
 **/

3836
static irqreturn_t e1000_intr(int irq, void *data)
L
Linus Torvalds 已提交
3837 3838
{
	struct net_device *netdev = data;
3839
	struct e1000_adapter *adapter = netdev_priv(netdev);
L
Linus Torvalds 已提交
3840
	struct e1000_hw *hw = &adapter->hw;
J
Joe Perches 已提交
3841
	u32 rctl, icr = er32(ICR);
3842
#ifndef CONFIG_E1000_NAPI
3843
	int i;
J
Jesse Brandeburg 已提交
3844 3845 3846 3847 3848 3849 3850 3851 3852 3853 3854
#endif
	if (unlikely(!icr))
		return IRQ_NONE;  /* Not our interrupt */

#ifdef CONFIG_E1000_NAPI
	/* IMS will not auto-mask if INT_ASSERTED is not set, and if it is
	 * not set, then the adapter didn't send an interrupt */
	if (unlikely(hw->mac_type >= e1000_82571 &&
	             !(icr & E1000_ICR_INT_ASSERTED)))
		return IRQ_NONE;

J
Jesse Brandeburg 已提交
3855 3856
	/* Interrupt Auto-Mask...upon reading ICR, interrupts are masked.  No
	 * need for the IMC write */
J
Jeff Garzik 已提交
3857
#endif
L
Linus Torvalds 已提交
3858

J
Jesse Brandeburg 已提交
3859
	if (unlikely(icr & (E1000_ICR_RXSEQ | E1000_ICR_LSC))) {
L
Linus Torvalds 已提交
3860
		hw->get_link_status = 1;
3861 3862 3863 3864 3865 3866
		/* 80003ES2LAN workaround--
		 * For packet buffer work-around on link down event;
		 * disable receives here in the ISR and
		 * reset adapter in watchdog
		 */
		if (netif_carrier_ok(netdev) &&
J
Joe Perches 已提交
3867
		    (hw->mac_type == e1000_80003es2lan)) {
3868
			/* disable receives */
J
Joe Perches 已提交
3869 3870
			rctl = er32(RCTL);
			ew32(RCTL, rctl & ~E1000_RCTL_EN);
3871
		}
A
Auke Kok 已提交
3872 3873 3874
		/* guard against interrupt when we're going down */
		if (!test_bit(__E1000_DOWN, &adapter->flags))
			mod_timer(&adapter->watchdog_timer, jiffies + 1);
L
Linus Torvalds 已提交
3875 3876 3877
	}

#ifdef CONFIG_E1000_NAPI
3878
	if (unlikely(hw->mac_type < e1000_82571)) {
J
Jesse Brandeburg 已提交
3879
		/* disable interrupts, without the synchronize_irq bit */
J
Joe Perches 已提交
3880 3881
		ew32(IMC, ~0);
		E1000_WRITE_FLUSH();
3882
	}
3883
	if (likely(netif_rx_schedule_prep(netdev, &adapter->napi))) {
J
Jesse Brandeburg 已提交
3884 3885 3886 3887
		adapter->total_tx_bytes = 0;
		adapter->total_tx_packets = 0;
		adapter->total_rx_bytes = 0;
		adapter->total_rx_packets = 0;
3888
		__netif_rx_schedule(netdev, &adapter->napi);
J
Jesse Brandeburg 已提交
3889
	} else
3890 3891
		/* this really should not happen! if it does it is basically a
		 * bug, but not a hard error, so enable ints and continue */
3892
		e1000_irq_enable(adapter);
3893
#else
L
Linus Torvalds 已提交
3894
	/* Writing IMC and IMS is needed for 82547.
J
Jesse Brandeburg 已提交
3895 3896 3897 3898 3899 3900 3901 3902 3903
	 * Due to Hub Link bus being occupied, an interrupt
	 * de-assertion message is not able to be sent.
	 * When an interrupt assertion message is generated later,
	 * two messages are re-ordered and sent out.
	 * That causes APIC to think 82547 is in de-assertion
	 * state, while 82547 is in assertion state, resulting
	 * in dead lock. Writing IMC forces 82547 into
	 * de-assertion state.
	 */
J
Jesse Brandeburg 已提交
3904
	if (hw->mac_type == e1000_82547 || hw->mac_type == e1000_82547_rev_2)
J
Joe Perches 已提交
3905
		ew32(IMC, ~0);
L
Linus Torvalds 已提交
3906

J
Jesse Brandeburg 已提交
3907 3908 3909 3910 3911
	adapter->total_tx_bytes = 0;
	adapter->total_rx_bytes = 0;
	adapter->total_tx_packets = 0;
	adapter->total_rx_packets = 0;

J
Jesse Brandeburg 已提交
3912 3913
	for (i = 0; i < E1000_MAX_INTR; i++)
		if (unlikely(!adapter->clean_rx(adapter, adapter->rx_ring) &
3914
		   !e1000_clean_tx_irq(adapter, adapter->tx_ring)))
L
Linus Torvalds 已提交
3915 3916
			break;

J
Jesse Brandeburg 已提交
3917 3918 3919
	if (likely(adapter->itr_setting & 3))
		e1000_set_itr(adapter);

J
Jesse Brandeburg 已提交
3920
	if (hw->mac_type == e1000_82547 || hw->mac_type == e1000_82547_rev_2)
L
Linus Torvalds 已提交
3921
		e1000_irq_enable(adapter);
3922

3923
#endif
L
Linus Torvalds 已提交
3924 3925 3926 3927 3928 3929 3930 3931 3932
	return IRQ_HANDLED;
}

#ifdef CONFIG_E1000_NAPI
/**
 * e1000_clean - NAPI Rx polling callback
 * @adapter: board private structure
 **/

3933
static int e1000_clean(struct napi_struct *napi, int budget)
L
Linus Torvalds 已提交
3934
{
3935 3936
	struct e1000_adapter *adapter = container_of(napi, struct e1000_adapter, napi);
	struct net_device *poll_dev = adapter->netdev;
3937
	int tx_cleaned = 0, work_done = 0;
3938 3939 3940 3941

	/* Must NOT use netdev_priv macro here. */
	adapter = poll_dev->priv;

3942 3943 3944 3945 3946
	/* e1000_clean is called per-cpu.  This lock protects
	 * tx_ring[0] from being cleaned by multiple cpus
	 * simultaneously.  A failure obtaining the lock means
	 * tx_ring[0] is currently being cleaned anyway. */
	if (spin_trylock(&adapter->tx_queue_lock)) {
3947 3948
		tx_cleaned = e1000_clean_tx_irq(adapter,
						&adapter->tx_ring[0]);
3949
		spin_unlock(&adapter->tx_queue_lock);
3950 3951
	}

3952
	adapter->clean_rx(adapter, &adapter->rx_ring[0],
3953
	                  &work_done, budget);
J
Jesse Brandeburg 已提交
3954

3955 3956 3957
	if (tx_cleaned)
		work_done = budget;

3958 3959
	/* If budget not fully consumed, exit the polling mode */
	if (work_done < budget) {
J
Jesse Brandeburg 已提交
3960 3961
		if (likely(adapter->itr_setting & 3))
			e1000_set_itr(adapter);
3962
		netif_rx_complete(poll_dev, napi);
L
Linus Torvalds 已提交
3963 3964 3965
		e1000_irq_enable(adapter);
	}

3966
	return work_done;
L
Linus Torvalds 已提交
3967 3968 3969 3970 3971 3972 3973 3974
}

#endif
/**
 * e1000_clean_tx_irq - Reclaim resources after transmit completes
 * @adapter: board private structure
 **/

3975 3976
static bool e1000_clean_tx_irq(struct e1000_adapter *adapter,
			       struct e1000_tx_ring *tx_ring)
L
Linus Torvalds 已提交
3977
{
J
Joe Perches 已提交
3978
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
3979 3980 3981 3982
	struct net_device *netdev = adapter->netdev;
	struct e1000_tx_desc *tx_desc, *eop_desc;
	struct e1000_buffer *buffer_info;
	unsigned int i, eop;
3983 3984 3985
#ifdef CONFIG_E1000_NAPI
	unsigned int count = 0;
#endif
J
Joe Perches 已提交
3986
	bool cleaned = false;
J
Jesse Brandeburg 已提交
3987
	unsigned int total_tx_bytes=0, total_tx_packets=0;
L
Linus Torvalds 已提交
3988 3989 3990 3991 3992

	i = tx_ring->next_to_clean;
	eop = tx_ring->buffer_info[i].next_to_watch;
	eop_desc = E1000_TX_DESC(*tx_ring, eop);

3993
	while (eop_desc->upper.data & cpu_to_le32(E1000_TXD_STAT_DD)) {
J
Joe Perches 已提交
3994
		for (cleaned = false; !cleaned; ) {
L
Linus Torvalds 已提交
3995 3996 3997 3998
			tx_desc = E1000_TX_DESC(*tx_ring, i);
			buffer_info = &tx_ring->buffer_info[i];
			cleaned = (i == eop);

J
Jesse Brandeburg 已提交
3999
			if (cleaned) {
4000
				struct sk_buff *skb = buffer_info->skb;
4001 4002 4003 4004 4005
				unsigned int segs, bytecount;
				segs = skb_shinfo(skb)->gso_segs ?: 1;
				/* multiply data chunks by size of headers */
				bytecount = ((segs - 1) * skb_headlen(skb)) +
				            skb->len;
4006
				total_tx_packets += segs;
4007
				total_tx_bytes += bytecount;
J
Jesse Brandeburg 已提交
4008
			}
J
Jeff Kirsher 已提交
4009
			e1000_unmap_and_free_tx_resource(adapter, buffer_info);
4010
			tx_desc->upper.data = 0;
L
Linus Torvalds 已提交
4011

J
Jesse Brandeburg 已提交
4012
			if (unlikely(++i == tx_ring->count)) i = 0;
L
Linus Torvalds 已提交
4013
		}
4014

L
Linus Torvalds 已提交
4015 4016
		eop = tx_ring->buffer_info[i].next_to_watch;
		eop_desc = E1000_TX_DESC(*tx_ring, eop);
4017 4018 4019
#ifdef CONFIG_E1000_NAPI
#define E1000_TX_WEIGHT 64
		/* weight of a sort for tx, to avoid endless transmit cleanup */
4020
		if (count++ == E1000_TX_WEIGHT) break;
4021
#endif
L
Linus Torvalds 已提交
4022 4023 4024 4025
	}

	tx_ring->next_to_clean = i;

4026
#define TX_WAKE_THRESHOLD 32
4027 4028 4029 4030 4031 4032
	if (unlikely(cleaned && netif_carrier_ok(netdev) &&
		     E1000_DESC_UNUSED(tx_ring) >= TX_WAKE_THRESHOLD)) {
		/* Make sure that anybody stopping the queue after this
		 * sees the new next_to_clean.
		 */
		smp_mb();
4033
		if (netif_queue_stopped(netdev)) {
4034
			netif_wake_queue(netdev);
4035 4036
			++adapter->restart_queue;
		}
4037
	}
4038

4039
	if (adapter->detect_tx_hung) {
4040
		/* Detect a transmit hang in hardware, this serializes the
L
Linus Torvalds 已提交
4041
		 * check with the clearing of time_stamp and movement of i */
J
Joe Perches 已提交
4042
		adapter->detect_tx_hung = false;
4043 4044
		if (tx_ring->buffer_info[eop].dma &&
		    time_after(jiffies, tx_ring->buffer_info[eop].time_stamp +
4045
		               (adapter->tx_timeout_factor * HZ))
J
Joe Perches 已提交
4046
		    && !(er32(STATUS) & E1000_STATUS_TXOFF)) {
4047 4048

			/* detected Tx unit hang */
4049
			DPRINTK(DRV, ERR, "Detected Tx Unit Hang\n"
4050
					"  Tx Queue             <%lu>\n"
4051 4052 4053 4054 4055 4056 4057 4058 4059
					"  TDH                  <%x>\n"
					"  TDT                  <%x>\n"
					"  next_to_use          <%x>\n"
					"  next_to_clean        <%x>\n"
					"buffer_info[next_to_clean]\n"
					"  time_stamp           <%lx>\n"
					"  next_to_watch        <%x>\n"
					"  jiffies              <%lx>\n"
					"  next_to_watch.status <%x>\n",
4060 4061
				(unsigned long)((tx_ring - adapter->tx_ring) /
					sizeof(struct e1000_tx_ring)),
J
Joe Perches 已提交
4062 4063
				readl(hw->hw_addr + tx_ring->tdh),
				readl(hw->hw_addr + tx_ring->tdt),
4064
				tx_ring->next_to_use,
4065 4066
				tx_ring->next_to_clean,
				tx_ring->buffer_info[eop].time_stamp,
4067 4068 4069
				eop,
				jiffies,
				eop_desc->upper.fields.status);
L
Linus Torvalds 已提交
4070
			netif_stop_queue(netdev);
4071
		}
L
Linus Torvalds 已提交
4072
	}
J
Jesse Brandeburg 已提交
4073 4074
	adapter->total_tx_bytes += total_tx_bytes;
	adapter->total_tx_packets += total_tx_packets;
4075 4076
	adapter->net_stats.tx_bytes += total_tx_bytes;
	adapter->net_stats.tx_packets += total_tx_packets;
L
Linus Torvalds 已提交
4077 4078 4079 4080 4081
	return cleaned;
}

/**
 * e1000_rx_checksum - Receive Checksum Offload for 82543
4082 4083 4084 4085
 * @adapter:     board private structure
 * @status_err:  receive descriptor status and error fields
 * @csum:        receive descriptor csum field
 * @sk_buff:     socket buffer with received data
L
Linus Torvalds 已提交
4086 4087
 **/

4088 4089
static void e1000_rx_checksum(struct e1000_adapter *adapter, u32 status_err,
			      u32 csum, struct sk_buff *skb)
L
Linus Torvalds 已提交
4090
{
J
Joe Perches 已提交
4091
	struct e1000_hw *hw = &adapter->hw;
4092 4093
	u16 status = (u16)status_err;
	u8 errors = (u8)(status_err >> 24);
4094 4095
	skb->ip_summed = CHECKSUM_NONE;

L
Linus Torvalds 已提交
4096
	/* 82543 or newer only */
J
Joe Perches 已提交
4097
	if (unlikely(hw->mac_type < e1000_82543)) return;
L
Linus Torvalds 已提交
4098
	/* Ignore Checksum bit is set */
J
Jesse Brandeburg 已提交
4099
	if (unlikely(status & E1000_RXD_STAT_IXSM)) return;
4100
	/* TCP/UDP checksum error bit is set */
J
Jesse Brandeburg 已提交
4101
	if (unlikely(errors & E1000_RXD_ERR_TCPE)) {
L
Linus Torvalds 已提交
4102 4103
		/* let the stack verify checksum errors */
		adapter->hw_csum_err++;
4104 4105 4106
		return;
	}
	/* TCP/UDP Checksum has not been calculated */
J
Joe Perches 已提交
4107
	if (hw->mac_type <= e1000_82547_rev_2) {
J
Jesse Brandeburg 已提交
4108
		if (!(status & E1000_RXD_STAT_TCPCS))
4109
			return;
L
Linus Torvalds 已提交
4110
	} else {
J
Jesse Brandeburg 已提交
4111
		if (!(status & (E1000_RXD_STAT_TCPCS | E1000_RXD_STAT_UDPCS)))
4112 4113 4114 4115
			return;
	}
	/* It must be a TCP or UDP packet with a valid checksum */
	if (likely(status & E1000_RXD_STAT_TCPCS)) {
L
Linus Torvalds 已提交
4116 4117
		/* TCP checksum is good */
		skb->ip_summed = CHECKSUM_UNNECESSARY;
J
Joe Perches 已提交
4118
	} else if (hw->mac_type > e1000_82547_rev_2) {
4119 4120 4121 4122
		/* IP fragment with UDP payload */
		/* Hardware complements the payload checksum, so we undo it
		 * and then put the value in host order for further stack use.
		 */
A
Al Viro 已提交
4123 4124
		__sum16 sum = (__force __sum16)htons(csum);
		skb->csum = csum_unfold(~sum);
4125
		skb->ip_summed = CHECKSUM_COMPLETE;
L
Linus Torvalds 已提交
4126
	}
4127
	adapter->hw_csum_good++;
L
Linus Torvalds 已提交
4128 4129 4130
}

/**
4131
 * e1000_clean_rx_irq - Send received data up the network stack; legacy
L
Linus Torvalds 已提交
4132 4133 4134
 * @adapter: board private structure
 **/
#ifdef CONFIG_E1000_NAPI
4135 4136 4137
static bool e1000_clean_rx_irq(struct e1000_adapter *adapter,
			       struct e1000_rx_ring *rx_ring,
			       int *work_done, int work_to_do)
L
Linus Torvalds 已提交
4138
#else
4139 4140
static bool e1000_clean_rx_irq(struct e1000_adapter *adapter,
			       struct e1000_rx_ring *rx_ring)
L
Linus Torvalds 已提交
4141 4142
#endif
{
J
Joe Perches 已提交
4143
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
4144 4145
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
4146 4147
	struct e1000_rx_desc *rx_desc, *next_rxd;
	struct e1000_buffer *buffer_info, *next_buffer;
L
Linus Torvalds 已提交
4148
	unsigned long flags;
4149 4150
	u32 length;
	u8 last_byte;
L
Linus Torvalds 已提交
4151
	unsigned int i;
4152
	int cleaned_count = 0;
J
Joe Perches 已提交
4153
	bool cleaned = false;
J
Jesse Brandeburg 已提交
4154
	unsigned int total_rx_bytes=0, total_rx_packets=0;
L
Linus Torvalds 已提交
4155 4156 4157

	i = rx_ring->next_to_clean;
	rx_desc = E1000_RX_DESC(*rx_ring, i);
4158
	buffer_info = &rx_ring->buffer_info[i];
L
Linus Torvalds 已提交
4159

4160
	while (rx_desc->status & E1000_RXD_STAT_DD) {
4161
		struct sk_buff *skb;
4162
		u8 status;
4163

L
Linus Torvalds 已提交
4164
#ifdef CONFIG_E1000_NAPI
J
Jesse Brandeburg 已提交
4165
		if (*work_done >= work_to_do)
L
Linus Torvalds 已提交
4166 4167 4168
			break;
		(*work_done)++;
#endif
4169
		status = rx_desc->status;
4170
		skb = buffer_info->skb;
4171 4172
		buffer_info->skb = NULL;

4173 4174
		prefetch(skb->data - NET_IP_ALIGN);

4175 4176
		if (++i == rx_ring->count) i = 0;
		next_rxd = E1000_RX_DESC(*rx_ring, i);
4177 4178
		prefetch(next_rxd);

4179 4180
		next_buffer = &rx_ring->buffer_info[i];

J
Joe Perches 已提交
4181
		cleaned = true;
4182
		cleaned_count++;
4183 4184 4185
		pci_unmap_single(pdev,
		                 buffer_info->dma,
		                 buffer_info->length,
L
Linus Torvalds 已提交
4186 4187 4188 4189
		                 PCI_DMA_FROMDEVICE);

		length = le16_to_cpu(rx_desc->length);

4190 4191 4192 4193
		if (unlikely(!(status & E1000_RXD_STAT_EOP))) {
			/* All receives must fit into a single buffer */
			E1000_DBG("%s: Receive packet consumed multiple"
				  " buffers\n", netdev->name);
A
Auke Kok 已提交
4194
			/* recycle */
4195
			buffer_info->skb = skb;
L
Linus Torvalds 已提交
4196 4197 4198
			goto next_desc;
		}

J
Jesse Brandeburg 已提交
4199
		if (unlikely(rx_desc->errors & E1000_RXD_ERR_FRAME_ERR_MASK)) {
L
Linus Torvalds 已提交
4200
			last_byte = *(skb->data + length - 1);
J
Joe Perches 已提交
4201 4202
			if (TBI_ACCEPT(hw, status, rx_desc->errors, length,
				       last_byte)) {
L
Linus Torvalds 已提交
4203
				spin_lock_irqsave(&adapter->stats_lock, flags);
J
Joe Perches 已提交
4204
				e1000_tbi_adjust_stats(hw, &adapter->stats,
L
Linus Torvalds 已提交
4205 4206 4207 4208 4209
				                       length, skb->data);
				spin_unlock_irqrestore(&adapter->stats_lock,
				                       flags);
				length--;
			} else {
4210 4211
				/* recycle */
				buffer_info->skb = skb;
L
Linus Torvalds 已提交
4212 4213
				goto next_desc;
			}
A
Auke Kok 已提交
4214
		}
L
Linus Torvalds 已提交
4215

4216 4217 4218 4219
		/* adjust length to remove Ethernet CRC, this must be
		 * done after the TBI_ACCEPT workaround above */
		length -= 4;

J
Jesse Brandeburg 已提交
4220 4221 4222 4223
		/* probably a little skewed due to removing CRC */
		total_rx_bytes += length;
		total_rx_packets++;

4224 4225 4226
		/* code added for copybreak, this should improve
		 * performance for small packets with large amounts
		 * of reassembly being done in the stack */
4227
		if (length < copybreak) {
4228
			struct sk_buff *new_skb =
4229
			    netdev_alloc_skb(netdev, length + NET_IP_ALIGN);
4230 4231
			if (new_skb) {
				skb_reserve(new_skb, NET_IP_ALIGN);
4232 4233 4234 4235 4236 4237
				skb_copy_to_linear_data_offset(new_skb,
							       -NET_IP_ALIGN,
							       (skb->data -
							        NET_IP_ALIGN),
							       (length +
							        NET_IP_ALIGN));
4238 4239 4240 4241
				/* save the skb in buffer_info as good */
				buffer_info->skb = skb;
				skb = new_skb;
			}
A
Auke Kok 已提交
4242 4243
			/* else just continue with the old one */
		}
4244
		/* end copybreak code */
A
Auke Kok 已提交
4245
		skb_put(skb, length);
L
Linus Torvalds 已提交
4246 4247

		/* Receive Checksum Offload */
4248
		e1000_rx_checksum(adapter,
4249 4250
				  (u32)(status) |
				  ((u32)(rx_desc->errors) << 24),
D
David S. Miller 已提交
4251
				  le16_to_cpu(rx_desc->csum), skb);
J
Jesse Brandeburg 已提交
4252

L
Linus Torvalds 已提交
4253 4254
		skb->protocol = eth_type_trans(skb, netdev);
#ifdef CONFIG_E1000_NAPI
J
Jesse Brandeburg 已提交
4255
		if (unlikely(adapter->vlgrp &&
4256
			    (status & E1000_RXD_STAT_VP))) {
L
Linus Torvalds 已提交
4257
			vlan_hwaccel_receive_skb(skb, adapter->vlgrp,
4258
						 le16_to_cpu(rx_desc->special));
L
Linus Torvalds 已提交
4259 4260 4261 4262
		} else {
			netif_receive_skb(skb);
		}
#else /* CONFIG_E1000_NAPI */
J
Jesse Brandeburg 已提交
4263
		if (unlikely(adapter->vlgrp &&
4264
			    (status & E1000_RXD_STAT_VP))) {
L
Linus Torvalds 已提交
4265
			vlan_hwaccel_rx(skb, adapter->vlgrp,
4266
					le16_to_cpu(rx_desc->special));
L
Linus Torvalds 已提交
4267 4268 4269 4270 4271 4272 4273 4274 4275
		} else {
			netif_rx(skb);
		}
#endif /* CONFIG_E1000_NAPI */
		netdev->last_rx = jiffies;

next_desc:
		rx_desc->status = 0;

4276 4277 4278 4279 4280 4281
		/* return some buffers to hardware, one at a time is too slow */
		if (unlikely(cleaned_count >= E1000_RX_BUFFER_WRITE)) {
			adapter->alloc_rx_buf(adapter, rx_ring, cleaned_count);
			cleaned_count = 0;
		}

4282
		/* use prefetched values */
4283 4284
		rx_desc = next_rxd;
		buffer_info = next_buffer;
L
Linus Torvalds 已提交
4285 4286
	}
	rx_ring->next_to_clean = i;
4287 4288 4289 4290

	cleaned_count = E1000_DESC_UNUSED(rx_ring);
	if (cleaned_count)
		adapter->alloc_rx_buf(adapter, rx_ring, cleaned_count);
4291

J
Jesse Brandeburg 已提交
4292 4293
	adapter->total_rx_packets += total_rx_packets;
	adapter->total_rx_bytes += total_rx_bytes;
4294 4295
	adapter->net_stats.rx_bytes += total_rx_bytes;
	adapter->net_stats.rx_packets += total_rx_packets;
4296 4297 4298 4299 4300 4301 4302 4303 4304
	return cleaned;
}

/**
 * e1000_clean_rx_irq_ps - Send received data up the network stack; packet split
 * @adapter: board private structure
 **/

#ifdef CONFIG_E1000_NAPI
4305 4306 4307
static bool e1000_clean_rx_irq_ps(struct e1000_adapter *adapter,
				  struct e1000_rx_ring *rx_ring,
				  int *work_done, int work_to_do)
4308
#else
4309 4310
static bool e1000_clean_rx_irq_ps(struct e1000_adapter *adapter,
				  struct e1000_rx_ring *rx_ring)
4311 4312
#endif
{
4313
	union e1000_rx_desc_packet_split *rx_desc, *next_rxd;
4314 4315
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
4316
	struct e1000_buffer *buffer_info, *next_buffer;
4317 4318
	struct e1000_ps_page *ps_page;
	struct e1000_ps_page_dma *ps_page_dma;
4319
	struct sk_buff *skb;
4320
	unsigned int i, j;
4321
	u32 length, staterr;
4322
	int cleaned_count = 0;
J
Joe Perches 已提交
4323
	bool cleaned = false;
J
Jesse Brandeburg 已提交
4324
	unsigned int total_rx_bytes=0, total_rx_packets=0;
4325 4326 4327

	i = rx_ring->next_to_clean;
	rx_desc = E1000_RX_DESC_PS(*rx_ring, i);
4328
	staterr = le32_to_cpu(rx_desc->wb.middle.status_error);
4329
	buffer_info = &rx_ring->buffer_info[i];
4330

J
Jesse Brandeburg 已提交
4331
	while (staterr & E1000_RXD_STAT_DD) {
4332 4333 4334
		ps_page = &rx_ring->ps_page[i];
		ps_page_dma = &rx_ring->ps_page_dma[i];
#ifdef CONFIG_E1000_NAPI
J
Jesse Brandeburg 已提交
4335
		if (unlikely(*work_done >= work_to_do))
4336 4337 4338
			break;
		(*work_done)++;
#endif
4339 4340
		skb = buffer_info->skb;

4341 4342 4343
		/* in the packet split case this is header only */
		prefetch(skb->data - NET_IP_ALIGN);

4344 4345
		if (++i == rx_ring->count) i = 0;
		next_rxd = E1000_RX_DESC_PS(*rx_ring, i);
4346 4347
		prefetch(next_rxd);

4348 4349
		next_buffer = &rx_ring->buffer_info[i];

J
Joe Perches 已提交
4350
		cleaned = true;
4351
		cleaned_count++;
4352 4353 4354 4355
		pci_unmap_single(pdev, buffer_info->dma,
				 buffer_info->length,
				 PCI_DMA_FROMDEVICE);

J
Jesse Brandeburg 已提交
4356
		if (unlikely(!(staterr & E1000_RXD_STAT_EOP))) {
4357 4358 4359 4360 4361
			E1000_DBG("%s: Packet Split buffers didn't pick up"
				  " the full packet\n", netdev->name);
			dev_kfree_skb_irq(skb);
			goto next_desc;
		}
L
Linus Torvalds 已提交
4362

J
Jesse Brandeburg 已提交
4363
		if (unlikely(staterr & E1000_RXDEXT_ERR_FRAME_ERR_MASK)) {
4364 4365 4366 4367 4368 4369
			dev_kfree_skb_irq(skb);
			goto next_desc;
		}

		length = le16_to_cpu(rx_desc->wb.middle.length0);

J
Jesse Brandeburg 已提交
4370
		if (unlikely(!length)) {
4371 4372 4373 4374 4375 4376 4377 4378 4379
			E1000_DBG("%s: Last part of the packet spanning"
				  " multiple descriptors\n", netdev->name);
			dev_kfree_skb_irq(skb);
			goto next_desc;
		}

		/* Good Receive */
		skb_put(skb, length);

4380 4381 4382 4383 4384 4385 4386
		{
		/* this looks ugly, but it seems compiler issues make it
		   more efficient than reusing j */
		int l1 = le16_to_cpu(rx_desc->wb.upper.length[0]);

		/* page alloc/put takes too long and effects small packet
		 * throughput, so unsplit small packets and save the alloc/put*/
4387
		if (l1 && (l1 <= copybreak) && ((length + l1) <= adapter->rx_ps_bsize0)) {
4388
			u8 *vaddr;
4389
			/* there is no documentation about how to call
4390 4391 4392 4393 4394 4395 4396 4397
			 * kmap_atomic, so we can't hold the mapping
			 * very long */
			pci_dma_sync_single_for_cpu(pdev,
				ps_page_dma->ps_page_dma[0],
				PAGE_SIZE,
				PCI_DMA_FROMDEVICE);
			vaddr = kmap_atomic(ps_page->ps_page[0],
			                    KM_SKB_DATA_SOFTIRQ);
4398
			memcpy(skb_tail_pointer(skb), vaddr, l1);
4399 4400 4401 4402
			kunmap_atomic(vaddr, KM_SKB_DATA_SOFTIRQ);
			pci_dma_sync_single_for_device(pdev,
				ps_page_dma->ps_page_dma[0],
				PAGE_SIZE, PCI_DMA_FROMDEVICE);
4403 4404
			/* remove the CRC */
			l1 -= 4;
4405 4406 4407 4408
			skb_put(skb, l1);
			goto copydone;
		} /* if */
		}
4409

J
Jesse Brandeburg 已提交
4410
		for (j = 0; j < adapter->rx_ps_pages; j++) {
4411 4412
			length = le16_to_cpu(rx_desc->wb.upper.length[j]);
			if (!length)
4413 4414 4415 4416
				break;
			pci_unmap_page(pdev, ps_page_dma->ps_page_dma[j],
					PAGE_SIZE, PCI_DMA_FROMDEVICE);
			ps_page_dma->ps_page_dma[j] = 0;
4417 4418
			skb_fill_page_desc(skb, j, ps_page->ps_page[j], 0,
			                   length);
4419 4420 4421
			ps_page->ps_page[j] = NULL;
			skb->len += length;
			skb->data_len += length;
4422
			skb->truesize += length;
4423 4424
		}

4425 4426 4427 4428
		/* strip the ethernet crc, problem is we're using pages now so
		 * this whole operation can get a little cpu intensive */
		pskb_trim(skb, skb->len - 4);

4429
copydone:
J
Jesse Brandeburg 已提交
4430 4431 4432
		total_rx_bytes += skb->len;
		total_rx_packets++;

4433
		e1000_rx_checksum(adapter, staterr,
D
David S. Miller 已提交
4434
				  le16_to_cpu(rx_desc->wb.lower.hi_dword.csum_ip.csum), skb);
4435 4436
		skb->protocol = eth_type_trans(skb, netdev);

J
Jesse Brandeburg 已提交
4437
		if (likely(rx_desc->wb.upper.header_status &
D
David S. Miller 已提交
4438
			   cpu_to_le16(E1000_RXDPS_HDRSTAT_HDRSP)))
4439
			adapter->rx_hdr_split++;
4440
#ifdef CONFIG_E1000_NAPI
J
Jesse Brandeburg 已提交
4441
		if (unlikely(adapter->vlgrp && (staterr & E1000_RXD_STAT_VP))) {
4442
			vlan_hwaccel_receive_skb(skb, adapter->vlgrp,
4443
				le16_to_cpu(rx_desc->wb.middle.vlan));
4444 4445 4446 4447
		} else {
			netif_receive_skb(skb);
		}
#else /* CONFIG_E1000_NAPI */
J
Jesse Brandeburg 已提交
4448
		if (unlikely(adapter->vlgrp && (staterr & E1000_RXD_STAT_VP))) {
4449
			vlan_hwaccel_rx(skb, adapter->vlgrp,
4450
				le16_to_cpu(rx_desc->wb.middle.vlan));
4451 4452 4453 4454 4455 4456 4457
		} else {
			netif_rx(skb);
		}
#endif /* CONFIG_E1000_NAPI */
		netdev->last_rx = jiffies;

next_desc:
D
David S. Miller 已提交
4458
		rx_desc->wb.middle.status_error &= cpu_to_le32(~0xFF);
4459 4460
		buffer_info->skb = NULL;

4461 4462 4463 4464 4465 4466
		/* return some buffers to hardware, one at a time is too slow */
		if (unlikely(cleaned_count >= E1000_RX_BUFFER_WRITE)) {
			adapter->alloc_rx_buf(adapter, rx_ring, cleaned_count);
			cleaned_count = 0;
		}

4467
		/* use prefetched values */
4468 4469 4470
		rx_desc = next_rxd;
		buffer_info = next_buffer;

4471
		staterr = le32_to_cpu(rx_desc->wb.middle.status_error);
4472 4473
	}
	rx_ring->next_to_clean = i;
4474 4475 4476 4477

	cleaned_count = E1000_DESC_UNUSED(rx_ring);
	if (cleaned_count)
		adapter->alloc_rx_buf(adapter, rx_ring, cleaned_count);
L
Linus Torvalds 已提交
4478

J
Jesse Brandeburg 已提交
4479 4480
	adapter->total_rx_packets += total_rx_packets;
	adapter->total_rx_bytes += total_rx_bytes;
4481 4482
	adapter->net_stats.rx_bytes += total_rx_bytes;
	adapter->net_stats.rx_packets += total_rx_packets;
L
Linus Torvalds 已提交
4483 4484 4485 4486
	return cleaned;
}

/**
4487
 * e1000_alloc_rx_buffers - Replace used receive buffers; legacy & extended
L
Linus Torvalds 已提交
4488 4489 4490
 * @adapter: address of board private structure
 **/

4491 4492 4493
static void e1000_alloc_rx_buffers(struct e1000_adapter *adapter,
				   struct e1000_rx_ring *rx_ring,
				   int cleaned_count)
L
Linus Torvalds 已提交
4494
{
J
Joe Perches 已提交
4495
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
4496 4497 4498 4499 4500
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
	struct e1000_rx_desc *rx_desc;
	struct e1000_buffer *buffer_info;
	struct sk_buff *skb;
4501 4502
	unsigned int i;
	unsigned int bufsz = adapter->rx_buffer_len + NET_IP_ALIGN;
L
Linus Torvalds 已提交
4503 4504 4505 4506

	i = rx_ring->next_to_use;
	buffer_info = &rx_ring->buffer_info[i];

4507
	while (cleaned_count--) {
4508 4509
		skb = buffer_info->skb;
		if (skb) {
4510 4511 4512 4513
			skb_trim(skb, 0);
			goto map_skb;
		}

4514
		skb = netdev_alloc_skb(netdev, bufsz);
J
Jesse Brandeburg 已提交
4515
		if (unlikely(!skb)) {
L
Linus Torvalds 已提交
4516
			/* Better luck next round */
4517
			adapter->alloc_rx_buff_failed++;
L
Linus Torvalds 已提交
4518 4519 4520
			break;
		}

4521
		/* Fix for errata 23, can't cross 64kB boundary */
L
Linus Torvalds 已提交
4522 4523
		if (!e1000_check_64k_bound(adapter, skb->data, bufsz)) {
			struct sk_buff *oldskb = skb;
4524 4525 4526
			DPRINTK(RX_ERR, ERR, "skb align check failed: %u bytes "
					     "at %p\n", bufsz, skb->data);
			/* Try again, without freeing the previous */
4527
			skb = netdev_alloc_skb(netdev, bufsz);
4528
			/* Failed allocation, critical failure */
L
Linus Torvalds 已提交
4529 4530 4531 4532
			if (!skb) {
				dev_kfree_skb(oldskb);
				break;
			}
4533

L
Linus Torvalds 已提交
4534 4535 4536 4537 4538 4539
			if (!e1000_check_64k_bound(adapter, skb->data, bufsz)) {
				/* give up */
				dev_kfree_skb(skb);
				dev_kfree_skb(oldskb);
				break; /* while !buffer_info->skb */
			}
4540 4541 4542

			/* Use new allocation */
			dev_kfree_skb(oldskb);
L
Linus Torvalds 已提交
4543 4544 4545 4546 4547 4548 4549 4550 4551
		}
		/* Make buffer alignment 2 beyond a 16 byte boundary
		 * this will result in a 16 byte aligned IP header after
		 * the 14 byte MAC header is removed
		 */
		skb_reserve(skb, NET_IP_ALIGN);

		buffer_info->skb = skb;
		buffer_info->length = adapter->rx_buffer_len;
4552
map_skb:
L
Linus Torvalds 已提交
4553 4554 4555 4556 4557
		buffer_info->dma = pci_map_single(pdev,
						  skb->data,
						  adapter->rx_buffer_len,
						  PCI_DMA_FROMDEVICE);

4558 4559 4560 4561 4562 4563 4564 4565
		/* Fix for errata 23, can't cross 64kB boundary */
		if (!e1000_check_64k_bound(adapter,
					(void *)(unsigned long)buffer_info->dma,
					adapter->rx_buffer_len)) {
			DPRINTK(RX_ERR, ERR,
				"dma align check failed: %u bytes at %p\n",
				adapter->rx_buffer_len,
				(void *)(unsigned long)buffer_info->dma);
L
Linus Torvalds 已提交
4566 4567 4568
			dev_kfree_skb(skb);
			buffer_info->skb = NULL;

4569
			pci_unmap_single(pdev, buffer_info->dma,
L
Linus Torvalds 已提交
4570 4571 4572 4573 4574 4575 4576 4577
					 adapter->rx_buffer_len,
					 PCI_DMA_FROMDEVICE);

			break; /* while !buffer_info->skb */
		}
		rx_desc = E1000_RX_DESC(*rx_ring, i);
		rx_desc->buffer_addr = cpu_to_le64(buffer_info->dma);

J
Jesse Brandeburg 已提交
4578 4579
		if (unlikely(++i == rx_ring->count))
			i = 0;
L
Linus Torvalds 已提交
4580 4581 4582
		buffer_info = &rx_ring->buffer_info[i];
	}

4583 4584 4585 4586 4587 4588 4589 4590 4591 4592
	if (likely(rx_ring->next_to_use != i)) {
		rx_ring->next_to_use = i;
		if (unlikely(i-- == 0))
			i = (rx_ring->count - 1);

		/* Force memory writes to complete before letting h/w
		 * know there are new descriptors to fetch.  (Only
		 * applicable for weak-ordered memory model archs,
		 * such as IA-64). */
		wmb();
J
Joe Perches 已提交
4593
		writel(i, hw->hw_addr + rx_ring->rdt);
4594
	}
L
Linus Torvalds 已提交
4595 4596
}

4597 4598 4599 4600 4601
/**
 * e1000_alloc_rx_buffers_ps - Replace used receive buffers; packet split
 * @adapter: address of board private structure
 **/

4602 4603 4604
static void e1000_alloc_rx_buffers_ps(struct e1000_adapter *adapter,
				      struct e1000_rx_ring *rx_ring,
				      int cleaned_count)
4605
{
J
Joe Perches 已提交
4606
	struct e1000_hw *hw = &adapter->hw;
4607 4608 4609 4610 4611 4612 4613 4614 4615 4616 4617 4618 4619 4620
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
	union e1000_rx_desc_packet_split *rx_desc;
	struct e1000_buffer *buffer_info;
	struct e1000_ps_page *ps_page;
	struct e1000_ps_page_dma *ps_page_dma;
	struct sk_buff *skb;
	unsigned int i, j;

	i = rx_ring->next_to_use;
	buffer_info = &rx_ring->buffer_info[i];
	ps_page = &rx_ring->ps_page[i];
	ps_page_dma = &rx_ring->ps_page_dma[i];

4621
	while (cleaned_count--) {
4622 4623
		rx_desc = E1000_RX_DESC_PS(*rx_ring, i);

J
Jesse Brandeburg 已提交
4624
		for (j = 0; j < PS_PAGE_BUFFERS; j++) {
4625 4626 4627 4628
			if (j < adapter->rx_ps_pages) {
				if (likely(!ps_page->ps_page[j])) {
					ps_page->ps_page[j] =
						alloc_page(GFP_ATOMIC);
4629 4630
					if (unlikely(!ps_page->ps_page[j])) {
						adapter->alloc_rx_buff_failed++;
4631
						goto no_buffers;
4632
					}
4633 4634 4635 4636 4637 4638 4639
					ps_page_dma->ps_page_dma[j] =
						pci_map_page(pdev,
							    ps_page->ps_page[j],
							    0, PAGE_SIZE,
							    PCI_DMA_FROMDEVICE);
				}
				/* Refresh the desc even if buffer_addrs didn't
J
Jesse Brandeburg 已提交
4640
				 * change because each write-back erases
4641 4642 4643 4644 4645
				 * this info.
				 */
				rx_desc->read.buffer_addr[j+1] =
				     cpu_to_le64(ps_page_dma->ps_page_dma[j]);
			} else
A
Al Viro 已提交
4646
				rx_desc->read.buffer_addr[j+1] = ~cpu_to_le64(0);
4647 4648
		}

4649
		skb = netdev_alloc_skb(netdev,
4650
		                       adapter->rx_ps_bsize0 + NET_IP_ALIGN);
4651

4652 4653
		if (unlikely(!skb)) {
			adapter->alloc_rx_buff_failed++;
4654
			break;
4655
		}
4656 4657 4658 4659 4660 4661 4662 4663 4664 4665 4666 4667 4668 4669 4670

		/* Make buffer alignment 2 beyond a 16 byte boundary
		 * this will result in a 16 byte aligned IP header after
		 * the 14 byte MAC header is removed
		 */
		skb_reserve(skb, NET_IP_ALIGN);

		buffer_info->skb = skb;
		buffer_info->length = adapter->rx_ps_bsize0;
		buffer_info->dma = pci_map_single(pdev, skb->data,
						  adapter->rx_ps_bsize0,
						  PCI_DMA_FROMDEVICE);

		rx_desc->read.buffer_addr[0] = cpu_to_le64(buffer_info->dma);

J
Jesse Brandeburg 已提交
4671
		if (unlikely(++i == rx_ring->count)) i = 0;
4672 4673 4674 4675 4676 4677
		buffer_info = &rx_ring->buffer_info[i];
		ps_page = &rx_ring->ps_page[i];
		ps_page_dma = &rx_ring->ps_page_dma[i];
	}

no_buffers:
4678 4679 4680 4681 4682 4683 4684 4685 4686 4687 4688 4689 4690
	if (likely(rx_ring->next_to_use != i)) {
		rx_ring->next_to_use = i;
		if (unlikely(i-- == 0)) i = (rx_ring->count - 1);

		/* Force memory writes to complete before letting h/w
		 * know there are new descriptors to fetch.  (Only
		 * applicable for weak-ordered memory model archs,
		 * such as IA-64). */
		wmb();
		/* Hardware increments by 16 bytes, but packet split
		 * descriptors are 32 bytes...so we increment tail
		 * twice as much.
		 */
J
Joe Perches 已提交
4691
		writel(i<<1, hw->hw_addr + rx_ring->rdt);
4692
	}
4693 4694
}

L
Linus Torvalds 已提交
4695 4696 4697 4698 4699
/**
 * e1000_smartspeed - Workaround for SmartSpeed on 82541 and 82547 controllers.
 * @adapter:
 **/

4700
static void e1000_smartspeed(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
4701
{
J
Joe Perches 已提交
4702
	struct e1000_hw *hw = &adapter->hw;
4703 4704
	u16 phy_status;
	u16 phy_ctrl;
L
Linus Torvalds 已提交
4705

J
Joe Perches 已提交
4706 4707
	if ((hw->phy_type != e1000_phy_igp) || !hw->autoneg ||
	   !(hw->autoneg_advertised & ADVERTISE_1000_FULL))
L
Linus Torvalds 已提交
4708 4709
		return;

J
Jesse Brandeburg 已提交
4710
	if (adapter->smartspeed == 0) {
L
Linus Torvalds 已提交
4711 4712
		/* If Master/Slave config fault is asserted twice,
		 * we assume back-to-back */
J
Joe Perches 已提交
4713
		e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_status);
J
Jesse Brandeburg 已提交
4714
		if (!(phy_status & SR_1000T_MS_CONFIG_FAULT)) return;
J
Joe Perches 已提交
4715
		e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_status);
J
Jesse Brandeburg 已提交
4716
		if (!(phy_status & SR_1000T_MS_CONFIG_FAULT)) return;
J
Joe Perches 已提交
4717
		e1000_read_phy_reg(hw, PHY_1000T_CTRL, &phy_ctrl);
J
Jesse Brandeburg 已提交
4718
		if (phy_ctrl & CR_1000T_MS_ENABLE) {
L
Linus Torvalds 已提交
4719
			phy_ctrl &= ~CR_1000T_MS_ENABLE;
J
Joe Perches 已提交
4720
			e1000_write_phy_reg(hw, PHY_1000T_CTRL,
L
Linus Torvalds 已提交
4721 4722
					    phy_ctrl);
			adapter->smartspeed++;
J
Joe Perches 已提交
4723 4724
			if (!e1000_phy_setup_autoneg(hw) &&
			   !e1000_read_phy_reg(hw, PHY_CTRL,
L
Linus Torvalds 已提交
4725 4726 4727
				   	       &phy_ctrl)) {
				phy_ctrl |= (MII_CR_AUTO_NEG_EN |
					     MII_CR_RESTART_AUTO_NEG);
J
Joe Perches 已提交
4728
				e1000_write_phy_reg(hw, PHY_CTRL,
L
Linus Torvalds 已提交
4729 4730 4731 4732
						    phy_ctrl);
			}
		}
		return;
J
Jesse Brandeburg 已提交
4733
	} else if (adapter->smartspeed == E1000_SMARTSPEED_DOWNSHIFT) {
L
Linus Torvalds 已提交
4734
		/* If still no link, perhaps using 2/3 pair cable */
J
Joe Perches 已提交
4735
		e1000_read_phy_reg(hw, PHY_1000T_CTRL, &phy_ctrl);
L
Linus Torvalds 已提交
4736
		phy_ctrl |= CR_1000T_MS_ENABLE;
J
Joe Perches 已提交
4737 4738 4739
		e1000_write_phy_reg(hw, PHY_1000T_CTRL, phy_ctrl);
		if (!e1000_phy_setup_autoneg(hw) &&
		   !e1000_read_phy_reg(hw, PHY_CTRL, &phy_ctrl)) {
L
Linus Torvalds 已提交
4740 4741
			phy_ctrl |= (MII_CR_AUTO_NEG_EN |
				     MII_CR_RESTART_AUTO_NEG);
J
Joe Perches 已提交
4742
			e1000_write_phy_reg(hw, PHY_CTRL, phy_ctrl);
L
Linus Torvalds 已提交
4743 4744 4745
		}
	}
	/* Restart process after E1000_SMARTSPEED_MAX iterations */
J
Jesse Brandeburg 已提交
4746
	if (adapter->smartspeed++ == E1000_SMARTSPEED_MAX)
L
Linus Torvalds 已提交
4747 4748 4749 4750 4751 4752 4753 4754 4755 4756
		adapter->smartspeed = 0;
}

/**
 * e1000_ioctl -
 * @netdev:
 * @ifreq:
 * @cmd:
 **/

4757
static int e1000_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
L
Linus Torvalds 已提交
4758 4759 4760 4761 4762 4763 4764 4765 4766 4767 4768 4769 4770 4771 4772 4773 4774 4775
{
	switch (cmd) {
	case SIOCGMIIPHY:
	case SIOCGMIIREG:
	case SIOCSMIIREG:
		return e1000_mii_ioctl(netdev, ifr, cmd);
	default:
		return -EOPNOTSUPP;
	}
}

/**
 * e1000_mii_ioctl -
 * @netdev:
 * @ifreq:
 * @cmd:
 **/

4776 4777
static int e1000_mii_ioctl(struct net_device *netdev, struct ifreq *ifr,
			   int cmd)
L
Linus Torvalds 已提交
4778
{
4779
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
4780
	struct e1000_hw *hw = &adapter->hw;
L
Linus Torvalds 已提交
4781 4782
	struct mii_ioctl_data *data = if_mii(ifr);
	int retval;
4783 4784
	u16 mii_reg;
	u16 spddplx;
4785
	unsigned long flags;
L
Linus Torvalds 已提交
4786

J
Joe Perches 已提交
4787
	if (hw->media_type != e1000_media_type_copper)
L
Linus Torvalds 已提交
4788 4789 4790 4791
		return -EOPNOTSUPP;

	switch (cmd) {
	case SIOCGMIIPHY:
J
Joe Perches 已提交
4792
		data->phy_id = hw->phy_addr;
L
Linus Torvalds 已提交
4793 4794
		break;
	case SIOCGMIIREG:
J
Jesse Brandeburg 已提交
4795
		if (!capable(CAP_NET_ADMIN))
L
Linus Torvalds 已提交
4796
			return -EPERM;
4797
		spin_lock_irqsave(&adapter->stats_lock, flags);
J
Joe Perches 已提交
4798
		if (e1000_read_phy_reg(hw, data->reg_num & 0x1F,
4799 4800
				   &data->val_out)) {
			spin_unlock_irqrestore(&adapter->stats_lock, flags);
L
Linus Torvalds 已提交
4801
			return -EIO;
4802 4803
		}
		spin_unlock_irqrestore(&adapter->stats_lock, flags);
L
Linus Torvalds 已提交
4804 4805
		break;
	case SIOCSMIIREG:
J
Jesse Brandeburg 已提交
4806
		if (!capable(CAP_NET_ADMIN))
L
Linus Torvalds 已提交
4807
			return -EPERM;
J
Jesse Brandeburg 已提交
4808
		if (data->reg_num & ~(0x1F))
L
Linus Torvalds 已提交
4809 4810
			return -EFAULT;
		mii_reg = data->val_in;
4811
		spin_lock_irqsave(&adapter->stats_lock, flags);
J
Joe Perches 已提交
4812
		if (e1000_write_phy_reg(hw, data->reg_num,
4813 4814
					mii_reg)) {
			spin_unlock_irqrestore(&adapter->stats_lock, flags);
L
Linus Torvalds 已提交
4815
			return -EIO;
4816
		}
4817
		spin_unlock_irqrestore(&adapter->stats_lock, flags);
J
Joe Perches 已提交
4818
		if (hw->media_type == e1000_media_type_copper) {
L
Linus Torvalds 已提交
4819 4820
			switch (data->reg_num) {
			case PHY_CTRL:
J
Jesse Brandeburg 已提交
4821
				if (mii_reg & MII_CR_POWER_DOWN)
L
Linus Torvalds 已提交
4822
					break;
J
Jesse Brandeburg 已提交
4823
				if (mii_reg & MII_CR_AUTO_NEG_EN) {
J
Joe Perches 已提交
4824 4825
					hw->autoneg = 1;
					hw->autoneg_advertised = 0x2F;
L
Linus Torvalds 已提交
4826 4827 4828 4829 4830 4831 4832 4833
				} else {
					if (mii_reg & 0x40)
						spddplx = SPEED_1000;
					else if (mii_reg & 0x2000)
						spddplx = SPEED_100;
					else
						spddplx = SPEED_10;
					spddplx += (mii_reg & 0x100)
4834 4835
						   ? DUPLEX_FULL :
						   DUPLEX_HALF;
L
Linus Torvalds 已提交
4836 4837
					retval = e1000_set_spd_dplx(adapter,
								    spddplx);
4838
					if (retval)
L
Linus Torvalds 已提交
4839 4840
						return retval;
				}
4841 4842 4843
				if (netif_running(adapter->netdev))
					e1000_reinit_locked(adapter);
				else
L
Linus Torvalds 已提交
4844 4845 4846 4847
					e1000_reset(adapter);
				break;
			case M88E1000_PHY_SPEC_CTRL:
			case M88E1000_EXT_PHY_SPEC_CTRL:
J
Joe Perches 已提交
4848
				if (e1000_phy_reset(hw))
L
Linus Torvalds 已提交
4849 4850 4851 4852 4853 4854
					return -EIO;
				break;
			}
		} else {
			switch (data->reg_num) {
			case PHY_CTRL:
J
Jesse Brandeburg 已提交
4855
				if (mii_reg & MII_CR_POWER_DOWN)
L
Linus Torvalds 已提交
4856
					break;
4857 4858 4859
				if (netif_running(adapter->netdev))
					e1000_reinit_locked(adapter);
				else
L
Linus Torvalds 已提交
4860 4861 4862 4863 4864 4865 4866 4867 4868 4869 4870
					e1000_reset(adapter);
				break;
			}
		}
		break;
	default:
		return -EOPNOTSUPP;
	}
	return E1000_SUCCESS;
}

4871
void e1000_pci_set_mwi(struct e1000_hw *hw)
L
Linus Torvalds 已提交
4872 4873
{
	struct e1000_adapter *adapter = hw->back;
4874
	int ret_val = pci_set_mwi(adapter->pdev);
L
Linus Torvalds 已提交
4875

J
Jesse Brandeburg 已提交
4876
	if (ret_val)
4877
		DPRINTK(PROBE, ERR, "Error in setting MWI\n");
L
Linus Torvalds 已提交
4878 4879
}

4880
void e1000_pci_clear_mwi(struct e1000_hw *hw)
L
Linus Torvalds 已提交
4881 4882 4883 4884 4885 4886
{
	struct e1000_adapter *adapter = hw->back;

	pci_clear_mwi(adapter->pdev);
}

4887
int e1000_pcix_get_mmrbc(struct e1000_hw *hw)
4888 4889 4890 4891 4892
{
	struct e1000_adapter *adapter = hw->back;
	return pcix_get_mmrbc(adapter->pdev);
}

4893
void e1000_pcix_set_mmrbc(struct e1000_hw *hw, int mmrbc)
4894 4895 4896 4897 4898
{
	struct e1000_adapter *adapter = hw->back;
	pcix_set_mmrbc(adapter->pdev, mmrbc);
}

4899
s32 e1000_read_pcie_cap_reg(struct e1000_hw *hw, u32 reg, u16 *value)
4900 4901
{
    struct e1000_adapter *adapter = hw->back;
4902
    u16 cap_offset;
4903 4904 4905 4906 4907 4908 4909 4910 4911 4912

    cap_offset = pci_find_capability(adapter->pdev, PCI_CAP_ID_EXP);
    if (!cap_offset)
        return -E1000_ERR_CONFIG;

    pci_read_config_word(adapter->pdev, cap_offset + reg, value);

    return E1000_SUCCESS;
}

4913
void e1000_io_write(struct e1000_hw *hw, unsigned long port, u32 value)
L
Linus Torvalds 已提交
4914 4915 4916 4917
{
	outl(value, port);
}

4918 4919
static void e1000_vlan_rx_register(struct net_device *netdev,
				   struct vlan_group *grp)
L
Linus Torvalds 已提交
4920
{
4921
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
4922
	struct e1000_hw *hw = &adapter->hw;
4923
	u32 ctrl, rctl;
L
Linus Torvalds 已提交
4924

J
Jesse Brandeburg 已提交
4925 4926
	if (!test_bit(__E1000_DOWN, &adapter->flags))
		e1000_irq_disable(adapter);
L
Linus Torvalds 已提交
4927 4928
	adapter->vlgrp = grp;

J
Jesse Brandeburg 已提交
4929
	if (grp) {
L
Linus Torvalds 已提交
4930
		/* enable VLAN tag insert/strip */
J
Joe Perches 已提交
4931
		ctrl = er32(CTRL);
L
Linus Torvalds 已提交
4932
		ctrl |= E1000_CTRL_VME;
J
Joe Perches 已提交
4933
		ew32(CTRL, ctrl);
L
Linus Torvalds 已提交
4934

4935
		if (adapter->hw.mac_type != e1000_ich8lan) {
4936
			/* enable VLAN receive filtering */
J
Joe Perches 已提交
4937
			rctl = er32(RCTL);
4938
			rctl &= ~E1000_RCTL_CFIEN;
J
Joe Perches 已提交
4939
			ew32(RCTL, rctl);
4940
			e1000_update_mng_vlan(adapter);
4941
		}
L
Linus Torvalds 已提交
4942 4943
	} else {
		/* disable VLAN tag insert/strip */
J
Joe Perches 已提交
4944
		ctrl = er32(CTRL);
L
Linus Torvalds 已提交
4945
		ctrl &= ~E1000_CTRL_VME;
J
Joe Perches 已提交
4946
		ew32(CTRL, ctrl);
L
Linus Torvalds 已提交
4947

4948
		if (adapter->hw.mac_type != e1000_ich8lan) {
4949
			if (adapter->mng_vlan_id !=
4950
			    (u16)E1000_MNG_VLAN_NONE) {
4951 4952 4953 4954
				e1000_vlan_rx_kill_vid(netdev,
				                       adapter->mng_vlan_id);
				adapter->mng_vlan_id = E1000_MNG_VLAN_NONE;
			}
4955
		}
L
Linus Torvalds 已提交
4956 4957
	}

J
Jesse Brandeburg 已提交
4958 4959
	if (!test_bit(__E1000_DOWN, &adapter->flags))
		e1000_irq_enable(adapter);
L
Linus Torvalds 已提交
4960 4961
}

4962
static void e1000_vlan_rx_add_vid(struct net_device *netdev, u16 vid)
L
Linus Torvalds 已提交
4963
{
4964
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
4965
	struct e1000_hw *hw = &adapter->hw;
4966
	u32 vfta, index;
J
Jesse Brandeburg 已提交
4967

J
Joe Perches 已提交
4968
	if ((hw->mng_cookie.status &
J
Jesse Brandeburg 已提交
4969 4970
	     E1000_MNG_DHCP_COOKIE_STATUS_VLAN_SUPPORT) &&
	    (vid == adapter->mng_vlan_id))
4971
		return;
L
Linus Torvalds 已提交
4972 4973
	/* add VID to filter table */
	index = (vid >> 5) & 0x7F;
J
Joe Perches 已提交
4974
	vfta = E1000_READ_REG_ARRAY(hw, VFTA, index);
L
Linus Torvalds 已提交
4975
	vfta |= (1 << (vid & 0x1F));
J
Joe Perches 已提交
4976
	e1000_write_vfta(hw, index, vfta);
L
Linus Torvalds 已提交
4977 4978
}

4979
static void e1000_vlan_rx_kill_vid(struct net_device *netdev, u16 vid)
L
Linus Torvalds 已提交
4980
{
4981
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
4982
	struct e1000_hw *hw = &adapter->hw;
4983
	u32 vfta, index;
L
Linus Torvalds 已提交
4984

J
Jesse Brandeburg 已提交
4985 4986
	if (!test_bit(__E1000_DOWN, &adapter->flags))
		e1000_irq_disable(adapter);
D
Dan Aloni 已提交
4987
	vlan_group_set_device(adapter->vlgrp, vid, NULL);
J
Jesse Brandeburg 已提交
4988 4989
	if (!test_bit(__E1000_DOWN, &adapter->flags))
		e1000_irq_enable(adapter);
L
Linus Torvalds 已提交
4990

J
Joe Perches 已提交
4991
	if ((hw->mng_cookie.status &
J
Jesse Brandeburg 已提交
4992
	     E1000_MNG_DHCP_COOKIE_STATUS_VLAN_SUPPORT) &&
J
Jeff Kirsher 已提交
4993 4994 4995
	    (vid == adapter->mng_vlan_id)) {
		/* release control to f/w */
		e1000_release_hw_control(adapter);
4996
		return;
J
Jeff Kirsher 已提交
4997 4998
	}

L
Linus Torvalds 已提交
4999 5000
	/* remove VID from filter table */
	index = (vid >> 5) & 0x7F;
J
Joe Perches 已提交
5001
	vfta = E1000_READ_REG_ARRAY(hw, VFTA, index);
L
Linus Torvalds 已提交
5002
	vfta &= ~(1 << (vid & 0x1F));
J
Joe Perches 已提交
5003
	e1000_write_vfta(hw, index, vfta);
L
Linus Torvalds 已提交
5004 5005
}

5006
static void e1000_restore_vlan(struct e1000_adapter *adapter)
L
Linus Torvalds 已提交
5007 5008 5009
{
	e1000_vlan_rx_register(adapter->netdev, adapter->vlgrp);

J
Jesse Brandeburg 已提交
5010
	if (adapter->vlgrp) {
5011
		u16 vid;
J
Jesse Brandeburg 已提交
5012
		for (vid = 0; vid < VLAN_GROUP_ARRAY_LEN; vid++) {
D
Dan Aloni 已提交
5013
			if (!vlan_group_get_device(adapter->vlgrp, vid))
L
Linus Torvalds 已提交
5014 5015 5016 5017 5018 5019
				continue;
			e1000_vlan_rx_add_vid(adapter->netdev, vid);
		}
	}
}

5020
int e1000_set_spd_dplx(struct e1000_adapter *adapter, u16 spddplx)
L
Linus Torvalds 已提交
5021
{
J
Joe Perches 已提交
5022 5023 5024
	struct e1000_hw *hw = &adapter->hw;

	hw->autoneg = 0;
L
Linus Torvalds 已提交
5025

5026
	/* Fiber NICs only allow 1000 gbps Full duplex */
J
Joe Perches 已提交
5027
	if ((hw->media_type == e1000_media_type_fiber) &&
5028 5029 5030 5031 5032
		spddplx != (SPEED_1000 + DUPLEX_FULL)) {
		DPRINTK(PROBE, ERR, "Unsupported Speed/Duplex configuration\n");
		return -EINVAL;
	}

J
Jesse Brandeburg 已提交
5033
	switch (spddplx) {
L
Linus Torvalds 已提交
5034
	case SPEED_10 + DUPLEX_HALF:
J
Joe Perches 已提交
5035
		hw->forced_speed_duplex = e1000_10_half;
L
Linus Torvalds 已提交
5036 5037
		break;
	case SPEED_10 + DUPLEX_FULL:
J
Joe Perches 已提交
5038
		hw->forced_speed_duplex = e1000_10_full;
L
Linus Torvalds 已提交
5039 5040
		break;
	case SPEED_100 + DUPLEX_HALF:
J
Joe Perches 已提交
5041
		hw->forced_speed_duplex = e1000_100_half;
L
Linus Torvalds 已提交
5042 5043
		break;
	case SPEED_100 + DUPLEX_FULL:
J
Joe Perches 已提交
5044
		hw->forced_speed_duplex = e1000_100_full;
L
Linus Torvalds 已提交
5045 5046
		break;
	case SPEED_1000 + DUPLEX_FULL:
J
Joe Perches 已提交
5047 5048
		hw->autoneg = 1;
		hw->autoneg_advertised = ADVERTISE_1000_FULL;
L
Linus Torvalds 已提交
5049 5050 5051
		break;
	case SPEED_1000 + DUPLEX_HALF: /* not supported */
	default:
5052
		DPRINTK(PROBE, ERR, "Unsupported Speed/Duplex configuration\n");
L
Linus Torvalds 已提交
5053 5054 5055 5056 5057
		return -EINVAL;
	}
	return 0;
}

5058
static int e1000_suspend(struct pci_dev *pdev, pm_message_t state)
L
Linus Torvalds 已提交
5059 5060
{
	struct net_device *netdev = pci_get_drvdata(pdev);
5061
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
5062
	struct e1000_hw *hw = &adapter->hw;
5063 5064
	u32 ctrl, ctrl_ext, rctl, status;
	u32 wufc = adapter->wol;
A
Auke Kok 已提交
5065
#ifdef CONFIG_PM
5066
	int retval = 0;
A
Auke Kok 已提交
5067
#endif
L
Linus Torvalds 已提交
5068 5069 5070

	netif_device_detach(netdev);

5071 5072
	if (netif_running(netdev)) {
		WARN_ON(test_bit(__E1000_RESETTING, &adapter->flags));
L
Linus Torvalds 已提交
5073
		e1000_down(adapter);
5074
	}
L
Linus Torvalds 已提交
5075

5076
#ifdef CONFIG_PM
5077
	retval = pci_save_state(pdev);
5078 5079 5080 5081
	if (retval)
		return retval;
#endif

J
Joe Perches 已提交
5082
	status = er32(STATUS);
J
Jesse Brandeburg 已提交
5083
	if (status & E1000_STATUS_LU)
L
Linus Torvalds 已提交
5084 5085
		wufc &= ~E1000_WUFC_LNKC;

J
Jesse Brandeburg 已提交
5086
	if (wufc) {
L
Linus Torvalds 已提交
5087
		e1000_setup_rctl(adapter);
5088
		e1000_set_rx_mode(netdev);
L
Linus Torvalds 已提交
5089 5090

		/* turn on all-multi mode if wake on multicast is enabled */
5091
		if (wufc & E1000_WUFC_MC) {
J
Joe Perches 已提交
5092
			rctl = er32(RCTL);
L
Linus Torvalds 已提交
5093
			rctl |= E1000_RCTL_MPE;
J
Joe Perches 已提交
5094
			ew32(RCTL, rctl);
L
Linus Torvalds 已提交
5095 5096
		}

J
Joe Perches 已提交
5097 5098
		if (hw->mac_type >= e1000_82540) {
			ctrl = er32(CTRL);
L
Linus Torvalds 已提交
5099 5100 5101 5102 5103 5104
			/* advertise wake from D3Cold */
			#define E1000_CTRL_ADVD3WUC 0x00100000
			/* phy power management enable */
			#define E1000_CTRL_EN_PHY_PWR_MGMT 0x00200000
			ctrl |= E1000_CTRL_ADVD3WUC |
				E1000_CTRL_EN_PHY_PWR_MGMT;
J
Joe Perches 已提交
5105
			ew32(CTRL, ctrl);
L
Linus Torvalds 已提交
5106 5107
		}

J
Joe Perches 已提交
5108 5109
		if (hw->media_type == e1000_media_type_fiber ||
		   hw->media_type == e1000_media_type_internal_serdes) {
L
Linus Torvalds 已提交
5110
			/* keep the laser running in D3 */
J
Joe Perches 已提交
5111
			ctrl_ext = er32(CTRL_EXT);
L
Linus Torvalds 已提交
5112
			ctrl_ext |= E1000_CTRL_EXT_SDP7_DATA;
J
Joe Perches 已提交
5113
			ew32(CTRL_EXT, ctrl_ext);
L
Linus Torvalds 已提交
5114 5115
		}

5116
		/* Allow time for pending master requests to run */
J
Joe Perches 已提交
5117
		e1000_disable_pciex_master(hw);
5118

J
Joe Perches 已提交
5119 5120
		ew32(WUC, E1000_WUC_PME_EN);
		ew32(WUFC, wufc);
5121 5122
		pci_enable_wake(pdev, PCI_D3hot, 1);
		pci_enable_wake(pdev, PCI_D3cold, 1);
L
Linus Torvalds 已提交
5123
	} else {
J
Joe Perches 已提交
5124 5125
		ew32(WUC, 0);
		ew32(WUFC, 0);
5126 5127
		pci_enable_wake(pdev, PCI_D3hot, 0);
		pci_enable_wake(pdev, PCI_D3cold, 0);
L
Linus Torvalds 已提交
5128 5129
	}

5130 5131 5132 5133 5134 5135
	e1000_release_manageability(adapter);

	/* make sure adapter isn't asleep if manageability is enabled */
	if (adapter->en_mng_pt) {
		pci_enable_wake(pdev, PCI_D3hot, 1);
		pci_enable_wake(pdev, PCI_D3cold, 1);
L
Linus Torvalds 已提交
5136 5137
	}

J
Joe Perches 已提交
5138 5139
	if (hw->phy_type == e1000_phy_igp_3)
		e1000_phy_powerdown_workaround(hw);
5140

5141 5142 5143
	if (netif_running(netdev))
		e1000_free_irq(adapter);

5144 5145 5146
	/* Release control of h/w to f/w.  If f/w is AMT enabled, this
	 * would have already happened in close and is redundant. */
	e1000_release_hw_control(adapter);
5147

L
Linus Torvalds 已提交
5148
	pci_disable_device(pdev);
5149

5150
	pci_set_power_state(pdev, pci_choose_state(pdev, state));
L
Linus Torvalds 已提交
5151 5152 5153 5154

	return 0;
}

5155
#ifdef CONFIG_PM
5156
static int e1000_resume(struct pci_dev *pdev)
L
Linus Torvalds 已提交
5157 5158
{
	struct net_device *netdev = pci_get_drvdata(pdev);
5159
	struct e1000_adapter *adapter = netdev_priv(netdev);
J
Joe Perches 已提交
5160
	struct e1000_hw *hw = &adapter->hw;
5161
	u32 err;
L
Linus Torvalds 已提交
5162

5163
	pci_set_power_state(pdev, PCI_D0);
5164
	pci_restore_state(pdev);
5165 5166
	err = pci_enable_device(pdev);
	if (err) {
5167 5168 5169
		printk(KERN_ERR "e1000: Cannot enable PCI device from suspend\n");
		return err;
	}
5170
	pci_set_master(pdev);
L
Linus Torvalds 已提交
5171

5172 5173
	pci_enable_wake(pdev, PCI_D3hot, 0);
	pci_enable_wake(pdev, PCI_D3cold, 0);
L
Linus Torvalds 已提交
5174

5175 5176 5177 5178 5179
	if (netif_running(netdev)) {
		err = e1000_request_irq(adapter);
		if (err)
			return err;
	}
5180 5181

	e1000_power_up_phy(adapter);
L
Linus Torvalds 已提交
5182
	e1000_reset(adapter);
J
Joe Perches 已提交
5183
	ew32(WUS, ~0);
L
Linus Torvalds 已提交
5184

5185 5186
	e1000_init_manageability(adapter);

J
Jesse Brandeburg 已提交
5187
	if (netif_running(netdev))
L
Linus Torvalds 已提交
5188 5189 5190 5191
		e1000_up(adapter);

	netif_device_attach(netdev);

5192 5193 5194 5195
	/* If the controller is 82573 and f/w is AMT, do not set
	 * DRV_LOAD until the interface is up.  For all other cases,
	 * let the f/w know that the h/w is now under the control
	 * of the driver. */
J
Joe Perches 已提交
5196 5197
	if (hw->mac_type != e1000_82573 ||
	    !e1000_check_mng_mode(hw))
5198
		e1000_get_hw_control(adapter);
5199

L
Linus Torvalds 已提交
5200 5201 5202
	return 0;
}
#endif
5203 5204 5205 5206 5207 5208

static void e1000_shutdown(struct pci_dev *pdev)
{
	e1000_suspend(pdev, PMSG_SUSPEND);
}

L
Linus Torvalds 已提交
5209 5210 5211 5212 5213 5214
#ifdef CONFIG_NET_POLL_CONTROLLER
/*
 * Polling 'interrupt' - used by things like netconsole to send skbs
 * without having to re-enable interrupts. It's not called while
 * the interrupt routine is executing.
 */
5215
static void e1000_netpoll(struct net_device *netdev)
L
Linus Torvalds 已提交
5216
{
5217
	struct e1000_adapter *adapter = netdev_priv(netdev);
5218

L
Linus Torvalds 已提交
5219
	disable_irq(adapter->pdev->irq);
5220
	e1000_intr(adapter->pdev->irq, netdev);
J
Jeff Kirsher 已提交
5221 5222 5223
#ifndef CONFIG_E1000_NAPI
	adapter->clean_rx(adapter, adapter->rx_ring);
#endif
L
Linus Torvalds 已提交
5224 5225 5226 5227
	enable_irq(adapter->pdev->irq);
}
#endif

A
Auke Kok 已提交
5228 5229 5230 5231 5232 5233 5234 5235
/**
 * e1000_io_error_detected - called when PCI error is detected
 * @pdev: Pointer to PCI device
 * @state: The current pci conneection state
 *
 * This function is called after a PCI bus error affecting
 * this device has been detected.
 */
5236 5237
static pci_ers_result_t e1000_io_error_detected(struct pci_dev *pdev,
						pci_channel_state_t state)
A
Auke Kok 已提交
5238 5239 5240 5241 5242 5243 5244 5245
{
	struct net_device *netdev = pci_get_drvdata(pdev);
	struct e1000_adapter *adapter = netdev->priv;

	netif_device_detach(netdev);

	if (netif_running(netdev))
		e1000_down(adapter);
5246
	pci_disable_device(pdev);
A
Auke Kok 已提交
5247 5248 5249 5250 5251 5252 5253 5254 5255 5256 5257 5258 5259 5260 5261 5262

	/* Request a slot slot reset. */
	return PCI_ERS_RESULT_NEED_RESET;
}

/**
 * e1000_io_slot_reset - called after the pci bus has been reset.
 * @pdev: Pointer to PCI device
 *
 * Restart the card from scratch, as if from a cold-boot. Implementation
 * resembles the first-half of the e1000_resume routine.
 */
static pci_ers_result_t e1000_io_slot_reset(struct pci_dev *pdev)
{
	struct net_device *netdev = pci_get_drvdata(pdev);
	struct e1000_adapter *adapter = netdev->priv;
J
Joe Perches 已提交
5263
	struct e1000_hw *hw = &adapter->hw;
A
Auke Kok 已提交
5264 5265 5266 5267 5268 5269 5270

	if (pci_enable_device(pdev)) {
		printk(KERN_ERR "e1000: Cannot re-enable PCI device after reset.\n");
		return PCI_ERS_RESULT_DISCONNECT;
	}
	pci_set_master(pdev);

5271 5272
	pci_enable_wake(pdev, PCI_D3hot, 0);
	pci_enable_wake(pdev, PCI_D3cold, 0);
A
Auke Kok 已提交
5273 5274

	e1000_reset(adapter);
J
Joe Perches 已提交
5275
	ew32(WUS, ~0);
A
Auke Kok 已提交
5276 5277 5278 5279 5280 5281 5282 5283 5284 5285 5286 5287 5288 5289 5290 5291

	return PCI_ERS_RESULT_RECOVERED;
}

/**
 * e1000_io_resume - called when traffic can start flowing again.
 * @pdev: Pointer to PCI device
 *
 * This callback is called when the error recovery driver tells us that
 * its OK to resume normal operation. Implementation resembles the
 * second-half of the e1000_resume routine.
 */
static void e1000_io_resume(struct pci_dev *pdev)
{
	struct net_device *netdev = pci_get_drvdata(pdev);
	struct e1000_adapter *adapter = netdev->priv;
J
Joe Perches 已提交
5292
	struct e1000_hw *hw = &adapter->hw;
5293 5294

	e1000_init_manageability(adapter);
A
Auke Kok 已提交
5295 5296 5297 5298 5299 5300 5301 5302 5303 5304

	if (netif_running(netdev)) {
		if (e1000_up(adapter)) {
			printk("e1000: can't bring device back up after reset\n");
			return;
		}
	}

	netif_device_attach(netdev);

5305 5306 5307 5308
	/* If the controller is 82573 and f/w is AMT, do not set
	 * DRV_LOAD until the interface is up.  For all other cases,
	 * let the f/w know that the h/w is now under the control
	 * of the driver. */
J
Joe Perches 已提交
5309 5310
	if (hw->mac_type != e1000_82573 ||
	    !e1000_check_mng_mode(hw))
5311
		e1000_get_hw_control(adapter);
A
Auke Kok 已提交
5312 5313 5314

}

L
Linus Torvalds 已提交
5315
/* e1000_main.c */