blob: b30a5992e3325e5e34e97e45f71053a824de36df [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * forcedeth: Ethernet driver for NVIDIA nForce media access controllers.
3 *
4 * Note: This driver is a cleanroom reimplementation based on reverse
5 * engineered documentation written by Carl-Daniel Hailfinger
Ayaz Abdulla87046e52006-12-19 23:33:32 -05006 * and Andrew de Quincey.
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 *
8 * NVIDIA, nForce and other NVIDIA marks are trademarks or registered
9 * trademarks of NVIDIA Corporation in the United States and other
10 * countries.
11 *
Manfred Spraul18360982005-12-24 14:19:24 +010012 * Copyright (C) 2003,4,5 Manfred Spraul
Linus Torvalds1da177e2005-04-16 15:20:36 -070013 * Copyright (C) 2004 Andrew de Quincey (wol support)
14 * Copyright (C) 2004 Carl-Daniel Hailfinger (invalid MAC handling, insane
15 * IRQ rate fixes, bigendian fixes, cleanups, verification)
Ayaz Abdullaf1405d322009-01-09 11:03:54 +000016 * Copyright (c) 2004,2005,2006,2007,2008,2009 NVIDIA Corporation
Linus Torvalds1da177e2005-04-16 15:20:36 -070017 *
18 * This program is free software; you can redistribute it and/or modify
19 * it under the terms of the GNU General Public License as published by
20 * the Free Software Foundation; either version 2 of the License, or
21 * (at your option) any later version.
22 *
23 * This program is distributed in the hope that it will be useful,
24 * but WITHOUT ANY WARRANTY; without even the implied warranty of
25 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
26 * GNU General Public License for more details.
27 *
28 * You should have received a copy of the GNU General Public License
29 * along with this program; if not, write to the Free Software
30 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
31 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070032 * Known bugs:
33 * We suspect that on some hardware no TX done interrupts are generated.
34 * This means recovery from netif_stop_queue only happens if the hw timer
35 * interrupt fires (100 times/second, configurable with NVREG_POLL_DEFAULT)
36 * and the timer is active in the IRQMask, or if a rx packet arrives by chance.
37 * If your hardware reliably generates tx done interrupts, then you can remove
38 * DEV_NEED_TIMERIRQ from the driver_data flags.
39 * DEV_NEED_TIMERIRQ will not harm you on sane hardware, only generating a few
40 * superfluous timer interrupts from the nic.
41 */
Ayaz Abdulla3e1a3ce2009-03-05 08:02:38 +000042#define FORCEDETH_VERSION "0.64"
Linus Torvalds1da177e2005-04-16 15:20:36 -070043#define DRV_NAME "forcedeth"
44
45#include <linux/module.h>
46#include <linux/types.h>
47#include <linux/pci.h>
48#include <linux/interrupt.h>
49#include <linux/netdevice.h>
50#include <linux/etherdevice.h>
51#include <linux/delay.h>
Alexey Dobriyand43c36d2009-10-07 17:09:06 +040052#include <linux/sched.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070053#include <linux/spinlock.h>
54#include <linux/ethtool.h>
55#include <linux/timer.h>
56#include <linux/skbuff.h>
57#include <linux/mii.h>
58#include <linux/random.h>
59#include <linux/init.h>
Manfred Spraul22c6d142005-04-19 21:17:09 +020060#include <linux/if_vlan.h>
Matthias Gehre910638a2006-03-28 01:56:48 -080061#include <linux/dma-mapping.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090062#include <linux/slab.h>
Szymon Janc5504e132010-11-27 08:39:45 +000063#include <linux/uaccess.h>
64#include <linux/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070065
66#include <asm/irq.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070067#include <asm/system.h>
68
Stephen Hemmingerbea33482007-10-03 16:41:36 -070069#define TX_WORK_PER_LOOP 64
70#define RX_WORK_PER_LOOP 64
Linus Torvalds1da177e2005-04-16 15:20:36 -070071
72/*
73 * Hardware access:
74 */
75
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +000076#define DEV_NEED_TIMERIRQ 0x0000001 /* set the timer irq flag in the irq mask */
77#define DEV_NEED_LINKTIMER 0x0000002 /* poll link settings. Relies on the timer irq */
78#define DEV_HAS_LARGEDESC 0x0000004 /* device supports jumbo frames and needs packet format 2 */
79#define DEV_HAS_HIGH_DMA 0x0000008 /* device supports 64bit dma */
80#define DEV_HAS_CHECKSUM 0x0000010 /* device supports tx and rx checksum offloads */
81#define DEV_HAS_VLAN 0x0000020 /* device supports vlan tagging and striping */
82#define DEV_HAS_MSI 0x0000040 /* device supports MSI */
83#define DEV_HAS_MSI_X 0x0000080 /* device supports MSI-X */
84#define DEV_HAS_POWER_CNTRL 0x0000100 /* device supports power savings */
85#define DEV_HAS_STATISTICS_V1 0x0000200 /* device supports hw statistics version 1 */
Mike Ditto7b5e0782010-07-25 21:54:28 -070086#define DEV_HAS_STATISTICS_V2 0x0000400 /* device supports hw statistics version 2 */
87#define DEV_HAS_STATISTICS_V3 0x0000800 /* device supports hw statistics version 3 */
88#define DEV_HAS_STATISTICS_V12 0x0000600 /* device supports hw statistics version 1 and 2 */
89#define DEV_HAS_STATISTICS_V123 0x0000e00 /* device supports hw statistics version 1, 2, and 3 */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +000090#define DEV_HAS_TEST_EXTENDED 0x0001000 /* device supports extended diagnostic test */
91#define DEV_HAS_MGMT_UNIT 0x0002000 /* device supports management unit */
92#define DEV_HAS_CORRECT_MACADDR 0x0004000 /* device supports correct mac address order */
93#define DEV_HAS_COLLISION_FIX 0x0008000 /* device supports tx collision fix */
94#define DEV_HAS_PAUSEFRAME_TX_V1 0x0010000 /* device supports tx pause frames version 1 */
95#define DEV_HAS_PAUSEFRAME_TX_V2 0x0020000 /* device supports tx pause frames version 2 */
96#define DEV_HAS_PAUSEFRAME_TX_V3 0x0040000 /* device supports tx pause frames version 3 */
97#define DEV_NEED_TX_LIMIT 0x0080000 /* device needs to limit tx */
98#define DEV_NEED_TX_LIMIT2 0x0180000 /* device needs to limit tx, expect for some revs */
99#define DEV_HAS_GEAR_MODE 0x0200000 /* device supports gear mode */
100#define DEV_NEED_PHY_INIT_FIX 0x0400000 /* device needs specific phy workaround */
101#define DEV_NEED_LOW_POWER_FIX 0x0800000 /* device needs special power up workaround */
102#define DEV_NEED_MSI_FIX 0x1000000 /* device needs msi workaround */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103
104enum {
105 NvRegIrqStatus = 0x000,
106#define NVREG_IRQSTAT_MIIEVENT 0x040
Ayaz Abdulladaa91a92009-02-07 00:25:00 -0800107#define NVREG_IRQSTAT_MASK 0x83ff
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108 NvRegIrqMask = 0x004,
109#define NVREG_IRQ_RX_ERROR 0x0001
110#define NVREG_IRQ_RX 0x0002
111#define NVREG_IRQ_RX_NOBUF 0x0004
112#define NVREG_IRQ_TX_ERR 0x0008
Manfred Spraulc2dba062005-07-31 18:29:47 +0200113#define NVREG_IRQ_TX_OK 0x0010
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114#define NVREG_IRQ_TIMER 0x0020
115#define NVREG_IRQ_LINK 0x0040
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500116#define NVREG_IRQ_RX_FORCED 0x0080
117#define NVREG_IRQ_TX_FORCED 0x0100
Ayaz Abdulladaa91a92009-02-07 00:25:00 -0800118#define NVREG_IRQ_RECOVER_ERROR 0x8200
Ayaz Abdullaa971c322005-11-11 08:30:38 -0500119#define NVREG_IRQMASK_THROUGHPUT 0x00df
Ayaz Abdulla096a4582007-05-21 20:23:11 -0400120#define NVREG_IRQMASK_CPU 0x0060
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500121#define NVREG_IRQ_TX_ALL (NVREG_IRQ_TX_ERR|NVREG_IRQ_TX_OK|NVREG_IRQ_TX_FORCED)
122#define NVREG_IRQ_RX_ALL (NVREG_IRQ_RX_ERROR|NVREG_IRQ_RX|NVREG_IRQ_RX_NOBUF|NVREG_IRQ_RX_FORCED)
Ayaz Abdullac5cf9102006-10-30 17:32:01 -0500123#define NVREG_IRQ_OTHER (NVREG_IRQ_TIMER|NVREG_IRQ_LINK|NVREG_IRQ_RECOVER_ERROR)
Manfred Spraulc2dba062005-07-31 18:29:47 +0200124
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125 NvRegUnknownSetupReg6 = 0x008,
126#define NVREG_UNKSETUP6_VAL 3
127
128/*
129 * NVREG_POLL_DEFAULT is the interval length of the timer source on the nic
130 * NVREG_POLL_DEFAULT=97 would result in an interval length of 1 ms
131 */
132 NvRegPollingInterval = 0x00c,
Ayaz Abdulla6cef67a2009-03-05 08:02:30 +0000133#define NVREG_POLL_DEFAULT_THROUGHPUT 65535 /* backup tx cleanup if loop max reached */
Ayaz Abdullaa971c322005-11-11 08:30:38 -0500134#define NVREG_POLL_DEFAULT_CPU 13
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500135 NvRegMSIMap0 = 0x020,
136 NvRegMSIMap1 = 0x024,
137 NvRegMSIIrqMask = 0x030,
138#define NVREG_MSI_VECTOR_0_ENABLED 0x01
Linus Torvalds1da177e2005-04-16 15:20:36 -0700139 NvRegMisc1 = 0x080,
Ayaz Abdullaeb91f612006-05-24 18:13:19 -0400140#define NVREG_MISC1_PAUSE_TX 0x01
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141#define NVREG_MISC1_HD 0x02
142#define NVREG_MISC1_FORCE 0x3b0f3c
143
Ayaz Abdulla0a626772008-01-13 16:02:42 -0500144 NvRegMacReset = 0x34,
Ayaz Abdulla86a0f042006-04-24 18:41:31 -0400145#define NVREG_MAC_RESET_ASSERT 0x0F3
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146 NvRegTransmitterControl = 0x084,
147#define NVREG_XMITCTL_START 0x01
Ayaz Abdulla7e680c22006-10-30 17:31:51 -0500148#define NVREG_XMITCTL_MGMT_ST 0x40000000
149#define NVREG_XMITCTL_SYNC_MASK 0x000f0000
150#define NVREG_XMITCTL_SYNC_NOT_READY 0x0
151#define NVREG_XMITCTL_SYNC_PHY_INIT 0x00040000
152#define NVREG_XMITCTL_MGMT_SEMA_MASK 0x00000f00
153#define NVREG_XMITCTL_MGMT_SEMA_FREE 0x0
154#define NVREG_XMITCTL_HOST_SEMA_MASK 0x0000f000
155#define NVREG_XMITCTL_HOST_SEMA_ACQ 0x0000f000
156#define NVREG_XMITCTL_HOST_LOADED 0x00004000
Ayaz Abdullaf35723e2003-02-20 03:03:54 -0500157#define NVREG_XMITCTL_TX_PATH_EN 0x01000000
Ayaz Abdullacac1c522009-02-07 00:23:57 -0800158#define NVREG_XMITCTL_DATA_START 0x00100000
159#define NVREG_XMITCTL_DATA_READY 0x00010000
160#define NVREG_XMITCTL_DATA_ERROR 0x00020000
Linus Torvalds1da177e2005-04-16 15:20:36 -0700161 NvRegTransmitterStatus = 0x088,
162#define NVREG_XMITSTAT_BUSY 0x01
163
164 NvRegPacketFilterFlags = 0x8c,
Ayaz Abdullaeb91f612006-05-24 18:13:19 -0400165#define NVREG_PFF_PAUSE_RX 0x08
166#define NVREG_PFF_ALWAYS 0x7F0000
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167#define NVREG_PFF_PROMISC 0x80
168#define NVREG_PFF_MYADDR 0x20
Ayaz Abdulla9589c772006-06-10 22:48:13 -0400169#define NVREG_PFF_LOOPBACK 0x10
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170
171 NvRegOffloadConfig = 0x90,
172#define NVREG_OFFLOAD_HOMEPHY 0x601
173#define NVREG_OFFLOAD_NORMAL RX_NIC_BUFSIZE
174 NvRegReceiverControl = 0x094,
175#define NVREG_RCVCTL_START 0x01
Ayaz Abdullaf35723e2003-02-20 03:03:54 -0500176#define NVREG_RCVCTL_RX_PATH_EN 0x01000000
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177 NvRegReceiverStatus = 0x98,
178#define NVREG_RCVSTAT_BUSY 0x01
179
Ayaz Abdullaa4336862008-04-18 13:50:43 -0700180 NvRegSlotTime = 0x9c,
181#define NVREG_SLOTTIME_LEGBF_ENABLED 0x80000000
182#define NVREG_SLOTTIME_10_100_FULL 0x00007f00
Szymon Janc78aea4f2010-11-27 08:39:43 +0000183#define NVREG_SLOTTIME_1000_FULL 0x0003ff00
Ayaz Abdullaa4336862008-04-18 13:50:43 -0700184#define NVREG_SLOTTIME_HALF 0x0000ff00
Szymon Janc78aea4f2010-11-27 08:39:43 +0000185#define NVREG_SLOTTIME_DEFAULT 0x00007f00
Ayaz Abdullaa4336862008-04-18 13:50:43 -0700186#define NVREG_SLOTTIME_MASK 0x000000ff
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187
Ayaz Abdulla9744e212006-07-06 16:45:58 -0400188 NvRegTxDeferral = 0xA0,
Ayaz Abdullafd9b5582008-02-05 12:29:49 -0500189#define NVREG_TX_DEFERRAL_DEFAULT 0x15050f
190#define NVREG_TX_DEFERRAL_RGMII_10_100 0x16070f
191#define NVREG_TX_DEFERRAL_RGMII_1000 0x14050f
192#define NVREG_TX_DEFERRAL_RGMII_STRETCH_10 0x16190f
193#define NVREG_TX_DEFERRAL_RGMII_STRETCH_100 0x16300f
194#define NVREG_TX_DEFERRAL_MII_STRETCH 0x152000
Ayaz Abdulla9744e212006-07-06 16:45:58 -0400195 NvRegRxDeferral = 0xA4,
196#define NVREG_RX_DEFERRAL_DEFAULT 0x16
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 NvRegMacAddrA = 0xA8,
198 NvRegMacAddrB = 0xAC,
199 NvRegMulticastAddrA = 0xB0,
200#define NVREG_MCASTADDRA_FORCE 0x01
201 NvRegMulticastAddrB = 0xB4,
202 NvRegMulticastMaskA = 0xB8,
Ayaz Abdullabb9a4fd2008-01-13 16:03:04 -0500203#define NVREG_MCASTMASKA_NONE 0xffffffff
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204 NvRegMulticastMaskB = 0xBC,
Ayaz Abdullabb9a4fd2008-01-13 16:03:04 -0500205#define NVREG_MCASTMASKB_NONE 0xffff
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206
207 NvRegPhyInterface = 0xC0,
208#define PHY_RGMII 0x10000000
Ayaz Abdullaa4336862008-04-18 13:50:43 -0700209 NvRegBackOffControl = 0xC4,
210#define NVREG_BKOFFCTRL_DEFAULT 0x70000000
211#define NVREG_BKOFFCTRL_SEED_MASK 0x000003ff
212#define NVREG_BKOFFCTRL_SELECT 24
213#define NVREG_BKOFFCTRL_GEAR 12
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214
215 NvRegTxRingPhysAddr = 0x100,
216 NvRegRxRingPhysAddr = 0x104,
217 NvRegRingSizes = 0x108,
218#define NVREG_RINGSZ_TXSHIFT 0
219#define NVREG_RINGSZ_RXSHIFT 16
Ayaz Abdulla5070d342006-07-31 12:05:01 -0400220 NvRegTransmitPoll = 0x10c,
221#define NVREG_TRANSMITPOLL_MAC_ADDR_REV 0x00008000
Linus Torvalds1da177e2005-04-16 15:20:36 -0700222 NvRegLinkSpeed = 0x110,
223#define NVREG_LINKSPEED_FORCE 0x10000
224#define NVREG_LINKSPEED_10 1000
225#define NVREG_LINKSPEED_100 100
226#define NVREG_LINKSPEED_1000 50
227#define NVREG_LINKSPEED_MASK (0xFFF)
228 NvRegUnknownSetupReg5 = 0x130,
229#define NVREG_UNKSETUP5_BIT31 (1<<31)
Ayaz Abdulla95d161c2006-07-06 16:46:25 -0400230 NvRegTxWatermark = 0x13c,
231#define NVREG_TX_WM_DESC1_DEFAULT 0x0200010
232#define NVREG_TX_WM_DESC2_3_DEFAULT 0x1e08000
233#define NVREG_TX_WM_DESC2_3_1000 0xfe08000
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234 NvRegTxRxControl = 0x144,
235#define NVREG_TXRXCTL_KICK 0x0001
236#define NVREG_TXRXCTL_BIT1 0x0002
237#define NVREG_TXRXCTL_BIT2 0x0004
238#define NVREG_TXRXCTL_IDLE 0x0008
239#define NVREG_TXRXCTL_RESET 0x0010
240#define NVREG_TXRXCTL_RXCHECK 0x0400
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -0400241#define NVREG_TXRXCTL_DESC_1 0
Ayaz Abdullad2f78412007-01-09 13:30:02 -0500242#define NVREG_TXRXCTL_DESC_2 0x002100
243#define NVREG_TXRXCTL_DESC_3 0xc02200
Ayaz Abdullaee407b02006-02-04 13:13:17 -0500244#define NVREG_TXRXCTL_VLANSTRIP 0x00040
245#define NVREG_TXRXCTL_VLANINS 0x00080
Ayaz Abdulla0832b252006-02-04 13:13:26 -0500246 NvRegTxRingPhysAddrHigh = 0x148,
247 NvRegRxRingPhysAddrHigh = 0x14C,
Ayaz Abdullaeb91f612006-05-24 18:13:19 -0400248 NvRegTxPauseFrame = 0x170,
Ayaz Abdulla5289b4c2008-02-05 12:30:01 -0500249#define NVREG_TX_PAUSEFRAME_DISABLE 0x0fff0080
250#define NVREG_TX_PAUSEFRAME_ENABLE_V1 0x01800010
251#define NVREG_TX_PAUSEFRAME_ENABLE_V2 0x056003f0
252#define NVREG_TX_PAUSEFRAME_ENABLE_V3 0x09f00880
Ayaz Abdulla9a33e882008-08-06 12:12:34 -0400253 NvRegTxPauseFrameLimit = 0x174,
254#define NVREG_TX_PAUSEFRAMELIMIT_ENABLE 0x00010000
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255 NvRegMIIStatus = 0x180,
256#define NVREG_MIISTAT_ERROR 0x0001
257#define NVREG_MIISTAT_LINKCHANGE 0x0008
Ayaz Abdullaeb798422008-02-04 15:14:04 -0500258#define NVREG_MIISTAT_MASK_RW 0x0007
259#define NVREG_MIISTAT_MASK_ALL 0x000f
Ayaz Abdulla7e680c22006-10-30 17:31:51 -0500260 NvRegMIIMask = 0x184,
261#define NVREG_MII_LINKCHANGE 0x0008
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262
263 NvRegAdapterControl = 0x188,
264#define NVREG_ADAPTCTL_START 0x02
265#define NVREG_ADAPTCTL_LINKUP 0x04
266#define NVREG_ADAPTCTL_PHYVALID 0x40000
267#define NVREG_ADAPTCTL_RUNNING 0x100000
268#define NVREG_ADAPTCTL_PHYSHIFT 24
269 NvRegMIISpeed = 0x18c,
270#define NVREG_MIISPEED_BIT8 (1<<8)
271#define NVREG_MIIDELAY 5
272 NvRegMIIControl = 0x190,
273#define NVREG_MIICTL_INUSE 0x08000
274#define NVREG_MIICTL_WRITE 0x00400
275#define NVREG_MIICTL_ADDRSHIFT 5
276 NvRegMIIData = 0x194,
Ayaz Abdulla9c662432008-08-06 12:11:42 -0400277 NvRegTxUnicast = 0x1a0,
278 NvRegTxMulticast = 0x1a4,
279 NvRegTxBroadcast = 0x1a8,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280 NvRegWakeUpFlags = 0x200,
281#define NVREG_WAKEUPFLAGS_VAL 0x7770
282#define NVREG_WAKEUPFLAGS_BUSYSHIFT 24
283#define NVREG_WAKEUPFLAGS_ENABLESHIFT 16
284#define NVREG_WAKEUPFLAGS_D3SHIFT 12
285#define NVREG_WAKEUPFLAGS_D2SHIFT 8
286#define NVREG_WAKEUPFLAGS_D1SHIFT 4
287#define NVREG_WAKEUPFLAGS_D0SHIFT 0
288#define NVREG_WAKEUPFLAGS_ACCEPT_MAGPAT 0x01
289#define NVREG_WAKEUPFLAGS_ACCEPT_WAKEUPPAT 0x02
290#define NVREG_WAKEUPFLAGS_ACCEPT_LINKCHANGE 0x04
291#define NVREG_WAKEUPFLAGS_ENABLE 0x1111
292
Ayaz Abdullacac1c522009-02-07 00:23:57 -0800293 NvRegMgmtUnitGetVersion = 0x204,
Szymon Janc78aea4f2010-11-27 08:39:43 +0000294#define NVREG_MGMTUNITGETVERSION 0x01
Ayaz Abdullacac1c522009-02-07 00:23:57 -0800295 NvRegMgmtUnitVersion = 0x208,
296#define NVREG_MGMTUNITVERSION 0x08
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297 NvRegPowerCap = 0x268,
298#define NVREG_POWERCAP_D3SUPP (1<<30)
299#define NVREG_POWERCAP_D2SUPP (1<<26)
300#define NVREG_POWERCAP_D1SUPP (1<<25)
301 NvRegPowerState = 0x26c,
302#define NVREG_POWERSTATE_POWEREDUP 0x8000
303#define NVREG_POWERSTATE_VALID 0x0100
304#define NVREG_POWERSTATE_MASK 0x0003
305#define NVREG_POWERSTATE_D0 0x0000
306#define NVREG_POWERSTATE_D1 0x0001
307#define NVREG_POWERSTATE_D2 0x0002
308#define NVREG_POWERSTATE_D3 0x0003
Ayaz Abdullacac1c522009-02-07 00:23:57 -0800309 NvRegMgmtUnitControl = 0x278,
310#define NVREG_MGMTUNITCONTROL_INUSE 0x20000
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400311 NvRegTxCnt = 0x280,
312 NvRegTxZeroReXmt = 0x284,
313 NvRegTxOneReXmt = 0x288,
314 NvRegTxManyReXmt = 0x28c,
315 NvRegTxLateCol = 0x290,
316 NvRegTxUnderflow = 0x294,
317 NvRegTxLossCarrier = 0x298,
318 NvRegTxExcessDef = 0x29c,
319 NvRegTxRetryErr = 0x2a0,
320 NvRegRxFrameErr = 0x2a4,
321 NvRegRxExtraByte = 0x2a8,
322 NvRegRxLateCol = 0x2ac,
323 NvRegRxRunt = 0x2b0,
324 NvRegRxFrameTooLong = 0x2b4,
325 NvRegRxOverflow = 0x2b8,
326 NvRegRxFCSErr = 0x2bc,
327 NvRegRxFrameAlignErr = 0x2c0,
328 NvRegRxLenErr = 0x2c4,
329 NvRegRxUnicast = 0x2c8,
330 NvRegRxMulticast = 0x2cc,
331 NvRegRxBroadcast = 0x2d0,
332 NvRegTxDef = 0x2d4,
333 NvRegTxFrame = 0x2d8,
334 NvRegRxCnt = 0x2dc,
335 NvRegTxPause = 0x2e0,
336 NvRegRxPause = 0x2e4,
337 NvRegRxDropFrame = 0x2e8,
Ayaz Abdullaee407b02006-02-04 13:13:17 -0500338 NvRegVlanControl = 0x300,
339#define NVREG_VLANCONTROL_ENABLE 0x2000
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500340 NvRegMSIXMap0 = 0x3e0,
341 NvRegMSIXMap1 = 0x3e4,
342 NvRegMSIXIrqStatus = 0x3f0,
Ayaz Abdulla86a0f042006-04-24 18:41:31 -0400343
344 NvRegPowerState2 = 0x600,
Ayaz Abdulla1545e202008-09-22 09:55:35 -0400345#define NVREG_POWERSTATE2_POWERUP_MASK 0x0F15
Ayaz Abdulla86a0f042006-04-24 18:41:31 -0400346#define NVREG_POWERSTATE2_POWERUP_REV_A3 0x0001
Ayaz Abdulla22ae03a2008-07-25 15:31:29 -0400347#define NVREG_POWERSTATE2_PHY_RESET 0x0004
Ayaz Abdulla88d7d8b2009-05-01 01:41:50 +0000348#define NVREG_POWERSTATE2_GATE_CLOCKS 0x0F00
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349};
350
351/* Big endian: should work, but is untested */
352struct ring_desc {
Stephen Hemmingera8bed492006-07-27 18:50:09 -0700353 __le32 buf;
354 __le32 flaglen;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355};
356
Manfred Spraulee733622005-07-31 18:32:26 +0200357struct ring_desc_ex {
Stephen Hemmingera8bed492006-07-27 18:50:09 -0700358 __le32 bufhigh;
359 __le32 buflow;
360 __le32 txvlan;
361 __le32 flaglen;
Manfred Spraulee733622005-07-31 18:32:26 +0200362};
363
Stephen Hemmingerf82a9352006-07-27 18:50:08 -0700364union ring_type {
Szymon Janc78aea4f2010-11-27 08:39:43 +0000365 struct ring_desc *orig;
366 struct ring_desc_ex *ex;
Stephen Hemmingerf82a9352006-07-27 18:50:08 -0700367};
Manfred Spraulee733622005-07-31 18:32:26 +0200368
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369#define FLAG_MASK_V1 0xffff0000
370#define FLAG_MASK_V2 0xffffc000
371#define LEN_MASK_V1 (0xffffffff ^ FLAG_MASK_V1)
372#define LEN_MASK_V2 (0xffffffff ^ FLAG_MASK_V2)
373
374#define NV_TX_LASTPACKET (1<<16)
375#define NV_TX_RETRYERROR (1<<19)
Ayaz Abdullaa4336862008-04-18 13:50:43 -0700376#define NV_TX_RETRYCOUNT_MASK (0xF<<20)
Manfred Spraulc2dba062005-07-31 18:29:47 +0200377#define NV_TX_FORCED_INTERRUPT (1<<24)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378#define NV_TX_DEFERRED (1<<26)
379#define NV_TX_CARRIERLOST (1<<27)
380#define NV_TX_LATECOLLISION (1<<28)
381#define NV_TX_UNDERFLOW (1<<29)
382#define NV_TX_ERROR (1<<30)
383#define NV_TX_VALID (1<<31)
384
385#define NV_TX2_LASTPACKET (1<<29)
386#define NV_TX2_RETRYERROR (1<<18)
Ayaz Abdullaa4336862008-04-18 13:50:43 -0700387#define NV_TX2_RETRYCOUNT_MASK (0xF<<19)
Manfred Spraulc2dba062005-07-31 18:29:47 +0200388#define NV_TX2_FORCED_INTERRUPT (1<<30)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389#define NV_TX2_DEFERRED (1<<25)
390#define NV_TX2_CARRIERLOST (1<<26)
391#define NV_TX2_LATECOLLISION (1<<27)
392#define NV_TX2_UNDERFLOW (1<<28)
393/* error and valid are the same for both */
394#define NV_TX2_ERROR (1<<30)
395#define NV_TX2_VALID (1<<31)
Ayaz Abdullaac9c1892005-10-26 00:51:24 -0400396#define NV_TX2_TSO (1<<28)
397#define NV_TX2_TSO_SHIFT 14
Ayaz Abdullafa454592006-01-05 22:45:45 -0800398#define NV_TX2_TSO_MAX_SHIFT 14
399#define NV_TX2_TSO_MAX_SIZE (1<<NV_TX2_TSO_MAX_SHIFT)
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -0400400#define NV_TX2_CHECKSUM_L3 (1<<27)
401#define NV_TX2_CHECKSUM_L4 (1<<26)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700402
Ayaz Abdullaee407b02006-02-04 13:13:17 -0500403#define NV_TX3_VLAN_TAG_PRESENT (1<<18)
404
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405#define NV_RX_DESCRIPTORVALID (1<<16)
406#define NV_RX_MISSEDFRAME (1<<17)
407#define NV_RX_SUBSTRACT1 (1<<18)
408#define NV_RX_ERROR1 (1<<23)
409#define NV_RX_ERROR2 (1<<24)
410#define NV_RX_ERROR3 (1<<25)
411#define NV_RX_ERROR4 (1<<26)
412#define NV_RX_CRCERR (1<<27)
413#define NV_RX_OVERFLOW (1<<28)
414#define NV_RX_FRAMINGERR (1<<29)
415#define NV_RX_ERROR (1<<30)
416#define NV_RX_AVAIL (1<<31)
Ayaz Abdulla1ef68412008-08-06 12:11:03 -0400417#define NV_RX_ERROR_MASK (NV_RX_ERROR1|NV_RX_ERROR2|NV_RX_ERROR3|NV_RX_ERROR4|NV_RX_CRCERR|NV_RX_OVERFLOW|NV_RX_FRAMINGERR)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418
419#define NV_RX2_CHECKSUMMASK (0x1C000000)
Ayaz Abdullabfaffe82008-01-13 16:02:55 -0500420#define NV_RX2_CHECKSUM_IP (0x10000000)
421#define NV_RX2_CHECKSUM_IP_TCP (0x14000000)
422#define NV_RX2_CHECKSUM_IP_UDP (0x18000000)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423#define NV_RX2_DESCRIPTORVALID (1<<29)
424#define NV_RX2_SUBSTRACT1 (1<<25)
425#define NV_RX2_ERROR1 (1<<18)
426#define NV_RX2_ERROR2 (1<<19)
427#define NV_RX2_ERROR3 (1<<20)
428#define NV_RX2_ERROR4 (1<<21)
429#define NV_RX2_CRCERR (1<<22)
430#define NV_RX2_OVERFLOW (1<<23)
431#define NV_RX2_FRAMINGERR (1<<24)
432/* error and avail are the same for both */
433#define NV_RX2_ERROR (1<<30)
434#define NV_RX2_AVAIL (1<<31)
Ayaz Abdulla1ef68412008-08-06 12:11:03 -0400435#define NV_RX2_ERROR_MASK (NV_RX2_ERROR1|NV_RX2_ERROR2|NV_RX2_ERROR3|NV_RX2_ERROR4|NV_RX2_CRCERR|NV_RX2_OVERFLOW|NV_RX2_FRAMINGERR)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436
Ayaz Abdullaee407b02006-02-04 13:13:17 -0500437#define NV_RX3_VLAN_TAG_PRESENT (1<<16)
438#define NV_RX3_VLAN_TAG_MASK (0x0000FFFF)
439
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440/* Miscelaneous hardware related defines: */
Szymon Janc78aea4f2010-11-27 08:39:43 +0000441#define NV_PCI_REGSZ_VER1 0x270
442#define NV_PCI_REGSZ_VER2 0x2d4
443#define NV_PCI_REGSZ_VER3 0x604
444#define NV_PCI_REGSZ_MAX 0x604
Linus Torvalds1da177e2005-04-16 15:20:36 -0700445
446/* various timeout delays: all in usec */
447#define NV_TXRX_RESET_DELAY 4
448#define NV_TXSTOP_DELAY1 10
449#define NV_TXSTOP_DELAY1MAX 500000
450#define NV_TXSTOP_DELAY2 100
451#define NV_RXSTOP_DELAY1 10
452#define NV_RXSTOP_DELAY1MAX 500000
453#define NV_RXSTOP_DELAY2 100
454#define NV_SETUP5_DELAY 5
455#define NV_SETUP5_DELAYMAX 50000
456#define NV_POWERUP_DELAY 5
457#define NV_POWERUP_DELAYMAX 5000
458#define NV_MIIBUSY_DELAY 50
459#define NV_MIIPHY_DELAY 10
460#define NV_MIIPHY_DELAYMAX 10000
Ayaz Abdulla86a0f042006-04-24 18:41:31 -0400461#define NV_MAC_RESET_DELAY 64
Linus Torvalds1da177e2005-04-16 15:20:36 -0700462
463#define NV_WAKEUPPATTERNS 5
464#define NV_WAKEUPMASKENTRIES 4
465
466/* General driver defaults */
467#define NV_WATCHDOG_TIMEO (5*HZ)
468
Ayaz Abdulla6cef67a2009-03-05 08:02:30 +0000469#define RX_RING_DEFAULT 512
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -0400470#define TX_RING_DEFAULT 256
471#define RX_RING_MIN 128
472#define TX_RING_MIN 64
473#define RING_MAX_DESC_VER_1 1024
474#define RING_MAX_DESC_VER_2_3 16384
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475
476/* rx/tx mac addr + type + vlan + align + slack*/
Manfred Sprauld81c0982005-07-31 18:20:30 +0200477#define NV_RX_HEADERS (64)
478/* even more slack. */
479#define NV_RX_ALLOC_PAD (64)
480
481/* maximum mtu size */
482#define NV_PKTLIMIT_1 ETH_DATA_LEN /* hard limit not known */
483#define NV_PKTLIMIT_2 9100 /* Actual limit according to NVidia: 9202 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484
485#define OOM_REFILL (1+HZ/20)
486#define POLL_WAIT (1+HZ/100)
487#define LINK_TIMEOUT (3*HZ)
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400488#define STATS_INTERVAL (10*HZ)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700489
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400490/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491 * desc_ver values:
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -0400492 * The nic supports three different descriptor types:
493 * - DESC_VER_1: Original
494 * - DESC_VER_2: support for jumbo frames.
495 * - DESC_VER_3: 64-bit format.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496 */
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -0400497#define DESC_VER_1 1
498#define DESC_VER_2 2
499#define DESC_VER_3 3
Linus Torvalds1da177e2005-04-16 15:20:36 -0700500
501/* PHY defines */
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -0400502#define PHY_OUI_MARVELL 0x5043
503#define PHY_OUI_CICADA 0x03f1
504#define PHY_OUI_VITESSE 0x01c1
505#define PHY_OUI_REALTEK 0x0732
506#define PHY_OUI_REALTEK2 0x0020
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507#define PHYID1_OUI_MASK 0x03ff
508#define PHYID1_OUI_SHFT 6
509#define PHYID2_OUI_MASK 0xfc00
510#define PHYID2_OUI_SHFT 10
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -0400511#define PHYID2_MODEL_MASK 0x03f0
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -0400512#define PHY_MODEL_REALTEK_8211 0x0110
513#define PHY_REV_MASK 0x0001
514#define PHY_REV_REALTEK_8211B 0x0000
515#define PHY_REV_REALTEK_8211C 0x0001
516#define PHY_MODEL_REALTEK_8201 0x0200
517#define PHY_MODEL_MARVELL_E3016 0x0220
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -0400518#define PHY_MARVELL_E3016_INITMASK 0x0300
Ayaz Abdulla14a67f32007-07-15 06:50:28 -0400519#define PHY_CICADA_INIT1 0x0f000
520#define PHY_CICADA_INIT2 0x0e00
521#define PHY_CICADA_INIT3 0x01000
522#define PHY_CICADA_INIT4 0x0200
523#define PHY_CICADA_INIT5 0x0004
524#define PHY_CICADA_INIT6 0x02000
Ayaz Abdullad215d8a2007-07-15 06:50:53 -0400525#define PHY_VITESSE_INIT_REG1 0x1f
526#define PHY_VITESSE_INIT_REG2 0x10
527#define PHY_VITESSE_INIT_REG3 0x11
528#define PHY_VITESSE_INIT_REG4 0x12
529#define PHY_VITESSE_INIT_MSK1 0xc
530#define PHY_VITESSE_INIT_MSK2 0x0180
531#define PHY_VITESSE_INIT1 0x52b5
532#define PHY_VITESSE_INIT2 0xaf8a
533#define PHY_VITESSE_INIT3 0x8
534#define PHY_VITESSE_INIT4 0x8f8a
535#define PHY_VITESSE_INIT5 0xaf86
536#define PHY_VITESSE_INIT6 0x8f86
537#define PHY_VITESSE_INIT7 0xaf82
538#define PHY_VITESSE_INIT8 0x0100
539#define PHY_VITESSE_INIT9 0x8f82
540#define PHY_VITESSE_INIT10 0x0
Ayaz Abdullac5e3ae82007-07-15 06:51:03 -0400541#define PHY_REALTEK_INIT_REG1 0x1f
542#define PHY_REALTEK_INIT_REG2 0x19
543#define PHY_REALTEK_INIT_REG3 0x13
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -0400544#define PHY_REALTEK_INIT_REG4 0x14
545#define PHY_REALTEK_INIT_REG5 0x18
546#define PHY_REALTEK_INIT_REG6 0x11
Ayaz Abdulla22ae03a2008-07-25 15:31:29 -0400547#define PHY_REALTEK_INIT_REG7 0x01
Ayaz Abdullac5e3ae82007-07-15 06:51:03 -0400548#define PHY_REALTEK_INIT1 0x0000
549#define PHY_REALTEK_INIT2 0x8e00
550#define PHY_REALTEK_INIT3 0x0001
551#define PHY_REALTEK_INIT4 0xad17
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -0400552#define PHY_REALTEK_INIT5 0xfb54
553#define PHY_REALTEK_INIT6 0xf5c7
554#define PHY_REALTEK_INIT7 0x1000
555#define PHY_REALTEK_INIT8 0x0003
Ayaz Abdulla22ae03a2008-07-25 15:31:29 -0400556#define PHY_REALTEK_INIT9 0x0008
557#define PHY_REALTEK_INIT10 0x0005
558#define PHY_REALTEK_INIT11 0x0200
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -0400559#define PHY_REALTEK_INIT_MSK1 0x0003
Ayaz Abdullad215d8a2007-07-15 06:50:53 -0400560
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561#define PHY_GIGABIT 0x0100
562
563#define PHY_TIMEOUT 0x1
564#define PHY_ERROR 0x2
565
566#define PHY_100 0x1
567#define PHY_1000 0x2
568#define PHY_HALF 0x100
569
Ayaz Abdullaeb91f612006-05-24 18:13:19 -0400570#define NV_PAUSEFRAME_RX_CAPABLE 0x0001
571#define NV_PAUSEFRAME_TX_CAPABLE 0x0002
572#define NV_PAUSEFRAME_RX_ENABLE 0x0004
573#define NV_PAUSEFRAME_TX_ENABLE 0x0008
Ayaz Abdullab6d07732006-06-10 22:47:42 -0400574#define NV_PAUSEFRAME_RX_REQ 0x0010
575#define NV_PAUSEFRAME_TX_REQ 0x0020
576#define NV_PAUSEFRAME_AUTONEG 0x0040
Linus Torvalds1da177e2005-04-16 15:20:36 -0700577
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500578/* MSI/MSI-X defines */
579#define NV_MSI_X_MAX_VECTORS 8
580#define NV_MSI_X_VECTORS_MASK 0x000f
581#define NV_MSI_CAPABLE 0x0010
582#define NV_MSI_X_CAPABLE 0x0020
583#define NV_MSI_ENABLED 0x0040
584#define NV_MSI_X_ENABLED 0x0080
585
586#define NV_MSI_X_VECTOR_ALL 0x0
587#define NV_MSI_X_VECTOR_RX 0x0
588#define NV_MSI_X_VECTOR_TX 0x1
589#define NV_MSI_X_VECTOR_OTHER 0x2
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590
Ayaz Abdullab6e44052009-02-07 00:24:15 -0800591#define NV_MSI_PRIV_OFFSET 0x68
592#define NV_MSI_PRIV_VALUE 0xffffffff
593
Ayaz Abdullab2976d22008-02-04 15:13:59 -0500594#define NV_RESTART_TX 0x1
595#define NV_RESTART_RX 0x2
596
Ayaz Abdulla3b446c32008-03-10 14:58:21 -0500597#define NV_TX_LIMIT_COUNT 16
598
Ayaz Abdulla4145ade2009-03-05 08:02:26 +0000599#define NV_DYNAMIC_THRESHOLD 4
600#define NV_DYNAMIC_MAX_QUIET_COUNT 2048
601
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400602/* statistics */
603struct nv_ethtool_str {
604 char name[ETH_GSTRING_LEN];
605};
606
607static const struct nv_ethtool_str nv_estats_str[] = {
608 { "tx_bytes" },
609 { "tx_zero_rexmt" },
610 { "tx_one_rexmt" },
611 { "tx_many_rexmt" },
612 { "tx_late_collision" },
613 { "tx_fifo_errors" },
614 { "tx_carrier_errors" },
615 { "tx_excess_deferral" },
616 { "tx_retry_error" },
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400617 { "rx_frame_error" },
618 { "rx_extra_byte" },
619 { "rx_late_collision" },
620 { "rx_runt" },
621 { "rx_frame_too_long" },
622 { "rx_over_errors" },
623 { "rx_crc_errors" },
624 { "rx_frame_align_error" },
625 { "rx_length_error" },
626 { "rx_unicast" },
627 { "rx_multicast" },
628 { "rx_broadcast" },
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400629 { "rx_packets" },
Ayaz Abdulla57fff692007-01-23 12:27:00 -0500630 { "rx_errors_total" },
631 { "tx_errors_total" },
632
633 /* version 2 stats */
634 { "tx_deferral" },
635 { "tx_packets" },
636 { "rx_bytes" },
637 { "tx_pause" },
638 { "rx_pause" },
Ayaz Abdulla9c662432008-08-06 12:11:42 -0400639 { "rx_drop_frame" },
640
641 /* version 3 stats */
642 { "tx_unicast" },
643 { "tx_multicast" },
644 { "tx_broadcast" }
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400645};
646
647struct nv_ethtool_stats {
648 u64 tx_bytes;
649 u64 tx_zero_rexmt;
650 u64 tx_one_rexmt;
651 u64 tx_many_rexmt;
652 u64 tx_late_collision;
653 u64 tx_fifo_errors;
654 u64 tx_carrier_errors;
655 u64 tx_excess_deferral;
656 u64 tx_retry_error;
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400657 u64 rx_frame_error;
658 u64 rx_extra_byte;
659 u64 rx_late_collision;
660 u64 rx_runt;
661 u64 rx_frame_too_long;
662 u64 rx_over_errors;
663 u64 rx_crc_errors;
664 u64 rx_frame_align_error;
665 u64 rx_length_error;
666 u64 rx_unicast;
667 u64 rx_multicast;
668 u64 rx_broadcast;
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400669 u64 rx_packets;
670 u64 rx_errors_total;
Ayaz Abdulla57fff692007-01-23 12:27:00 -0500671 u64 tx_errors_total;
672
673 /* version 2 stats */
674 u64 tx_deferral;
675 u64 tx_packets;
676 u64 rx_bytes;
677 u64 tx_pause;
678 u64 rx_pause;
679 u64 rx_drop_frame;
Ayaz Abdulla9c662432008-08-06 12:11:42 -0400680
681 /* version 3 stats */
682 u64 tx_unicast;
683 u64 tx_multicast;
684 u64 tx_broadcast;
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400685};
686
Ayaz Abdulla9c662432008-08-06 12:11:42 -0400687#define NV_DEV_STATISTICS_V3_COUNT (sizeof(struct nv_ethtool_stats)/sizeof(u64))
688#define NV_DEV_STATISTICS_V2_COUNT (NV_DEV_STATISTICS_V3_COUNT - 3)
Ayaz Abdulla57fff692007-01-23 12:27:00 -0500689#define NV_DEV_STATISTICS_V1_COUNT (NV_DEV_STATISTICS_V2_COUNT - 6)
690
Ayaz Abdulla9589c772006-06-10 22:48:13 -0400691/* diagnostics */
692#define NV_TEST_COUNT_BASE 3
693#define NV_TEST_COUNT_EXTENDED 4
694
695static const struct nv_ethtool_str nv_etests_str[] = {
696 { "link (online/offline)" },
697 { "register (offline) " },
698 { "interrupt (offline) " },
699 { "loopback (offline) " }
700};
701
702struct register_test {
Al Viro5bb7ea22007-12-09 16:06:41 +0000703 __u32 reg;
704 __u32 mask;
Ayaz Abdulla9589c772006-06-10 22:48:13 -0400705};
706
707static const struct register_test nv_registers_test[] = {
708 { NvRegUnknownSetupReg6, 0x01 },
709 { NvRegMisc1, 0x03c },
710 { NvRegOffloadConfig, 0x03ff },
711 { NvRegMulticastAddrA, 0xffffffff },
Ayaz Abdulla95d161c2006-07-06 16:46:25 -0400712 { NvRegTxWatermark, 0x0ff },
Ayaz Abdulla9589c772006-06-10 22:48:13 -0400713 { NvRegWakeUpFlags, 0x07777 },
Szymon Janc78aea4f2010-11-27 08:39:43 +0000714 { 0, 0 }
Ayaz Abdulla9589c772006-06-10 22:48:13 -0400715};
716
Ayaz Abdulla761fcd92007-01-09 13:30:07 -0500717struct nv_skb_map {
718 struct sk_buff *skb;
719 dma_addr_t dma;
Eric Dumazet73a37072009-06-17 21:17:59 +0000720 unsigned int dma_len:31;
721 unsigned int dma_single:1;
Ayaz Abdulla3b446c32008-03-10 14:58:21 -0500722 struct ring_desc_ex *first_tx_desc;
723 struct nv_skb_map *next_tx_ctx;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -0500724};
725
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726/*
727 * SMP locking:
Wang Chenb74ca3a2008-12-08 01:14:16 -0800728 * All hardware access under netdev_priv(dev)->lock, except the performance
Linus Torvalds1da177e2005-04-16 15:20:36 -0700729 * critical parts:
730 * - rx is (pseudo-) lockless: it relies on the single-threading provided
731 * by the arch code for interrupts.
Herbert Xu932ff272006-06-09 12:20:56 -0700732 * - tx setup is lockless: it relies on netif_tx_lock. Actual submission
Wang Chenb74ca3a2008-12-08 01:14:16 -0800733 * needs netdev_priv(dev)->lock :-(
Herbert Xu932ff272006-06-09 12:20:56 -0700734 * - set_multicast_list: preparation lockless, relies on netif_tx_lock.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700735 */
736
737/* in dev: base, irq */
738struct fe_priv {
739 spinlock_t lock;
740
Stephen Hemmingerbea33482007-10-03 16:41:36 -0700741 struct net_device *dev;
742 struct napi_struct napi;
743
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744 /* General data:
745 * Locking: spin_lock(&np->lock); */
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400746 struct nv_ethtool_stats estats;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700747 int in_shutdown;
748 u32 linkspeed;
749 int duplex;
750 int autoneg;
751 int fixed_mode;
752 int phyaddr;
753 int wolenabled;
754 unsigned int phy_oui;
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -0400755 unsigned int phy_model;
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -0400756 unsigned int phy_rev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700757 u16 gigabit;
Ayaz Abdulla9589c772006-06-10 22:48:13 -0400758 int intr_test;
Ayaz Abdullac5cf9102006-10-30 17:32:01 -0500759 int recover_error;
Ayaz Abdulla4145ade2009-03-05 08:02:26 +0000760 int quiet_count;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761
762 /* General data: RO fields */
763 dma_addr_t ring_addr;
764 struct pci_dev *pci_dev;
765 u32 orig_mac[2];
Ayaz Abdulla582806b2009-03-05 08:02:03 +0000766 u32 events;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700767 u32 irqmask;
768 u32 desc_ver;
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -0400769 u32 txrxctl_bits;
Ayaz Abdullaee407b02006-02-04 13:13:17 -0500770 u32 vlanctl_bits;
Ayaz Abdulla86a0f042006-04-24 18:41:31 -0400771 u32 driver_data;
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -0400772 u32 device_id;
Ayaz Abdulla86a0f042006-04-24 18:41:31 -0400773 u32 register_size;
Ayaz Abdullaf2ad2d92006-08-24 17:35:41 -0400774 int rx_csum;
Ayaz Abdulla7e680c22006-10-30 17:31:51 -0500775 u32 mac_in_use;
Ayaz Abdullacac1c522009-02-07 00:23:57 -0800776 int mgmt_version;
777 int mgmt_sema;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700778
779 void __iomem *base;
780
781 /* rx specific fields.
782 * Locking: Within irq hander or disable_irq+spin_lock(&np->lock);
783 */
Ayaz Abdulla761fcd92007-01-09 13:30:07 -0500784 union ring_type get_rx, put_rx, first_rx, last_rx;
785 struct nv_skb_map *get_rx_ctx, *put_rx_ctx;
786 struct nv_skb_map *first_rx_ctx, *last_rx_ctx;
787 struct nv_skb_map *rx_skb;
788
Stephen Hemmingerf82a9352006-07-27 18:50:08 -0700789 union ring_type rx_ring;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700790 unsigned int rx_buf_sz;
Manfred Sprauld81c0982005-07-31 18:20:30 +0200791 unsigned int pkt_limit;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700792 struct timer_list oom_kick;
793 struct timer_list nic_poll;
Ayaz Abdulla52da3572006-06-10 22:48:04 -0400794 struct timer_list stats_poll;
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500795 u32 nic_poll_irq;
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -0400796 int rx_ring_size;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700797
798 /* media detection workaround.
799 * Locking: Within irq hander or disable_irq+spin_lock(&np->lock);
800 */
801 int need_linktimer;
802 unsigned long link_timeout;
803 /*
804 * tx specific fields.
805 */
Ayaz Abdulla761fcd92007-01-09 13:30:07 -0500806 union ring_type get_tx, put_tx, first_tx, last_tx;
807 struct nv_skb_map *get_tx_ctx, *put_tx_ctx;
808 struct nv_skb_map *first_tx_ctx, *last_tx_ctx;
809 struct nv_skb_map *tx_skb;
810
Stephen Hemmingerf82a9352006-07-27 18:50:08 -0700811 union ring_type tx_ring;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700812 u32 tx_flags;
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -0400813 int tx_ring_size;
Ayaz Abdulla3b446c32008-03-10 14:58:21 -0500814 int tx_limit;
815 u32 tx_pkts_in_progress;
816 struct nv_skb_map *tx_change_owner;
817 struct nv_skb_map *tx_end_flip;
Ayaz Abdullaaaa37d22007-01-21 18:10:42 -0500818 int tx_stop;
Ayaz Abdullaee407b02006-02-04 13:13:17 -0500819
820 /* vlan fields */
821 struct vlan_group *vlangrp;
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500822
823 /* msi/msi-x fields */
824 u32 msi_flags;
825 struct msix_entry msi_x_entry[NV_MSI_X_MAX_VECTORS];
Ayaz Abdullaeb91f612006-05-24 18:13:19 -0400826
827 /* flow control */
828 u32 pause_flags;
Tobias Diedrich1a1ca862008-05-18 15:03:44 +0200829
830 /* power saved state */
831 u32 saved_config_space[NV_PCI_REGSZ_MAX/4];
Yinghai Luddb213f2009-02-06 01:29:23 -0800832
833 /* for different msi-x irq type */
834 char name_rx[IFNAMSIZ + 3]; /* -rx */
835 char name_tx[IFNAMSIZ + 3]; /* -tx */
836 char name_other[IFNAMSIZ + 6]; /* -other */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837};
838
839/*
840 * Maximum number of loops until we assume that a bit in the irq mask
841 * is stuck. Overridable with module param.
842 */
Ayaz Abdulla4145ade2009-03-05 08:02:26 +0000843static int max_interrupt_work = 4;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844
Ayaz Abdullaa971c322005-11-11 08:30:38 -0500845/*
846 * Optimization can be either throuput mode or cpu mode
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400847 *
Ayaz Abdullaa971c322005-11-11 08:30:38 -0500848 * Throughput Mode: Every tx and rx packet will generate an interrupt.
849 * CPU Mode: Interrupts are controlled by a timer.
850 */
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -0400851enum {
852 NV_OPTIMIZATION_MODE_THROUGHPUT,
Ayaz Abdulla9e184762009-03-05 08:02:18 +0000853 NV_OPTIMIZATION_MODE_CPU,
854 NV_OPTIMIZATION_MODE_DYNAMIC
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -0400855};
Ayaz Abdulla9e184762009-03-05 08:02:18 +0000856static int optimization_mode = NV_OPTIMIZATION_MODE_DYNAMIC;
Ayaz Abdullaa971c322005-11-11 08:30:38 -0500857
858/*
859 * Poll interval for timer irq
860 *
861 * This interval determines how frequent an interrupt is generated.
862 * The is value is determined by [(time_in_micro_secs * 100) / (2^10)]
863 * Min = 0, and Max = 65535
864 */
865static int poll_interval = -1;
866
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500867/*
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -0400868 * MSI interrupts
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500869 */
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -0400870enum {
871 NV_MSI_INT_DISABLED,
872 NV_MSI_INT_ENABLED
873};
874static int msi = NV_MSI_INT_ENABLED;
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500875
876/*
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -0400877 * MSIX interrupts
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500878 */
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -0400879enum {
880 NV_MSIX_INT_DISABLED,
881 NV_MSIX_INT_ENABLED
882};
Yinghai Lu39482792009-02-06 01:31:12 -0800883static int msix = NV_MSIX_INT_ENABLED;
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -0400884
885/*
886 * DMA 64bit
887 */
888enum {
889 NV_DMA_64BIT_DISABLED,
890 NV_DMA_64BIT_ENABLED
891};
892static int dma_64bit = NV_DMA_64BIT_ENABLED;
Ayaz Abdullad33a73c82006-02-04 13:13:31 -0500893
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -0400894/*
895 * Crossover Detection
896 * Realtek 8201 phy + some OEM boards do not work properly.
897 */
898enum {
899 NV_CROSSOVER_DETECTION_DISABLED,
900 NV_CROSSOVER_DETECTION_ENABLED
901};
902static int phy_cross = NV_CROSSOVER_DETECTION_DISABLED;
903
Ed Swierk5a9a8e32009-06-02 00:19:52 -0700904/*
905 * Power down phy when interface is down (persists through reboot;
906 * older Linux and other OSes may not power it up again)
907 */
Szymon Janc78aea4f2010-11-27 08:39:43 +0000908static int phy_power_down;
Ed Swierk5a9a8e32009-06-02 00:19:52 -0700909
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910static inline struct fe_priv *get_nvpriv(struct net_device *dev)
911{
912 return netdev_priv(dev);
913}
914
915static inline u8 __iomem *get_hwbase(struct net_device *dev)
916{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -0400917 return ((struct fe_priv *)netdev_priv(dev))->base;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918}
919
920static inline void pci_push(u8 __iomem *base)
921{
922 /* force out pending posted writes */
923 readl(base);
924}
925
926static inline u32 nv_descr_getlength(struct ring_desc *prd, u32 v)
927{
Stephen Hemmingerf82a9352006-07-27 18:50:08 -0700928 return le32_to_cpu(prd->flaglen)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700929 & ((v == DESC_VER_1) ? LEN_MASK_V1 : LEN_MASK_V2);
930}
931
Manfred Spraulee733622005-07-31 18:32:26 +0200932static inline u32 nv_descr_getlength_ex(struct ring_desc_ex *prd, u32 v)
933{
Stephen Hemmingerf82a9352006-07-27 18:50:08 -0700934 return le32_to_cpu(prd->flaglen) & LEN_MASK_V2;
Manfred Spraulee733622005-07-31 18:32:26 +0200935}
936
Jeff Garzik36b30ea2007-10-16 01:40:30 -0400937static bool nv_optimized(struct fe_priv *np)
938{
939 if (np->desc_ver == DESC_VER_1 || np->desc_ver == DESC_VER_2)
940 return false;
941 return true;
942}
943
Linus Torvalds1da177e2005-04-16 15:20:36 -0700944static int reg_delay(struct net_device *dev, int offset, u32 mask, u32 target,
Joe Perches344d0dc2010-11-29 07:41:52 +0000945 int delay, int delaymax)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700946{
947 u8 __iomem *base = get_hwbase(dev);
948
949 pci_push(base);
950 do {
951 udelay(delay);
952 delaymax -= delay;
Joe Perches344d0dc2010-11-29 07:41:52 +0000953 if (delaymax < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700954 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700955 } while ((readl(base + offset) & mask) != target);
956 return 0;
957}
958
Ayaz Abdulla0832b252006-02-04 13:13:26 -0500959#define NV_SETUP_RX_RING 0x01
960#define NV_SETUP_TX_RING 0x02
961
Al Viro5bb7ea22007-12-09 16:06:41 +0000962static inline u32 dma_low(dma_addr_t addr)
963{
964 return addr;
965}
966
967static inline u32 dma_high(dma_addr_t addr)
968{
969 return addr>>31>>1; /* 0 if 32bit, shift down by 32 if 64bit */
970}
971
Ayaz Abdulla0832b252006-02-04 13:13:26 -0500972static void setup_hw_rings(struct net_device *dev, int rxtx_flags)
973{
974 struct fe_priv *np = get_nvpriv(dev);
975 u8 __iomem *base = get_hwbase(dev);
976
Jeff Garzik36b30ea2007-10-16 01:40:30 -0400977 if (!nv_optimized(np)) {
Szymon Janc78aea4f2010-11-27 08:39:43 +0000978 if (rxtx_flags & NV_SETUP_RX_RING)
Al Viro5bb7ea22007-12-09 16:06:41 +0000979 writel(dma_low(np->ring_addr), base + NvRegRxRingPhysAddr);
Szymon Janc78aea4f2010-11-27 08:39:43 +0000980 if (rxtx_flags & NV_SETUP_TX_RING)
Al Viro5bb7ea22007-12-09 16:06:41 +0000981 writel(dma_low(np->ring_addr + np->rx_ring_size*sizeof(struct ring_desc)), base + NvRegTxRingPhysAddr);
Ayaz Abdulla0832b252006-02-04 13:13:26 -0500982 } else {
983 if (rxtx_flags & NV_SETUP_RX_RING) {
Al Viro5bb7ea22007-12-09 16:06:41 +0000984 writel(dma_low(np->ring_addr), base + NvRegRxRingPhysAddr);
985 writel(dma_high(np->ring_addr), base + NvRegRxRingPhysAddrHigh);
Ayaz Abdulla0832b252006-02-04 13:13:26 -0500986 }
987 if (rxtx_flags & NV_SETUP_TX_RING) {
Al Viro5bb7ea22007-12-09 16:06:41 +0000988 writel(dma_low(np->ring_addr + np->rx_ring_size*sizeof(struct ring_desc_ex)), base + NvRegTxRingPhysAddr);
989 writel(dma_high(np->ring_addr + np->rx_ring_size*sizeof(struct ring_desc_ex)), base + NvRegTxRingPhysAddrHigh);
Ayaz Abdulla0832b252006-02-04 13:13:26 -0500990 }
991 }
992}
993
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -0400994static void free_rings(struct net_device *dev)
995{
996 struct fe_priv *np = get_nvpriv(dev);
997
Jeff Garzik36b30ea2007-10-16 01:40:30 -0400998 if (!nv_optimized(np)) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -0700999 if (np->rx_ring.orig)
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04001000 pci_free_consistent(np->pci_dev, sizeof(struct ring_desc) * (np->rx_ring_size + np->tx_ring_size),
1001 np->rx_ring.orig, np->ring_addr);
1002 } else {
1003 if (np->rx_ring.ex)
1004 pci_free_consistent(np->pci_dev, sizeof(struct ring_desc_ex) * (np->rx_ring_size + np->tx_ring_size),
1005 np->rx_ring.ex, np->ring_addr);
1006 }
Szymon Janc9b03b062010-11-27 08:39:44 +00001007 kfree(np->rx_skb);
1008 kfree(np->tx_skb);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04001009}
1010
Ayaz Abdulla84b39322006-05-20 14:59:48 -07001011static int using_multi_irqs(struct net_device *dev)
1012{
1013 struct fe_priv *np = get_nvpriv(dev);
1014
1015 if (!(np->msi_flags & NV_MSI_X_ENABLED) ||
1016 ((np->msi_flags & NV_MSI_X_ENABLED) &&
1017 ((np->msi_flags & NV_MSI_X_VECTORS_MASK) == 0x1)))
1018 return 0;
1019 else
1020 return 1;
1021}
1022
Ayaz Abdulla88d7d8b2009-05-01 01:41:50 +00001023static void nv_txrx_gate(struct net_device *dev, bool gate)
1024{
1025 struct fe_priv *np = get_nvpriv(dev);
1026 u8 __iomem *base = get_hwbase(dev);
1027 u32 powerstate;
1028
1029 if (!np->mac_in_use &&
1030 (np->driver_data & DEV_HAS_POWER_CNTRL)) {
1031 powerstate = readl(base + NvRegPowerState2);
1032 if (gate)
1033 powerstate |= NVREG_POWERSTATE2_GATE_CLOCKS;
1034 else
1035 powerstate &= ~NVREG_POWERSTATE2_GATE_CLOCKS;
1036 writel(powerstate, base + NvRegPowerState2);
1037 }
1038}
1039
Ayaz Abdulla84b39322006-05-20 14:59:48 -07001040static void nv_enable_irq(struct net_device *dev)
1041{
1042 struct fe_priv *np = get_nvpriv(dev);
1043
1044 if (!using_multi_irqs(dev)) {
1045 if (np->msi_flags & NV_MSI_X_ENABLED)
1046 enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector);
1047 else
Manfred Spraula7475902007-10-17 21:52:33 +02001048 enable_irq(np->pci_dev->irq);
Ayaz Abdulla84b39322006-05-20 14:59:48 -07001049 } else {
1050 enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector);
1051 enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector);
1052 enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector);
1053 }
1054}
1055
1056static void nv_disable_irq(struct net_device *dev)
1057{
1058 struct fe_priv *np = get_nvpriv(dev);
1059
1060 if (!using_multi_irqs(dev)) {
1061 if (np->msi_flags & NV_MSI_X_ENABLED)
1062 disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector);
1063 else
Manfred Spraula7475902007-10-17 21:52:33 +02001064 disable_irq(np->pci_dev->irq);
Ayaz Abdulla84b39322006-05-20 14:59:48 -07001065 } else {
1066 disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector);
1067 disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector);
1068 disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector);
1069 }
1070}
1071
1072/* In MSIX mode, a write to irqmask behaves as XOR */
1073static void nv_enable_hw_interrupts(struct net_device *dev, u32 mask)
1074{
1075 u8 __iomem *base = get_hwbase(dev);
1076
1077 writel(mask, base + NvRegIrqMask);
1078}
1079
1080static void nv_disable_hw_interrupts(struct net_device *dev, u32 mask)
1081{
1082 struct fe_priv *np = get_nvpriv(dev);
1083 u8 __iomem *base = get_hwbase(dev);
1084
1085 if (np->msi_flags & NV_MSI_X_ENABLED) {
1086 writel(mask, base + NvRegIrqMask);
1087 } else {
1088 if (np->msi_flags & NV_MSI_ENABLED)
1089 writel(0, base + NvRegMSIIrqMask);
1090 writel(0, base + NvRegIrqMask);
1091 }
1092}
1093
Ayaz Abdulla08d93572009-03-05 08:01:55 +00001094static void nv_napi_enable(struct net_device *dev)
1095{
Ayaz Abdulla08d93572009-03-05 08:01:55 +00001096 struct fe_priv *np = get_nvpriv(dev);
1097
1098 napi_enable(&np->napi);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00001099}
1100
1101static void nv_napi_disable(struct net_device *dev)
1102{
Ayaz Abdulla08d93572009-03-05 08:01:55 +00001103 struct fe_priv *np = get_nvpriv(dev);
1104
1105 napi_disable(&np->napi);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00001106}
1107
Linus Torvalds1da177e2005-04-16 15:20:36 -07001108#define MII_READ (-1)
1109/* mii_rw: read/write a register on the PHY.
1110 *
1111 * Caller must guarantee serialization
1112 */
1113static int mii_rw(struct net_device *dev, int addr, int miireg, int value)
1114{
1115 u8 __iomem *base = get_hwbase(dev);
1116 u32 reg;
1117 int retval;
1118
Ayaz Abdullaeb798422008-02-04 15:14:04 -05001119 writel(NVREG_MIISTAT_MASK_RW, base + NvRegMIIStatus);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001120
1121 reg = readl(base + NvRegMIIControl);
1122 if (reg & NVREG_MIICTL_INUSE) {
1123 writel(NVREG_MIICTL_INUSE, base + NvRegMIIControl);
1124 udelay(NV_MIIBUSY_DELAY);
1125 }
1126
1127 reg = (addr << NVREG_MIICTL_ADDRSHIFT) | miireg;
1128 if (value != MII_READ) {
1129 writel(value, base + NvRegMIIData);
1130 reg |= NVREG_MIICTL_WRITE;
1131 }
1132 writel(reg, base + NvRegMIIControl);
1133
1134 if (reg_delay(dev, NvRegMIIControl, NVREG_MIICTL_INUSE, 0,
Joe Perches344d0dc2010-11-29 07:41:52 +00001135 NV_MIIPHY_DELAY, NV_MIIPHY_DELAYMAX)) {
Joe Perches6b808582010-11-29 07:41:53 +00001136 netdev_dbg(dev, "mii_rw of reg %d at PHY %d timed out\n",
1137 miireg, addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001138 retval = -1;
1139 } else if (value != MII_READ) {
1140 /* it was a write operation - fewer failures are detectable */
Joe Perches6b808582010-11-29 07:41:53 +00001141 netdev_dbg(dev, "mii_rw wrote 0x%x to reg %d at PHY %d\n",
1142 value, miireg, addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001143 retval = 0;
1144 } else if (readl(base + NvRegMIIStatus) & NVREG_MIISTAT_ERROR) {
Joe Perches6b808582010-11-29 07:41:53 +00001145 netdev_dbg(dev, "mii_rw of reg %d at PHY %d failed\n",
1146 miireg, addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001147 retval = -1;
1148 } else {
1149 retval = readl(base + NvRegMIIData);
Joe Perches6b808582010-11-29 07:41:53 +00001150 netdev_dbg(dev, "mii_rw read from reg %d at PHY %d: 0x%x\n",
1151 miireg, addr, retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001152 }
1153
1154 return retval;
1155}
1156
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04001157static int phy_reset(struct net_device *dev, u32 bmcr_setup)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001158{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001159 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001160 u32 miicontrol;
1161 unsigned int tries = 0;
1162
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04001163 miicontrol = BMCR_RESET | bmcr_setup;
Szymon Janc78aea4f2010-11-27 08:39:43 +00001164 if (mii_rw(dev, np->phyaddr, MII_BMCR, miicontrol))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001165 return -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001166
1167 /* wait for 500ms */
1168 msleep(500);
1169
1170 /* must wait till reset is deasserted */
1171 while (miicontrol & BMCR_RESET) {
Szymon Jancde855b92010-11-27 08:39:48 +00001172 usleep_range(10000, 20000);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001173 miicontrol = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
1174 /* FIXME: 100 tries seem excessive */
1175 if (tries++ > 100)
1176 return -1;
1177 }
1178 return 0;
1179}
1180
1181static int phy_init(struct net_device *dev)
1182{
1183 struct fe_priv *np = get_nvpriv(dev);
1184 u8 __iomem *base = get_hwbase(dev);
Szymon Janc78aea4f2010-11-27 08:39:43 +00001185 u32 phyinterface, phy_reserved, mii_status, mii_control, mii_control_1000, reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001186
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04001187 /* phy errata for E3016 phy */
1188 if (np->phy_model == PHY_MODEL_MARVELL_E3016) {
1189 reg = mii_rw(dev, np->phyaddr, MII_NCONFIG, MII_READ);
1190 reg &= ~PHY_MARVELL_E3016_INITMASK;
1191 if (mii_rw(dev, np->phyaddr, MII_NCONFIG, reg)) {
1192 printk(KERN_INFO "%s: phy write to errata reg failed.\n", pci_name(np->pci_dev));
1193 return PHY_ERROR;
1194 }
1195 }
Ayaz Abdullac5e3ae82007-07-15 06:51:03 -04001196 if (np->phy_oui == PHY_OUI_REALTEK) {
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04001197 if (np->phy_model == PHY_MODEL_REALTEK_8211 &&
1198 np->phy_rev == PHY_REV_REALTEK_8211B) {
1199 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1)) {
1200 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1201 return PHY_ERROR;
1202 }
1203 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, PHY_REALTEK_INIT2)) {
1204 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1205 return PHY_ERROR;
1206 }
1207 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3)) {
1208 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1209 return PHY_ERROR;
1210 }
1211 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG3, PHY_REALTEK_INIT4)) {
1212 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1213 return PHY_ERROR;
1214 }
1215 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG4, PHY_REALTEK_INIT5)) {
1216 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1217 return PHY_ERROR;
1218 }
1219 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG5, PHY_REALTEK_INIT6)) {
1220 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1221 return PHY_ERROR;
1222 }
1223 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1)) {
1224 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1225 return PHY_ERROR;
1226 }
Ayaz Abdullac5e3ae82007-07-15 06:51:03 -04001227 }
Ayaz Abdulla22ae03a2008-07-25 15:31:29 -04001228 if (np->phy_model == PHY_MODEL_REALTEK_8211 &&
1229 np->phy_rev == PHY_REV_REALTEK_8211C) {
1230 u32 powerstate = readl(base + NvRegPowerState2);
1231
1232 /* need to perform hw phy reset */
1233 powerstate |= NVREG_POWERSTATE2_PHY_RESET;
1234 writel(powerstate, base + NvRegPowerState2);
1235 msleep(25);
1236
1237 powerstate &= ~NVREG_POWERSTATE2_PHY_RESET;
1238 writel(powerstate, base + NvRegPowerState2);
1239 msleep(25);
1240
1241 reg = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, MII_READ);
1242 reg |= PHY_REALTEK_INIT9;
1243 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, reg)) {
1244 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1245 return PHY_ERROR;
1246 }
1247 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT10)) {
1248 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1249 return PHY_ERROR;
1250 }
1251 reg = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG7, MII_READ);
1252 if (!(reg & PHY_REALTEK_INIT11)) {
1253 reg |= PHY_REALTEK_INIT11;
1254 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG7, reg)) {
1255 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1256 return PHY_ERROR;
1257 }
1258 }
1259 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1)) {
1260 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1261 return PHY_ERROR;
1262 }
1263 }
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04001264 if (np->phy_model == PHY_MODEL_REALTEK_8201) {
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00001265 if (np->driver_data & DEV_NEED_PHY_INIT_FIX) {
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04001266 phy_reserved = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, MII_READ);
1267 phy_reserved |= PHY_REALTEK_INIT7;
1268 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, phy_reserved)) {
1269 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1270 return PHY_ERROR;
1271 }
1272 }
Ayaz Abdullac5e3ae82007-07-15 06:51:03 -04001273 }
1274 }
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04001275
Linus Torvalds1da177e2005-04-16 15:20:36 -07001276 /* set advertise register */
1277 reg = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04001278 reg |= (ADVERTISE_10HALF|ADVERTISE_10FULL|ADVERTISE_100HALF|ADVERTISE_100FULL|ADVERTISE_PAUSE_ASYM|ADVERTISE_PAUSE_CAP);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001279 if (mii_rw(dev, np->phyaddr, MII_ADVERTISE, reg)) {
1280 printk(KERN_INFO "%s: phy write to advertise failed.\n", pci_name(np->pci_dev));
1281 return PHY_ERROR;
1282 }
1283
1284 /* get phy interface type */
1285 phyinterface = readl(base + NvRegPhyInterface);
1286
1287 /* see if gigabit phy */
1288 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
1289 if (mii_status & PHY_GIGABIT) {
1290 np->gigabit = PHY_GIGABIT;
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04001291 mii_control_1000 = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001292 mii_control_1000 &= ~ADVERTISE_1000HALF;
1293 if (phyinterface & PHY_RGMII)
1294 mii_control_1000 |= ADVERTISE_1000FULL;
1295 else
1296 mii_control_1000 &= ~ADVERTISE_1000FULL;
1297
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04001298 if (mii_rw(dev, np->phyaddr, MII_CTRL1000, mii_control_1000)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001299 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1300 return PHY_ERROR;
1301 }
Szymon Janc78aea4f2010-11-27 08:39:43 +00001302 } else
Linus Torvalds1da177e2005-04-16 15:20:36 -07001303 np->gigabit = 0;
1304
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04001305 mii_control = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
1306 mii_control |= BMCR_ANENABLE;
1307
Ayaz Abdulla22ae03a2008-07-25 15:31:29 -04001308 if (np->phy_oui == PHY_OUI_REALTEK &&
1309 np->phy_model == PHY_MODEL_REALTEK_8211 &&
1310 np->phy_rev == PHY_REV_REALTEK_8211C) {
1311 /* start autoneg since we already performed hw reset above */
1312 mii_control |= BMCR_ANRESTART;
1313 if (mii_rw(dev, np->phyaddr, MII_BMCR, mii_control)) {
1314 printk(KERN_INFO "%s: phy init failed\n", pci_name(np->pci_dev));
1315 return PHY_ERROR;
1316 }
1317 } else {
1318 /* reset the phy
1319 * (certain phys need bmcr to be setup with reset)
1320 */
1321 if (phy_reset(dev, mii_control)) {
1322 printk(KERN_INFO "%s: phy reset failed\n", pci_name(np->pci_dev));
1323 return PHY_ERROR;
1324 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001325 }
1326
1327 /* phy vendor specific configuration */
Szymon Janc78aea4f2010-11-27 08:39:43 +00001328 if ((np->phy_oui == PHY_OUI_CICADA) && (phyinterface & PHY_RGMII)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001329 phy_reserved = mii_rw(dev, np->phyaddr, MII_RESV1, MII_READ);
Ayaz Abdulla14a67f32007-07-15 06:50:28 -04001330 phy_reserved &= ~(PHY_CICADA_INIT1 | PHY_CICADA_INIT2);
1331 phy_reserved |= (PHY_CICADA_INIT3 | PHY_CICADA_INIT4);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332 if (mii_rw(dev, np->phyaddr, MII_RESV1, phy_reserved)) {
1333 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1334 return PHY_ERROR;
1335 }
1336 phy_reserved = mii_rw(dev, np->phyaddr, MII_NCONFIG, MII_READ);
Ayaz Abdulla14a67f32007-07-15 06:50:28 -04001337 phy_reserved |= PHY_CICADA_INIT5;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338 if (mii_rw(dev, np->phyaddr, MII_NCONFIG, phy_reserved)) {
1339 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1340 return PHY_ERROR;
1341 }
1342 }
1343 if (np->phy_oui == PHY_OUI_CICADA) {
1344 phy_reserved = mii_rw(dev, np->phyaddr, MII_SREVISION, MII_READ);
Ayaz Abdulla14a67f32007-07-15 06:50:28 -04001345 phy_reserved |= PHY_CICADA_INIT6;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001346 if (mii_rw(dev, np->phyaddr, MII_SREVISION, phy_reserved)) {
1347 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1348 return PHY_ERROR;
1349 }
1350 }
Ayaz Abdullad215d8a2007-07-15 06:50:53 -04001351 if (np->phy_oui == PHY_OUI_VITESSE) {
1352 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG1, PHY_VITESSE_INIT1)) {
1353 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1354 return PHY_ERROR;
1355 }
1356 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT2)) {
1357 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1358 return PHY_ERROR;
1359 }
1360 phy_reserved = mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, MII_READ);
1361 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, phy_reserved)) {
1362 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1363 return PHY_ERROR;
1364 }
1365 phy_reserved = mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, MII_READ);
1366 phy_reserved &= ~PHY_VITESSE_INIT_MSK1;
1367 phy_reserved |= PHY_VITESSE_INIT3;
1368 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, phy_reserved)) {
1369 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1370 return PHY_ERROR;
1371 }
1372 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT4)) {
1373 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1374 return PHY_ERROR;
1375 }
1376 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT5)) {
1377 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1378 return PHY_ERROR;
1379 }
1380 phy_reserved = mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, MII_READ);
1381 phy_reserved &= ~PHY_VITESSE_INIT_MSK1;
1382 phy_reserved |= PHY_VITESSE_INIT3;
1383 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, phy_reserved)) {
1384 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1385 return PHY_ERROR;
1386 }
1387 phy_reserved = mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, MII_READ);
1388 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, phy_reserved)) {
1389 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1390 return PHY_ERROR;
1391 }
1392 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT6)) {
1393 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1394 return PHY_ERROR;
1395 }
1396 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT7)) {
1397 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1398 return PHY_ERROR;
1399 }
1400 phy_reserved = mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, MII_READ);
1401 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, phy_reserved)) {
1402 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1403 return PHY_ERROR;
1404 }
1405 phy_reserved = mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, MII_READ);
1406 phy_reserved &= ~PHY_VITESSE_INIT_MSK2;
1407 phy_reserved |= PHY_VITESSE_INIT8;
1408 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, phy_reserved)) {
1409 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1410 return PHY_ERROR;
1411 }
1412 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT9)) {
1413 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1414 return PHY_ERROR;
1415 }
1416 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG1, PHY_VITESSE_INIT10)) {
1417 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1418 return PHY_ERROR;
1419 }
1420 }
Ayaz Abdullac5e3ae82007-07-15 06:51:03 -04001421 if (np->phy_oui == PHY_OUI_REALTEK) {
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04001422 if (np->phy_model == PHY_MODEL_REALTEK_8211 &&
1423 np->phy_rev == PHY_REV_REALTEK_8211B) {
1424 /* reset could have cleared these out, set them back */
1425 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1)) {
1426 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1427 return PHY_ERROR;
1428 }
1429 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, PHY_REALTEK_INIT2)) {
1430 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1431 return PHY_ERROR;
1432 }
1433 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3)) {
1434 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1435 return PHY_ERROR;
1436 }
1437 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG3, PHY_REALTEK_INIT4)) {
1438 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1439 return PHY_ERROR;
1440 }
1441 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG4, PHY_REALTEK_INIT5)) {
1442 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1443 return PHY_ERROR;
1444 }
1445 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG5, PHY_REALTEK_INIT6)) {
1446 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1447 return PHY_ERROR;
1448 }
1449 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1)) {
1450 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1451 return PHY_ERROR;
1452 }
Ayaz Abdullac5e3ae82007-07-15 06:51:03 -04001453 }
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04001454 if (np->phy_model == PHY_MODEL_REALTEK_8201) {
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00001455 if (np->driver_data & DEV_NEED_PHY_INIT_FIX) {
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04001456 phy_reserved = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, MII_READ);
1457 phy_reserved |= PHY_REALTEK_INIT7;
1458 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, phy_reserved)) {
1459 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1460 return PHY_ERROR;
1461 }
1462 }
1463 if (phy_cross == NV_CROSSOVER_DETECTION_DISABLED) {
1464 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3)) {
1465 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1466 return PHY_ERROR;
1467 }
1468 phy_reserved = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, MII_READ);
1469 phy_reserved &= ~PHY_REALTEK_INIT_MSK1;
1470 phy_reserved |= PHY_REALTEK_INIT3;
1471 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, phy_reserved)) {
1472 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1473 return PHY_ERROR;
1474 }
1475 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1)) {
1476 printk(KERN_INFO "%s: phy init failed.\n", pci_name(np->pci_dev));
1477 return PHY_ERROR;
1478 }
1479 }
Ayaz Abdullac5e3ae82007-07-15 06:51:03 -04001480 }
1481 }
1482
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04001483 /* some phys clear out pause advertisment on reset, set it back */
1484 mii_rw(dev, np->phyaddr, MII_ADVERTISE, reg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001485
Ed Swierkcb52deb2008-12-01 12:24:43 +00001486 /* restart auto negotiation, power down phy */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001487 mii_control = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
Ed Swierk5a9a8e32009-06-02 00:19:52 -07001488 mii_control |= (BMCR_ANRESTART | BMCR_ANENABLE);
Szymon Janc78aea4f2010-11-27 08:39:43 +00001489 if (phy_power_down)
Ed Swierk5a9a8e32009-06-02 00:19:52 -07001490 mii_control |= BMCR_PDOWN;
Szymon Janc78aea4f2010-11-27 08:39:43 +00001491 if (mii_rw(dev, np->phyaddr, MII_BMCR, mii_control))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001492 return PHY_ERROR;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001493
1494 return 0;
1495}
1496
1497static void nv_start_rx(struct net_device *dev)
1498{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001499 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001500 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001501 u32 rx_ctrl = readl(base + NvRegReceiverControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001502
Joe Perches6b808582010-11-29 07:41:53 +00001503 netdev_dbg(dev, "%s\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001504 /* Already running? Stop it. */
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001505 if ((readl(base + NvRegReceiverControl) & NVREG_RCVCTL_START) && !np->mac_in_use) {
1506 rx_ctrl &= ~NVREG_RCVCTL_START;
1507 writel(rx_ctrl, base + NvRegReceiverControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001508 pci_push(base);
1509 }
1510 writel(np->linkspeed, base + NvRegLinkSpeed);
1511 pci_push(base);
Szymon Janc78aea4f2010-11-27 08:39:43 +00001512 rx_ctrl |= NVREG_RCVCTL_START;
1513 if (np->mac_in_use)
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001514 rx_ctrl &= ~NVREG_RCVCTL_RX_PATH_EN;
1515 writel(rx_ctrl, base + NvRegReceiverControl);
Joe Perches6b808582010-11-29 07:41:53 +00001516 netdev_dbg(dev, "%s: duplex %d, speed 0x%08x\n",
1517 __func__, np->duplex, np->linkspeed);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001518 pci_push(base);
1519}
1520
1521static void nv_stop_rx(struct net_device *dev)
1522{
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001523 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001524 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001525 u32 rx_ctrl = readl(base + NvRegReceiverControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001526
Joe Perches6b808582010-11-29 07:41:53 +00001527 netdev_dbg(dev, "%s\n", __func__);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001528 if (!np->mac_in_use)
1529 rx_ctrl &= ~NVREG_RCVCTL_START;
1530 else
1531 rx_ctrl |= NVREG_RCVCTL_RX_PATH_EN;
1532 writel(rx_ctrl, base + NvRegReceiverControl);
Joe Perches344d0dc2010-11-29 07:41:52 +00001533 if (reg_delay(dev, NvRegReceiverStatus, NVREG_RCVSTAT_BUSY, 0,
1534 NV_RXSTOP_DELAY1, NV_RXSTOP_DELAY1MAX))
1535 printk(KERN_INFO "nv_stop_rx: ReceiverStatus remained busy");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001536
1537 udelay(NV_RXSTOP_DELAY2);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001538 if (!np->mac_in_use)
1539 writel(0, base + NvRegLinkSpeed);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001540}
1541
1542static void nv_start_tx(struct net_device *dev)
1543{
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001544 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001545 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001546 u32 tx_ctrl = readl(base + NvRegTransmitterControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547
Joe Perches6b808582010-11-29 07:41:53 +00001548 netdev_dbg(dev, "%s\n", __func__);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001549 tx_ctrl |= NVREG_XMITCTL_START;
1550 if (np->mac_in_use)
1551 tx_ctrl &= ~NVREG_XMITCTL_TX_PATH_EN;
1552 writel(tx_ctrl, base + NvRegTransmitterControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001553 pci_push(base);
1554}
1555
1556static void nv_stop_tx(struct net_device *dev)
1557{
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001558 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001559 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001560 u32 tx_ctrl = readl(base + NvRegTransmitterControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001561
Joe Perches6b808582010-11-29 07:41:53 +00001562 netdev_dbg(dev, "%s\n", __func__);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001563 if (!np->mac_in_use)
1564 tx_ctrl &= ~NVREG_XMITCTL_START;
1565 else
1566 tx_ctrl |= NVREG_XMITCTL_TX_PATH_EN;
1567 writel(tx_ctrl, base + NvRegTransmitterControl);
Joe Perches344d0dc2010-11-29 07:41:52 +00001568 if (reg_delay(dev, NvRegTransmitterStatus, NVREG_XMITSTAT_BUSY, 0,
1569 NV_TXSTOP_DELAY1, NV_TXSTOP_DELAY1MAX))
1570 printk(KERN_INFO "nv_stop_tx: TransmitterStatus remained busy");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001571
1572 udelay(NV_TXSTOP_DELAY2);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05001573 if (!np->mac_in_use)
1574 writel(readl(base + NvRegTransmitPoll) & NVREG_TRANSMITPOLL_MAC_ADDR_REV,
1575 base + NvRegTransmitPoll);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001576}
1577
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001578static void nv_start_rxtx(struct net_device *dev)
1579{
1580 nv_start_rx(dev);
1581 nv_start_tx(dev);
1582}
1583
1584static void nv_stop_rxtx(struct net_device *dev)
1585{
1586 nv_stop_rx(dev);
1587 nv_stop_tx(dev);
1588}
1589
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590static void nv_txrx_reset(struct net_device *dev)
1591{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001592 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001593 u8 __iomem *base = get_hwbase(dev);
1594
Joe Perches6b808582010-11-29 07:41:53 +00001595 netdev_dbg(dev, "%s\n", __func__);
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04001596 writel(NVREG_TXRXCTL_BIT2 | NVREG_TXRXCTL_RESET | np->txrxctl_bits, base + NvRegTxRxControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001597 pci_push(base);
1598 udelay(NV_TXRX_RESET_DELAY);
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04001599 writel(NVREG_TXRXCTL_BIT2 | np->txrxctl_bits, base + NvRegTxRxControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001600 pci_push(base);
1601}
1602
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04001603static void nv_mac_reset(struct net_device *dev)
1604{
1605 struct fe_priv *np = netdev_priv(dev);
1606 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdulla4e84f9b2008-02-04 15:14:09 -05001607 u32 temp1, temp2, temp3;
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04001608
Joe Perches6b808582010-11-29 07:41:53 +00001609 netdev_dbg(dev, "%s\n", __func__);
Ayaz Abdulla4e84f9b2008-02-04 15:14:09 -05001610
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04001611 writel(NVREG_TXRXCTL_BIT2 | NVREG_TXRXCTL_RESET | np->txrxctl_bits, base + NvRegTxRxControl);
1612 pci_push(base);
Ayaz Abdulla4e84f9b2008-02-04 15:14:09 -05001613
1614 /* save registers since they will be cleared on reset */
1615 temp1 = readl(base + NvRegMacAddrA);
1616 temp2 = readl(base + NvRegMacAddrB);
1617 temp3 = readl(base + NvRegTransmitPoll);
1618
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04001619 writel(NVREG_MAC_RESET_ASSERT, base + NvRegMacReset);
1620 pci_push(base);
1621 udelay(NV_MAC_RESET_DELAY);
1622 writel(0, base + NvRegMacReset);
1623 pci_push(base);
1624 udelay(NV_MAC_RESET_DELAY);
Ayaz Abdulla4e84f9b2008-02-04 15:14:09 -05001625
1626 /* restore saved registers */
1627 writel(temp1, base + NvRegMacAddrA);
1628 writel(temp2, base + NvRegMacAddrB);
1629 writel(temp3, base + NvRegTransmitPoll);
1630
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04001631 writel(NVREG_TXRXCTL_BIT2 | np->txrxctl_bits, base + NvRegTxRxControl);
1632 pci_push(base);
1633}
1634
Ayaz Abdulla57fff692007-01-23 12:27:00 -05001635static void nv_get_hw_stats(struct net_device *dev)
1636{
1637 struct fe_priv *np = netdev_priv(dev);
1638 u8 __iomem *base = get_hwbase(dev);
1639
1640 np->estats.tx_bytes += readl(base + NvRegTxCnt);
1641 np->estats.tx_zero_rexmt += readl(base + NvRegTxZeroReXmt);
1642 np->estats.tx_one_rexmt += readl(base + NvRegTxOneReXmt);
1643 np->estats.tx_many_rexmt += readl(base + NvRegTxManyReXmt);
1644 np->estats.tx_late_collision += readl(base + NvRegTxLateCol);
1645 np->estats.tx_fifo_errors += readl(base + NvRegTxUnderflow);
1646 np->estats.tx_carrier_errors += readl(base + NvRegTxLossCarrier);
1647 np->estats.tx_excess_deferral += readl(base + NvRegTxExcessDef);
1648 np->estats.tx_retry_error += readl(base + NvRegTxRetryErr);
1649 np->estats.rx_frame_error += readl(base + NvRegRxFrameErr);
1650 np->estats.rx_extra_byte += readl(base + NvRegRxExtraByte);
1651 np->estats.rx_late_collision += readl(base + NvRegRxLateCol);
1652 np->estats.rx_runt += readl(base + NvRegRxRunt);
1653 np->estats.rx_frame_too_long += readl(base + NvRegRxFrameTooLong);
1654 np->estats.rx_over_errors += readl(base + NvRegRxOverflow);
1655 np->estats.rx_crc_errors += readl(base + NvRegRxFCSErr);
1656 np->estats.rx_frame_align_error += readl(base + NvRegRxFrameAlignErr);
1657 np->estats.rx_length_error += readl(base + NvRegRxLenErr);
1658 np->estats.rx_unicast += readl(base + NvRegRxUnicast);
1659 np->estats.rx_multicast += readl(base + NvRegRxMulticast);
1660 np->estats.rx_broadcast += readl(base + NvRegRxBroadcast);
1661 np->estats.rx_packets =
1662 np->estats.rx_unicast +
1663 np->estats.rx_multicast +
1664 np->estats.rx_broadcast;
1665 np->estats.rx_errors_total =
1666 np->estats.rx_crc_errors +
1667 np->estats.rx_over_errors +
1668 np->estats.rx_frame_error +
1669 (np->estats.rx_frame_align_error - np->estats.rx_extra_byte) +
1670 np->estats.rx_late_collision +
1671 np->estats.rx_runt +
1672 np->estats.rx_frame_too_long;
1673 np->estats.tx_errors_total =
1674 np->estats.tx_late_collision +
1675 np->estats.tx_fifo_errors +
1676 np->estats.tx_carrier_errors +
1677 np->estats.tx_excess_deferral +
1678 np->estats.tx_retry_error;
1679
1680 if (np->driver_data & DEV_HAS_STATISTICS_V2) {
1681 np->estats.tx_deferral += readl(base + NvRegTxDef);
1682 np->estats.tx_packets += readl(base + NvRegTxFrame);
1683 np->estats.rx_bytes += readl(base + NvRegRxCnt);
1684 np->estats.tx_pause += readl(base + NvRegTxPause);
1685 np->estats.rx_pause += readl(base + NvRegRxPause);
1686 np->estats.rx_drop_frame += readl(base + NvRegRxDropFrame);
1687 }
Ayaz Abdulla9c662432008-08-06 12:11:42 -04001688
1689 if (np->driver_data & DEV_HAS_STATISTICS_V3) {
1690 np->estats.tx_unicast += readl(base + NvRegTxUnicast);
1691 np->estats.tx_multicast += readl(base + NvRegTxMulticast);
1692 np->estats.tx_broadcast += readl(base + NvRegTxBroadcast);
1693 }
Ayaz Abdulla57fff692007-01-23 12:27:00 -05001694}
1695
Linus Torvalds1da177e2005-04-16 15:20:36 -07001696/*
1697 * nv_get_stats: dev->get_stats function
1698 * Get latest stats value from the nic.
1699 * Called with read_lock(&dev_base_lock) held for read -
1700 * only synchronized against unregister_netdevice.
1701 */
1702static struct net_device_stats *nv_get_stats(struct net_device *dev)
1703{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001704 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001705
Ayaz Abdulla21828162007-01-23 12:27:21 -05001706 /* If the nic supports hw counters then retrieve latest values */
Ayaz Abdulla9c662432008-08-06 12:11:42 -04001707 if (np->driver_data & (DEV_HAS_STATISTICS_V1|DEV_HAS_STATISTICS_V2|DEV_HAS_STATISTICS_V3)) {
Ayaz Abdulla21828162007-01-23 12:27:21 -05001708 nv_get_hw_stats(dev);
1709
1710 /* copy to net_device stats */
Jeff Garzik8148ff42007-10-16 20:56:09 -04001711 dev->stats.tx_bytes = np->estats.tx_bytes;
1712 dev->stats.tx_fifo_errors = np->estats.tx_fifo_errors;
1713 dev->stats.tx_carrier_errors = np->estats.tx_carrier_errors;
1714 dev->stats.rx_crc_errors = np->estats.rx_crc_errors;
1715 dev->stats.rx_over_errors = np->estats.rx_over_errors;
1716 dev->stats.rx_errors = np->estats.rx_errors_total;
1717 dev->stats.tx_errors = np->estats.tx_errors_total;
Ayaz Abdulla21828162007-01-23 12:27:21 -05001718 }
Jeff Garzik8148ff42007-10-16 20:56:09 -04001719
1720 return &dev->stats;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001721}
1722
1723/*
1724 * nv_alloc_rx: fill rx ring entries.
1725 * Return 1 if the allocations for the skbs failed and the
1726 * rx engine is without Available descriptors
1727 */
1728static int nv_alloc_rx(struct net_device *dev)
1729{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001730 struct fe_priv *np = netdev_priv(dev);
Szymon Janc78aea4f2010-11-27 08:39:43 +00001731 struct ring_desc *less_rx;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001732
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001733 less_rx = np->get_rx.orig;
1734 if (less_rx-- == np->first_rx.orig)
1735 less_rx = np->last_rx.orig;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001736
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001737 while (np->put_rx.orig != less_rx) {
1738 struct sk_buff *skb = dev_alloc_skb(np->rx_buf_sz + NV_RX_ALLOC_PAD);
Ayaz Abdulla0d63fb32007-01-09 13:30:13 -05001739 if (skb) {
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001740 np->put_rx_ctx->skb = skb;
Arnaldo Carvalho de Melo4305b542007-04-19 20:43:29 -07001741 np->put_rx_ctx->dma = pci_map_single(np->pci_dev,
1742 skb->data,
Arnaldo Carvalho de Melo8b5be262007-03-20 12:08:20 -03001743 skb_tailroom(skb),
Arnaldo Carvalho de Melo4305b542007-04-19 20:43:29 -07001744 PCI_DMA_FROMDEVICE);
Arnaldo Carvalho de Melo8b5be262007-03-20 12:08:20 -03001745 np->put_rx_ctx->dma_len = skb_tailroom(skb);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001746 np->put_rx.orig->buf = cpu_to_le32(np->put_rx_ctx->dma);
1747 wmb();
1748 np->put_rx.orig->flaglen = cpu_to_le32(np->rx_buf_sz | NV_RX_AVAIL);
Ayaz Abdullab01867c2007-01-21 18:10:52 -05001749 if (unlikely(np->put_rx.orig++ == np->last_rx.orig))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001750 np->put_rx.orig = np->first_rx.orig;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05001751 if (unlikely(np->put_rx_ctx++ == np->last_rx_ctx))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001752 np->put_rx_ctx = np->first_rx_ctx;
Szymon Janc78aea4f2010-11-27 08:39:43 +00001753 } else
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001754 return 1;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001755 }
1756 return 0;
1757}
1758
1759static int nv_alloc_rx_optimized(struct net_device *dev)
1760{
1761 struct fe_priv *np = netdev_priv(dev);
Szymon Janc78aea4f2010-11-27 08:39:43 +00001762 struct ring_desc_ex *less_rx;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001763
1764 less_rx = np->get_rx.ex;
1765 if (less_rx-- == np->first_rx.ex)
1766 less_rx = np->last_rx.ex;
1767
1768 while (np->put_rx.ex != less_rx) {
1769 struct sk_buff *skb = dev_alloc_skb(np->rx_buf_sz + NV_RX_ALLOC_PAD);
1770 if (skb) {
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001771 np->put_rx_ctx->skb = skb;
Arnaldo Carvalho de Melo4305b542007-04-19 20:43:29 -07001772 np->put_rx_ctx->dma = pci_map_single(np->pci_dev,
1773 skb->data,
Arnaldo Carvalho de Melo8b5be262007-03-20 12:08:20 -03001774 skb_tailroom(skb),
Arnaldo Carvalho de Melo4305b542007-04-19 20:43:29 -07001775 PCI_DMA_FROMDEVICE);
Arnaldo Carvalho de Melo8b5be262007-03-20 12:08:20 -03001776 np->put_rx_ctx->dma_len = skb_tailroom(skb);
Al Viro5bb7ea22007-12-09 16:06:41 +00001777 np->put_rx.ex->bufhigh = cpu_to_le32(dma_high(np->put_rx_ctx->dma));
1778 np->put_rx.ex->buflow = cpu_to_le32(dma_low(np->put_rx_ctx->dma));
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001779 wmb();
1780 np->put_rx.ex->flaglen = cpu_to_le32(np->rx_buf_sz | NV_RX2_AVAIL);
Ayaz Abdullab01867c2007-01-21 18:10:52 -05001781 if (unlikely(np->put_rx.ex++ == np->last_rx.ex))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001782 np->put_rx.ex = np->first_rx.ex;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05001783 if (unlikely(np->put_rx_ctx++ == np->last_rx_ctx))
Ayaz Abdulla0d63fb32007-01-09 13:30:13 -05001784 np->put_rx_ctx = np->first_rx_ctx;
Szymon Janc78aea4f2010-11-27 08:39:43 +00001785 } else
Ayaz Abdulla0d63fb32007-01-09 13:30:13 -05001786 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001787 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001788 return 0;
1789}
1790
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07001791/* If rx bufs are exhausted called after 50ms to attempt to refresh */
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07001792static void nv_do_rx_refill(unsigned long data)
1793{
1794 struct net_device *dev = (struct net_device *) data;
Stephen Hemmingerbea33482007-10-03 16:41:36 -07001795 struct fe_priv *np = netdev_priv(dev);
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07001796
1797 /* Just reschedule NAPI rx processing */
Ben Hutchings288379f2009-01-19 16:43:59 -08001798 napi_schedule(&np->napi);
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07001799}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001800
Jeff Garzikf3b197a2006-05-26 21:39:03 -04001801static void nv_init_rx(struct net_device *dev)
Manfred Sprauld81c0982005-07-31 18:20:30 +02001802{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001803 struct fe_priv *np = netdev_priv(dev);
Manfred Sprauld81c0982005-07-31 18:20:30 +02001804 int i;
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001805
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001806 np->get_rx = np->put_rx = np->first_rx = np->rx_ring;
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001807
1808 if (!nv_optimized(np))
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001809 np->last_rx.orig = &np->rx_ring.orig[np->rx_ring_size-1];
1810 else
1811 np->last_rx.ex = &np->rx_ring.ex[np->rx_ring_size-1];
1812 np->get_rx_ctx = np->put_rx_ctx = np->first_rx_ctx = np->rx_skb;
1813 np->last_rx_ctx = &np->rx_skb[np->rx_ring_size-1];
Manfred Sprauld81c0982005-07-31 18:20:30 +02001814
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001815 for (i = 0; i < np->rx_ring_size; i++) {
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001816 if (!nv_optimized(np)) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07001817 np->rx_ring.orig[i].flaglen = 0;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001818 np->rx_ring.orig[i].buf = 0;
1819 } else {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07001820 np->rx_ring.ex[i].flaglen = 0;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001821 np->rx_ring.ex[i].txvlan = 0;
1822 np->rx_ring.ex[i].bufhigh = 0;
1823 np->rx_ring.ex[i].buflow = 0;
1824 }
1825 np->rx_skb[i].skb = NULL;
1826 np->rx_skb[i].dma = 0;
1827 }
Manfred Sprauld81c0982005-07-31 18:20:30 +02001828}
1829
1830static void nv_init_tx(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001831{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001832 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001833 int i;
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001834
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001835 np->get_tx = np->put_tx = np->first_tx = np->tx_ring;
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001836
1837 if (!nv_optimized(np))
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001838 np->last_tx.orig = &np->tx_ring.orig[np->tx_ring_size-1];
1839 else
1840 np->last_tx.ex = &np->tx_ring.ex[np->tx_ring_size-1];
1841 np->get_tx_ctx = np->put_tx_ctx = np->first_tx_ctx = np->tx_skb;
1842 np->last_tx_ctx = &np->tx_skb[np->tx_ring_size-1];
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05001843 np->tx_pkts_in_progress = 0;
1844 np->tx_change_owner = NULL;
1845 np->tx_end_flip = NULL;
Ayaz Abdulla8f955d72009-04-25 09:17:56 +00001846 np->tx_stop = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001847
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04001848 for (i = 0; i < np->tx_ring_size; i++) {
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001849 if (!nv_optimized(np)) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07001850 np->tx_ring.orig[i].flaglen = 0;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001851 np->tx_ring.orig[i].buf = 0;
1852 } else {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07001853 np->tx_ring.ex[i].flaglen = 0;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001854 np->tx_ring.ex[i].txvlan = 0;
1855 np->tx_ring.ex[i].bufhigh = 0;
1856 np->tx_ring.ex[i].buflow = 0;
1857 }
1858 np->tx_skb[i].skb = NULL;
1859 np->tx_skb[i].dma = 0;
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05001860 np->tx_skb[i].dma_len = 0;
Eric Dumazet73a37072009-06-17 21:17:59 +00001861 np->tx_skb[i].dma_single = 0;
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05001862 np->tx_skb[i].first_tx_desc = NULL;
1863 np->tx_skb[i].next_tx_ctx = NULL;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001864 }
Manfred Sprauld81c0982005-07-31 18:20:30 +02001865}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001866
Manfred Sprauld81c0982005-07-31 18:20:30 +02001867static int nv_init_ring(struct net_device *dev)
1868{
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001869 struct fe_priv *np = netdev_priv(dev);
1870
Manfred Sprauld81c0982005-07-31 18:20:30 +02001871 nv_init_tx(dev);
1872 nv_init_rx(dev);
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001873
1874 if (!nv_optimized(np))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05001875 return nv_alloc_rx(dev);
1876 else
1877 return nv_alloc_rx_optimized(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001878}
1879
Eric Dumazet73a37072009-06-17 21:17:59 +00001880static void nv_unmap_txskb(struct fe_priv *np, struct nv_skb_map *tx_skb)
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001881{
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001882 if (tx_skb->dma) {
Eric Dumazet73a37072009-06-17 21:17:59 +00001883 if (tx_skb->dma_single)
1884 pci_unmap_single(np->pci_dev, tx_skb->dma,
1885 tx_skb->dma_len,
1886 PCI_DMA_TODEVICE);
1887 else
1888 pci_unmap_page(np->pci_dev, tx_skb->dma,
1889 tx_skb->dma_len,
1890 PCI_DMA_TODEVICE);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001891 tx_skb->dma = 0;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001892 }
Eric Dumazet73a37072009-06-17 21:17:59 +00001893}
1894
1895static int nv_release_txskb(struct fe_priv *np, struct nv_skb_map *tx_skb)
1896{
1897 nv_unmap_txskb(np, tx_skb);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001898 if (tx_skb->skb) {
1899 dev_kfree_skb_any(tx_skb->skb);
1900 tx_skb->skb = NULL;
Ayaz Abdullafa454592006-01-05 22:45:45 -08001901 return 1;
Ayaz Abdullafa454592006-01-05 22:45:45 -08001902 }
Eric Dumazet73a37072009-06-17 21:17:59 +00001903 return 0;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001904}
1905
Linus Torvalds1da177e2005-04-16 15:20:36 -07001906static void nv_drain_tx(struct net_device *dev)
1907{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001908 struct fe_priv *np = netdev_priv(dev);
1909 unsigned int i;
Jeff Garzikf3b197a2006-05-26 21:39:03 -04001910
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04001911 for (i = 0; i < np->tx_ring_size; i++) {
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001912 if (!nv_optimized(np)) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07001913 np->tx_ring.orig[i].flaglen = 0;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001914 np->tx_ring.orig[i].buf = 0;
1915 } else {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07001916 np->tx_ring.ex[i].flaglen = 0;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001917 np->tx_ring.ex[i].txvlan = 0;
1918 np->tx_ring.ex[i].bufhigh = 0;
1919 np->tx_ring.ex[i].buflow = 0;
1920 }
Eric Dumazet73a37072009-06-17 21:17:59 +00001921 if (nv_release_txskb(np, &np->tx_skb[i]))
Jeff Garzik8148ff42007-10-16 20:56:09 -04001922 dev->stats.tx_dropped++;
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05001923 np->tx_skb[i].dma = 0;
1924 np->tx_skb[i].dma_len = 0;
Eric Dumazet73a37072009-06-17 21:17:59 +00001925 np->tx_skb[i].dma_single = 0;
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05001926 np->tx_skb[i].first_tx_desc = NULL;
1927 np->tx_skb[i].next_tx_ctx = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001928 }
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05001929 np->tx_pkts_in_progress = 0;
1930 np->tx_change_owner = NULL;
1931 np->tx_end_flip = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001932}
1933
1934static void nv_drain_rx(struct net_device *dev)
1935{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04001936 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001937 int i;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001938
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04001939 for (i = 0; i < np->rx_ring_size; i++) {
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001940 if (!nv_optimized(np)) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07001941 np->rx_ring.orig[i].flaglen = 0;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001942 np->rx_ring.orig[i].buf = 0;
1943 } else {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07001944 np->rx_ring.ex[i].flaglen = 0;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001945 np->rx_ring.ex[i].txvlan = 0;
1946 np->rx_ring.ex[i].bufhigh = 0;
1947 np->rx_ring.ex[i].buflow = 0;
1948 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001949 wmb();
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001950 if (np->rx_skb[i].skb) {
1951 pci_unmap_single(np->pci_dev, np->rx_skb[i].dma,
Arnaldo Carvalho de Melo4305b542007-04-19 20:43:29 -07001952 (skb_end_pointer(np->rx_skb[i].skb) -
1953 np->rx_skb[i].skb->data),
1954 PCI_DMA_FROMDEVICE);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001955 dev_kfree_skb(np->rx_skb[i].skb);
1956 np->rx_skb[i].skb = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001957 }
1958 }
1959}
1960
Jeff Garzik36b30ea2007-10-16 01:40:30 -04001961static void nv_drain_rxtx(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001962{
1963 nv_drain_tx(dev);
1964 nv_drain_rx(dev);
1965}
1966
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05001967static inline u32 nv_get_empty_tx_slots(struct fe_priv *np)
1968{
1969 return (u32)(np->tx_ring_size - ((np->tx_ring_size + (np->put_tx_ctx - np->get_tx_ctx)) % np->tx_ring_size));
1970}
1971
Ayaz Abdullaa4336862008-04-18 13:50:43 -07001972static void nv_legacybackoff_reseed(struct net_device *dev)
1973{
1974 u8 __iomem *base = get_hwbase(dev);
1975 u32 reg;
1976 u32 low;
1977 int tx_status = 0;
1978
1979 reg = readl(base + NvRegSlotTime) & ~NVREG_SLOTTIME_MASK;
1980 get_random_bytes(&low, sizeof(low));
1981 reg |= low & NVREG_SLOTTIME_MASK;
1982
1983 /* Need to stop tx before change takes effect.
1984 * Caller has already gained np->lock.
1985 */
1986 tx_status = readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_START;
1987 if (tx_status)
1988 nv_stop_tx(dev);
1989 nv_stop_rx(dev);
1990 writel(reg, base + NvRegSlotTime);
1991 if (tx_status)
1992 nv_start_tx(dev);
1993 nv_start_rx(dev);
1994}
1995
1996/* Gear Backoff Seeds */
1997#define BACKOFF_SEEDSET_ROWS 8
1998#define BACKOFF_SEEDSET_LFSRS 15
1999
2000/* Known Good seed sets */
2001static const u32 main_seedset[BACKOFF_SEEDSET_ROWS][BACKOFF_SEEDSET_LFSRS] = {
Szymon Janc78aea4f2010-11-27 08:39:43 +00002002 {145, 155, 165, 175, 185, 196, 235, 245, 255, 265, 275, 285, 660, 690, 874},
2003 {245, 255, 265, 575, 385, 298, 335, 345, 355, 366, 375, 385, 761, 790, 974},
2004 {145, 155, 165, 175, 185, 196, 235, 245, 255, 265, 275, 285, 660, 690, 874},
2005 {245, 255, 265, 575, 385, 298, 335, 345, 355, 366, 375, 386, 761, 790, 974},
2006 {266, 265, 276, 585, 397, 208, 345, 355, 365, 376, 385, 396, 771, 700, 984},
2007 {266, 265, 276, 586, 397, 208, 346, 355, 365, 376, 285, 396, 771, 700, 984},
2008 {366, 365, 376, 686, 497, 308, 447, 455, 466, 476, 485, 496, 871, 800, 84},
2009 {466, 465, 476, 786, 597, 408, 547, 555, 566, 576, 585, 597, 971, 900, 184} };
Ayaz Abdullaa4336862008-04-18 13:50:43 -07002010
2011static const u32 gear_seedset[BACKOFF_SEEDSET_ROWS][BACKOFF_SEEDSET_LFSRS] = {
Szymon Janc78aea4f2010-11-27 08:39:43 +00002012 {251, 262, 273, 324, 319, 508, 375, 364, 341, 371, 398, 193, 375, 30, 295},
2013 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395},
2014 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 397},
2015 {251, 262, 273, 324, 319, 508, 375, 364, 341, 371, 398, 193, 375, 30, 295},
2016 {251, 262, 273, 324, 319, 508, 375, 364, 341, 371, 398, 193, 375, 30, 295},
2017 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395},
2018 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395},
2019 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395} };
Ayaz Abdullaa4336862008-04-18 13:50:43 -07002020
2021static void nv_gear_backoff_reseed(struct net_device *dev)
2022{
2023 u8 __iomem *base = get_hwbase(dev);
2024 u32 miniseed1, miniseed2, miniseed2_reversed, miniseed3, miniseed3_reversed;
2025 u32 temp, seedset, combinedSeed;
2026 int i;
2027
2028 /* Setup seed for free running LFSR */
2029 /* We are going to read the time stamp counter 3 times
2030 and swizzle bits around to increase randomness */
2031 get_random_bytes(&miniseed1, sizeof(miniseed1));
2032 miniseed1 &= 0x0fff;
2033 if (miniseed1 == 0)
2034 miniseed1 = 0xabc;
2035
2036 get_random_bytes(&miniseed2, sizeof(miniseed2));
2037 miniseed2 &= 0x0fff;
2038 if (miniseed2 == 0)
2039 miniseed2 = 0xabc;
2040 miniseed2_reversed =
2041 ((miniseed2 & 0xF00) >> 8) |
2042 (miniseed2 & 0x0F0) |
2043 ((miniseed2 & 0x00F) << 8);
2044
2045 get_random_bytes(&miniseed3, sizeof(miniseed3));
2046 miniseed3 &= 0x0fff;
2047 if (miniseed3 == 0)
2048 miniseed3 = 0xabc;
2049 miniseed3_reversed =
2050 ((miniseed3 & 0xF00) >> 8) |
2051 (miniseed3 & 0x0F0) |
2052 ((miniseed3 & 0x00F) << 8);
2053
2054 combinedSeed = ((miniseed1 ^ miniseed2_reversed) << 12) |
2055 (miniseed2 ^ miniseed3_reversed);
2056
2057 /* Seeds can not be zero */
2058 if ((combinedSeed & NVREG_BKOFFCTRL_SEED_MASK) == 0)
2059 combinedSeed |= 0x08;
2060 if ((combinedSeed & (NVREG_BKOFFCTRL_SEED_MASK << NVREG_BKOFFCTRL_GEAR)) == 0)
2061 combinedSeed |= 0x8000;
2062
2063 /* No need to disable tx here */
2064 temp = NVREG_BKOFFCTRL_DEFAULT | (0 << NVREG_BKOFFCTRL_SELECT);
2065 temp |= combinedSeed & NVREG_BKOFFCTRL_SEED_MASK;
2066 temp |= combinedSeed >> NVREG_BKOFFCTRL_GEAR;
Szymon Janc78aea4f2010-11-27 08:39:43 +00002067 writel(temp, base + NvRegBackOffControl);
Ayaz Abdullaa4336862008-04-18 13:50:43 -07002068
Szymon Janc78aea4f2010-11-27 08:39:43 +00002069 /* Setup seeds for all gear LFSRs. */
Ayaz Abdullaa4336862008-04-18 13:50:43 -07002070 get_random_bytes(&seedset, sizeof(seedset));
2071 seedset = seedset % BACKOFF_SEEDSET_ROWS;
Szymon Janc78aea4f2010-11-27 08:39:43 +00002072 for (i = 1; i <= BACKOFF_SEEDSET_LFSRS; i++) {
Ayaz Abdullaa4336862008-04-18 13:50:43 -07002073 temp = NVREG_BKOFFCTRL_DEFAULT | (i << NVREG_BKOFFCTRL_SELECT);
2074 temp |= main_seedset[seedset][i-1] & 0x3ff;
2075 temp |= ((gear_seedset[seedset][i-1] & 0x3ff) << NVREG_BKOFFCTRL_GEAR);
2076 writel(temp, base + NvRegBackOffControl);
2077 }
2078}
2079
Linus Torvalds1da177e2005-04-16 15:20:36 -07002080/*
2081 * nv_start_xmit: dev->hard_start_xmit function
Herbert Xu932ff272006-06-09 12:20:56 -07002082 * Called with netif_tx_lock held.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002083 */
Stephen Hemminger613573252009-08-31 19:50:58 +00002084static netdev_tx_t nv_start_xmit(struct sk_buff *skb, struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002085{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002086 struct fe_priv *np = netdev_priv(dev);
Ayaz Abdullafa454592006-01-05 22:45:45 -08002087 u32 tx_flags = 0;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002088 u32 tx_flags_extra = (np->desc_ver == DESC_VER_1 ? NV_TX_LASTPACKET : NV_TX2_LASTPACKET);
2089 unsigned int fragments = skb_shinfo(skb)->nr_frags;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002090 unsigned int i;
Ayaz Abdullafa454592006-01-05 22:45:45 -08002091 u32 offset = 0;
2092 u32 bcnt;
Eric Dumazete743d312010-04-14 15:59:40 -07002093 u32 size = skb_headlen(skb);
Ayaz Abdullafa454592006-01-05 22:45:45 -08002094 u32 entries = (size >> NV_TX2_TSO_MAX_SHIFT) + ((size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002095 u32 empty_slots;
Szymon Janc78aea4f2010-11-27 08:39:43 +00002096 struct ring_desc *put_tx;
2097 struct ring_desc *start_tx;
2098 struct ring_desc *prev_tx;
2099 struct nv_skb_map *prev_tx_ctx;
Ingo Molnarbd6ca632008-03-28 14:41:30 -07002100 unsigned long flags;
Ayaz Abdullafa454592006-01-05 22:45:45 -08002101
2102 /* add fragments to entries count */
2103 for (i = 0; i < fragments; i++) {
2104 entries += (skb_shinfo(skb)->frags[i].size >> NV_TX2_TSO_MAX_SHIFT) +
2105 ((skb_shinfo(skb)->frags[i].size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0);
2106 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002107
Ayaz Abdulla001eb842009-01-09 11:03:44 +00002108 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002109 empty_slots = nv_get_empty_tx_slots(np);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002110 if (unlikely(empty_slots <= entries)) {
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002111 netif_stop_queue(dev);
Ayaz Abdullaaaa37d22007-01-21 18:10:42 -05002112 np->tx_stop = 1;
Ingo Molnarbd6ca632008-03-28 14:41:30 -07002113 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002114 return NETDEV_TX_BUSY;
2115 }
Ayaz Abdulla001eb842009-01-09 11:03:44 +00002116 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002117
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002118 start_tx = put_tx = np->put_tx.orig;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002119
Ayaz Abdullafa454592006-01-05 22:45:45 -08002120 /* setup the header buffer */
2121 do {
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002122 prev_tx = put_tx;
2123 prev_tx_ctx = np->put_tx_ctx;
Ayaz Abdullafa454592006-01-05 22:45:45 -08002124 bcnt = (size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : size;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002125 np->put_tx_ctx->dma = pci_map_single(np->pci_dev, skb->data + offset, bcnt,
Ayaz Abdullafa454592006-01-05 22:45:45 -08002126 PCI_DMA_TODEVICE);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002127 np->put_tx_ctx->dma_len = bcnt;
Eric Dumazet73a37072009-06-17 21:17:59 +00002128 np->put_tx_ctx->dma_single = 1;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002129 put_tx->buf = cpu_to_le32(np->put_tx_ctx->dma);
2130 put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002131
Ayaz Abdullafa454592006-01-05 22:45:45 -08002132 tx_flags = np->tx_flags;
2133 offset += bcnt;
2134 size -= bcnt;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002135 if (unlikely(put_tx++ == np->last_tx.orig))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002136 put_tx = np->first_tx.orig;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002137 if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx))
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002138 np->put_tx_ctx = np->first_tx_ctx;
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002139 } while (size);
Ayaz Abdullafa454592006-01-05 22:45:45 -08002140
2141 /* setup the fragments */
2142 for (i = 0; i < fragments; i++) {
2143 skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
2144 u32 size = frag->size;
2145 offset = 0;
2146
2147 do {
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002148 prev_tx = put_tx;
2149 prev_tx_ctx = np->put_tx_ctx;
Ayaz Abdullafa454592006-01-05 22:45:45 -08002150 bcnt = (size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : size;
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002151 np->put_tx_ctx->dma = pci_map_page(np->pci_dev, frag->page, frag->page_offset+offset, bcnt,
2152 PCI_DMA_TODEVICE);
2153 np->put_tx_ctx->dma_len = bcnt;
Eric Dumazet73a37072009-06-17 21:17:59 +00002154 np->put_tx_ctx->dma_single = 0;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002155 put_tx->buf = cpu_to_le32(np->put_tx_ctx->dma);
2156 put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002157
Ayaz Abdullafa454592006-01-05 22:45:45 -08002158 offset += bcnt;
2159 size -= bcnt;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002160 if (unlikely(put_tx++ == np->last_tx.orig))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002161 put_tx = np->first_tx.orig;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002162 if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx))
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002163 np->put_tx_ctx = np->first_tx_ctx;
Ayaz Abdullafa454592006-01-05 22:45:45 -08002164 } while (size);
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002165 }
2166
Ayaz Abdullafa454592006-01-05 22:45:45 -08002167 /* set last fragment flag */
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002168 prev_tx->flaglen |= cpu_to_le32(tx_flags_extra);
Ayaz Abdullafa454592006-01-05 22:45:45 -08002169
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002170 /* save skb in this slot's context area */
2171 prev_tx_ctx->skb = skb;
Ayaz Abdullafa454592006-01-05 22:45:45 -08002172
Herbert Xu89114af2006-07-08 13:34:32 -07002173 if (skb_is_gso(skb))
Herbert Xu79671682006-06-22 02:40:14 -07002174 tx_flags_extra = NV_TX2_TSO | (skb_shinfo(skb)->gso_size << NV_TX2_TSO_SHIFT);
Manfred Spraulee733622005-07-31 18:32:26 +02002175 else
Arjan van de Ven1d39ed52006-12-12 14:06:23 +01002176 tx_flags_extra = skb->ip_summed == CHECKSUM_PARTIAL ?
Patrick McHardy84fa7932006-08-29 16:44:56 -07002177 NV_TX2_CHECKSUM_L3 | NV_TX2_CHECKSUM_L4 : 0;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002178
Ingo Molnarbd6ca632008-03-28 14:41:30 -07002179 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdulla164a86e2007-01-09 13:30:10 -05002180
Ayaz Abdullafa454592006-01-05 22:45:45 -08002181 /* set tx flags */
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002182 start_tx->flaglen |= cpu_to_le32(tx_flags | tx_flags_extra);
2183 np->put_tx.orig = put_tx;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002184
Ingo Molnarbd6ca632008-03-28 14:41:30 -07002185 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002186
Joe Perches6b808582010-11-29 07:41:53 +00002187 netdev_dbg(dev, "%s: entries %d queued for transmission. tx_flags_extra: %x\n",
2188 __func__, entries, tx_flags_extra);
Joe Perchese6499852010-11-29 07:41:54 +00002189#ifdef DEBUG
2190 print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, 16, 1,
2191 skb->data, 64, true);
2192#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002193
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04002194 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002195 return NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002196}
2197
Stephen Hemminger613573252009-08-31 19:50:58 +00002198static netdev_tx_t nv_start_xmit_optimized(struct sk_buff *skb,
2199 struct net_device *dev)
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002200{
2201 struct fe_priv *np = netdev_priv(dev);
2202 u32 tx_flags = 0;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002203 u32 tx_flags_extra;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002204 unsigned int fragments = skb_shinfo(skb)->nr_frags;
2205 unsigned int i;
2206 u32 offset = 0;
2207 u32 bcnt;
Eric Dumazete743d312010-04-14 15:59:40 -07002208 u32 size = skb_headlen(skb);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002209 u32 entries = (size >> NV_TX2_TSO_MAX_SHIFT) + ((size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0);
2210 u32 empty_slots;
Szymon Janc78aea4f2010-11-27 08:39:43 +00002211 struct ring_desc_ex *put_tx;
2212 struct ring_desc_ex *start_tx;
2213 struct ring_desc_ex *prev_tx;
2214 struct nv_skb_map *prev_tx_ctx;
2215 struct nv_skb_map *start_tx_ctx;
Ingo Molnarbd6ca632008-03-28 14:41:30 -07002216 unsigned long flags;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002217
2218 /* add fragments to entries count */
2219 for (i = 0; i < fragments; i++) {
2220 entries += (skb_shinfo(skb)->frags[i].size >> NV_TX2_TSO_MAX_SHIFT) +
2221 ((skb_shinfo(skb)->frags[i].size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0);
2222 }
2223
Ayaz Abdulla001eb842009-01-09 11:03:44 +00002224 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002225 empty_slots = nv_get_empty_tx_slots(np);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002226 if (unlikely(empty_slots <= entries)) {
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002227 netif_stop_queue(dev);
Ayaz Abdullaaaa37d22007-01-21 18:10:42 -05002228 np->tx_stop = 1;
Ingo Molnarbd6ca632008-03-28 14:41:30 -07002229 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002230 return NETDEV_TX_BUSY;
2231 }
Ayaz Abdulla001eb842009-01-09 11:03:44 +00002232 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002233
2234 start_tx = put_tx = np->put_tx.ex;
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05002235 start_tx_ctx = np->put_tx_ctx;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002236
2237 /* setup the header buffer */
2238 do {
2239 prev_tx = put_tx;
2240 prev_tx_ctx = np->put_tx_ctx;
2241 bcnt = (size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : size;
2242 np->put_tx_ctx->dma = pci_map_single(np->pci_dev, skb->data + offset, bcnt,
2243 PCI_DMA_TODEVICE);
2244 np->put_tx_ctx->dma_len = bcnt;
Eric Dumazet73a37072009-06-17 21:17:59 +00002245 np->put_tx_ctx->dma_single = 1;
Al Viro5bb7ea22007-12-09 16:06:41 +00002246 put_tx->bufhigh = cpu_to_le32(dma_high(np->put_tx_ctx->dma));
2247 put_tx->buflow = cpu_to_le32(dma_low(np->put_tx_ctx->dma));
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002248 put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002249
2250 tx_flags = NV_TX2_VALID;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002251 offset += bcnt;
2252 size -= bcnt;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002253 if (unlikely(put_tx++ == np->last_tx.ex))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002254 put_tx = np->first_tx.ex;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002255 if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002256 np->put_tx_ctx = np->first_tx_ctx;
2257 } while (size);
2258
2259 /* setup the fragments */
2260 for (i = 0; i < fragments; i++) {
2261 skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
2262 u32 size = frag->size;
2263 offset = 0;
2264
2265 do {
2266 prev_tx = put_tx;
2267 prev_tx_ctx = np->put_tx_ctx;
2268 bcnt = (size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : size;
2269 np->put_tx_ctx->dma = pci_map_page(np->pci_dev, frag->page, frag->page_offset+offset, bcnt,
2270 PCI_DMA_TODEVICE);
2271 np->put_tx_ctx->dma_len = bcnt;
Eric Dumazet73a37072009-06-17 21:17:59 +00002272 np->put_tx_ctx->dma_single = 0;
Al Viro5bb7ea22007-12-09 16:06:41 +00002273 put_tx->bufhigh = cpu_to_le32(dma_high(np->put_tx_ctx->dma));
2274 put_tx->buflow = cpu_to_le32(dma_low(np->put_tx_ctx->dma));
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002275 put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002276
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002277 offset += bcnt;
2278 size -= bcnt;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002279 if (unlikely(put_tx++ == np->last_tx.ex))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002280 put_tx = np->first_tx.ex;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002281 if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002282 np->put_tx_ctx = np->first_tx_ctx;
2283 } while (size);
2284 }
2285
2286 /* set last fragment flag */
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002287 prev_tx->flaglen |= cpu_to_le32(NV_TX2_LASTPACKET);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002288
2289 /* save skb in this slot's context area */
2290 prev_tx_ctx->skb = skb;
2291
2292 if (skb_is_gso(skb))
2293 tx_flags_extra = NV_TX2_TSO | (skb_shinfo(skb)->gso_size << NV_TX2_TSO_SHIFT);
2294 else
2295 tx_flags_extra = skb->ip_summed == CHECKSUM_PARTIAL ?
2296 NV_TX2_CHECKSUM_L3 | NV_TX2_CHECKSUM_L4 : 0;
2297
2298 /* vlan tag */
Jesse Grosseab6d182010-10-20 13:56:03 +00002299 if (vlan_tx_tag_present(skb))
2300 start_tx->txvlan = cpu_to_le32(NV_TX3_VLAN_TAG_PRESENT |
2301 vlan_tx_tag_get(skb));
2302 else
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002303 start_tx->txvlan = 0;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002304
Ingo Molnarbd6ca632008-03-28 14:41:30 -07002305 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002306
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05002307 if (np->tx_limit) {
2308 /* Limit the number of outstanding tx. Setup all fragments, but
2309 * do not set the VALID bit on the first descriptor. Save a pointer
2310 * to that descriptor and also for next skb_map element.
2311 */
2312
2313 if (np->tx_pkts_in_progress == NV_TX_LIMIT_COUNT) {
2314 if (!np->tx_change_owner)
2315 np->tx_change_owner = start_tx_ctx;
2316
2317 /* remove VALID bit */
2318 tx_flags &= ~NV_TX2_VALID;
2319 start_tx_ctx->first_tx_desc = start_tx;
2320 start_tx_ctx->next_tx_ctx = np->put_tx_ctx;
2321 np->tx_end_flip = np->put_tx_ctx;
2322 } else {
2323 np->tx_pkts_in_progress++;
2324 }
2325 }
2326
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002327 /* set tx flags */
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002328 start_tx->flaglen |= cpu_to_le32(tx_flags | tx_flags_extra);
2329 np->put_tx.ex = put_tx;
2330
Ingo Molnarbd6ca632008-03-28 14:41:30 -07002331 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002332
Joe Perches6b808582010-11-29 07:41:53 +00002333 netdev_dbg(dev, "%s: entries %d queued for transmission. tx_flags_extra: %x\n",
2334 __func__, entries, tx_flags_extra);
Joe Perchese6499852010-11-29 07:41:54 +00002335#ifdef DEBUG
2336 print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, 16, 1,
2337 skb->data, 64, true);
2338#endif
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002339
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002340 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002341 return NETDEV_TX_OK;
2342}
2343
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05002344static inline void nv_tx_flip_ownership(struct net_device *dev)
2345{
2346 struct fe_priv *np = netdev_priv(dev);
2347
2348 np->tx_pkts_in_progress--;
2349 if (np->tx_change_owner) {
Al Viro30ecce92008-03-26 05:57:12 +00002350 np->tx_change_owner->first_tx_desc->flaglen |=
2351 cpu_to_le32(NV_TX2_VALID);
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05002352 np->tx_pkts_in_progress++;
2353
2354 np->tx_change_owner = np->tx_change_owner->next_tx_ctx;
2355 if (np->tx_change_owner == np->tx_end_flip)
2356 np->tx_change_owner = NULL;
2357
2358 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
2359 }
2360}
2361
Linus Torvalds1da177e2005-04-16 15:20:36 -07002362/*
2363 * nv_tx_done: check for completed packets, release the skbs.
2364 *
2365 * Caller must own np->lock.
2366 */
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002367static int nv_tx_done(struct net_device *dev, int limit)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002368{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002369 struct fe_priv *np = netdev_priv(dev);
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002370 u32 flags;
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002371 int tx_work = 0;
Szymon Janc78aea4f2010-11-27 08:39:43 +00002372 struct ring_desc *orig_get_tx = np->get_tx.orig;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002373
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002374 while ((np->get_tx.orig != np->put_tx.orig) &&
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002375 !((flags = le32_to_cpu(np->get_tx.orig->flaglen)) & NV_TX_VALID) &&
2376 (tx_work < limit)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002377
Joe Perches6b808582010-11-29 07:41:53 +00002378 netdev_dbg(dev, "%s: flags 0x%x\n", __func__, flags);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002379
Eric Dumazet73a37072009-06-17 21:17:59 +00002380 nv_unmap_txskb(np, np->get_tx_ctx);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002381
Linus Torvalds1da177e2005-04-16 15:20:36 -07002382 if (np->desc_ver == DESC_VER_1) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002383 if (flags & NV_TX_LASTPACKET) {
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002384 if (flags & NV_TX_ERROR) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002385 if (flags & NV_TX_UNDERFLOW)
Jeff Garzik8148ff42007-10-16 20:56:09 -04002386 dev->stats.tx_fifo_errors++;
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002387 if (flags & NV_TX_CARRIERLOST)
Jeff Garzik8148ff42007-10-16 20:56:09 -04002388 dev->stats.tx_carrier_errors++;
Ayaz Abdullaa4336862008-04-18 13:50:43 -07002389 if ((flags & NV_TX_RETRYERROR) && !(flags & NV_TX_RETRYCOUNT_MASK))
2390 nv_legacybackoff_reseed(dev);
Jeff Garzik8148ff42007-10-16 20:56:09 -04002391 dev->stats.tx_errors++;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002392 } else {
Jeff Garzik8148ff42007-10-16 20:56:09 -04002393 dev->stats.tx_packets++;
2394 dev->stats.tx_bytes += np->get_tx_ctx->skb->len;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002395 }
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002396 dev_kfree_skb_any(np->get_tx_ctx->skb);
2397 np->get_tx_ctx->skb = NULL;
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002398 tx_work++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002399 }
2400 } else {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002401 if (flags & NV_TX2_LASTPACKET) {
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002402 if (flags & NV_TX2_ERROR) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002403 if (flags & NV_TX2_UNDERFLOW)
Jeff Garzik8148ff42007-10-16 20:56:09 -04002404 dev->stats.tx_fifo_errors++;
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002405 if (flags & NV_TX2_CARRIERLOST)
Jeff Garzik8148ff42007-10-16 20:56:09 -04002406 dev->stats.tx_carrier_errors++;
Ayaz Abdullaa4336862008-04-18 13:50:43 -07002407 if ((flags & NV_TX2_RETRYERROR) && !(flags & NV_TX2_RETRYCOUNT_MASK))
2408 nv_legacybackoff_reseed(dev);
Jeff Garzik8148ff42007-10-16 20:56:09 -04002409 dev->stats.tx_errors++;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002410 } else {
Jeff Garzik8148ff42007-10-16 20:56:09 -04002411 dev->stats.tx_packets++;
2412 dev->stats.tx_bytes += np->get_tx_ctx->skb->len;
Jeff Garzikf3b197a2006-05-26 21:39:03 -04002413 }
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002414 dev_kfree_skb_any(np->get_tx_ctx->skb);
2415 np->get_tx_ctx->skb = NULL;
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002416 tx_work++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002417 }
2418 }
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002419 if (unlikely(np->get_tx.orig++ == np->last_tx.orig))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002420 np->get_tx.orig = np->first_tx.orig;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002421 if (unlikely(np->get_tx_ctx++ == np->last_tx_ctx))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002422 np->get_tx_ctx = np->first_tx_ctx;
2423 }
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002424 if (unlikely((np->tx_stop == 1) && (np->get_tx.orig != orig_get_tx))) {
Ayaz Abdullaaaa37d22007-01-21 18:10:42 -05002425 np->tx_stop = 0;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002426 netif_wake_queue(dev);
Ayaz Abdullaaaa37d22007-01-21 18:10:42 -05002427 }
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002428 return tx_work;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002429}
2430
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002431static int nv_tx_done_optimized(struct net_device *dev, int limit)
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002432{
2433 struct fe_priv *np = netdev_priv(dev);
2434 u32 flags;
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002435 int tx_work = 0;
Szymon Janc78aea4f2010-11-27 08:39:43 +00002436 struct ring_desc_ex *orig_get_tx = np->get_tx.ex;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002437
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002438 while ((np->get_tx.ex != np->put_tx.ex) &&
Julia Lawall217d32d2010-07-05 22:15:47 -07002439 !((flags = le32_to_cpu(np->get_tx.ex->flaglen)) & NV_TX2_VALID) &&
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002440 (tx_work < limit)) {
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002441
Joe Perches6b808582010-11-29 07:41:53 +00002442 netdev_dbg(dev, "%s: flags 0x%x\n", __func__, flags);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002443
Eric Dumazet73a37072009-06-17 21:17:59 +00002444 nv_unmap_txskb(np, np->get_tx_ctx);
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002445
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002446 if (flags & NV_TX2_LASTPACKET) {
Ayaz Abdulla21828162007-01-23 12:27:21 -05002447 if (!(flags & NV_TX2_ERROR))
Jeff Garzik8148ff42007-10-16 20:56:09 -04002448 dev->stats.tx_packets++;
Ayaz Abdullaa4336862008-04-18 13:50:43 -07002449 else {
2450 if ((flags & NV_TX2_RETRYERROR) && !(flags & NV_TX2_RETRYCOUNT_MASK)) {
2451 if (np->driver_data & DEV_HAS_GEAR_MODE)
2452 nv_gear_backoff_reseed(dev);
2453 else
2454 nv_legacybackoff_reseed(dev);
2455 }
2456 }
2457
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002458 dev_kfree_skb_any(np->get_tx_ctx->skb);
2459 np->get_tx_ctx->skb = NULL;
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002460 tx_work++;
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05002461
Szymon Janc78aea4f2010-11-27 08:39:43 +00002462 if (np->tx_limit)
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05002463 nv_tx_flip_ownership(dev);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002464 }
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002465 if (unlikely(np->get_tx.ex++ == np->last_tx.ex))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002466 np->get_tx.ex = np->first_tx.ex;
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002467 if (unlikely(np->get_tx_ctx++ == np->last_tx_ctx))
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002468 np->get_tx_ctx = np->first_tx_ctx;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002469 }
Ayaz Abdulla445583b2007-01-21 18:10:47 -05002470 if (unlikely((np->tx_stop == 1) && (np->get_tx.ex != orig_get_tx))) {
Ayaz Abdullaaaa37d22007-01-21 18:10:42 -05002471 np->tx_stop = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002472 netif_wake_queue(dev);
Ayaz Abdullaaaa37d22007-01-21 18:10:42 -05002473 }
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002474 return tx_work;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002475}
2476
2477/*
2478 * nv_tx_timeout: dev->tx_timeout function
Herbert Xu932ff272006-06-09 12:20:56 -07002479 * Called with netif_tx_lock held.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002480 */
2481static void nv_tx_timeout(struct net_device *dev)
2482{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002483 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002484 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05002485 u32 status;
Ayaz Abdulla8f955d72009-04-25 09:17:56 +00002486 union ring_type put_tx;
2487 int saved_tx_limit;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002488
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05002489 if (np->msi_flags & NV_MSI_X_ENABLED)
2490 status = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQSTAT_MASK;
2491 else
2492 status = readl(base + NvRegIrqStatus) & NVREG_IRQSTAT_MASK;
2493
2494 printk(KERN_INFO "%s: Got tx_timeout. irq: %08x\n", dev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002495
Manfred Spraulc2dba062005-07-31 18:29:47 +02002496 {
2497 int i;
2498
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002499 printk(KERN_INFO "%s: Ring at %lx\n",
2500 dev->name, (unsigned long)np->ring_addr);
Manfred Spraulc2dba062005-07-31 18:29:47 +02002501 printk(KERN_INFO "%s: Dumping tx registers\n", dev->name);
Szymon Janc78aea4f2010-11-27 08:39:43 +00002502 for (i = 0; i <= np->register_size; i += 32) {
Manfred Spraulc2dba062005-07-31 18:29:47 +02002503 printk(KERN_INFO "%3x: %08x %08x %08x %08x %08x %08x %08x %08x\n",
2504 i,
2505 readl(base + i + 0), readl(base + i + 4),
2506 readl(base + i + 8), readl(base + i + 12),
2507 readl(base + i + 16), readl(base + i + 20),
2508 readl(base + i + 24), readl(base + i + 28));
2509 }
2510 printk(KERN_INFO "%s: Dumping tx ring\n", dev->name);
Szymon Janc78aea4f2010-11-27 08:39:43 +00002511 for (i = 0; i < np->tx_ring_size; i += 4) {
Jeff Garzik36b30ea2007-10-16 01:40:30 -04002512 if (!nv_optimized(np)) {
Manfred Spraulee733622005-07-31 18:32:26 +02002513 printk(KERN_INFO "%03x: %08x %08x // %08x %08x // %08x %08x // %08x %08x\n",
Jeff Garzikf3b197a2006-05-26 21:39:03 -04002514 i,
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002515 le32_to_cpu(np->tx_ring.orig[i].buf),
2516 le32_to_cpu(np->tx_ring.orig[i].flaglen),
2517 le32_to_cpu(np->tx_ring.orig[i+1].buf),
2518 le32_to_cpu(np->tx_ring.orig[i+1].flaglen),
2519 le32_to_cpu(np->tx_ring.orig[i+2].buf),
2520 le32_to_cpu(np->tx_ring.orig[i+2].flaglen),
2521 le32_to_cpu(np->tx_ring.orig[i+3].buf),
2522 le32_to_cpu(np->tx_ring.orig[i+3].flaglen));
Manfred Spraulee733622005-07-31 18:32:26 +02002523 } else {
2524 printk(KERN_INFO "%03x: %08x %08x %08x // %08x %08x %08x // %08x %08x %08x // %08x %08x %08x\n",
Jeff Garzikf3b197a2006-05-26 21:39:03 -04002525 i,
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002526 le32_to_cpu(np->tx_ring.ex[i].bufhigh),
2527 le32_to_cpu(np->tx_ring.ex[i].buflow),
2528 le32_to_cpu(np->tx_ring.ex[i].flaglen),
2529 le32_to_cpu(np->tx_ring.ex[i+1].bufhigh),
2530 le32_to_cpu(np->tx_ring.ex[i+1].buflow),
2531 le32_to_cpu(np->tx_ring.ex[i+1].flaglen),
2532 le32_to_cpu(np->tx_ring.ex[i+2].bufhigh),
2533 le32_to_cpu(np->tx_ring.ex[i+2].buflow),
2534 le32_to_cpu(np->tx_ring.ex[i+2].flaglen),
2535 le32_to_cpu(np->tx_ring.ex[i+3].bufhigh),
2536 le32_to_cpu(np->tx_ring.ex[i+3].buflow),
2537 le32_to_cpu(np->tx_ring.ex[i+3].flaglen));
Manfred Spraulee733622005-07-31 18:32:26 +02002538 }
Manfred Spraulc2dba062005-07-31 18:29:47 +02002539 }
2540 }
2541
Linus Torvalds1da177e2005-04-16 15:20:36 -07002542 spin_lock_irq(&np->lock);
2543
2544 /* 1) stop tx engine */
2545 nv_stop_tx(dev);
2546
Ayaz Abdulla8f955d72009-04-25 09:17:56 +00002547 /* 2) complete any outstanding tx and do not give HW any limited tx pkts */
2548 saved_tx_limit = np->tx_limit;
2549 np->tx_limit = 0; /* prevent giving HW any limited pkts */
2550 np->tx_stop = 0; /* prevent waking tx queue */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04002551 if (!nv_optimized(np))
Ayaz Abdulla33912e72009-03-05 08:02:10 +00002552 nv_tx_done(dev, np->tx_ring_size);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002553 else
Ayaz Abdulla4e16ed12007-01-23 12:00:56 -05002554 nv_tx_done_optimized(dev, np->tx_ring_size);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002555
Ayaz Abdulla8f955d72009-04-25 09:17:56 +00002556 /* save current HW postion */
2557 if (np->tx_change_owner)
2558 put_tx.ex = np->tx_change_owner->first_tx_desc;
2559 else
2560 put_tx = np->put_tx;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002561
Ayaz Abdulla8f955d72009-04-25 09:17:56 +00002562 /* 3) clear all tx state */
2563 nv_drain_tx(dev);
2564 nv_init_tx(dev);
Ayaz Abdulla3ba4d092007-03-23 05:50:02 -05002565
Ayaz Abdulla8f955d72009-04-25 09:17:56 +00002566 /* 4) restore state to current HW position */
2567 np->get_tx = np->put_tx = put_tx;
2568 np->tx_limit = saved_tx_limit;
2569
2570 /* 5) restart tx engine */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002571 nv_start_tx(dev);
Ayaz Abdulla8f955d72009-04-25 09:17:56 +00002572 netif_wake_queue(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002573 spin_unlock_irq(&np->lock);
2574}
2575
Manfred Spraul22c6d142005-04-19 21:17:09 +02002576/*
2577 * Called when the nic notices a mismatch between the actual data len on the
2578 * wire and the len indicated in the 802 header
2579 */
2580static int nv_getlen(struct net_device *dev, void *packet, int datalen)
2581{
2582 int hdrlen; /* length of the 802 header */
2583 int protolen; /* length as stored in the proto field */
2584
2585 /* 1) calculate len according to header */
Szymon Janc78aea4f2010-11-27 08:39:43 +00002586 if (((struct vlan_ethhdr *)packet)->h_vlan_proto == htons(ETH_P_8021Q)) {
2587 protolen = ntohs(((struct vlan_ethhdr *)packet)->h_vlan_encapsulated_proto);
Manfred Spraul22c6d142005-04-19 21:17:09 +02002588 hdrlen = VLAN_HLEN;
2589 } else {
Szymon Janc78aea4f2010-11-27 08:39:43 +00002590 protolen = ntohs(((struct ethhdr *)packet)->h_proto);
Manfred Spraul22c6d142005-04-19 21:17:09 +02002591 hdrlen = ETH_HLEN;
2592 }
Joe Perches6b808582010-11-29 07:41:53 +00002593 netdev_dbg(dev, "%s: datalen %d, protolen %d, hdrlen %d\n",
2594 __func__, datalen, protolen, hdrlen);
Manfred Spraul22c6d142005-04-19 21:17:09 +02002595 if (protolen > ETH_DATA_LEN)
2596 return datalen; /* Value in proto field not a len, no checks possible */
2597
2598 protolen += hdrlen;
2599 /* consistency checks: */
2600 if (datalen > ETH_ZLEN) {
2601 if (datalen >= protolen) {
2602 /* more data on wire than in 802 header, trim of
2603 * additional data.
2604 */
Joe Perches6b808582010-11-29 07:41:53 +00002605 netdev_dbg(dev, "%s: accepting %d bytes\n",
2606 __func__, protolen);
Manfred Spraul22c6d142005-04-19 21:17:09 +02002607 return protolen;
2608 } else {
2609 /* less data on wire than mentioned in header.
2610 * Discard the packet.
2611 */
Joe Perches6b808582010-11-29 07:41:53 +00002612 netdev_dbg(dev, "%s: discarding long packet\n",
2613 __func__);
Manfred Spraul22c6d142005-04-19 21:17:09 +02002614 return -1;
2615 }
2616 } else {
2617 /* short packet. Accept only if 802 values are also short */
2618 if (protolen > ETH_ZLEN) {
Joe Perches6b808582010-11-29 07:41:53 +00002619 netdev_dbg(dev, "%s: discarding short packet\n",
2620 __func__);
Manfred Spraul22c6d142005-04-19 21:17:09 +02002621 return -1;
2622 }
Joe Perches6b808582010-11-29 07:41:53 +00002623 netdev_dbg(dev, "%s: accepting %d bytes\n", __func__, datalen);
Manfred Spraul22c6d142005-04-19 21:17:09 +02002624 return datalen;
2625 }
2626}
2627
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07002628static int nv_rx_process(struct net_device *dev, int limit)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002629{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002630 struct fe_priv *np = netdev_priv(dev);
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002631 u32 flags;
Ingo Molnarbcb5feb2007-10-16 20:44:59 -04002632 int rx_work = 0;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002633 struct sk_buff *skb;
2634 int len;
Ayaz Abdullaee407b02006-02-04 13:13:17 -05002635
Szymon Janc78aea4f2010-11-27 08:39:43 +00002636 while ((np->get_rx.orig != np->put_rx.orig) &&
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002637 !((flags = le32_to_cpu(np->get_rx.orig->flaglen)) & NV_RX_AVAIL) &&
Ingo Molnarbcb5feb2007-10-16 20:44:59 -04002638 (rx_work < limit)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002639
Joe Perches6b808582010-11-29 07:41:53 +00002640 netdev_dbg(dev, "%s: flags 0x%x\n", __func__, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002641
Linus Torvalds1da177e2005-04-16 15:20:36 -07002642 /*
2643 * the packet is for us - immediately tear down the pci mapping.
2644 * TODO: check if a prefetch of the first cacheline improves
2645 * the performance.
2646 */
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002647 pci_unmap_single(np->pci_dev, np->get_rx_ctx->dma,
2648 np->get_rx_ctx->dma_len,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002649 PCI_DMA_FROMDEVICE);
Ayaz Abdulla0d63fb32007-01-09 13:30:13 -05002650 skb = np->get_rx_ctx->skb;
2651 np->get_rx_ctx->skb = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002652
Joe Perches6b808582010-11-29 07:41:53 +00002653 netdev_dbg(dev, "Dumping packet (flags 0x%x)\n", flags);
Joe Perchese6499852010-11-29 07:41:54 +00002654#ifdef DEBUG
2655 print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET,
2656 16, 1, skb->data, 64, true);
2657#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002658 /* look at what we actually got: */
2659 if (np->desc_ver == DESC_VER_1) {
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002660 if (likely(flags & NV_RX_DESCRIPTORVALID)) {
2661 len = flags & LEN_MASK_V1;
2662 if (unlikely(flags & NV_RX_ERROR)) {
Ayaz Abdulla1ef68412008-08-06 12:11:03 -04002663 if ((flags & NV_RX_ERROR_MASK) == NV_RX_ERROR4) {
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002664 len = nv_getlen(dev, skb->data, len);
2665 if (len < 0) {
Jeff Garzik8148ff42007-10-16 20:56:09 -04002666 dev->stats.rx_errors++;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002667 dev_kfree_skb(skb);
2668 goto next_pkt;
2669 }
2670 }
2671 /* framing errors are soft errors */
Ayaz Abdulla1ef68412008-08-06 12:11:03 -04002672 else if ((flags & NV_RX_ERROR_MASK) == NV_RX_FRAMINGERR) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00002673 if (flags & NV_RX_SUBSTRACT1)
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002674 len--;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002675 }
2676 /* the rest are hard errors */
2677 else {
2678 if (flags & NV_RX_MISSEDFRAME)
Jeff Garzik8148ff42007-10-16 20:56:09 -04002679 dev->stats.rx_missed_errors++;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002680 if (flags & NV_RX_CRCERR)
Jeff Garzik8148ff42007-10-16 20:56:09 -04002681 dev->stats.rx_crc_errors++;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002682 if (flags & NV_RX_OVERFLOW)
Jeff Garzik8148ff42007-10-16 20:56:09 -04002683 dev->stats.rx_over_errors++;
2684 dev->stats.rx_errors++;
Ayaz Abdulla0d63fb32007-01-09 13:30:13 -05002685 dev_kfree_skb(skb);
Ayaz Abdullaa971c322005-11-11 08:30:38 -05002686 goto next_pkt;
2687 }
2688 }
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002689 } else {
2690 dev_kfree_skb(skb);
2691 goto next_pkt;
Manfred Spraul22c6d142005-04-19 21:17:09 +02002692 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002693 } else {
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002694 if (likely(flags & NV_RX2_DESCRIPTORVALID)) {
2695 len = flags & LEN_MASK_V2;
2696 if (unlikely(flags & NV_RX2_ERROR)) {
Ayaz Abdulla1ef68412008-08-06 12:11:03 -04002697 if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_ERROR4) {
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002698 len = nv_getlen(dev, skb->data, len);
2699 if (len < 0) {
Jeff Garzik8148ff42007-10-16 20:56:09 -04002700 dev->stats.rx_errors++;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002701 dev_kfree_skb(skb);
2702 goto next_pkt;
2703 }
2704 }
2705 /* framing errors are soft errors */
Ayaz Abdulla1ef68412008-08-06 12:11:03 -04002706 else if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_FRAMINGERR) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00002707 if (flags & NV_RX2_SUBSTRACT1)
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002708 len--;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002709 }
2710 /* the rest are hard errors */
2711 else {
2712 if (flags & NV_RX2_CRCERR)
Jeff Garzik8148ff42007-10-16 20:56:09 -04002713 dev->stats.rx_crc_errors++;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002714 if (flags & NV_RX2_OVERFLOW)
Jeff Garzik8148ff42007-10-16 20:56:09 -04002715 dev->stats.rx_over_errors++;
2716 dev->stats.rx_errors++;
Ayaz Abdulla0d63fb32007-01-09 13:30:13 -05002717 dev_kfree_skb(skb);
Ayaz Abdullaa971c322005-11-11 08:30:38 -05002718 goto next_pkt;
2719 }
2720 }
Ayaz Abdullabfaffe82008-01-13 16:02:55 -05002721 if (((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_TCP) || /*ip and tcp */
2722 ((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_UDP)) /*ip and udp */
Ayaz Abdulla0d63fb32007-01-09 13:30:13 -05002723 skb->ip_summed = CHECKSUM_UNNECESSARY;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002724 } else {
2725 dev_kfree_skb(skb);
2726 goto next_pkt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002727 }
2728 }
2729 /* got a valid packet - forward it to the network core */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002730 skb_put(skb, len);
2731 skb->protocol = eth_type_trans(skb, dev);
Joe Perches6b808582010-11-29 07:41:53 +00002732 netdev_dbg(dev, "%s: %d bytes, proto %d accepted\n",
2733 __func__, len, skb->protocol);
Tom Herbert53f224c2010-05-03 19:08:45 +00002734 napi_gro_receive(&np->napi, skb);
Jeff Garzik8148ff42007-10-16 20:56:09 -04002735 dev->stats.rx_packets++;
2736 dev->stats.rx_bytes += len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002737next_pkt:
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002738 if (unlikely(np->get_rx.orig++ == np->last_rx.orig))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002739 np->get_rx.orig = np->first_rx.orig;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002740 if (unlikely(np->get_rx_ctx++ == np->last_rx_ctx))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002741 np->get_rx_ctx = np->first_rx_ctx;
Ingo Molnarbcb5feb2007-10-16 20:44:59 -04002742
2743 rx_work++;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002744 }
2745
Ingo Molnarbcb5feb2007-10-16 20:44:59 -04002746 return rx_work;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002747}
2748
2749static int nv_rx_process_optimized(struct net_device *dev, int limit)
2750{
2751 struct fe_priv *np = netdev_priv(dev);
2752 u32 flags;
2753 u32 vlanflags = 0;
Ingo Molnarc1b71512007-10-17 12:18:23 +02002754 int rx_work = 0;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002755 struct sk_buff *skb;
2756 int len;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002757
Szymon Janc78aea4f2010-11-27 08:39:43 +00002758 while ((np->get_rx.ex != np->put_rx.ex) &&
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002759 !((flags = le32_to_cpu(np->get_rx.ex->flaglen)) & NV_RX2_AVAIL) &&
Ingo Molnarc1b71512007-10-17 12:18:23 +02002760 (rx_work < limit)) {
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002761
Joe Perches6b808582010-11-29 07:41:53 +00002762 netdev_dbg(dev, "%s: flags 0x%x\n", __func__, flags);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002763
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002764 /*
2765 * the packet is for us - immediately tear down the pci mapping.
2766 * TODO: check if a prefetch of the first cacheline improves
2767 * the performance.
2768 */
2769 pci_unmap_single(np->pci_dev, np->get_rx_ctx->dma,
2770 np->get_rx_ctx->dma_len,
2771 PCI_DMA_FROMDEVICE);
2772 skb = np->get_rx_ctx->skb;
2773 np->get_rx_ctx->skb = NULL;
2774
Joe Perchese6499852010-11-29 07:41:54 +00002775 netdev_dbg(dev, "Dumping packet (flags 0x%x)\n", flags);
2776#ifdef DEBUG
2777 print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, 16, 1,
2778 skb->data, 64, true);
2779#endif
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002780 /* look at what we actually got: */
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002781 if (likely(flags & NV_RX2_DESCRIPTORVALID)) {
2782 len = flags & LEN_MASK_V2;
2783 if (unlikely(flags & NV_RX2_ERROR)) {
Ayaz Abdulla1ef68412008-08-06 12:11:03 -04002784 if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_ERROR4) {
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002785 len = nv_getlen(dev, skb->data, len);
2786 if (len < 0) {
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002787 dev_kfree_skb(skb);
2788 goto next_pkt;
2789 }
2790 }
2791 /* framing errors are soft errors */
Ayaz Abdulla1ef68412008-08-06 12:11:03 -04002792 else if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_FRAMINGERR) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00002793 if (flags & NV_RX2_SUBSTRACT1)
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002794 len--;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002795 }
2796 /* the rest are hard errors */
2797 else {
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002798 dev_kfree_skb(skb);
2799 goto next_pkt;
2800 }
2801 }
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002802
Ayaz Abdullabfaffe82008-01-13 16:02:55 -05002803 if (((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_TCP) || /*ip and tcp */
2804 ((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_UDP)) /*ip and udp */
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002805 skb->ip_summed = CHECKSUM_UNNECESSARY;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002806
2807 /* got a valid packet - forward it to the network core */
2808 skb_put(skb, len);
2809 skb->protocol = eth_type_trans(skb, dev);
2810 prefetch(skb->data);
2811
Joe Perches6b808582010-11-29 07:41:53 +00002812 netdev_dbg(dev, "%s: %d bytes, proto %d accepted\n",
2813 __func__, len, skb->protocol);
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002814
2815 if (likely(!np->vlangrp)) {
Tom Herbert53f224c2010-05-03 19:08:45 +00002816 napi_gro_receive(&np->napi, skb);
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002817 } else {
2818 vlanflags = le32_to_cpu(np->get_rx.ex->buflow);
2819 if (vlanflags & NV_RX3_VLAN_TAG_PRESENT) {
Tom Herbert53f224c2010-05-03 19:08:45 +00002820 vlan_gro_receive(&np->napi, np->vlangrp,
2821 vlanflags & NV_RX3_VLAN_TAG_MASK, skb);
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002822 } else {
Tom Herbert53f224c2010-05-03 19:08:45 +00002823 napi_gro_receive(&np->napi, skb);
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002824 }
2825 }
2826
Jeff Garzik8148ff42007-10-16 20:56:09 -04002827 dev->stats.rx_packets++;
2828 dev->stats.rx_bytes += len;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002829 } else {
2830 dev_kfree_skb(skb);
2831 }
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002832next_pkt:
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002833 if (unlikely(np->get_rx.ex++ == np->last_rx.ex))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05002834 np->get_rx.ex = np->first_rx.ex;
Ayaz Abdullab01867c2007-01-21 18:10:52 -05002835 if (unlikely(np->get_rx_ctx++ == np->last_rx_ctx))
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05002836 np->get_rx_ctx = np->first_rx_ctx;
Ingo Molnarc1b71512007-10-17 12:18:23 +02002837
2838 rx_work++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002839 }
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07002840
Ingo Molnarc1b71512007-10-17 12:18:23 +02002841 return rx_work;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002842}
2843
Manfred Sprauld81c0982005-07-31 18:20:30 +02002844static void set_bufsize(struct net_device *dev)
2845{
2846 struct fe_priv *np = netdev_priv(dev);
2847
2848 if (dev->mtu <= ETH_DATA_LEN)
2849 np->rx_buf_sz = ETH_DATA_LEN + NV_RX_HEADERS;
2850 else
2851 np->rx_buf_sz = dev->mtu + NV_RX_HEADERS;
2852}
2853
Linus Torvalds1da177e2005-04-16 15:20:36 -07002854/*
2855 * nv_change_mtu: dev->change_mtu function
2856 * Called with dev_base_lock held for read.
2857 */
2858static int nv_change_mtu(struct net_device *dev, int new_mtu)
2859{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002860 struct fe_priv *np = netdev_priv(dev);
Manfred Sprauld81c0982005-07-31 18:20:30 +02002861 int old_mtu;
2862
2863 if (new_mtu < 64 || new_mtu > np->pkt_limit)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002864 return -EINVAL;
Manfred Sprauld81c0982005-07-31 18:20:30 +02002865
2866 old_mtu = dev->mtu;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002867 dev->mtu = new_mtu;
Manfred Sprauld81c0982005-07-31 18:20:30 +02002868
2869 /* return early if the buffer sizes will not change */
2870 if (old_mtu <= ETH_DATA_LEN && new_mtu <= ETH_DATA_LEN)
2871 return 0;
2872 if (old_mtu == new_mtu)
2873 return 0;
2874
2875 /* synchronized against open : rtnl_lock() held by caller */
2876 if (netif_running(dev)) {
viro@ftp.linux.org.uk25097d42005-09-06 01:36:58 +01002877 u8 __iomem *base = get_hwbase(dev);
Manfred Sprauld81c0982005-07-31 18:20:30 +02002878 /*
2879 * It seems that the nic preloads valid ring entries into an
2880 * internal buffer. The procedure for flushing everything is
2881 * guessed, there is probably a simpler approach.
2882 * Changing the MTU is a rare event, it shouldn't matter.
2883 */
Ayaz Abdulla84b39322006-05-20 14:59:48 -07002884 nv_disable_irq(dev);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00002885 nv_napi_disable(dev);
Herbert Xu932ff272006-06-09 12:20:56 -07002886 netif_tx_lock_bh(dev);
David S. Millere308a5d2008-07-15 00:13:44 -07002887 netif_addr_lock(dev);
Manfred Sprauld81c0982005-07-31 18:20:30 +02002888 spin_lock(&np->lock);
2889 /* stop engines */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04002890 nv_stop_rxtx(dev);
Manfred Sprauld81c0982005-07-31 18:20:30 +02002891 nv_txrx_reset(dev);
2892 /* drain rx queue */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04002893 nv_drain_rxtx(dev);
Manfred Sprauld81c0982005-07-31 18:20:30 +02002894 /* reinit driver view of the rx queue */
Manfred Sprauld81c0982005-07-31 18:20:30 +02002895 set_bufsize(dev);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04002896 if (nv_init_ring(dev)) {
Manfred Sprauld81c0982005-07-31 18:20:30 +02002897 if (!np->in_shutdown)
2898 mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
2899 }
2900 /* reinit nic view of the rx queue */
2901 writel(np->rx_buf_sz, base + NvRegOffloadConfig);
Ayaz Abdulla0832b252006-02-04 13:13:26 -05002902 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
Szymon Janc78aea4f2010-11-27 08:39:43 +00002903 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
Manfred Sprauld81c0982005-07-31 18:20:30 +02002904 base + NvRegRingSizes);
2905 pci_push(base);
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04002906 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
Manfred Sprauld81c0982005-07-31 18:20:30 +02002907 pci_push(base);
2908
2909 /* restart rx engine */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04002910 nv_start_rxtx(dev);
Manfred Sprauld81c0982005-07-31 18:20:30 +02002911 spin_unlock(&np->lock);
David S. Millere308a5d2008-07-15 00:13:44 -07002912 netif_addr_unlock(dev);
Herbert Xu932ff272006-06-09 12:20:56 -07002913 netif_tx_unlock_bh(dev);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00002914 nv_napi_enable(dev);
Ayaz Abdulla84b39322006-05-20 14:59:48 -07002915 nv_enable_irq(dev);
Manfred Sprauld81c0982005-07-31 18:20:30 +02002916 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002917 return 0;
2918}
2919
Manfred Spraul72b31782005-07-31 18:33:34 +02002920static void nv_copy_mac_to_hw(struct net_device *dev)
2921{
viro@ftp.linux.org.uk25097d42005-09-06 01:36:58 +01002922 u8 __iomem *base = get_hwbase(dev);
Manfred Spraul72b31782005-07-31 18:33:34 +02002923 u32 mac[2];
2924
2925 mac[0] = (dev->dev_addr[0] << 0) + (dev->dev_addr[1] << 8) +
2926 (dev->dev_addr[2] << 16) + (dev->dev_addr[3] << 24);
2927 mac[1] = (dev->dev_addr[4] << 0) + (dev->dev_addr[5] << 8);
2928
2929 writel(mac[0], base + NvRegMacAddrA);
2930 writel(mac[1], base + NvRegMacAddrB);
2931}
2932
2933/*
2934 * nv_set_mac_address: dev->set_mac_address function
2935 * Called with rtnl_lock() held.
2936 */
2937static int nv_set_mac_address(struct net_device *dev, void *addr)
2938{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002939 struct fe_priv *np = netdev_priv(dev);
Szymon Janc78aea4f2010-11-27 08:39:43 +00002940 struct sockaddr *macaddr = (struct sockaddr *)addr;
Manfred Spraul72b31782005-07-31 18:33:34 +02002941
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07002942 if (!is_valid_ether_addr(macaddr->sa_data))
Manfred Spraul72b31782005-07-31 18:33:34 +02002943 return -EADDRNOTAVAIL;
2944
2945 /* synchronized against open : rtnl_lock() held by caller */
2946 memcpy(dev->dev_addr, macaddr->sa_data, ETH_ALEN);
2947
2948 if (netif_running(dev)) {
Herbert Xu932ff272006-06-09 12:20:56 -07002949 netif_tx_lock_bh(dev);
David S. Millere308a5d2008-07-15 00:13:44 -07002950 netif_addr_lock(dev);
Manfred Spraul72b31782005-07-31 18:33:34 +02002951 spin_lock_irq(&np->lock);
2952
2953 /* stop rx engine */
2954 nv_stop_rx(dev);
2955
2956 /* set mac address */
2957 nv_copy_mac_to_hw(dev);
2958
2959 /* restart rx engine */
2960 nv_start_rx(dev);
2961 spin_unlock_irq(&np->lock);
David S. Millere308a5d2008-07-15 00:13:44 -07002962 netif_addr_unlock(dev);
Herbert Xu932ff272006-06-09 12:20:56 -07002963 netif_tx_unlock_bh(dev);
Manfred Spraul72b31782005-07-31 18:33:34 +02002964 } else {
2965 nv_copy_mac_to_hw(dev);
2966 }
2967 return 0;
2968}
2969
Linus Torvalds1da177e2005-04-16 15:20:36 -07002970/*
2971 * nv_set_multicast: dev->set_multicast function
Herbert Xu932ff272006-06-09 12:20:56 -07002972 * Called with netif_tx_lock held.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002973 */
2974static void nv_set_multicast(struct net_device *dev)
2975{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04002976 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002977 u8 __iomem *base = get_hwbase(dev);
2978 u32 addr[2];
2979 u32 mask[2];
Ayaz Abdullab6d07732006-06-10 22:47:42 -04002980 u32 pff = readl(base + NvRegPacketFilterFlags) & NVREG_PFF_PAUSE_RX;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002981
2982 memset(addr, 0, sizeof(addr));
2983 memset(mask, 0, sizeof(mask));
2984
2985 if (dev->flags & IFF_PROMISC) {
Ayaz Abdullab6d07732006-06-10 22:47:42 -04002986 pff |= NVREG_PFF_PROMISC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002987 } else {
Ayaz Abdullab6d07732006-06-10 22:47:42 -04002988 pff |= NVREG_PFF_MYADDR;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002989
Jiri Pirko48e2f182010-02-22 09:22:26 +00002990 if (dev->flags & IFF_ALLMULTI || !netdev_mc_empty(dev)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002991 u32 alwaysOff[2];
2992 u32 alwaysOn[2];
2993
2994 alwaysOn[0] = alwaysOn[1] = alwaysOff[0] = alwaysOff[1] = 0xffffffff;
2995 if (dev->flags & IFF_ALLMULTI) {
2996 alwaysOn[0] = alwaysOn[1] = alwaysOff[0] = alwaysOff[1] = 0;
2997 } else {
Jiri Pirko22bedad32010-04-01 21:22:57 +00002998 struct netdev_hw_addr *ha;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002999
Jiri Pirko22bedad32010-04-01 21:22:57 +00003000 netdev_for_each_mc_addr(ha, dev) {
3001 unsigned char *addr = ha->addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003002 u32 a, b;
Jiri Pirko22bedad32010-04-01 21:22:57 +00003003
3004 a = le32_to_cpu(*(__le32 *) addr);
3005 b = le16_to_cpu(*(__le16 *) (&addr[4]));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003006 alwaysOn[0] &= a;
3007 alwaysOff[0] &= ~a;
3008 alwaysOn[1] &= b;
3009 alwaysOff[1] &= ~b;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003010 }
3011 }
3012 addr[0] = alwaysOn[0];
3013 addr[1] = alwaysOn[1];
3014 mask[0] = alwaysOn[0] | alwaysOff[0];
3015 mask[1] = alwaysOn[1] | alwaysOff[1];
Ayaz Abdullabb9a4fd2008-01-13 16:03:04 -05003016 } else {
3017 mask[0] = NVREG_MCASTMASKA_NONE;
3018 mask[1] = NVREG_MCASTMASKB_NONE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003019 }
3020 }
3021 addr[0] |= NVREG_MCASTADDRA_FORCE;
3022 pff |= NVREG_PFF_ALWAYS;
3023 spin_lock_irq(&np->lock);
3024 nv_stop_rx(dev);
3025 writel(addr[0], base + NvRegMulticastAddrA);
3026 writel(addr[1], base + NvRegMulticastAddrB);
3027 writel(mask[0], base + NvRegMulticastMaskA);
3028 writel(mask[1], base + NvRegMulticastMaskB);
3029 writel(pff, base + NvRegPacketFilterFlags);
Joe Perchesf52dafc2010-11-29 07:41:55 +00003030 netdev_dbg(dev, "reconfiguration for multicast lists\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003031 nv_start_rx(dev);
3032 spin_unlock_irq(&np->lock);
3033}
3034
Adrian Bunkc7985052006-06-22 12:03:29 +02003035static void nv_update_pause(struct net_device *dev, u32 pause_flags)
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003036{
3037 struct fe_priv *np = netdev_priv(dev);
3038 u8 __iomem *base = get_hwbase(dev);
3039
3040 np->pause_flags &= ~(NV_PAUSEFRAME_TX_ENABLE | NV_PAUSEFRAME_RX_ENABLE);
3041
3042 if (np->pause_flags & NV_PAUSEFRAME_RX_CAPABLE) {
3043 u32 pff = readl(base + NvRegPacketFilterFlags) & ~NVREG_PFF_PAUSE_RX;
3044 if (pause_flags & NV_PAUSEFRAME_RX_ENABLE) {
3045 writel(pff|NVREG_PFF_PAUSE_RX, base + NvRegPacketFilterFlags);
3046 np->pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
3047 } else {
3048 writel(pff, base + NvRegPacketFilterFlags);
3049 }
3050 }
3051 if (np->pause_flags & NV_PAUSEFRAME_TX_CAPABLE) {
3052 u32 regmisc = readl(base + NvRegMisc1) & ~NVREG_MISC1_PAUSE_TX;
3053 if (pause_flags & NV_PAUSEFRAME_TX_ENABLE) {
Ayaz Abdulla5289b4c2008-02-05 12:30:01 -05003054 u32 pause_enable = NVREG_TX_PAUSEFRAME_ENABLE_V1;
3055 if (np->driver_data & DEV_HAS_PAUSEFRAME_TX_V2)
3056 pause_enable = NVREG_TX_PAUSEFRAME_ENABLE_V2;
Ayaz Abdulla9a33e882008-08-06 12:12:34 -04003057 if (np->driver_data & DEV_HAS_PAUSEFRAME_TX_V3) {
Ayaz Abdulla5289b4c2008-02-05 12:30:01 -05003058 pause_enable = NVREG_TX_PAUSEFRAME_ENABLE_V3;
Ayaz Abdulla9a33e882008-08-06 12:12:34 -04003059 /* limit the number of tx pause frames to a default of 8 */
3060 writel(readl(base + NvRegTxPauseFrameLimit)|NVREG_TX_PAUSEFRAMELIMIT_ENABLE, base + NvRegTxPauseFrameLimit);
3061 }
Ayaz Abdulla5289b4c2008-02-05 12:30:01 -05003062 writel(pause_enable, base + NvRegTxPauseFrame);
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003063 writel(regmisc|NVREG_MISC1_PAUSE_TX, base + NvRegMisc1);
3064 np->pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
3065 } else {
3066 writel(NVREG_TX_PAUSEFRAME_DISABLE, base + NvRegTxPauseFrame);
3067 writel(regmisc, base + NvRegMisc1);
3068 }
3069 }
3070}
3071
Ayaz Abdulla4ea7f292005-11-11 08:29:59 -05003072/**
3073 * nv_update_linkspeed: Setup the MAC according to the link partner
3074 * @dev: Network device to be configured
3075 *
3076 * The function queries the PHY and checks if there is a link partner.
3077 * If yes, then it sets up the MAC accordingly. Otherwise, the MAC is
3078 * set to 10 MBit HD.
3079 *
3080 * The function returns 0 if there is no link partner and 1 if there is
3081 * a good link partner.
3082 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003083static int nv_update_linkspeed(struct net_device *dev)
3084{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04003085 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003086 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003087 int adv = 0;
3088 int lpa = 0;
3089 int adv_lpa, adv_pause, lpa_pause;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003090 int newls = np->linkspeed;
3091 int newdup = np->duplex;
3092 int mii_status;
3093 int retval = 0;
Ayaz Abdulla9744e212006-07-06 16:45:58 -04003094 u32 control_1000, status_1000, phyreg, pause_flags, txreg;
Ayaz Abdullab2976d22008-02-04 15:13:59 -05003095 u32 txrxFlags = 0;
Ayaz Abdullafd9b5582008-02-05 12:29:49 -05003096 u32 phy_exp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003097
3098 /* BMSR_LSTATUS is latched, read it twice:
3099 * we want the current value.
3100 */
3101 mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
3102 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
3103
3104 if (!(mii_status & BMSR_LSTATUS)) {
Joe Perches6b808582010-11-29 07:41:53 +00003105 netdev_dbg(dev,
3106 "no link detected by phy - falling back to 10HD\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003107 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
3108 newdup = 0;
3109 retval = 0;
3110 goto set_speed;
3111 }
3112
3113 if (np->autoneg == 0) {
Joe Perches6b808582010-11-29 07:41:53 +00003114 netdev_dbg(dev, "%s: autoneg off, PHY set to 0x%04x\n",
3115 __func__, np->fixed_mode);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003116 if (np->fixed_mode & LPA_100FULL) {
3117 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100;
3118 newdup = 1;
3119 } else if (np->fixed_mode & LPA_100HALF) {
3120 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100;
3121 newdup = 0;
3122 } else if (np->fixed_mode & LPA_10FULL) {
3123 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
3124 newdup = 1;
3125 } else {
3126 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
3127 newdup = 0;
3128 }
3129 retval = 1;
3130 goto set_speed;
3131 }
3132 /* check auto negotiation is complete */
3133 if (!(mii_status & BMSR_ANEGCOMPLETE)) {
3134 /* still in autonegotiation - configure nic for 10 MBit HD and wait. */
3135 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
3136 newdup = 0;
3137 retval = 0;
Joe Perches6b808582010-11-29 07:41:53 +00003138 netdev_dbg(dev,
3139 "autoneg not completed - falling back to 10HD\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003140 goto set_speed;
3141 }
3142
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003143 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
3144 lpa = mii_rw(dev, np->phyaddr, MII_LPA, MII_READ);
Joe Perches6b808582010-11-29 07:41:53 +00003145 netdev_dbg(dev, "%s: PHY advertises 0x%04x, lpa 0x%04x\n",
3146 __func__, adv, lpa);
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003147
Linus Torvalds1da177e2005-04-16 15:20:36 -07003148 retval = 1;
3149 if (np->gigabit == PHY_GIGABIT) {
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003150 control_1000 = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ);
3151 status_1000 = mii_rw(dev, np->phyaddr, MII_STAT1000, MII_READ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003152
3153 if ((control_1000 & ADVERTISE_1000FULL) &&
3154 (status_1000 & LPA_1000FULL)) {
Joe Perches6b808582010-11-29 07:41:53 +00003155 netdev_dbg(dev, "%s: GBit ethernet detected\n",
3156 __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003157 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_1000;
3158 newdup = 1;
3159 goto set_speed;
3160 }
3161 }
3162
Linus Torvalds1da177e2005-04-16 15:20:36 -07003163 /* FIXME: handle parallel detection properly */
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003164 adv_lpa = lpa & adv;
3165 if (adv_lpa & LPA_100FULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003166 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100;
3167 newdup = 1;
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003168 } else if (adv_lpa & LPA_100HALF) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003169 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100;
3170 newdup = 0;
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003171 } else if (adv_lpa & LPA_10FULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003172 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
3173 newdup = 1;
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003174 } else if (adv_lpa & LPA_10HALF) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003175 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
3176 newdup = 0;
3177 } else {
Joe Perches6b808582010-11-29 07:41:53 +00003178 netdev_dbg(dev, "bad ability %04x - falling back to 10HD\n",
3179 adv_lpa);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003180 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
3181 newdup = 0;
3182 }
3183
3184set_speed:
3185 if (np->duplex == newdup && np->linkspeed == newls)
3186 return retval;
3187
Joe Perchesf52dafc2010-11-29 07:41:55 +00003188 netdev_dbg(dev, "changing link setting from %d/%d to %d/%d\n",
3189 np->linkspeed, np->duplex, newls, newdup);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003190
3191 np->duplex = newdup;
3192 np->linkspeed = newls;
3193
Ayaz Abdullab2976d22008-02-04 15:13:59 -05003194 /* The transmitter and receiver must be restarted for safe update */
3195 if (readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_START) {
3196 txrxFlags |= NV_RESTART_TX;
3197 nv_stop_tx(dev);
3198 }
3199 if (readl(base + NvRegReceiverControl) & NVREG_RCVCTL_START) {
3200 txrxFlags |= NV_RESTART_RX;
3201 nv_stop_rx(dev);
3202 }
3203
Linus Torvalds1da177e2005-04-16 15:20:36 -07003204 if (np->gigabit == PHY_GIGABIT) {
Ayaz Abdullaa4336862008-04-18 13:50:43 -07003205 phyreg = readl(base + NvRegSlotTime);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003206 phyreg &= ~(0x3FF00);
Ayaz Abdullaa4336862008-04-18 13:50:43 -07003207 if (((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_10) ||
3208 ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_100))
3209 phyreg |= NVREG_SLOTTIME_10_100_FULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003210 else if ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_1000)
Ayaz Abdullaa4336862008-04-18 13:50:43 -07003211 phyreg |= NVREG_SLOTTIME_1000_FULL;
3212 writel(phyreg, base + NvRegSlotTime);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003213 }
3214
3215 phyreg = readl(base + NvRegPhyInterface);
3216 phyreg &= ~(PHY_HALF|PHY_100|PHY_1000);
3217 if (np->duplex == 0)
3218 phyreg |= PHY_HALF;
3219 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_100)
3220 phyreg |= PHY_100;
3221 else if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_1000)
3222 phyreg |= PHY_1000;
3223 writel(phyreg, base + NvRegPhyInterface);
3224
Ayaz Abdullafd9b5582008-02-05 12:29:49 -05003225 phy_exp = mii_rw(dev, np->phyaddr, MII_EXPANSION, MII_READ) & EXPANSION_NWAY; /* autoneg capable */
Ayaz Abdulla9744e212006-07-06 16:45:58 -04003226 if (phyreg & PHY_RGMII) {
Ayaz Abdullafd9b5582008-02-05 12:29:49 -05003227 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_1000) {
Ayaz Abdulla9744e212006-07-06 16:45:58 -04003228 txreg = NVREG_TX_DEFERRAL_RGMII_1000;
Ayaz Abdullafd9b5582008-02-05 12:29:49 -05003229 } else {
3230 if (!phy_exp && !np->duplex && (np->driver_data & DEV_HAS_COLLISION_FIX)) {
3231 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_10)
3232 txreg = NVREG_TX_DEFERRAL_RGMII_STRETCH_10;
3233 else
3234 txreg = NVREG_TX_DEFERRAL_RGMII_STRETCH_100;
3235 } else {
3236 txreg = NVREG_TX_DEFERRAL_RGMII_10_100;
3237 }
3238 }
Ayaz Abdulla9744e212006-07-06 16:45:58 -04003239 } else {
Ayaz Abdullafd9b5582008-02-05 12:29:49 -05003240 if (!phy_exp && !np->duplex && (np->driver_data & DEV_HAS_COLLISION_FIX))
3241 txreg = NVREG_TX_DEFERRAL_MII_STRETCH;
3242 else
3243 txreg = NVREG_TX_DEFERRAL_DEFAULT;
Ayaz Abdulla9744e212006-07-06 16:45:58 -04003244 }
3245 writel(txreg, base + NvRegTxDeferral);
3246
Ayaz Abdulla95d161c2006-07-06 16:46:25 -04003247 if (np->desc_ver == DESC_VER_1) {
3248 txreg = NVREG_TX_WM_DESC1_DEFAULT;
3249 } else {
3250 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_1000)
3251 txreg = NVREG_TX_WM_DESC2_3_1000;
3252 else
3253 txreg = NVREG_TX_WM_DESC2_3_DEFAULT;
3254 }
3255 writel(txreg, base + NvRegTxWatermark);
3256
Szymon Janc78aea4f2010-11-27 08:39:43 +00003257 writel(NVREG_MISC1_FORCE | (np->duplex ? 0 : NVREG_MISC1_HD),
Linus Torvalds1da177e2005-04-16 15:20:36 -07003258 base + NvRegMisc1);
3259 pci_push(base);
3260 writel(np->linkspeed, base + NvRegLinkSpeed);
3261 pci_push(base);
3262
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003263 pause_flags = 0;
3264 /* setup pause frame */
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003265 if (np->duplex != 0) {
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003266 if (np->autoneg && np->pause_flags & NV_PAUSEFRAME_AUTONEG) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00003267 adv_pause = adv & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
3268 lpa_pause = lpa & (LPA_PAUSE_CAP | LPA_PAUSE_ASYM);
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003269
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003270 switch (adv_pause) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07003271 case ADVERTISE_PAUSE_CAP:
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003272 if (lpa_pause & LPA_PAUSE_CAP) {
3273 pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
3274 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ)
3275 pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
3276 }
3277 break;
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07003278 case ADVERTISE_PAUSE_ASYM:
Szymon Janc78aea4f2010-11-27 08:39:43 +00003279 if (lpa_pause == (LPA_PAUSE_CAP | LPA_PAUSE_ASYM))
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003280 pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003281 break;
Szymon Janc78aea4f2010-11-27 08:39:43 +00003282 case ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM:
3283 if (lpa_pause & LPA_PAUSE_CAP) {
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003284 pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
3285 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ)
3286 pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
3287 }
3288 if (lpa_pause == LPA_PAUSE_ASYM)
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003289 pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003290 break;
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003291 }
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003292 } else {
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003293 pause_flags = np->pause_flags;
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003294 }
3295 }
Ayaz Abdullab6d07732006-06-10 22:47:42 -04003296 nv_update_pause(dev, pause_flags);
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04003297
Ayaz Abdullab2976d22008-02-04 15:13:59 -05003298 if (txrxFlags & NV_RESTART_TX)
3299 nv_start_tx(dev);
3300 if (txrxFlags & NV_RESTART_RX)
3301 nv_start_rx(dev);
3302
Linus Torvalds1da177e2005-04-16 15:20:36 -07003303 return retval;
3304}
3305
3306static void nv_linkchange(struct net_device *dev)
3307{
3308 if (nv_update_linkspeed(dev)) {
Ayaz Abdulla4ea7f292005-11-11 08:29:59 -05003309 if (!netif_carrier_ok(dev)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003310 netif_carrier_on(dev);
3311 printk(KERN_INFO "%s: link up.\n", dev->name);
Ayaz Abdulla88d7d8b2009-05-01 01:41:50 +00003312 nv_txrx_gate(dev, false);
Ayaz Abdulla4ea7f292005-11-11 08:29:59 -05003313 nv_start_rx(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003314 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003315 } else {
3316 if (netif_carrier_ok(dev)) {
3317 netif_carrier_off(dev);
3318 printk(KERN_INFO "%s: link down.\n", dev->name);
Ayaz Abdulla88d7d8b2009-05-01 01:41:50 +00003319 nv_txrx_gate(dev, true);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003320 nv_stop_rx(dev);
3321 }
3322 }
3323}
3324
3325static void nv_link_irq(struct net_device *dev)
3326{
3327 u8 __iomem *base = get_hwbase(dev);
3328 u32 miistat;
3329
3330 miistat = readl(base + NvRegMIIStatus);
Ayaz Abdullaeb798422008-02-04 15:14:04 -05003331 writel(NVREG_MIISTAT_LINKCHANGE, base + NvRegMIIStatus);
Joe Perchesf52dafc2010-11-29 07:41:55 +00003332 netdev_dbg(dev, "link change irq, status 0x%x\n", miistat);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003333
3334 if (miistat & (NVREG_MIISTAT_LINKCHANGE))
3335 nv_linkchange(dev);
Joe Perches6b808582010-11-29 07:41:53 +00003336 netdev_dbg(dev, "link change notification done\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003337}
3338
Ayaz Abdulla4db0ee172008-06-09 16:51:06 -07003339static void nv_msi_workaround(struct fe_priv *np)
3340{
3341
3342 /* Need to toggle the msi irq mask within the ethernet device,
3343 * otherwise, future interrupts will not be detected.
3344 */
3345 if (np->msi_flags & NV_MSI_ENABLED) {
3346 u8 __iomem *base = np->base;
3347
3348 writel(0, base + NvRegMSIIrqMask);
3349 writel(NVREG_MSI_VECTOR_0_ENABLED, base + NvRegMSIIrqMask);
3350 }
3351}
3352
Ayaz Abdulla4145ade2009-03-05 08:02:26 +00003353static inline int nv_change_interrupt_mode(struct net_device *dev, int total_work)
3354{
3355 struct fe_priv *np = netdev_priv(dev);
3356
3357 if (optimization_mode == NV_OPTIMIZATION_MODE_DYNAMIC) {
3358 if (total_work > NV_DYNAMIC_THRESHOLD) {
3359 /* transition to poll based interrupts */
3360 np->quiet_count = 0;
3361 if (np->irqmask != NVREG_IRQMASK_CPU) {
3362 np->irqmask = NVREG_IRQMASK_CPU;
3363 return 1;
3364 }
3365 } else {
3366 if (np->quiet_count < NV_DYNAMIC_MAX_QUIET_COUNT) {
3367 np->quiet_count++;
3368 } else {
3369 /* reached a period of low activity, switch
3370 to per tx/rx packet interrupts */
3371 if (np->irqmask != NVREG_IRQMASK_THROUGHPUT) {
3372 np->irqmask = NVREG_IRQMASK_THROUGHPUT;
3373 return 1;
3374 }
3375 }
3376 }
3377 }
3378 return 0;
3379}
3380
David Howells7d12e782006-10-05 14:55:46 +01003381static irqreturn_t nv_nic_irq(int foo, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003382{
3383 struct net_device *dev = (struct net_device *) data;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04003384 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003385 u8 __iomem *base = get_hwbase(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003386
Joe Perches6b808582010-11-29 07:41:53 +00003387 netdev_dbg(dev, "%s\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003388
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003389 if (!(np->msi_flags & NV_MSI_X_ENABLED)) {
3390 np->events = readl(base + NvRegIrqStatus);
Ayaz Abdulla1b2bb762009-03-05 08:02:34 +00003391 writel(np->events, base + NvRegIrqStatus);
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003392 } else {
3393 np->events = readl(base + NvRegMSIXIrqStatus);
Ayaz Abdulla1b2bb762009-03-05 08:02:34 +00003394 writel(np->events, base + NvRegMSIXIrqStatus);
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003395 }
Joe Perches6b808582010-11-29 07:41:53 +00003396 netdev_dbg(dev, "irq: %08x\n", np->events);
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003397 if (!(np->events & np->irqmask))
3398 return IRQ_NONE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003399
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003400 nv_msi_workaround(np);
Ayaz Abdulla4db0ee172008-06-09 16:51:06 -07003401
Eric Dumazet78c29bd2009-07-02 04:04:45 +00003402 if (napi_schedule_prep(&np->napi)) {
3403 /*
3404 * Disable further irq's (msix not enabled with napi)
3405 */
3406 writel(0, base + NvRegIrqMask);
3407 __napi_schedule(&np->napi);
3408 }
Ayaz Abdullaf27e6f32009-03-05 08:02:14 +00003409
Joe Perches6b808582010-11-29 07:41:53 +00003410 netdev_dbg(dev, "%s: completed\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003411
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003412 return IRQ_HANDLED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003413}
3414
Ayaz Abdullaf0734ab2007-01-21 18:10:57 -05003415/**
3416 * All _optimized functions are used to help increase performance
3417 * (reduce CPU and increase throughput). They use descripter version 3,
3418 * compiler directives, and reduce memory accesses.
3419 */
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003420static irqreturn_t nv_nic_irq_optimized(int foo, void *data)
3421{
3422 struct net_device *dev = (struct net_device *) data;
3423 struct fe_priv *np = netdev_priv(dev);
3424 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003425
Joe Perches6b808582010-11-29 07:41:53 +00003426 netdev_dbg(dev, "%s\n", __func__);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003427
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003428 if (!(np->msi_flags & NV_MSI_X_ENABLED)) {
3429 np->events = readl(base + NvRegIrqStatus);
Ayaz Abdulla1b2bb762009-03-05 08:02:34 +00003430 writel(np->events, base + NvRegIrqStatus);
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003431 } else {
3432 np->events = readl(base + NvRegMSIXIrqStatus);
Ayaz Abdulla1b2bb762009-03-05 08:02:34 +00003433 writel(np->events, base + NvRegMSIXIrqStatus);
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003434 }
Joe Perches6b808582010-11-29 07:41:53 +00003435 netdev_dbg(dev, "irq: %08x\n", np->events);
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003436 if (!(np->events & np->irqmask))
3437 return IRQ_NONE;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003438
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003439 nv_msi_workaround(np);
Ayaz Abdulla4db0ee172008-06-09 16:51:06 -07003440
Eric Dumazet78c29bd2009-07-02 04:04:45 +00003441 if (napi_schedule_prep(&np->napi)) {
3442 /*
3443 * Disable further irq's (msix not enabled with napi)
3444 */
3445 writel(0, base + NvRegIrqMask);
3446 __napi_schedule(&np->napi);
3447 }
Joe Perches6b808582010-11-29 07:41:53 +00003448 netdev_dbg(dev, "%s: completed\n", __func__);
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003449
Ayaz Abdullab67874a2009-03-05 08:02:22 +00003450 return IRQ_HANDLED;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003451}
3452
David Howells7d12e782006-10-05 14:55:46 +01003453static irqreturn_t nv_nic_irq_tx(int foo, void *data)
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003454{
3455 struct net_device *dev = (struct net_device *) data;
3456 struct fe_priv *np = netdev_priv(dev);
3457 u8 __iomem *base = get_hwbase(dev);
3458 u32 events;
3459 int i;
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003460 unsigned long flags;
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003461
Joe Perches6b808582010-11-29 07:41:53 +00003462 netdev_dbg(dev, "%s\n", __func__);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003463
Szymon Janc78aea4f2010-11-27 08:39:43 +00003464 for (i = 0;; i++) {
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003465 events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQ_TX_ALL;
3466 writel(NVREG_IRQ_TX_ALL, base + NvRegMSIXIrqStatus);
Joe Perches6b808582010-11-29 07:41:53 +00003467 netdev_dbg(dev, "tx irq: %08x\n", events);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003468 if (!(events & np->irqmask))
3469 break;
3470
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003471 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdulla4e16ed12007-01-23 12:00:56 -05003472 nv_tx_done_optimized(dev, TX_WORK_PER_LOOP);
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003473 spin_unlock_irqrestore(&np->lock, flags);
Jeff Garzikf3b197a2006-05-26 21:39:03 -04003474
Ayaz Abdullaf0734ab2007-01-21 18:10:57 -05003475 if (unlikely(i > max_interrupt_work)) {
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003476 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003477 /* disable interrupts on the nic */
3478 writel(NVREG_IRQ_TX_ALL, base + NvRegIrqMask);
3479 pci_push(base);
3480
3481 if (!np->in_shutdown) {
3482 np->nic_poll_irq |= NVREG_IRQ_TX_ALL;
3483 mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
3484 }
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003485 spin_unlock_irqrestore(&np->lock, flags);
Timo Jantunen1a2b7332007-08-14 21:56:57 +03003486 printk(KERN_DEBUG "%s: too many iterations (%d) in nv_nic_irq_tx.\n", dev->name, i);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003487 break;
3488 }
3489
3490 }
Joe Perches6b808582010-11-29 07:41:53 +00003491 netdev_dbg(dev, "%s: completed\n", __func__);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003492
3493 return IRQ_RETVAL(i);
3494}
3495
Stephen Hemmingerbea33482007-10-03 16:41:36 -07003496static int nv_napi_poll(struct napi_struct *napi, int budget)
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07003497{
Stephen Hemmingerbea33482007-10-03 16:41:36 -07003498 struct fe_priv *np = container_of(napi, struct fe_priv, napi);
3499 struct net_device *dev = np->dev;
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07003500 u8 __iomem *base = get_hwbase(dev);
Francois Romieud15e9c42006-12-17 23:03:15 +01003501 unsigned long flags;
Ayaz Abdulla4145ade2009-03-05 08:02:26 +00003502 int retcode;
Szymon Janc78aea4f2010-11-27 08:39:43 +00003503 int rx_count, tx_work = 0, rx_work = 0;
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07003504
stephen hemminger81a2e362010-04-28 08:25:28 +00003505 do {
3506 if (!nv_optimized(np)) {
3507 spin_lock_irqsave(&np->lock, flags);
3508 tx_work += nv_tx_done(dev, np->tx_ring_size);
3509 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdullaf27e6f32009-03-05 08:02:14 +00003510
Tom Herbertd951f722010-05-05 18:15:21 +00003511 rx_count = nv_rx_process(dev, budget - rx_work);
stephen hemminger81a2e362010-04-28 08:25:28 +00003512 retcode = nv_alloc_rx(dev);
3513 } else {
3514 spin_lock_irqsave(&np->lock, flags);
3515 tx_work += nv_tx_done_optimized(dev, np->tx_ring_size);
3516 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdullaf27e6f32009-03-05 08:02:14 +00003517
Tom Herbertd951f722010-05-05 18:15:21 +00003518 rx_count = nv_rx_process_optimized(dev,
3519 budget - rx_work);
stephen hemminger81a2e362010-04-28 08:25:28 +00003520 retcode = nv_alloc_rx_optimized(dev);
3521 }
3522 } while (retcode == 0 &&
3523 rx_count > 0 && (rx_work += rx_count) < budget);
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07003524
Ayaz Abdullae0379a12007-02-20 03:34:30 -05003525 if (retcode) {
Francois Romieud15e9c42006-12-17 23:03:15 +01003526 spin_lock_irqsave(&np->lock, flags);
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07003527 if (!np->in_shutdown)
3528 mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
Francois Romieud15e9c42006-12-17 23:03:15 +01003529 spin_unlock_irqrestore(&np->lock, flags);
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07003530 }
3531
Ayaz Abdulla4145ade2009-03-05 08:02:26 +00003532 nv_change_interrupt_mode(dev, tx_work + rx_work);
3533
Ayaz Abdullaf27e6f32009-03-05 08:02:14 +00003534 if (unlikely(np->events & NVREG_IRQ_LINK)) {
3535 spin_lock_irqsave(&np->lock, flags);
3536 nv_link_irq(dev);
3537 spin_unlock_irqrestore(&np->lock, flags);
3538 }
3539 if (unlikely(np->need_linktimer && time_after(jiffies, np->link_timeout))) {
3540 spin_lock_irqsave(&np->lock, flags);
3541 nv_linkchange(dev);
3542 spin_unlock_irqrestore(&np->lock, flags);
3543 np->link_timeout = jiffies + LINK_TIMEOUT;
3544 }
3545 if (unlikely(np->events & NVREG_IRQ_RECOVER_ERROR)) {
3546 spin_lock_irqsave(&np->lock, flags);
3547 if (!np->in_shutdown) {
3548 np->nic_poll_irq = np->irqmask;
3549 np->recover_error = 1;
3550 mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
3551 }
3552 spin_unlock_irqrestore(&np->lock, flags);
David S. Miller6c2da9c2009-04-09 01:09:33 -07003553 napi_complete(napi);
Ayaz Abdulla4145ade2009-03-05 08:02:26 +00003554 return rx_work;
Ayaz Abdullaf27e6f32009-03-05 08:02:14 +00003555 }
3556
Ayaz Abdulla4145ade2009-03-05 08:02:26 +00003557 if (rx_work < budget) {
Ayaz Abdullaf27e6f32009-03-05 08:02:14 +00003558 /* re-enable interrupts
3559 (msix not enabled in napi) */
David S. Miller6c2da9c2009-04-09 01:09:33 -07003560 napi_complete(napi);
Stephen Hemmingerbea33482007-10-03 16:41:36 -07003561
Ayaz Abdullaf27e6f32009-03-05 08:02:14 +00003562 writel(np->irqmask, base + NvRegIrqMask);
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07003563 }
Ayaz Abdulla4145ade2009-03-05 08:02:26 +00003564 return rx_work;
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07003565}
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07003566
David Howells7d12e782006-10-05 14:55:46 +01003567static irqreturn_t nv_nic_irq_rx(int foo, void *data)
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003568{
3569 struct net_device *dev = (struct net_device *) data;
3570 struct fe_priv *np = netdev_priv(dev);
3571 u8 __iomem *base = get_hwbase(dev);
3572 u32 events;
3573 int i;
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003574 unsigned long flags;
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003575
Joe Perches6b808582010-11-29 07:41:53 +00003576 netdev_dbg(dev, "%s\n", __func__);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003577
Szymon Janc78aea4f2010-11-27 08:39:43 +00003578 for (i = 0;; i++) {
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003579 events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQ_RX_ALL;
3580 writel(NVREG_IRQ_RX_ALL, base + NvRegMSIXIrqStatus);
Joe Perches6b808582010-11-29 07:41:53 +00003581 netdev_dbg(dev, "rx irq: %08x\n", events);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003582 if (!(events & np->irqmask))
3583 break;
Jeff Garzikf3b197a2006-05-26 21:39:03 -04003584
Stephen Hemmingerbea33482007-10-03 16:41:36 -07003585 if (nv_rx_process_optimized(dev, RX_WORK_PER_LOOP)) {
Ayaz Abdullaf0734ab2007-01-21 18:10:57 -05003586 if (unlikely(nv_alloc_rx_optimized(dev))) {
3587 spin_lock_irqsave(&np->lock, flags);
3588 if (!np->in_shutdown)
3589 mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
3590 spin_unlock_irqrestore(&np->lock, flags);
3591 }
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003592 }
Jeff Garzikf3b197a2006-05-26 21:39:03 -04003593
Ayaz Abdullaf0734ab2007-01-21 18:10:57 -05003594 if (unlikely(i > max_interrupt_work)) {
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003595 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003596 /* disable interrupts on the nic */
3597 writel(NVREG_IRQ_RX_ALL, base + NvRegIrqMask);
3598 pci_push(base);
3599
3600 if (!np->in_shutdown) {
3601 np->nic_poll_irq |= NVREG_IRQ_RX_ALL;
3602 mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
3603 }
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003604 spin_unlock_irqrestore(&np->lock, flags);
Timo Jantunen1a2b7332007-08-14 21:56:57 +03003605 printk(KERN_DEBUG "%s: too many iterations (%d) in nv_nic_irq_rx.\n", dev->name, i);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003606 break;
3607 }
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003608 }
Joe Perches6b808582010-11-29 07:41:53 +00003609 netdev_dbg(dev, "%s: completed\n", __func__);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003610
3611 return IRQ_RETVAL(i);
3612}
3613
David Howells7d12e782006-10-05 14:55:46 +01003614static irqreturn_t nv_nic_irq_other(int foo, void *data)
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003615{
3616 struct net_device *dev = (struct net_device *) data;
3617 struct fe_priv *np = netdev_priv(dev);
3618 u8 __iomem *base = get_hwbase(dev);
3619 u32 events;
3620 int i;
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003621 unsigned long flags;
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003622
Joe Perches6b808582010-11-29 07:41:53 +00003623 netdev_dbg(dev, "%s\n", __func__);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003624
Szymon Janc78aea4f2010-11-27 08:39:43 +00003625 for (i = 0;; i++) {
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003626 events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQ_OTHER;
3627 writel(NVREG_IRQ_OTHER, base + NvRegMSIXIrqStatus);
Joe Perches6b808582010-11-29 07:41:53 +00003628 netdev_dbg(dev, "irq: %08x\n", events);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003629 if (!(events & np->irqmask))
3630 break;
Jeff Garzikf3b197a2006-05-26 21:39:03 -04003631
Ayaz Abdulla4e16ed12007-01-23 12:00:56 -05003632 /* check tx in case we reached max loop limit in tx isr */
3633 spin_lock_irqsave(&np->lock, flags);
3634 nv_tx_done_optimized(dev, TX_WORK_PER_LOOP);
3635 spin_unlock_irqrestore(&np->lock, flags);
3636
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003637 if (events & NVREG_IRQ_LINK) {
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003638 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003639 nv_link_irq(dev);
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003640 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003641 }
3642 if (np->need_linktimer && time_after(jiffies, np->link_timeout)) {
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003643 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003644 nv_linkchange(dev);
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003645 spin_unlock_irqrestore(&np->lock, flags);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003646 np->link_timeout = jiffies + LINK_TIMEOUT;
3647 }
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003648 if (events & NVREG_IRQ_RECOVER_ERROR) {
3649 spin_lock_irq(&np->lock);
3650 /* disable interrupts on the nic */
3651 writel(NVREG_IRQ_OTHER, base + NvRegIrqMask);
3652 pci_push(base);
3653
3654 if (!np->in_shutdown) {
3655 np->nic_poll_irq |= NVREG_IRQ_OTHER;
3656 np->recover_error = 1;
3657 mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
3658 }
3659 spin_unlock_irq(&np->lock);
3660 break;
3661 }
Ayaz Abdullaf0734ab2007-01-21 18:10:57 -05003662 if (unlikely(i > max_interrupt_work)) {
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003663 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003664 /* disable interrupts on the nic */
3665 writel(NVREG_IRQ_OTHER, base + NvRegIrqMask);
3666 pci_push(base);
3667
3668 if (!np->in_shutdown) {
3669 np->nic_poll_irq |= NVREG_IRQ_OTHER;
3670 mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
3671 }
Peter Zijlstra0a07bc62006-09-19 14:55:22 +02003672 spin_unlock_irqrestore(&np->lock, flags);
Timo Jantunen1a2b7332007-08-14 21:56:57 +03003673 printk(KERN_DEBUG "%s: too many iterations (%d) in nv_nic_irq_other.\n", dev->name, i);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003674 break;
3675 }
3676
3677 }
Joe Perches6b808582010-11-29 07:41:53 +00003678 netdev_dbg(dev, "%s: completed\n", __func__);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003679
3680 return IRQ_RETVAL(i);
3681}
3682
David Howells7d12e782006-10-05 14:55:46 +01003683static irqreturn_t nv_nic_irq_test(int foo, void *data)
Ayaz Abdulla9589c772006-06-10 22:48:13 -04003684{
3685 struct net_device *dev = (struct net_device *) data;
3686 struct fe_priv *np = netdev_priv(dev);
3687 u8 __iomem *base = get_hwbase(dev);
3688 u32 events;
3689
Joe Perches6b808582010-11-29 07:41:53 +00003690 netdev_dbg(dev, "%s\n", __func__);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04003691
3692 if (!(np->msi_flags & NV_MSI_X_ENABLED)) {
3693 events = readl(base + NvRegIrqStatus) & NVREG_IRQSTAT_MASK;
3694 writel(NVREG_IRQ_TIMER, base + NvRegIrqStatus);
3695 } else {
3696 events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQSTAT_MASK;
3697 writel(NVREG_IRQ_TIMER, base + NvRegMSIXIrqStatus);
3698 }
3699 pci_push(base);
Joe Perches6b808582010-11-29 07:41:53 +00003700 netdev_dbg(dev, "irq: %08x\n", events);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04003701 if (!(events & NVREG_IRQ_TIMER))
3702 return IRQ_RETVAL(0);
3703
Ayaz Abdulla4db0ee172008-06-09 16:51:06 -07003704 nv_msi_workaround(np);
3705
Ayaz Abdulla9589c772006-06-10 22:48:13 -04003706 spin_lock(&np->lock);
3707 np->intr_test = 1;
3708 spin_unlock(&np->lock);
3709
Joe Perches6b808582010-11-29 07:41:53 +00003710 netdev_dbg(dev, "%s: completed\n", __func__);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04003711
3712 return IRQ_RETVAL(1);
3713}
3714
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003715static void set_msix_vector_map(struct net_device *dev, u32 vector, u32 irqmask)
3716{
3717 u8 __iomem *base = get_hwbase(dev);
3718 int i;
3719 u32 msixmap = 0;
3720
3721 /* Each interrupt bit can be mapped to a MSIX vector (4 bits).
3722 * MSIXMap0 represents the first 8 interrupts and MSIXMap1 represents
3723 * the remaining 8 interrupts.
3724 */
3725 for (i = 0; i < 8; i++) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00003726 if ((irqmask >> i) & 0x1)
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003727 msixmap |= vector << (i << 2);
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003728 }
3729 writel(readl(base + NvRegMSIXMap0) | msixmap, base + NvRegMSIXMap0);
3730
3731 msixmap = 0;
3732 for (i = 0; i < 8; i++) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00003733 if ((irqmask >> (i + 8)) & 0x1)
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003734 msixmap |= vector << (i << 2);
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003735 }
3736 writel(readl(base + NvRegMSIXMap1) | msixmap, base + NvRegMSIXMap1);
3737}
3738
Ayaz Abdulla9589c772006-06-10 22:48:13 -04003739static int nv_request_irq(struct net_device *dev, int intr_test)
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003740{
3741 struct fe_priv *np = get_nvpriv(dev);
3742 u8 __iomem *base = get_hwbase(dev);
3743 int ret = 1;
3744 int i;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003745 irqreturn_t (*handler)(int foo, void *data);
3746
3747 if (intr_test) {
3748 handler = nv_nic_irq_test;
3749 } else {
Jeff Garzik36b30ea2007-10-16 01:40:30 -04003750 if (nv_optimized(np))
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003751 handler = nv_nic_irq_optimized;
3752 else
3753 handler = nv_nic_irq;
3754 }
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003755
3756 if (np->msi_flags & NV_MSI_X_CAPABLE) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00003757 for (i = 0; i < (np->msi_flags & NV_MSI_X_VECTORS_MASK); i++)
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003758 np->msi_x_entry[i].entry = i;
Szymon Janc34cf97e2010-11-27 08:39:46 +00003759 ret = pci_enable_msix(np->pci_dev, np->msi_x_entry, (np->msi_flags & NV_MSI_X_VECTORS_MASK));
3760 if (ret == 0) {
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003761 np->msi_flags |= NV_MSI_X_ENABLED;
Ayaz Abdulla9589c772006-06-10 22:48:13 -04003762 if (optimization_mode == NV_OPTIMIZATION_MODE_THROUGHPUT && !intr_test) {
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003763 /* Request irq for rx handling */
Yinghai Luddb213f2009-02-06 01:29:23 -08003764 sprintf(np->name_rx, "%s-rx", dev->name);
3765 if (request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector,
Joe Perchesa0607fd2009-11-18 23:29:17 -08003766 nv_nic_irq_rx, IRQF_SHARED, np->name_rx, dev) != 0) {
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003767 printk(KERN_INFO "forcedeth: request_irq failed for rx %d\n", ret);
3768 pci_disable_msix(np->pci_dev);
3769 np->msi_flags &= ~NV_MSI_X_ENABLED;
3770 goto out_err;
3771 }
3772 /* Request irq for tx handling */
Yinghai Luddb213f2009-02-06 01:29:23 -08003773 sprintf(np->name_tx, "%s-tx", dev->name);
3774 if (request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector,
Joe Perchesa0607fd2009-11-18 23:29:17 -08003775 nv_nic_irq_tx, IRQF_SHARED, np->name_tx, dev) != 0) {
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003776 printk(KERN_INFO "forcedeth: request_irq failed for tx %d\n", ret);
3777 pci_disable_msix(np->pci_dev);
3778 np->msi_flags &= ~NV_MSI_X_ENABLED;
3779 goto out_free_rx;
3780 }
3781 /* Request irq for link and timer handling */
Yinghai Luddb213f2009-02-06 01:29:23 -08003782 sprintf(np->name_other, "%s-other", dev->name);
3783 if (request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector,
Joe Perchesa0607fd2009-11-18 23:29:17 -08003784 nv_nic_irq_other, IRQF_SHARED, np->name_other, dev) != 0) {
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003785 printk(KERN_INFO "forcedeth: request_irq failed for link %d\n", ret);
3786 pci_disable_msix(np->pci_dev);
3787 np->msi_flags &= ~NV_MSI_X_ENABLED;
3788 goto out_free_tx;
3789 }
3790 /* map interrupts to their respective vector */
3791 writel(0, base + NvRegMSIXMap0);
3792 writel(0, base + NvRegMSIXMap1);
3793 set_msix_vector_map(dev, NV_MSI_X_VECTOR_RX, NVREG_IRQ_RX_ALL);
3794 set_msix_vector_map(dev, NV_MSI_X_VECTOR_TX, NVREG_IRQ_TX_ALL);
3795 set_msix_vector_map(dev, NV_MSI_X_VECTOR_OTHER, NVREG_IRQ_OTHER);
3796 } else {
3797 /* Request irq for all interrupts */
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003798 if (request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector, handler, IRQF_SHARED, dev->name, dev) != 0) {
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003799 printk(KERN_INFO "forcedeth: request_irq failed %d\n", ret);
3800 pci_disable_msix(np->pci_dev);
3801 np->msi_flags &= ~NV_MSI_X_ENABLED;
3802 goto out_err;
3803 }
3804
3805 /* map interrupts to vector 0 */
3806 writel(0, base + NvRegMSIXMap0);
3807 writel(0, base + NvRegMSIXMap1);
3808 }
3809 }
3810 }
3811 if (ret != 0 && np->msi_flags & NV_MSI_CAPABLE) {
Szymon Janc34cf97e2010-11-27 08:39:46 +00003812 ret = pci_enable_msi(np->pci_dev);
3813 if (ret == 0) {
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003814 np->msi_flags |= NV_MSI_ENABLED;
Manfred Spraula7475902007-10-17 21:52:33 +02003815 dev->irq = np->pci_dev->irq;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003816 if (request_irq(np->pci_dev->irq, handler, IRQF_SHARED, dev->name, dev) != 0) {
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003817 printk(KERN_INFO "forcedeth: request_irq failed %d\n", ret);
3818 pci_disable_msi(np->pci_dev);
3819 np->msi_flags &= ~NV_MSI_ENABLED;
Manfred Spraula7475902007-10-17 21:52:33 +02003820 dev->irq = np->pci_dev->irq;
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003821 goto out_err;
3822 }
3823
3824 /* map interrupts to vector 0 */
3825 writel(0, base + NvRegMSIMap0);
3826 writel(0, base + NvRegMSIMap1);
3827 /* enable msi vector 0 */
3828 writel(NVREG_MSI_VECTOR_0_ENABLED, base + NvRegMSIIrqMask);
3829 }
3830 }
3831 if (ret != 0) {
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05003832 if (request_irq(np->pci_dev->irq, handler, IRQF_SHARED, dev->name, dev) != 0)
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003833 goto out_err;
Ayaz Abdulla9589c772006-06-10 22:48:13 -04003834
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003835 }
3836
3837 return 0;
3838out_free_tx:
3839 free_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector, dev);
3840out_free_rx:
3841 free_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector, dev);
3842out_err:
3843 return 1;
3844}
3845
3846static void nv_free_irq(struct net_device *dev)
3847{
3848 struct fe_priv *np = get_nvpriv(dev);
3849 int i;
3850
3851 if (np->msi_flags & NV_MSI_X_ENABLED) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00003852 for (i = 0; i < (np->msi_flags & NV_MSI_X_VECTORS_MASK); i++)
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003853 free_irq(np->msi_x_entry[i].vector, dev);
Ayaz Abdulla7a1854b2006-06-10 22:48:08 -04003854 pci_disable_msix(np->pci_dev);
3855 np->msi_flags &= ~NV_MSI_X_ENABLED;
3856 } else {
3857 free_irq(np->pci_dev->irq, dev);
3858 if (np->msi_flags & NV_MSI_ENABLED) {
3859 pci_disable_msi(np->pci_dev);
3860 np->msi_flags &= ~NV_MSI_ENABLED;
3861 }
3862 }
3863}
3864
Linus Torvalds1da177e2005-04-16 15:20:36 -07003865static void nv_do_nic_poll(unsigned long data)
3866{
3867 struct net_device *dev = (struct net_device *) data;
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04003868 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003869 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003870 u32 mask = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003871
Linus Torvalds1da177e2005-04-16 15:20:36 -07003872 /*
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003873 * First disable irq(s) and then
Linus Torvalds1da177e2005-04-16 15:20:36 -07003874 * reenable interrupts on the nic, we have to do this before calling
3875 * nv_nic_irq because that may decide to do otherwise
3876 */
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003877
Ayaz Abdulla84b39322006-05-20 14:59:48 -07003878 if (!using_multi_irqs(dev)) {
3879 if (np->msi_flags & NV_MSI_X_ENABLED)
Ingo Molnar8688cfc2006-07-03 00:25:39 -07003880 disable_irq_lockdep(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector);
Ayaz Abdulla84b39322006-05-20 14:59:48 -07003881 else
Manfred Spraula7475902007-10-17 21:52:33 +02003882 disable_irq_lockdep(np->pci_dev->irq);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003883 mask = np->irqmask;
3884 } else {
3885 if (np->nic_poll_irq & NVREG_IRQ_RX_ALL) {
Ingo Molnar8688cfc2006-07-03 00:25:39 -07003886 disable_irq_lockdep(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003887 mask |= NVREG_IRQ_RX_ALL;
3888 }
3889 if (np->nic_poll_irq & NVREG_IRQ_TX_ALL) {
Ingo Molnar8688cfc2006-07-03 00:25:39 -07003890 disable_irq_lockdep(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003891 mask |= NVREG_IRQ_TX_ALL;
3892 }
3893 if (np->nic_poll_irq & NVREG_IRQ_OTHER) {
Ingo Molnar8688cfc2006-07-03 00:25:39 -07003894 disable_irq_lockdep(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003895 mask |= NVREG_IRQ_OTHER;
3896 }
3897 }
Manfred Spraula7475902007-10-17 21:52:33 +02003898 /* disable_irq() contains synchronize_irq, thus no irq handler can run now */
3899
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003900 if (np->recover_error) {
3901 np->recover_error = 0;
Ayaz Abdulladaa91a92009-02-07 00:25:00 -08003902 printk(KERN_INFO "%s: MAC in recoverable error state\n", dev->name);
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003903 if (netif_running(dev)) {
3904 netif_tx_lock_bh(dev);
David S. Millere308a5d2008-07-15 00:13:44 -07003905 netif_addr_lock(dev);
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003906 spin_lock(&np->lock);
3907 /* stop engines */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04003908 nv_stop_rxtx(dev);
Ayaz Abdulladaa91a92009-02-07 00:25:00 -08003909 if (np->driver_data & DEV_HAS_POWER_CNTRL)
3910 nv_mac_reset(dev);
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003911 nv_txrx_reset(dev);
3912 /* drain rx queue */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04003913 nv_drain_rxtx(dev);
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003914 /* reinit driver view of the rx queue */
3915 set_bufsize(dev);
3916 if (nv_init_ring(dev)) {
3917 if (!np->in_shutdown)
3918 mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
3919 }
3920 /* reinit nic view of the rx queue */
3921 writel(np->rx_buf_sz, base + NvRegOffloadConfig);
3922 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
Szymon Janc78aea4f2010-11-27 08:39:43 +00003923 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003924 base + NvRegRingSizes);
3925 pci_push(base);
3926 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
3927 pci_push(base);
Ayaz Abdulladaa91a92009-02-07 00:25:00 -08003928 /* clear interrupts */
3929 if (!(np->msi_flags & NV_MSI_X_ENABLED))
3930 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
3931 else
3932 writel(NVREG_IRQSTAT_MASK, base + NvRegMSIXIrqStatus);
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003933
3934 /* restart rx engine */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04003935 nv_start_rxtx(dev);
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003936 spin_unlock(&np->lock);
David S. Millere308a5d2008-07-15 00:13:44 -07003937 netif_addr_unlock(dev);
Ayaz Abdullac5cf9102006-10-30 17:32:01 -05003938 netif_tx_unlock_bh(dev);
3939 }
3940 }
3941
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003942 writel(mask, base + NvRegIrqMask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003943 pci_push(base);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003944
Ayaz Abdulla84b39322006-05-20 14:59:48 -07003945 if (!using_multi_irqs(dev)) {
Yinghai Lu79d30a52009-02-06 01:30:01 -08003946 np->nic_poll_irq = 0;
Jeff Garzik36b30ea2007-10-16 01:40:30 -04003947 if (nv_optimized(np))
Ayaz Abdullafcc5f262007-03-23 05:49:37 -05003948 nv_nic_irq_optimized(0, dev);
3949 else
3950 nv_nic_irq(0, dev);
Ayaz Abdulla84b39322006-05-20 14:59:48 -07003951 if (np->msi_flags & NV_MSI_X_ENABLED)
Ingo Molnar8688cfc2006-07-03 00:25:39 -07003952 enable_irq_lockdep(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector);
Ayaz Abdulla84b39322006-05-20 14:59:48 -07003953 else
Manfred Spraula7475902007-10-17 21:52:33 +02003954 enable_irq_lockdep(np->pci_dev->irq);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003955 } else {
3956 if (np->nic_poll_irq & NVREG_IRQ_RX_ALL) {
Yinghai Lu79d30a52009-02-06 01:30:01 -08003957 np->nic_poll_irq &= ~NVREG_IRQ_RX_ALL;
David Howells7d12e782006-10-05 14:55:46 +01003958 nv_nic_irq_rx(0, dev);
Ingo Molnar8688cfc2006-07-03 00:25:39 -07003959 enable_irq_lockdep(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003960 }
3961 if (np->nic_poll_irq & NVREG_IRQ_TX_ALL) {
Yinghai Lu79d30a52009-02-06 01:30:01 -08003962 np->nic_poll_irq &= ~NVREG_IRQ_TX_ALL;
David Howells7d12e782006-10-05 14:55:46 +01003963 nv_nic_irq_tx(0, dev);
Ingo Molnar8688cfc2006-07-03 00:25:39 -07003964 enable_irq_lockdep(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003965 }
3966 if (np->nic_poll_irq & NVREG_IRQ_OTHER) {
Yinghai Lu79d30a52009-02-06 01:30:01 -08003967 np->nic_poll_irq &= ~NVREG_IRQ_OTHER;
David Howells7d12e782006-10-05 14:55:46 +01003968 nv_nic_irq_other(0, dev);
Ingo Molnar8688cfc2006-07-03 00:25:39 -07003969 enable_irq_lockdep(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05003970 }
3971 }
Yinghai Lu79d30a52009-02-06 01:30:01 -08003972
Linus Torvalds1da177e2005-04-16 15:20:36 -07003973}
3974
Michal Schmidt2918c352005-05-12 19:42:06 -04003975#ifdef CONFIG_NET_POLL_CONTROLLER
3976static void nv_poll_controller(struct net_device *dev)
3977{
3978 nv_do_nic_poll((unsigned long) dev);
3979}
3980#endif
3981
Ayaz Abdulla52da3572006-06-10 22:48:04 -04003982static void nv_do_stats_poll(unsigned long data)
3983{
3984 struct net_device *dev = (struct net_device *) data;
3985 struct fe_priv *np = netdev_priv(dev);
Ayaz Abdulla52da3572006-06-10 22:48:04 -04003986
Ayaz Abdulla57fff692007-01-23 12:27:00 -05003987 nv_get_hw_stats(dev);
Ayaz Abdulla52da3572006-06-10 22:48:04 -04003988
3989 if (!np->in_shutdown)
Daniel Drakebfebbb82008-03-18 11:07:18 +00003990 mod_timer(&np->stats_poll,
3991 round_jiffies(jiffies + STATS_INTERVAL));
Ayaz Abdulla52da3572006-06-10 22:48:04 -04003992}
3993
Linus Torvalds1da177e2005-04-16 15:20:36 -07003994static void nv_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
3995{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04003996 struct fe_priv *np = netdev_priv(dev);
Jeff Garzik3f88ce42007-10-16 04:09:09 -04003997 strcpy(info->driver, DRV_NAME);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003998 strcpy(info->version, FORCEDETH_VERSION);
3999 strcpy(info->bus_info, pci_name(np->pci_dev));
4000}
4001
4002static void nv_get_wol(struct net_device *dev, struct ethtool_wolinfo *wolinfo)
4003{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04004004 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004005 wolinfo->supported = WAKE_MAGIC;
4006
4007 spin_lock_irq(&np->lock);
4008 if (np->wolenabled)
4009 wolinfo->wolopts = WAKE_MAGIC;
4010 spin_unlock_irq(&np->lock);
4011}
4012
4013static int nv_set_wol(struct net_device *dev, struct ethtool_wolinfo *wolinfo)
4014{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04004015 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004016 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdullac42d9df2006-06-10 22:47:52 -04004017 u32 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004018
Linus Torvalds1da177e2005-04-16 15:20:36 -07004019 if (wolinfo->wolopts == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004020 np->wolenabled = 0;
Ayaz Abdullac42d9df2006-06-10 22:47:52 -04004021 } else if (wolinfo->wolopts & WAKE_MAGIC) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004022 np->wolenabled = 1;
Ayaz Abdullac42d9df2006-06-10 22:47:52 -04004023 flags = NVREG_WAKEUPFLAGS_ENABLE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004024 }
Ayaz Abdullac42d9df2006-06-10 22:47:52 -04004025 if (netif_running(dev)) {
4026 spin_lock_irq(&np->lock);
4027 writel(flags, base + NvRegWakeUpFlags);
4028 spin_unlock_irq(&np->lock);
4029 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004030 return 0;
4031}
4032
4033static int nv_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
4034{
4035 struct fe_priv *np = netdev_priv(dev);
4036 int adv;
4037
4038 spin_lock_irq(&np->lock);
4039 ecmd->port = PORT_MII;
4040 if (!netif_running(dev)) {
4041 /* We do not track link speed / duplex setting if the
4042 * interface is disabled. Force a link check */
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004043 if (nv_update_linkspeed(dev)) {
4044 if (!netif_carrier_ok(dev))
4045 netif_carrier_on(dev);
4046 } else {
4047 if (netif_carrier_ok(dev))
4048 netif_carrier_off(dev);
4049 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004050 }
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004051
4052 if (netif_carrier_ok(dev)) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00004053 switch (np->linkspeed & (NVREG_LINKSPEED_MASK)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004054 case NVREG_LINKSPEED_10:
4055 ecmd->speed = SPEED_10;
4056 break;
4057 case NVREG_LINKSPEED_100:
4058 ecmd->speed = SPEED_100;
4059 break;
4060 case NVREG_LINKSPEED_1000:
4061 ecmd->speed = SPEED_1000;
4062 break;
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004063 }
4064 ecmd->duplex = DUPLEX_HALF;
4065 if (np->duplex)
4066 ecmd->duplex = DUPLEX_FULL;
4067 } else {
4068 ecmd->speed = -1;
4069 ecmd->duplex = -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004070 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004071
4072 ecmd->autoneg = np->autoneg;
4073
4074 ecmd->advertising = ADVERTISED_MII;
4075 if (np->autoneg) {
4076 ecmd->advertising |= ADVERTISED_Autoneg;
4077 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004078 if (adv & ADVERTISE_10HALF)
4079 ecmd->advertising |= ADVERTISED_10baseT_Half;
4080 if (adv & ADVERTISE_10FULL)
4081 ecmd->advertising |= ADVERTISED_10baseT_Full;
4082 if (adv & ADVERTISE_100HALF)
4083 ecmd->advertising |= ADVERTISED_100baseT_Half;
4084 if (adv & ADVERTISE_100FULL)
4085 ecmd->advertising |= ADVERTISED_100baseT_Full;
4086 if (np->gigabit == PHY_GIGABIT) {
4087 adv = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ);
4088 if (adv & ADVERTISE_1000FULL)
4089 ecmd->advertising |= ADVERTISED_1000baseT_Full;
4090 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004091 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004092 ecmd->supported = (SUPPORTED_Autoneg |
4093 SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full |
4094 SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full |
4095 SUPPORTED_MII);
4096 if (np->gigabit == PHY_GIGABIT)
4097 ecmd->supported |= SUPPORTED_1000baseT_Full;
4098
4099 ecmd->phy_address = np->phyaddr;
4100 ecmd->transceiver = XCVR_EXTERNAL;
4101
4102 /* ignore maxtxpkt, maxrxpkt for now */
4103 spin_unlock_irq(&np->lock);
4104 return 0;
4105}
4106
4107static int nv_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
4108{
4109 struct fe_priv *np = netdev_priv(dev);
4110
4111 if (ecmd->port != PORT_MII)
4112 return -EINVAL;
4113 if (ecmd->transceiver != XCVR_EXTERNAL)
4114 return -EINVAL;
4115 if (ecmd->phy_address != np->phyaddr) {
4116 /* TODO: support switching between multiple phys. Should be
4117 * trivial, but not enabled due to lack of test hardware. */
4118 return -EINVAL;
4119 }
4120 if (ecmd->autoneg == AUTONEG_ENABLE) {
4121 u32 mask;
4122
4123 mask = ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full |
4124 ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full;
4125 if (np->gigabit == PHY_GIGABIT)
4126 mask |= ADVERTISED_1000baseT_Full;
4127
4128 if ((ecmd->advertising & mask) == 0)
4129 return -EINVAL;
4130
4131 } else if (ecmd->autoneg == AUTONEG_DISABLE) {
4132 /* Note: autonegotiation disable, speed 1000 intentionally
4133 * forbidden - noone should need that. */
4134
4135 if (ecmd->speed != SPEED_10 && ecmd->speed != SPEED_100)
4136 return -EINVAL;
4137 if (ecmd->duplex != DUPLEX_HALF && ecmd->duplex != DUPLEX_FULL)
4138 return -EINVAL;
4139 } else {
4140 return -EINVAL;
4141 }
4142
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004143 netif_carrier_off(dev);
4144 if (netif_running(dev)) {
Tobias Diedrich97bff092008-07-03 23:54:56 -07004145 unsigned long flags;
4146
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004147 nv_disable_irq(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004148 netif_tx_lock_bh(dev);
David S. Millere308a5d2008-07-15 00:13:44 -07004149 netif_addr_lock(dev);
Tobias Diedrich97bff092008-07-03 23:54:56 -07004150 /* with plain spinlock lockdep complains */
4151 spin_lock_irqsave(&np->lock, flags);
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004152 /* stop engines */
Tobias Diedrich97bff092008-07-03 23:54:56 -07004153 /* FIXME:
4154 * this can take some time, and interrupts are disabled
4155 * due to spin_lock_irqsave, but let's hope no daemon
4156 * is going to change the settings very often...
4157 * Worst case:
4158 * NV_RXSTOP_DELAY1MAX + NV_TXSTOP_DELAY1MAX
4159 * + some minor delays, which is up to a second approximately
4160 */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004161 nv_stop_rxtx(dev);
Tobias Diedrich97bff092008-07-03 23:54:56 -07004162 spin_unlock_irqrestore(&np->lock, flags);
David S. Millere308a5d2008-07-15 00:13:44 -07004163 netif_addr_unlock(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004164 netif_tx_unlock_bh(dev);
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004165 }
4166
Linus Torvalds1da177e2005-04-16 15:20:36 -07004167 if (ecmd->autoneg == AUTONEG_ENABLE) {
4168 int adv, bmcr;
4169
4170 np->autoneg = 1;
4171
4172 /* advertise only what has been requested */
4173 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04004174 adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004175 if (ecmd->advertising & ADVERTISED_10baseT_Half)
4176 adv |= ADVERTISE_10HALF;
4177 if (ecmd->advertising & ADVERTISED_10baseT_Full)
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004178 adv |= ADVERTISE_10FULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004179 if (ecmd->advertising & ADVERTISED_100baseT_Half)
4180 adv |= ADVERTISE_100HALF;
4181 if (ecmd->advertising & ADVERTISED_100baseT_Full)
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004182 adv |= ADVERTISE_100FULL;
4183 if (np->pause_flags & NV_PAUSEFRAME_RX_REQ) /* for rx we set both advertisments but disable tx pause */
4184 adv |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
4185 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ)
4186 adv |= ADVERTISE_PAUSE_ASYM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004187 mii_rw(dev, np->phyaddr, MII_ADVERTISE, adv);
4188
4189 if (np->gigabit == PHY_GIGABIT) {
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04004190 adv = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004191 adv &= ~ADVERTISE_1000FULL;
4192 if (ecmd->advertising & ADVERTISED_1000baseT_Full)
4193 adv |= ADVERTISE_1000FULL;
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04004194 mii_rw(dev, np->phyaddr, MII_CTRL1000, adv);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004195 }
4196
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004197 if (netif_running(dev))
4198 printk(KERN_INFO "%s: link down.\n", dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004199 bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04004200 if (np->phy_model == PHY_MODEL_MARVELL_E3016) {
4201 bmcr |= BMCR_ANENABLE;
4202 /* reset the phy in order for settings to stick,
4203 * and cause autoneg to start */
4204 if (phy_reset(dev, bmcr)) {
4205 printk(KERN_INFO "%s: phy reset failed\n", dev->name);
4206 return -EINVAL;
4207 }
4208 } else {
4209 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
4210 mii_rw(dev, np->phyaddr, MII_BMCR, bmcr);
4211 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004212 } else {
4213 int adv, bmcr;
4214
4215 np->autoneg = 0;
4216
4217 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04004218 adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004219 if (ecmd->speed == SPEED_10 && ecmd->duplex == DUPLEX_HALF)
4220 adv |= ADVERTISE_10HALF;
4221 if (ecmd->speed == SPEED_10 && ecmd->duplex == DUPLEX_FULL)
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004222 adv |= ADVERTISE_10FULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004223 if (ecmd->speed == SPEED_100 && ecmd->duplex == DUPLEX_HALF)
4224 adv |= ADVERTISE_100HALF;
4225 if (ecmd->speed == SPEED_100 && ecmd->duplex == DUPLEX_FULL)
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004226 adv |= ADVERTISE_100FULL;
4227 np->pause_flags &= ~(NV_PAUSEFRAME_AUTONEG|NV_PAUSEFRAME_RX_ENABLE|NV_PAUSEFRAME_TX_ENABLE);
4228 if (np->pause_flags & NV_PAUSEFRAME_RX_REQ) {/* for rx we set both advertisments but disable tx pause */
4229 adv |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
4230 np->pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
4231 }
4232 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ) {
4233 adv |= ADVERTISE_PAUSE_ASYM;
4234 np->pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
4235 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004236 mii_rw(dev, np->phyaddr, MII_ADVERTISE, adv);
4237 np->fixed_mode = adv;
4238
4239 if (np->gigabit == PHY_GIGABIT) {
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04004240 adv = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004241 adv &= ~ADVERTISE_1000FULL;
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04004242 mii_rw(dev, np->phyaddr, MII_CTRL1000, adv);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004243 }
4244
4245 bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004246 bmcr &= ~(BMCR_ANENABLE|BMCR_SPEED100|BMCR_SPEED1000|BMCR_FULLDPLX);
4247 if (np->fixed_mode & (ADVERTISE_10FULL|ADVERTISE_100FULL))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004248 bmcr |= BMCR_FULLDPLX;
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004249 if (np->fixed_mode & (ADVERTISE_100HALF|ADVERTISE_100FULL))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004250 bmcr |= BMCR_SPEED100;
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004251 if (np->phy_oui == PHY_OUI_MARVELL) {
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04004252 /* reset the phy in order for forced mode settings to stick */
4253 if (phy_reset(dev, bmcr)) {
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004254 printk(KERN_INFO "%s: phy reset failed\n", dev->name);
4255 return -EINVAL;
4256 }
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04004257 } else {
4258 mii_rw(dev, np->phyaddr, MII_BMCR, bmcr);
4259 if (netif_running(dev)) {
4260 /* Wait a bit and then reconfigure the nic. */
4261 udelay(10);
4262 nv_linkchange(dev);
4263 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004264 }
4265 }
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004266
4267 if (netif_running(dev)) {
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004268 nv_start_rxtx(dev);
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004269 nv_enable_irq(dev);
4270 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004271
4272 return 0;
4273}
4274
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004275#define FORCEDETH_REGS_VER 1
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004276
4277static int nv_get_regs_len(struct net_device *dev)
4278{
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04004279 struct fe_priv *np = netdev_priv(dev);
4280 return np->register_size;
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004281}
4282
4283static void nv_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *buf)
4284{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04004285 struct fe_priv *np = netdev_priv(dev);
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004286 u8 __iomem *base = get_hwbase(dev);
4287 u32 *rbuf = buf;
4288 int i;
4289
4290 regs->version = FORCEDETH_REGS_VER;
4291 spin_lock_irq(&np->lock);
Szymon Janc78aea4f2010-11-27 08:39:43 +00004292 for (i = 0; i <= np->register_size/sizeof(u32); i++)
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004293 rbuf[i] = readl(base + i*sizeof(u32));
4294 spin_unlock_irq(&np->lock);
4295}
4296
4297static int nv_nway_reset(struct net_device *dev)
4298{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04004299 struct fe_priv *np = netdev_priv(dev);
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004300 int ret;
4301
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004302 if (np->autoneg) {
4303 int bmcr;
4304
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004305 netif_carrier_off(dev);
4306 if (netif_running(dev)) {
4307 nv_disable_irq(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004308 netif_tx_lock_bh(dev);
David S. Millere308a5d2008-07-15 00:13:44 -07004309 netif_addr_lock(dev);
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004310 spin_lock(&np->lock);
4311 /* stop engines */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004312 nv_stop_rxtx(dev);
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004313 spin_unlock(&np->lock);
David S. Millere308a5d2008-07-15 00:13:44 -07004314 netif_addr_unlock(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004315 netif_tx_unlock_bh(dev);
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004316 printk(KERN_INFO "%s: link down.\n", dev->name);
4317 }
4318
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004319 bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04004320 if (np->phy_model == PHY_MODEL_MARVELL_E3016) {
4321 bmcr |= BMCR_ANENABLE;
4322 /* reset the phy in order for settings to stick*/
4323 if (phy_reset(dev, bmcr)) {
4324 printk(KERN_INFO "%s: phy reset failed\n", dev->name);
4325 return -EINVAL;
4326 }
4327 } else {
4328 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
4329 mii_rw(dev, np->phyaddr, MII_BMCR, bmcr);
4330 }
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004331
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004332 if (netif_running(dev)) {
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004333 nv_start_rxtx(dev);
Ayaz Abdullaf9430a02006-06-10 22:47:47 -04004334 nv_enable_irq(dev);
4335 }
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004336 ret = 0;
4337 } else {
4338 ret = -EINVAL;
4339 }
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004340
4341 return ret;
4342}
4343
Zachary Amsden0674d592006-06-04 02:51:38 -07004344static int nv_set_tso(struct net_device *dev, u32 value)
4345{
4346 struct fe_priv *np = netdev_priv(dev);
4347
4348 if ((np->driver_data & DEV_HAS_CHECKSUM))
4349 return ethtool_op_set_tso(dev, value);
4350 else
Ayaz Abdulla6a788142006-06-10 22:47:26 -04004351 return -EOPNOTSUPP;
Zachary Amsden0674d592006-06-04 02:51:38 -07004352}
Zachary Amsden0674d592006-06-04 02:51:38 -07004353
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004354static void nv_get_ringparam(struct net_device *dev, struct ethtool_ringparam* ring)
4355{
4356 struct fe_priv *np = netdev_priv(dev);
4357
4358 ring->rx_max_pending = (np->desc_ver == DESC_VER_1) ? RING_MAX_DESC_VER_1 : RING_MAX_DESC_VER_2_3;
4359 ring->rx_mini_max_pending = 0;
4360 ring->rx_jumbo_max_pending = 0;
4361 ring->tx_max_pending = (np->desc_ver == DESC_VER_1) ? RING_MAX_DESC_VER_1 : RING_MAX_DESC_VER_2_3;
4362
4363 ring->rx_pending = np->rx_ring_size;
4364 ring->rx_mini_pending = 0;
4365 ring->rx_jumbo_pending = 0;
4366 ring->tx_pending = np->tx_ring_size;
4367}
4368
4369static int nv_set_ringparam(struct net_device *dev, struct ethtool_ringparam* ring)
4370{
4371 struct fe_priv *np = netdev_priv(dev);
4372 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05004373 u8 *rxtx_ring, *rx_skbuff, *tx_skbuff;
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004374 dma_addr_t ring_addr;
4375
4376 if (ring->rx_pending < RX_RING_MIN ||
4377 ring->tx_pending < TX_RING_MIN ||
4378 ring->rx_mini_pending != 0 ||
4379 ring->rx_jumbo_pending != 0 ||
4380 (np->desc_ver == DESC_VER_1 &&
4381 (ring->rx_pending > RING_MAX_DESC_VER_1 ||
4382 ring->tx_pending > RING_MAX_DESC_VER_1)) ||
4383 (np->desc_ver != DESC_VER_1 &&
4384 (ring->rx_pending > RING_MAX_DESC_VER_2_3 ||
4385 ring->tx_pending > RING_MAX_DESC_VER_2_3))) {
4386 return -EINVAL;
4387 }
4388
4389 /* allocate new rings */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004390 if (!nv_optimized(np)) {
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004391 rxtx_ring = pci_alloc_consistent(np->pci_dev,
4392 sizeof(struct ring_desc) * (ring->rx_pending + ring->tx_pending),
4393 &ring_addr);
4394 } else {
4395 rxtx_ring = pci_alloc_consistent(np->pci_dev,
4396 sizeof(struct ring_desc_ex) * (ring->rx_pending + ring->tx_pending),
4397 &ring_addr);
4398 }
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05004399 rx_skbuff = kmalloc(sizeof(struct nv_skb_map) * ring->rx_pending, GFP_KERNEL);
4400 tx_skbuff = kmalloc(sizeof(struct nv_skb_map) * ring->tx_pending, GFP_KERNEL);
4401 if (!rxtx_ring || !rx_skbuff || !tx_skbuff) {
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004402 /* fall back to old rings */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004403 if (!nv_optimized(np)) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07004404 if (rxtx_ring)
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004405 pci_free_consistent(np->pci_dev, sizeof(struct ring_desc) * (ring->rx_pending + ring->tx_pending),
4406 rxtx_ring, ring_addr);
4407 } else {
4408 if (rxtx_ring)
4409 pci_free_consistent(np->pci_dev, sizeof(struct ring_desc_ex) * (ring->rx_pending + ring->tx_pending),
4410 rxtx_ring, ring_addr);
4411 }
Szymon Janc9b03b062010-11-27 08:39:44 +00004412
4413 kfree(rx_skbuff);
4414 kfree(tx_skbuff);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004415 goto exit;
4416 }
4417
4418 if (netif_running(dev)) {
4419 nv_disable_irq(dev);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00004420 nv_napi_disable(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004421 netif_tx_lock_bh(dev);
David S. Millere308a5d2008-07-15 00:13:44 -07004422 netif_addr_lock(dev);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004423 spin_lock(&np->lock);
4424 /* stop engines */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004425 nv_stop_rxtx(dev);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004426 nv_txrx_reset(dev);
4427 /* drain queues */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004428 nv_drain_rxtx(dev);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004429 /* delete queues */
4430 free_rings(dev);
4431 }
4432
4433 /* set new values */
4434 np->rx_ring_size = ring->rx_pending;
4435 np->tx_ring_size = ring->tx_pending;
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004436
4437 if (!nv_optimized(np)) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00004438 np->rx_ring.orig = (struct ring_desc *)rxtx_ring;
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004439 np->tx_ring.orig = &np->rx_ring.orig[np->rx_ring_size];
4440 } else {
Szymon Janc78aea4f2010-11-27 08:39:43 +00004441 np->rx_ring.ex = (struct ring_desc_ex *)rxtx_ring;
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004442 np->tx_ring.ex = &np->rx_ring.ex[np->rx_ring_size];
4443 }
Szymon Janc78aea4f2010-11-27 08:39:43 +00004444 np->rx_skb = (struct nv_skb_map *)rx_skbuff;
4445 np->tx_skb = (struct nv_skb_map *)tx_skbuff;
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004446 np->ring_addr = ring_addr;
4447
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05004448 memset(np->rx_skb, 0, sizeof(struct nv_skb_map) * np->rx_ring_size);
4449 memset(np->tx_skb, 0, sizeof(struct nv_skb_map) * np->tx_ring_size);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004450
4451 if (netif_running(dev)) {
4452 /* reinit driver view of the queues */
4453 set_bufsize(dev);
4454 if (nv_init_ring(dev)) {
4455 if (!np->in_shutdown)
4456 mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
4457 }
4458
4459 /* reinit nic view of the queues */
4460 writel(np->rx_buf_sz, base + NvRegOffloadConfig);
4461 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
Szymon Janc78aea4f2010-11-27 08:39:43 +00004462 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004463 base + NvRegRingSizes);
4464 pci_push(base);
4465 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
4466 pci_push(base);
4467
4468 /* restart engines */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004469 nv_start_rxtx(dev);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004470 spin_unlock(&np->lock);
David S. Millere308a5d2008-07-15 00:13:44 -07004471 netif_addr_unlock(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004472 netif_tx_unlock_bh(dev);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00004473 nv_napi_enable(dev);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004474 nv_enable_irq(dev);
4475 }
4476 return 0;
4477exit:
4478 return -ENOMEM;
4479}
4480
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004481static void nv_get_pauseparam(struct net_device *dev, struct ethtool_pauseparam* pause)
4482{
4483 struct fe_priv *np = netdev_priv(dev);
4484
4485 pause->autoneg = (np->pause_flags & NV_PAUSEFRAME_AUTONEG) != 0;
4486 pause->rx_pause = (np->pause_flags & NV_PAUSEFRAME_RX_ENABLE) != 0;
4487 pause->tx_pause = (np->pause_flags & NV_PAUSEFRAME_TX_ENABLE) != 0;
4488}
4489
4490static int nv_set_pauseparam(struct net_device *dev, struct ethtool_pauseparam* pause)
4491{
4492 struct fe_priv *np = netdev_priv(dev);
4493 int adv, bmcr;
4494
4495 if ((!np->autoneg && np->duplex == 0) ||
4496 (np->autoneg && !pause->autoneg && np->duplex == 0)) {
4497 printk(KERN_INFO "%s: can not set pause settings when forced link is in half duplex.\n",
4498 dev->name);
4499 return -EINVAL;
4500 }
4501 if (pause->tx_pause && !(np->pause_flags & NV_PAUSEFRAME_TX_CAPABLE)) {
4502 printk(KERN_INFO "%s: hardware does not support tx pause frames.\n", dev->name);
4503 return -EINVAL;
4504 }
4505
4506 netif_carrier_off(dev);
4507 if (netif_running(dev)) {
4508 nv_disable_irq(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004509 netif_tx_lock_bh(dev);
David S. Millere308a5d2008-07-15 00:13:44 -07004510 netif_addr_lock(dev);
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004511 spin_lock(&np->lock);
4512 /* stop engines */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004513 nv_stop_rxtx(dev);
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004514 spin_unlock(&np->lock);
David S. Millere308a5d2008-07-15 00:13:44 -07004515 netif_addr_unlock(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004516 netif_tx_unlock_bh(dev);
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004517 }
4518
4519 np->pause_flags &= ~(NV_PAUSEFRAME_RX_REQ|NV_PAUSEFRAME_TX_REQ);
4520 if (pause->rx_pause)
4521 np->pause_flags |= NV_PAUSEFRAME_RX_REQ;
4522 if (pause->tx_pause)
4523 np->pause_flags |= NV_PAUSEFRAME_TX_REQ;
4524
4525 if (np->autoneg && pause->autoneg) {
4526 np->pause_flags |= NV_PAUSEFRAME_AUTONEG;
4527
4528 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
4529 adv &= ~(ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
4530 if (np->pause_flags & NV_PAUSEFRAME_RX_REQ) /* for rx we set both advertisments but disable tx pause */
4531 adv |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
4532 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ)
4533 adv |= ADVERTISE_PAUSE_ASYM;
4534 mii_rw(dev, np->phyaddr, MII_ADVERTISE, adv);
4535
4536 if (netif_running(dev))
4537 printk(KERN_INFO "%s: link down.\n", dev->name);
4538 bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
4539 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
4540 mii_rw(dev, np->phyaddr, MII_BMCR, bmcr);
4541 } else {
4542 np->pause_flags &= ~(NV_PAUSEFRAME_AUTONEG|NV_PAUSEFRAME_RX_ENABLE|NV_PAUSEFRAME_TX_ENABLE);
4543 if (pause->rx_pause)
4544 np->pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
4545 if (pause->tx_pause)
4546 np->pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
4547
4548 if (!netif_running(dev))
4549 nv_update_linkspeed(dev);
4550 else
4551 nv_update_pause(dev, np->pause_flags);
4552 }
4553
4554 if (netif_running(dev)) {
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004555 nv_start_rxtx(dev);
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004556 nv_enable_irq(dev);
4557 }
4558 return 0;
4559}
4560
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004561static u32 nv_get_rx_csum(struct net_device *dev)
4562{
4563 struct fe_priv *np = netdev_priv(dev);
Eric Dumazet807540b2010-09-23 05:40:09 +00004564 return np->rx_csum != 0;
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004565}
4566
4567static int nv_set_rx_csum(struct net_device *dev, u32 data)
4568{
4569 struct fe_priv *np = netdev_priv(dev);
4570 u8 __iomem *base = get_hwbase(dev);
4571 int retcode = 0;
4572
4573 if (np->driver_data & DEV_HAS_CHECKSUM) {
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004574 if (data) {
Ayaz Abdullaf2ad2d92006-08-24 17:35:41 -04004575 np->rx_csum = 1;
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004576 np->txrxctl_bits |= NVREG_TXRXCTL_RXCHECK;
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004577 } else {
Ayaz Abdullaf2ad2d92006-08-24 17:35:41 -04004578 np->rx_csum = 0;
4579 /* vlan is dependent on rx checksum offload */
4580 if (!(np->vlanctl_bits & NVREG_VLANCONTROL_ENABLE))
4581 np->txrxctl_bits &= ~NVREG_TXRXCTL_RXCHECK;
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004582 }
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004583 if (netif_running(dev)) {
4584 spin_lock_irq(&np->lock);
4585 writel(np->txrxctl_bits, base + NvRegTxRxControl);
4586 spin_unlock_irq(&np->lock);
4587 }
4588 } else {
4589 return -EINVAL;
4590 }
4591
4592 return retcode;
4593}
4594
4595static int nv_set_tx_csum(struct net_device *dev, u32 data)
4596{
4597 struct fe_priv *np = netdev_priv(dev);
4598
4599 if (np->driver_data & DEV_HAS_CHECKSUM)
Ayaz Abdullac1086cd2009-02-07 00:24:39 -08004600 return ethtool_op_set_tx_csum(dev, data);
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004601 else
4602 return -EOPNOTSUPP;
4603}
4604
4605static int nv_set_sg(struct net_device *dev, u32 data)
4606{
4607 struct fe_priv *np = netdev_priv(dev);
4608
4609 if (np->driver_data & DEV_HAS_CHECKSUM)
4610 return ethtool_op_set_sg(dev, data);
4611 else
4612 return -EOPNOTSUPP;
4613}
4614
Jeff Garzikb9f2c042007-10-03 18:07:32 -07004615static int nv_get_sset_count(struct net_device *dev, int sset)
Ayaz Abdulla52da3572006-06-10 22:48:04 -04004616{
4617 struct fe_priv *np = netdev_priv(dev);
4618
Jeff Garzikb9f2c042007-10-03 18:07:32 -07004619 switch (sset) {
4620 case ETH_SS_TEST:
4621 if (np->driver_data & DEV_HAS_TEST_EXTENDED)
4622 return NV_TEST_COUNT_EXTENDED;
4623 else
4624 return NV_TEST_COUNT_BASE;
4625 case ETH_SS_STATS:
Ayaz Abdulla8ed14542009-03-05 08:01:49 +00004626 if (np->driver_data & DEV_HAS_STATISTICS_V3)
4627 return NV_DEV_STATISTICS_V3_COUNT;
Jeff Garzikb9f2c042007-10-03 18:07:32 -07004628 else if (np->driver_data & DEV_HAS_STATISTICS_V2)
4629 return NV_DEV_STATISTICS_V2_COUNT;
Ayaz Abdulla8ed14542009-03-05 08:01:49 +00004630 else if (np->driver_data & DEV_HAS_STATISTICS_V1)
4631 return NV_DEV_STATISTICS_V1_COUNT;
Jeff Garzikb9f2c042007-10-03 18:07:32 -07004632 else
4633 return 0;
4634 default:
4635 return -EOPNOTSUPP;
4636 }
Ayaz Abdulla52da3572006-06-10 22:48:04 -04004637}
4638
4639static void nv_get_ethtool_stats(struct net_device *dev, struct ethtool_stats *estats, u64 *buffer)
4640{
4641 struct fe_priv *np = netdev_priv(dev);
4642
4643 /* update stats */
4644 nv_do_stats_poll((unsigned long)dev);
4645
Jeff Garzikb9f2c042007-10-03 18:07:32 -07004646 memcpy(buffer, &np->estats, nv_get_sset_count(dev, ETH_SS_STATS)*sizeof(u64));
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004647}
4648
4649static int nv_link_test(struct net_device *dev)
4650{
4651 struct fe_priv *np = netdev_priv(dev);
4652 int mii_status;
4653
4654 mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
4655 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
4656
4657 /* check phy link status */
4658 if (!(mii_status & BMSR_LSTATUS))
4659 return 0;
4660 else
4661 return 1;
4662}
4663
4664static int nv_register_test(struct net_device *dev)
4665{
4666 u8 __iomem *base = get_hwbase(dev);
4667 int i = 0;
4668 u32 orig_read, new_read;
4669
4670 do {
4671 orig_read = readl(base + nv_registers_test[i].reg);
4672
4673 /* xor with mask to toggle bits */
4674 orig_read ^= nv_registers_test[i].mask;
4675
4676 writel(orig_read, base + nv_registers_test[i].reg);
4677
4678 new_read = readl(base + nv_registers_test[i].reg);
4679
4680 if ((new_read & nv_registers_test[i].mask) != (orig_read & nv_registers_test[i].mask))
4681 return 0;
4682
4683 /* restore original value */
4684 orig_read ^= nv_registers_test[i].mask;
4685 writel(orig_read, base + nv_registers_test[i].reg);
4686
4687 } while (nv_registers_test[++i].reg != 0);
4688
4689 return 1;
4690}
4691
4692static int nv_interrupt_test(struct net_device *dev)
4693{
4694 struct fe_priv *np = netdev_priv(dev);
4695 u8 __iomem *base = get_hwbase(dev);
4696 int ret = 1;
4697 int testcnt;
4698 u32 save_msi_flags, save_poll_interval = 0;
4699
4700 if (netif_running(dev)) {
4701 /* free current irq */
4702 nv_free_irq(dev);
4703 save_poll_interval = readl(base+NvRegPollingInterval);
4704 }
4705
4706 /* flag to test interrupt handler */
4707 np->intr_test = 0;
4708
4709 /* setup test irq */
4710 save_msi_flags = np->msi_flags;
4711 np->msi_flags &= ~NV_MSI_X_VECTORS_MASK;
4712 np->msi_flags |= 0x001; /* setup 1 vector */
4713 if (nv_request_irq(dev, 1))
4714 return 0;
4715
4716 /* setup timer interrupt */
4717 writel(NVREG_POLL_DEFAULT_CPU, base + NvRegPollingInterval);
4718 writel(NVREG_UNKSETUP6_VAL, base + NvRegUnknownSetupReg6);
4719
4720 nv_enable_hw_interrupts(dev, NVREG_IRQ_TIMER);
4721
4722 /* wait for at least one interrupt */
4723 msleep(100);
4724
4725 spin_lock_irq(&np->lock);
4726
4727 /* flag should be set within ISR */
4728 testcnt = np->intr_test;
4729 if (!testcnt)
4730 ret = 2;
4731
4732 nv_disable_hw_interrupts(dev, NVREG_IRQ_TIMER);
4733 if (!(np->msi_flags & NV_MSI_X_ENABLED))
4734 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
4735 else
4736 writel(NVREG_IRQSTAT_MASK, base + NvRegMSIXIrqStatus);
4737
4738 spin_unlock_irq(&np->lock);
4739
4740 nv_free_irq(dev);
4741
4742 np->msi_flags = save_msi_flags;
4743
4744 if (netif_running(dev)) {
4745 writel(save_poll_interval, base + NvRegPollingInterval);
4746 writel(NVREG_UNKSETUP6_VAL, base + NvRegUnknownSetupReg6);
4747 /* restore original irq */
4748 if (nv_request_irq(dev, 0))
4749 return 0;
4750 }
4751
4752 return ret;
4753}
4754
4755static int nv_loopback_test(struct net_device *dev)
4756{
4757 struct fe_priv *np = netdev_priv(dev);
4758 u8 __iomem *base = get_hwbase(dev);
4759 struct sk_buff *tx_skb, *rx_skb;
4760 dma_addr_t test_dma_addr;
4761 u32 tx_flags_extra = (np->desc_ver == DESC_VER_1 ? NV_TX_LASTPACKET : NV_TX2_LASTPACKET);
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07004762 u32 flags;
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004763 int len, i, pkt_len;
4764 u8 *pkt_data;
4765 u32 filter_flags = 0;
4766 u32 misc1_flags = 0;
4767 int ret = 1;
4768
4769 if (netif_running(dev)) {
4770 nv_disable_irq(dev);
4771 filter_flags = readl(base + NvRegPacketFilterFlags);
4772 misc1_flags = readl(base + NvRegMisc1);
4773 } else {
4774 nv_txrx_reset(dev);
4775 }
4776
4777 /* reinit driver view of the rx queue */
4778 set_bufsize(dev);
4779 nv_init_ring(dev);
4780
4781 /* setup hardware for loopback */
4782 writel(NVREG_MISC1_FORCE, base + NvRegMisc1);
4783 writel(NVREG_PFF_ALWAYS | NVREG_PFF_LOOPBACK, base + NvRegPacketFilterFlags);
4784
4785 /* reinit nic view of the rx queue */
4786 writel(np->rx_buf_sz, base + NvRegOffloadConfig);
4787 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
Szymon Janc78aea4f2010-11-27 08:39:43 +00004788 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004789 base + NvRegRingSizes);
4790 pci_push(base);
4791
4792 /* restart rx engine */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004793 nv_start_rxtx(dev);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004794
4795 /* setup packet for tx */
4796 pkt_len = ETH_DATA_LEN;
4797 tx_skb = dev_alloc_skb(pkt_len);
Jesper Juhl46798c82006-09-25 16:39:24 -07004798 if (!tx_skb) {
4799 printk(KERN_ERR "dev_alloc_skb() failed during loopback test"
4800 " of %s\n", dev->name);
4801 ret = 0;
4802 goto out;
4803 }
Arnaldo Carvalho de Melo8b5be262007-03-20 12:08:20 -03004804 test_dma_addr = pci_map_single(np->pci_dev, tx_skb->data,
4805 skb_tailroom(tx_skb),
4806 PCI_DMA_FROMDEVICE);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004807 pkt_data = skb_put(tx_skb, pkt_len);
4808 for (i = 0; i < pkt_len; i++)
4809 pkt_data[i] = (u8)(i & 0xff);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004810
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004811 if (!nv_optimized(np)) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07004812 np->tx_ring.orig[0].buf = cpu_to_le32(test_dma_addr);
4813 np->tx_ring.orig[0].flaglen = cpu_to_le32((pkt_len-1) | np->tx_flags | tx_flags_extra);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004814 } else {
Al Viro5bb7ea22007-12-09 16:06:41 +00004815 np->tx_ring.ex[0].bufhigh = cpu_to_le32(dma_high(test_dma_addr));
4816 np->tx_ring.ex[0].buflow = cpu_to_le32(dma_low(test_dma_addr));
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07004817 np->tx_ring.ex[0].flaglen = cpu_to_le32((pkt_len-1) | np->tx_flags | tx_flags_extra);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004818 }
4819 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
4820 pci_push(get_hwbase(dev));
4821
4822 msleep(500);
4823
4824 /* check for rx of the packet */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004825 if (!nv_optimized(np)) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07004826 flags = le32_to_cpu(np->rx_ring.orig[0].flaglen);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004827 len = nv_descr_getlength(&np->rx_ring.orig[0], np->desc_ver);
4828
4829 } else {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07004830 flags = le32_to_cpu(np->rx_ring.ex[0].flaglen);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004831 len = nv_descr_getlength_ex(&np->rx_ring.ex[0], np->desc_ver);
4832 }
4833
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07004834 if (flags & NV_RX_AVAIL) {
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004835 ret = 0;
4836 } else if (np->desc_ver == DESC_VER_1) {
Stephen Hemmingerf82a9352006-07-27 18:50:08 -07004837 if (flags & NV_RX_ERROR)
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004838 ret = 0;
4839 } else {
Szymon Janc78aea4f2010-11-27 08:39:43 +00004840 if (flags & NV_RX2_ERROR)
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004841 ret = 0;
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004842 }
4843
4844 if (ret) {
4845 if (len != pkt_len) {
4846 ret = 0;
Joe Perches6b808582010-11-29 07:41:53 +00004847 netdev_dbg(dev, "loopback len mismatch %d vs %d\n",
4848 len, pkt_len);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004849 } else {
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05004850 rx_skb = np->rx_skb[0].skb;
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004851 for (i = 0; i < pkt_len; i++) {
4852 if (rx_skb->data[i] != (u8)(i & 0xff)) {
4853 ret = 0;
Joe Perches6b808582010-11-29 07:41:53 +00004854 netdev_dbg(dev, "loopback pattern check failed on byte %d\n",
4855 i);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004856 break;
4857 }
4858 }
4859 }
4860 } else {
Joe Perches6b808582010-11-29 07:41:53 +00004861 netdev_dbg(dev, "loopback - did not receive test packet\n");
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004862 }
4863
Eric Dumazet73a37072009-06-17 21:17:59 +00004864 pci_unmap_single(np->pci_dev, test_dma_addr,
Arnaldo Carvalho de Melo4305b542007-04-19 20:43:29 -07004865 (skb_end_pointer(tx_skb) - tx_skb->data),
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004866 PCI_DMA_TODEVICE);
4867 dev_kfree_skb_any(tx_skb);
Jesper Juhl46798c82006-09-25 16:39:24 -07004868 out:
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004869 /* stop engines */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004870 nv_stop_rxtx(dev);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004871 nv_txrx_reset(dev);
4872 /* drain rx queue */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004873 nv_drain_rxtx(dev);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004874
4875 if (netif_running(dev)) {
4876 writel(misc1_flags, base + NvRegMisc1);
4877 writel(filter_flags, base + NvRegPacketFilterFlags);
4878 nv_enable_irq(dev);
4879 }
4880
4881 return ret;
4882}
4883
4884static void nv_self_test(struct net_device *dev, struct ethtool_test *test, u64 *buffer)
4885{
4886 struct fe_priv *np = netdev_priv(dev);
4887 u8 __iomem *base = get_hwbase(dev);
4888 int result;
Jeff Garzikb9f2c042007-10-03 18:07:32 -07004889 memset(buffer, 0, nv_get_sset_count(dev, ETH_SS_TEST)*sizeof(u64));
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004890
4891 if (!nv_link_test(dev)) {
4892 test->flags |= ETH_TEST_FL_FAILED;
4893 buffer[0] = 1;
4894 }
4895
4896 if (test->flags & ETH_TEST_FL_OFFLINE) {
4897 if (netif_running(dev)) {
4898 netif_stop_queue(dev);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00004899 nv_napi_disable(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004900 netif_tx_lock_bh(dev);
David S. Millere308a5d2008-07-15 00:13:44 -07004901 netif_addr_lock(dev);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004902 spin_lock_irq(&np->lock);
4903 nv_disable_hw_interrupts(dev, np->irqmask);
Szymon Janc78aea4f2010-11-27 08:39:43 +00004904 if (!(np->msi_flags & NV_MSI_X_ENABLED))
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004905 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
Szymon Janc78aea4f2010-11-27 08:39:43 +00004906 else
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004907 writel(NVREG_IRQSTAT_MASK, base + NvRegMSIXIrqStatus);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004908 /* stop engines */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004909 nv_stop_rxtx(dev);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004910 nv_txrx_reset(dev);
4911 /* drain rx queue */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004912 nv_drain_rxtx(dev);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004913 spin_unlock_irq(&np->lock);
David S. Millere308a5d2008-07-15 00:13:44 -07004914 netif_addr_unlock(dev);
Herbert Xu58dfd9c2006-06-21 10:53:54 +10004915 netif_tx_unlock_bh(dev);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004916 }
4917
4918 if (!nv_register_test(dev)) {
4919 test->flags |= ETH_TEST_FL_FAILED;
4920 buffer[1] = 1;
4921 }
4922
4923 result = nv_interrupt_test(dev);
4924 if (result != 1) {
4925 test->flags |= ETH_TEST_FL_FAILED;
4926 buffer[2] = 1;
4927 }
4928 if (result == 0) {
4929 /* bail out */
4930 return;
4931 }
4932
4933 if (!nv_loopback_test(dev)) {
4934 test->flags |= ETH_TEST_FL_FAILED;
4935 buffer[3] = 1;
4936 }
4937
4938 if (netif_running(dev)) {
4939 /* reinit driver view of the rx queue */
4940 set_bufsize(dev);
4941 if (nv_init_ring(dev)) {
4942 if (!np->in_shutdown)
4943 mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
4944 }
4945 /* reinit nic view of the rx queue */
4946 writel(np->rx_buf_sz, base + NvRegOffloadConfig);
4947 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
Szymon Janc78aea4f2010-11-27 08:39:43 +00004948 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004949 base + NvRegRingSizes);
4950 pci_push(base);
4951 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
4952 pci_push(base);
4953 /* restart rx engine */
Jeff Garzik36b30ea2007-10-16 01:40:30 -04004954 nv_start_rxtx(dev);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004955 netif_start_queue(dev);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00004956 nv_napi_enable(dev);
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004957 nv_enable_hw_interrupts(dev, np->irqmask);
4958 }
4959 }
4960}
4961
Ayaz Abdulla52da3572006-06-10 22:48:04 -04004962static void nv_get_strings(struct net_device *dev, u32 stringset, u8 *buffer)
4963{
4964 switch (stringset) {
4965 case ETH_SS_STATS:
Jeff Garzikb9f2c042007-10-03 18:07:32 -07004966 memcpy(buffer, &nv_estats_str, nv_get_sset_count(dev, ETH_SS_STATS)*sizeof(struct nv_ethtool_str));
Ayaz Abdulla52da3572006-06-10 22:48:04 -04004967 break;
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004968 case ETH_SS_TEST:
Jeff Garzikb9f2c042007-10-03 18:07:32 -07004969 memcpy(buffer, &nv_etests_str, nv_get_sset_count(dev, ETH_SS_TEST)*sizeof(struct nv_ethtool_str));
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004970 break;
Ayaz Abdulla52da3572006-06-10 22:48:04 -04004971 }
4972}
4973
Jeff Garzik7282d492006-09-13 14:30:00 -04004974static const struct ethtool_ops ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004975 .get_drvinfo = nv_get_drvinfo,
4976 .get_link = ethtool_op_get_link,
4977 .get_wol = nv_get_wol,
4978 .set_wol = nv_set_wol,
4979 .get_settings = nv_get_settings,
4980 .set_settings = nv_set_settings,
Manfred Sprauldc8216c2005-07-31 18:26:05 +02004981 .get_regs_len = nv_get_regs_len,
4982 .get_regs = nv_get_regs,
4983 .nway_reset = nv_nway_reset,
Ayaz Abdulla6a788142006-06-10 22:47:26 -04004984 .set_tso = nv_set_tso,
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04004985 .get_ringparam = nv_get_ringparam,
4986 .set_ringparam = nv_set_ringparam,
Ayaz Abdullab6d07732006-06-10 22:47:42 -04004987 .get_pauseparam = nv_get_pauseparam,
4988 .set_pauseparam = nv_set_pauseparam,
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004989 .get_rx_csum = nv_get_rx_csum,
4990 .set_rx_csum = nv_set_rx_csum,
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004991 .set_tx_csum = nv_set_tx_csum,
Ayaz Abdulla5ed26162006-06-10 22:47:59 -04004992 .set_sg = nv_set_sg,
Ayaz Abdulla52da3572006-06-10 22:48:04 -04004993 .get_strings = nv_get_strings,
Ayaz Abdulla52da3572006-06-10 22:48:04 -04004994 .get_ethtool_stats = nv_get_ethtool_stats,
Jeff Garzikb9f2c042007-10-03 18:07:32 -07004995 .get_sset_count = nv_get_sset_count,
Ayaz Abdulla9589c772006-06-10 22:48:13 -04004996 .self_test = nv_self_test,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004997};
4998
Ayaz Abdullaee407b02006-02-04 13:13:17 -05004999static void nv_vlan_rx_register(struct net_device *dev, struct vlan_group *grp)
5000{
5001 struct fe_priv *np = get_nvpriv(dev);
5002
5003 spin_lock_irq(&np->lock);
5004
5005 /* save vlan group */
5006 np->vlangrp = grp;
5007
5008 if (grp) {
5009 /* enable vlan on MAC */
5010 np->txrxctl_bits |= NVREG_TXRXCTL_VLANSTRIP | NVREG_TXRXCTL_VLANINS;
5011 } else {
5012 /* disable vlan on MAC */
5013 np->txrxctl_bits &= ~NVREG_TXRXCTL_VLANSTRIP;
5014 np->txrxctl_bits &= ~NVREG_TXRXCTL_VLANINS;
5015 }
5016
5017 writel(np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
5018
5019 spin_unlock_irq(&np->lock);
Stephen Hemminger25805dc2007-06-01 09:44:01 -07005020}
Ayaz Abdullaee407b02006-02-04 13:13:17 -05005021
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005022/* The mgmt unit and driver use a semaphore to access the phy during init */
5023static int nv_mgmt_acquire_sema(struct net_device *dev)
5024{
Ayaz Abdullacac1c522009-02-07 00:23:57 -08005025 struct fe_priv *np = netdev_priv(dev);
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005026 u8 __iomem *base = get_hwbase(dev);
5027 int i;
5028 u32 tx_ctrl, mgmt_sema;
5029
5030 for (i = 0; i < 10; i++) {
5031 mgmt_sema = readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_MGMT_SEMA_MASK;
5032 if (mgmt_sema == NVREG_XMITCTL_MGMT_SEMA_FREE)
5033 break;
5034 msleep(500);
5035 }
5036
5037 if (mgmt_sema != NVREG_XMITCTL_MGMT_SEMA_FREE)
5038 return 0;
5039
5040 for (i = 0; i < 2; i++) {
5041 tx_ctrl = readl(base + NvRegTransmitterControl);
5042 tx_ctrl |= NVREG_XMITCTL_HOST_SEMA_ACQ;
5043 writel(tx_ctrl, base + NvRegTransmitterControl);
5044
5045 /* verify that semaphore was acquired */
5046 tx_ctrl = readl(base + NvRegTransmitterControl);
5047 if (((tx_ctrl & NVREG_XMITCTL_HOST_SEMA_MASK) == NVREG_XMITCTL_HOST_SEMA_ACQ) &&
Ayaz Abdullacac1c522009-02-07 00:23:57 -08005048 ((tx_ctrl & NVREG_XMITCTL_MGMT_SEMA_MASK) == NVREG_XMITCTL_MGMT_SEMA_FREE)) {
5049 np->mgmt_sema = 1;
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005050 return 1;
Szymon Janc78aea4f2010-11-27 08:39:43 +00005051 } else
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005052 udelay(50);
5053 }
5054
5055 return 0;
5056}
5057
Ayaz Abdullacac1c522009-02-07 00:23:57 -08005058static void nv_mgmt_release_sema(struct net_device *dev)
5059{
5060 struct fe_priv *np = netdev_priv(dev);
5061 u8 __iomem *base = get_hwbase(dev);
5062 u32 tx_ctrl;
5063
5064 if (np->driver_data & DEV_HAS_MGMT_UNIT) {
5065 if (np->mgmt_sema) {
5066 tx_ctrl = readl(base + NvRegTransmitterControl);
5067 tx_ctrl &= ~NVREG_XMITCTL_HOST_SEMA_ACQ;
5068 writel(tx_ctrl, base + NvRegTransmitterControl);
5069 }
5070 }
5071}
5072
5073
5074static int nv_mgmt_get_version(struct net_device *dev)
5075{
5076 struct fe_priv *np = netdev_priv(dev);
5077 u8 __iomem *base = get_hwbase(dev);
5078 u32 data_ready = readl(base + NvRegTransmitterControl);
5079 u32 data_ready2 = 0;
5080 unsigned long start;
5081 int ready = 0;
5082
5083 writel(NVREG_MGMTUNITGETVERSION, base + NvRegMgmtUnitGetVersion);
5084 writel(data_ready ^ NVREG_XMITCTL_DATA_START, base + NvRegTransmitterControl);
5085 start = jiffies;
5086 while (time_before(jiffies, start + 5*HZ)) {
5087 data_ready2 = readl(base + NvRegTransmitterControl);
5088 if ((data_ready & NVREG_XMITCTL_DATA_READY) != (data_ready2 & NVREG_XMITCTL_DATA_READY)) {
5089 ready = 1;
5090 break;
5091 }
5092 schedule_timeout_uninterruptible(1);
5093 }
5094
5095 if (!ready || (data_ready2 & NVREG_XMITCTL_DATA_ERROR))
5096 return 0;
5097
5098 np->mgmt_version = readl(base + NvRegMgmtUnitVersion) & NVREG_MGMTUNITVERSION;
5099
5100 return 1;
5101}
5102
Linus Torvalds1da177e2005-04-16 15:20:36 -07005103static int nv_open(struct net_device *dev)
5104{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04005105 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005106 u8 __iomem *base = get_hwbase(dev);
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05005107 int ret = 1;
5108 int oom, i;
Ayaz Abdullaa4336862008-04-18 13:50:43 -07005109 u32 low;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005110
Joe Perches6b808582010-11-29 07:41:53 +00005111 netdev_dbg(dev, "%s\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005112
Ed Swierkcb52deb2008-12-01 12:24:43 +00005113 /* power up phy */
5114 mii_rw(dev, np->phyaddr, MII_BMCR,
5115 mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ) & ~BMCR_PDOWN);
5116
Ayaz Abdulla88d7d8b2009-05-01 01:41:50 +00005117 nv_txrx_gate(dev, false);
Ayaz Abdullaf1489652006-07-31 12:04:45 -04005118 /* erase previous misconfiguration */
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04005119 if (np->driver_data & DEV_HAS_POWER_CNTRL)
5120 nv_mac_reset(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005121 writel(NVREG_MCASTADDRA_FORCE, base + NvRegMulticastAddrA);
5122 writel(0, base + NvRegMulticastAddrB);
Ayaz Abdullabb9a4fd2008-01-13 16:03:04 -05005123 writel(NVREG_MCASTMASKA_NONE, base + NvRegMulticastMaskA);
5124 writel(NVREG_MCASTMASKB_NONE, base + NvRegMulticastMaskB);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005125 writel(0, base + NvRegPacketFilterFlags);
5126
5127 writel(0, base + NvRegTransmitterControl);
5128 writel(0, base + NvRegReceiverControl);
5129
5130 writel(0, base + NvRegAdapterControl);
5131
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04005132 if (np->pause_flags & NV_PAUSEFRAME_TX_CAPABLE)
5133 writel(NVREG_TX_PAUSEFRAME_DISABLE, base + NvRegTxPauseFrame);
5134
Ayaz Abdullaf1489652006-07-31 12:04:45 -04005135 /* initialize descriptor rings */
Manfred Sprauld81c0982005-07-31 18:20:30 +02005136 set_bufsize(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005137 oom = nv_init_ring(dev);
5138
5139 writel(0, base + NvRegLinkSpeed);
Ayaz Abdulla5070d342006-07-31 12:05:01 -04005140 writel(readl(base + NvRegTransmitPoll) & NVREG_TRANSMITPOLL_MAC_ADDR_REV, base + NvRegTransmitPoll);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005141 nv_txrx_reset(dev);
5142 writel(0, base + NvRegUnknownSetupReg6);
5143
5144 np->in_shutdown = 0;
5145
Ayaz Abdullaf1489652006-07-31 12:04:45 -04005146 /* give hw rings */
Ayaz Abdulla0832b252006-02-04 13:13:26 -05005147 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
Szymon Janc78aea4f2010-11-27 08:39:43 +00005148 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
Linus Torvalds1da177e2005-04-16 15:20:36 -07005149 base + NvRegRingSizes);
5150
Linus Torvalds1da177e2005-04-16 15:20:36 -07005151 writel(np->linkspeed, base + NvRegLinkSpeed);
Ayaz Abdulla95d161c2006-07-06 16:46:25 -04005152 if (np->desc_ver == DESC_VER_1)
5153 writel(NVREG_TX_WM_DESC1_DEFAULT, base + NvRegTxWatermark);
5154 else
5155 writel(NVREG_TX_WM_DESC2_3_DEFAULT, base + NvRegTxWatermark);
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005156 writel(np->txrxctl_bits, base + NvRegTxRxControl);
Ayaz Abdullaee407b02006-02-04 13:13:17 -05005157 writel(np->vlanctl_bits, base + NvRegVlanControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005158 pci_push(base);
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005159 writel(NVREG_TXRXCTL_BIT1|np->txrxctl_bits, base + NvRegTxRxControl);
Joe Perches344d0dc2010-11-29 07:41:52 +00005160 if (reg_delay(dev, NvRegUnknownSetupReg5,
5161 NVREG_UNKSETUP5_BIT31, NVREG_UNKSETUP5_BIT31,
5162 NV_SETUP5_DELAY, NV_SETUP5_DELAYMAX))
5163 printk(KERN_INFO "open: SetupReg5, Bit 31 remained off\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07005164
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005165 writel(0, base + NvRegMIIMask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005166 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
Ayaz Abdullaeb798422008-02-04 15:14:04 -05005167 writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005168
Linus Torvalds1da177e2005-04-16 15:20:36 -07005169 writel(NVREG_MISC1_FORCE | NVREG_MISC1_HD, base + NvRegMisc1);
5170 writel(readl(base + NvRegTransmitterStatus), base + NvRegTransmitterStatus);
5171 writel(NVREG_PFF_ALWAYS, base + NvRegPacketFilterFlags);
Manfred Sprauld81c0982005-07-31 18:20:30 +02005172 writel(np->rx_buf_sz, base + NvRegOffloadConfig);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005173
5174 writel(readl(base + NvRegReceiverStatus), base + NvRegReceiverStatus);
Ayaz Abdullaa4336862008-04-18 13:50:43 -07005175
5176 get_random_bytes(&low, sizeof(low));
5177 low &= NVREG_SLOTTIME_MASK;
5178 if (np->desc_ver == DESC_VER_1) {
5179 writel(low|NVREG_SLOTTIME_DEFAULT, base + NvRegSlotTime);
5180 } else {
5181 if (!(np->driver_data & DEV_HAS_GEAR_MODE)) {
5182 /* setup legacy backoff */
5183 writel(NVREG_SLOTTIME_LEGBF_ENABLED|NVREG_SLOTTIME_10_100_FULL|low, base + NvRegSlotTime);
5184 } else {
5185 writel(NVREG_SLOTTIME_10_100_FULL, base + NvRegSlotTime);
5186 nv_gear_backoff_reseed(dev);
5187 }
5188 }
Ayaz Abdulla9744e212006-07-06 16:45:58 -04005189 writel(NVREG_TX_DEFERRAL_DEFAULT, base + NvRegTxDeferral);
5190 writel(NVREG_RX_DEFERRAL_DEFAULT, base + NvRegRxDeferral);
Ayaz Abdullaa971c322005-11-11 08:30:38 -05005191 if (poll_interval == -1) {
5192 if (optimization_mode == NV_OPTIMIZATION_MODE_THROUGHPUT)
5193 writel(NVREG_POLL_DEFAULT_THROUGHPUT, base + NvRegPollingInterval);
5194 else
5195 writel(NVREG_POLL_DEFAULT_CPU, base + NvRegPollingInterval);
Szymon Janc78aea4f2010-11-27 08:39:43 +00005196 } else
Ayaz Abdullaa971c322005-11-11 08:30:38 -05005197 writel(poll_interval & 0xFFFF, base + NvRegPollingInterval);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005198 writel(NVREG_UNKSETUP6_VAL, base + NvRegUnknownSetupReg6);
5199 writel((np->phyaddr << NVREG_ADAPTCTL_PHYSHIFT)|NVREG_ADAPTCTL_PHYVALID|NVREG_ADAPTCTL_RUNNING,
5200 base + NvRegAdapterControl);
5201 writel(NVREG_MIISPEED_BIT8|NVREG_MIIDELAY, base + NvRegMIISpeed);
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005202 writel(NVREG_MII_LINKCHANGE, base + NvRegMIIMask);
Ayaz Abdullac42d9df2006-06-10 22:47:52 -04005203 if (np->wolenabled)
5204 writel(NVREG_WAKEUPFLAGS_ENABLE , base + NvRegWakeUpFlags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005205
5206 i = readl(base + NvRegPowerState);
Szymon Janc78aea4f2010-11-27 08:39:43 +00005207 if ((i & NVREG_POWERSTATE_POWEREDUP) == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005208 writel(NVREG_POWERSTATE_POWEREDUP|i, base + NvRegPowerState);
5209
5210 pci_push(base);
5211 udelay(10);
5212 writel(readl(base + NvRegPowerState) | NVREG_POWERSTATE_VALID, base + NvRegPowerState);
5213
Ayaz Abdulla84b39322006-05-20 14:59:48 -07005214 nv_disable_hw_interrupts(dev, np->irqmask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005215 pci_push(base);
Ayaz Abdullaeb798422008-02-04 15:14:04 -05005216 writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005217 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
5218 pci_push(base);
5219
Szymon Janc78aea4f2010-11-27 08:39:43 +00005220 if (nv_request_irq(dev, 0))
Ayaz Abdulla84b39322006-05-20 14:59:48 -07005221 goto out_drain;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005222
5223 /* ask for interrupts */
Ayaz Abdulla84b39322006-05-20 14:59:48 -07005224 nv_enable_hw_interrupts(dev, np->irqmask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005225
5226 spin_lock_irq(&np->lock);
5227 writel(NVREG_MCASTADDRA_FORCE, base + NvRegMulticastAddrA);
5228 writel(0, base + NvRegMulticastAddrB);
Ayaz Abdullabb9a4fd2008-01-13 16:03:04 -05005229 writel(NVREG_MCASTMASKA_NONE, base + NvRegMulticastMaskA);
5230 writel(NVREG_MCASTMASKB_NONE, base + NvRegMulticastMaskB);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005231 writel(NVREG_PFF_ALWAYS|NVREG_PFF_MYADDR, base + NvRegPacketFilterFlags);
5232 /* One manual link speed update: Interrupts are enabled, future link
5233 * speed changes cause interrupts and are handled by nv_link_irq().
5234 */
5235 {
5236 u32 miistat;
5237 miistat = readl(base + NvRegMIIStatus);
Ayaz Abdullaeb798422008-02-04 15:14:04 -05005238 writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus);
Joe Perchesf52dafc2010-11-29 07:41:55 +00005239 netdev_dbg(dev, "startup: got 0x%08x\n", miistat);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005240 }
Manfred Spraul1b1b3c92005-08-06 23:47:55 +02005241 /* set linkspeed to invalid value, thus force nv_update_linkspeed
5242 * to init hw */
5243 np->linkspeed = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005244 ret = nv_update_linkspeed(dev);
Jeff Garzik36b30ea2007-10-16 01:40:30 -04005245 nv_start_rxtx(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005246 netif_start_queue(dev);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00005247 nv_napi_enable(dev);
Stephen Hemmingere27cdba2006-07-31 20:37:19 -07005248
Linus Torvalds1da177e2005-04-16 15:20:36 -07005249 if (ret) {
5250 netif_carrier_on(dev);
5251 } else {
Ed Swierkf7ab6972007-09-28 22:42:13 -07005252 printk(KERN_INFO "%s: no link during initialization.\n", dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005253 netif_carrier_off(dev);
5254 }
5255 if (oom)
5256 mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
Ayaz Abdulla52da3572006-06-10 22:48:04 -04005257
5258 /* start statistics timer */
Ayaz Abdulla9c662432008-08-06 12:11:42 -04005259 if (np->driver_data & (DEV_HAS_STATISTICS_V1|DEV_HAS_STATISTICS_V2|DEV_HAS_STATISTICS_V3))
Daniel Drakebfebbb82008-03-18 11:07:18 +00005260 mod_timer(&np->stats_poll,
5261 round_jiffies(jiffies + STATS_INTERVAL));
Ayaz Abdulla52da3572006-06-10 22:48:04 -04005262
Linus Torvalds1da177e2005-04-16 15:20:36 -07005263 spin_unlock_irq(&np->lock);
5264
5265 return 0;
5266out_drain:
Jeff Garzik36b30ea2007-10-16 01:40:30 -04005267 nv_drain_rxtx(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005268 return ret;
5269}
5270
5271static int nv_close(struct net_device *dev)
5272{
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04005273 struct fe_priv *np = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005274 u8 __iomem *base;
5275
5276 spin_lock_irq(&np->lock);
5277 np->in_shutdown = 1;
5278 spin_unlock_irq(&np->lock);
Ayaz Abdulla08d93572009-03-05 08:01:55 +00005279 nv_napi_disable(dev);
Manfred Spraula7475902007-10-17 21:52:33 +02005280 synchronize_irq(np->pci_dev->irq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005281
5282 del_timer_sync(&np->oom_kick);
5283 del_timer_sync(&np->nic_poll);
Ayaz Abdulla52da3572006-06-10 22:48:04 -04005284 del_timer_sync(&np->stats_poll);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005285
5286 netif_stop_queue(dev);
5287 spin_lock_irq(&np->lock);
Jeff Garzik36b30ea2007-10-16 01:40:30 -04005288 nv_stop_rxtx(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005289 nv_txrx_reset(dev);
5290
5291 /* disable interrupts on the nic or we will lock up */
5292 base = get_hwbase(dev);
Ayaz Abdulla84b39322006-05-20 14:59:48 -07005293 nv_disable_hw_interrupts(dev, np->irqmask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005294 pci_push(base);
Joe Perchesf52dafc2010-11-29 07:41:55 +00005295 netdev_dbg(dev, "Irqmask is zero again\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07005296
5297 spin_unlock_irq(&np->lock);
5298
Ayaz Abdulla84b39322006-05-20 14:59:48 -07005299 nv_free_irq(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005300
Jeff Garzik36b30ea2007-10-16 01:40:30 -04005301 nv_drain_rxtx(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005302
Ed Swierk5a9a8e32009-06-02 00:19:52 -07005303 if (np->wolenabled || !phy_power_down) {
Ayaz Abdulla88d7d8b2009-05-01 01:41:50 +00005304 nv_txrx_gate(dev, false);
Tim Mann2cc49a52007-06-14 13:16:38 -07005305 writel(NVREG_PFF_ALWAYS|NVREG_PFF_MYADDR, base + NvRegPacketFilterFlags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005306 nv_start_rx(dev);
Ed Swierkcb52deb2008-12-01 12:24:43 +00005307 } else {
5308 /* power down phy */
5309 mii_rw(dev, np->phyaddr, MII_BMCR,
5310 mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ)|BMCR_PDOWN);
Ayaz Abdulla88d7d8b2009-05-01 01:41:50 +00005311 nv_txrx_gate(dev, true);
Tim Mann2cc49a52007-06-14 13:16:38 -07005312 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005313
5314 /* FIXME: power down nic */
5315
5316 return 0;
5317}
5318
Stephen Hemmingerb94426b2008-11-19 22:26:51 -08005319static const struct net_device_ops nv_netdev_ops = {
5320 .ndo_open = nv_open,
5321 .ndo_stop = nv_close,
5322 .ndo_get_stats = nv_get_stats,
Stephen Hemminger00829822008-11-20 20:14:53 -08005323 .ndo_start_xmit = nv_start_xmit,
5324 .ndo_tx_timeout = nv_tx_timeout,
5325 .ndo_change_mtu = nv_change_mtu,
5326 .ndo_validate_addr = eth_validate_addr,
5327 .ndo_set_mac_address = nv_set_mac_address,
5328 .ndo_set_multicast_list = nv_set_multicast,
5329 .ndo_vlan_rx_register = nv_vlan_rx_register,
5330#ifdef CONFIG_NET_POLL_CONTROLLER
5331 .ndo_poll_controller = nv_poll_controller,
5332#endif
5333};
5334
5335static const struct net_device_ops nv_netdev_ops_optimized = {
5336 .ndo_open = nv_open,
5337 .ndo_stop = nv_close,
5338 .ndo_get_stats = nv_get_stats,
5339 .ndo_start_xmit = nv_start_xmit_optimized,
Stephen Hemmingerb94426b2008-11-19 22:26:51 -08005340 .ndo_tx_timeout = nv_tx_timeout,
5341 .ndo_change_mtu = nv_change_mtu,
5342 .ndo_validate_addr = eth_validate_addr,
5343 .ndo_set_mac_address = nv_set_mac_address,
5344 .ndo_set_multicast_list = nv_set_multicast,
5345 .ndo_vlan_rx_register = nv_vlan_rx_register,
5346#ifdef CONFIG_NET_POLL_CONTROLLER
5347 .ndo_poll_controller = nv_poll_controller,
5348#endif
5349};
5350
Linus Torvalds1da177e2005-04-16 15:20:36 -07005351static int __devinit nv_probe(struct pci_dev *pci_dev, const struct pci_device_id *id)
5352{
5353 struct net_device *dev;
5354 struct fe_priv *np;
5355 unsigned long addr;
5356 u8 __iomem *base;
5357 int err, i;
Ayaz Abdulla5070d342006-07-31 12:05:01 -04005358 u32 powerstate, txreg;
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005359 u32 phystate_orig = 0, phystate;
5360 int phyinitialized = 0;
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005361 static int printed_version;
5362
5363 if (!printed_version++)
5364 printk(KERN_INFO "%s: Reverse Engineered nForce ethernet"
5365 " driver. Version %s.\n", DRV_NAME, FORCEDETH_VERSION);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005366
5367 dev = alloc_etherdev(sizeof(struct fe_priv));
5368 err = -ENOMEM;
5369 if (!dev)
5370 goto out;
5371
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04005372 np = netdev_priv(dev);
Stephen Hemmingerbea33482007-10-03 16:41:36 -07005373 np->dev = dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005374 np->pci_dev = pci_dev;
5375 spin_lock_init(&np->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005376 SET_NETDEV_DEV(dev, &pci_dev->dev);
5377
5378 init_timer(&np->oom_kick);
5379 np->oom_kick.data = (unsigned long) dev;
Joe Perchesc061b182010-08-23 18:20:03 +00005380 np->oom_kick.function = nv_do_rx_refill; /* timer handler */
Linus Torvalds1da177e2005-04-16 15:20:36 -07005381 init_timer(&np->nic_poll);
5382 np->nic_poll.data = (unsigned long) dev;
Joe Perchesc061b182010-08-23 18:20:03 +00005383 np->nic_poll.function = nv_do_nic_poll; /* timer handler */
Ayaz Abdulla52da3572006-06-10 22:48:04 -04005384 init_timer(&np->stats_poll);
5385 np->stats_poll.data = (unsigned long) dev;
Joe Perchesc061b182010-08-23 18:20:03 +00005386 np->stats_poll.function = nv_do_stats_poll; /* timer handler */
Linus Torvalds1da177e2005-04-16 15:20:36 -07005387
5388 err = pci_enable_device(pci_dev);
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005389 if (err)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005390 goto out_free;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005391
5392 pci_set_master(pci_dev);
5393
5394 err = pci_request_regions(pci_dev, DRV_NAME);
5395 if (err < 0)
5396 goto out_disable;
5397
Ayaz Abdulla9c662432008-08-06 12:11:42 -04005398 if (id->driver_data & (DEV_HAS_VLAN|DEV_HAS_MSI_X|DEV_HAS_POWER_CNTRL|DEV_HAS_STATISTICS_V2|DEV_HAS_STATISTICS_V3))
Ayaz Abdulla57fff692007-01-23 12:27:00 -05005399 np->register_size = NV_PCI_REGSZ_VER3;
5400 else if (id->driver_data & DEV_HAS_STATISTICS_V1)
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04005401 np->register_size = NV_PCI_REGSZ_VER2;
5402 else
5403 np->register_size = NV_PCI_REGSZ_VER1;
5404
Linus Torvalds1da177e2005-04-16 15:20:36 -07005405 err = -EINVAL;
5406 addr = 0;
5407 for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
Joe Perches6b808582010-11-29 07:41:53 +00005408 netdev_dbg(dev, "%s: resource %d start %p len %lld flags 0x%08lx\n",
5409 pci_name(pci_dev), i,
5410 (void *)(unsigned long)pci_resource_start(pci_dev, i),
5411 (long long)pci_resource_len(pci_dev, i),
5412 pci_resource_flags(pci_dev, i));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005413 if (pci_resource_flags(pci_dev, i) & IORESOURCE_MEM &&
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04005414 pci_resource_len(pci_dev, i) >= np->register_size) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005415 addr = pci_resource_start(pci_dev, i);
5416 break;
5417 }
5418 }
5419 if (i == DEVICE_COUNT_RESOURCE) {
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005420 dev_printk(KERN_INFO, &pci_dev->dev,
5421 "Couldn't find register window\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07005422 goto out_relreg;
5423 }
5424
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04005425 /* copy of driver data */
5426 np->driver_data = id->driver_data;
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04005427 /* copy of device id */
5428 np->device_id = id->device;
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04005429
Linus Torvalds1da177e2005-04-16 15:20:36 -07005430 /* handle different descriptor versions */
Manfred Spraulee733622005-07-31 18:32:26 +02005431 if (id->driver_data & DEV_HAS_HIGH_DMA) {
5432 /* packet format 3: supports 40-bit addressing */
5433 np->desc_ver = DESC_VER_3;
Ayaz Abdulla84b39322006-05-20 14:59:48 -07005434 np->txrxctl_bits = NVREG_TXRXCTL_DESC_3;
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -04005435 if (dma_64bit) {
Yang Hongyang6afd1422009-04-06 19:01:15 -07005436 if (pci_set_dma_mask(pci_dev, DMA_BIT_MASK(39)))
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005437 dev_printk(KERN_INFO, &pci_dev->dev,
5438 "64-bit DMA failed, using 32-bit addressing\n");
5439 else
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -04005440 dev->features |= NETIF_F_HIGHDMA;
Yang Hongyang6afd1422009-04-06 19:01:15 -07005441 if (pci_set_consistent_dma_mask(pci_dev, DMA_BIT_MASK(39))) {
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005442 dev_printk(KERN_INFO, &pci_dev->dev,
5443 "64-bit DMA (consistent) failed, using 32-bit ring buffers\n");
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -04005444 }
Ayaz Abdulla84b39322006-05-20 14:59:48 -07005445 }
Manfred Spraulee733622005-07-31 18:32:26 +02005446 } else if (id->driver_data & DEV_HAS_LARGEDESC) {
5447 /* packet format 2: supports jumbo frames */
Linus Torvalds1da177e2005-04-16 15:20:36 -07005448 np->desc_ver = DESC_VER_2;
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005449 np->txrxctl_bits = NVREG_TXRXCTL_DESC_2;
Manfred Spraulee733622005-07-31 18:32:26 +02005450 } else {
5451 /* original packet format */
5452 np->desc_ver = DESC_VER_1;
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005453 np->txrxctl_bits = NVREG_TXRXCTL_DESC_1;
Manfred Sprauld81c0982005-07-31 18:20:30 +02005454 }
Manfred Spraulee733622005-07-31 18:32:26 +02005455
5456 np->pkt_limit = NV_PKTLIMIT_1;
5457 if (id->driver_data & DEV_HAS_LARGEDESC)
5458 np->pkt_limit = NV_PKTLIMIT_2;
5459
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005460 if (id->driver_data & DEV_HAS_CHECKSUM) {
Ayaz Abdullaf2ad2d92006-08-24 17:35:41 -04005461 np->rx_csum = 1;
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005462 np->txrxctl_bits |= NVREG_TXRXCTL_RXCHECK;
Ayaz Abdullaedcfe5f2008-08-20 16:34:37 -07005463 dev->features |= NETIF_F_IP_CSUM | NETIF_F_SG;
Ayaz Abdullafa454592006-01-05 22:45:45 -08005464 dev->features |= NETIF_F_TSO;
Tom Herbert53f224c2010-05-03 19:08:45 +00005465 dev->features |= NETIF_F_GRO;
Ayaz Abdulla21828162007-01-23 12:27:21 -05005466 }
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005467
Ayaz Abdullaee407b02006-02-04 13:13:17 -05005468 np->vlanctl_bits = 0;
5469 if (id->driver_data & DEV_HAS_VLAN) {
5470 np->vlanctl_bits = NVREG_VLANCONTROL_ENABLE;
5471 dev->features |= NETIF_F_HW_VLAN_RX | NETIF_F_HW_VLAN_TX;
Ayaz Abdullaee407b02006-02-04 13:13:17 -05005472 }
5473
Ayaz Abdullab6d07732006-06-10 22:47:42 -04005474 np->pause_flags = NV_PAUSEFRAME_RX_CAPABLE | NV_PAUSEFRAME_RX_REQ | NV_PAUSEFRAME_AUTONEG;
Ayaz Abdulla5289b4c2008-02-05 12:30:01 -05005475 if ((id->driver_data & DEV_HAS_PAUSEFRAME_TX_V1) ||
5476 (id->driver_data & DEV_HAS_PAUSEFRAME_TX_V2) ||
5477 (id->driver_data & DEV_HAS_PAUSEFRAME_TX_V3)) {
Ayaz Abdullab6d07732006-06-10 22:47:42 -04005478 np->pause_flags |= NV_PAUSEFRAME_TX_CAPABLE | NV_PAUSEFRAME_TX_REQ;
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04005479 }
Jeff Garzikf3b197a2006-05-26 21:39:03 -04005480
Ayaz Abdullaeb91f612006-05-24 18:13:19 -04005481
Linus Torvalds1da177e2005-04-16 15:20:36 -07005482 err = -ENOMEM;
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04005483 np->base = ioremap(addr, np->register_size);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005484 if (!np->base)
5485 goto out_relreg;
5486 dev->base_addr = (unsigned long)np->base;
Manfred Spraulee733622005-07-31 18:32:26 +02005487
Linus Torvalds1da177e2005-04-16 15:20:36 -07005488 dev->irq = pci_dev->irq;
Manfred Spraulee733622005-07-31 18:32:26 +02005489
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005490 np->rx_ring_size = RX_RING_DEFAULT;
5491 np->tx_ring_size = TX_RING_DEFAULT;
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005492
Jeff Garzik36b30ea2007-10-16 01:40:30 -04005493 if (!nv_optimized(np)) {
Manfred Spraulee733622005-07-31 18:32:26 +02005494 np->rx_ring.orig = pci_alloc_consistent(pci_dev,
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005495 sizeof(struct ring_desc) * (np->rx_ring_size + np->tx_ring_size),
Manfred Spraulee733622005-07-31 18:32:26 +02005496 &np->ring_addr);
5497 if (!np->rx_ring.orig)
5498 goto out_unmap;
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005499 np->tx_ring.orig = &np->rx_ring.orig[np->rx_ring_size];
Manfred Spraulee733622005-07-31 18:32:26 +02005500 } else {
5501 np->rx_ring.ex = pci_alloc_consistent(pci_dev,
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005502 sizeof(struct ring_desc_ex) * (np->rx_ring_size + np->tx_ring_size),
Manfred Spraulee733622005-07-31 18:32:26 +02005503 &np->ring_addr);
5504 if (!np->rx_ring.ex)
5505 goto out_unmap;
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005506 np->tx_ring.ex = &np->rx_ring.ex[np->rx_ring_size];
Manfred Spraulee733622005-07-31 18:32:26 +02005507 }
Yoann Padioleaudd00cc42007-07-19 01:49:03 -07005508 np->rx_skb = kcalloc(np->rx_ring_size, sizeof(struct nv_skb_map), GFP_KERNEL);
5509 np->tx_skb = kcalloc(np->tx_ring_size, sizeof(struct nv_skb_map), GFP_KERNEL);
Ayaz Abdulla761fcd92007-01-09 13:30:07 -05005510 if (!np->rx_skb || !np->tx_skb)
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005511 goto out_freering;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005512
Jeff Garzik36b30ea2007-10-16 01:40:30 -04005513 if (!nv_optimized(np))
Stephen Hemminger00829822008-11-20 20:14:53 -08005514 dev->netdev_ops = &nv_netdev_ops;
Ayaz Abdulla86b22b02007-01-21 18:10:37 -05005515 else
Stephen Hemminger00829822008-11-20 20:14:53 -08005516 dev->netdev_ops = &nv_netdev_ops_optimized;
Stephen Hemmingerb94426b2008-11-19 22:26:51 -08005517
Stephen Hemmingerbea33482007-10-03 16:41:36 -07005518 netif_napi_add(dev, &np->napi, nv_napi_poll, RX_WORK_PER_LOOP);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005519 SET_ETHTOOL_OPS(dev, &ops);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005520 dev->watchdog_timeo = NV_WATCHDOG_TIMEO;
5521
5522 pci_set_drvdata(pci_dev, dev);
5523
5524 /* read the mac address */
5525 base = get_hwbase(dev);
5526 np->orig_mac[0] = readl(base + NvRegMacAddrA);
5527 np->orig_mac[1] = readl(base + NvRegMacAddrB);
5528
Ayaz Abdulla5070d342006-07-31 12:05:01 -04005529 /* check the workaround bit for correct mac address order */
5530 txreg = readl(base + NvRegTransmitPoll);
Ayaz Abdullaa376e792008-04-10 21:30:35 -07005531 if (id->driver_data & DEV_HAS_CORRECT_MACADDR) {
Ayaz Abdulla5070d342006-07-31 12:05:01 -04005532 /* mac address is already in correct order */
5533 dev->dev_addr[0] = (np->orig_mac[0] >> 0) & 0xff;
5534 dev->dev_addr[1] = (np->orig_mac[0] >> 8) & 0xff;
5535 dev->dev_addr[2] = (np->orig_mac[0] >> 16) & 0xff;
5536 dev->dev_addr[3] = (np->orig_mac[0] >> 24) & 0xff;
5537 dev->dev_addr[4] = (np->orig_mac[1] >> 0) & 0xff;
5538 dev->dev_addr[5] = (np->orig_mac[1] >> 8) & 0xff;
Ayaz Abdullaa376e792008-04-10 21:30:35 -07005539 } else if (txreg & NVREG_TRANSMITPOLL_MAC_ADDR_REV) {
5540 /* mac address is already in correct order */
5541 dev->dev_addr[0] = (np->orig_mac[0] >> 0) & 0xff;
5542 dev->dev_addr[1] = (np->orig_mac[0] >> 8) & 0xff;
5543 dev->dev_addr[2] = (np->orig_mac[0] >> 16) & 0xff;
5544 dev->dev_addr[3] = (np->orig_mac[0] >> 24) & 0xff;
5545 dev->dev_addr[4] = (np->orig_mac[1] >> 0) & 0xff;
5546 dev->dev_addr[5] = (np->orig_mac[1] >> 8) & 0xff;
5547 /*
5548 * Set orig mac address back to the reversed version.
5549 * This flag will be cleared during low power transition.
5550 * Therefore, we should always put back the reversed address.
5551 */
5552 np->orig_mac[0] = (dev->dev_addr[5] << 0) + (dev->dev_addr[4] << 8) +
5553 (dev->dev_addr[3] << 16) + (dev->dev_addr[2] << 24);
5554 np->orig_mac[1] = (dev->dev_addr[1] << 0) + (dev->dev_addr[0] << 8);
Ayaz Abdulla5070d342006-07-31 12:05:01 -04005555 } else {
5556 /* need to reverse mac address to correct order */
5557 dev->dev_addr[0] = (np->orig_mac[1] >> 8) & 0xff;
5558 dev->dev_addr[1] = (np->orig_mac[1] >> 0) & 0xff;
5559 dev->dev_addr[2] = (np->orig_mac[0] >> 24) & 0xff;
5560 dev->dev_addr[3] = (np->orig_mac[0] >> 16) & 0xff;
5561 dev->dev_addr[4] = (np->orig_mac[0] >> 8) & 0xff;
5562 dev->dev_addr[5] = (np->orig_mac[0] >> 0) & 0xff;
Ayaz Abdulla5070d342006-07-31 12:05:01 -04005563 writel(txreg|NVREG_TRANSMITPOLL_MAC_ADDR_REV, base + NvRegTransmitPoll);
Yinghai Luf55c21f2008-09-13 13:10:31 -07005564 printk(KERN_DEBUG "nv_probe: set workaround bit for reversed mac addr\n");
Ayaz Abdulla5070d342006-07-31 12:05:01 -04005565 }
John W. Linvillec704b852005-09-12 10:48:56 -04005566 memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005567
John W. Linvillec704b852005-09-12 10:48:56 -04005568 if (!is_valid_ether_addr(dev->perm_addr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005569 /*
5570 * Bad mac address. At least one bios sets the mac address
5571 * to 01:23:45:67:89:ab
5572 */
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005573 dev_printk(KERN_ERR, &pci_dev->dev,
Johannes Berge1749612008-10-27 15:59:26 -07005574 "Invalid Mac address detected: %pM\n",
Szymon Janc78aea4f2010-11-27 08:39:43 +00005575 dev->dev_addr);
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005576 dev_printk(KERN_ERR, &pci_dev->dev,
5577 "Please complain to your hardware vendor. Switching to a random MAC.\n");
Stanislav O. Bezzubtsev655a6592009-11-15 21:17:02 -08005578 random_ether_addr(dev->dev_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005579 }
5580
Joe Perches6b808582010-11-29 07:41:53 +00005581 netdev_dbg(dev, "%s: MAC Address %pM\n",
5582 pci_name(pci_dev), dev->dev_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005583
Ayaz Abdullaf1489652006-07-31 12:04:45 -04005584 /* set mac address */
5585 nv_copy_mac_to_hw(dev);
5586
Tobias Diedrich9a60a822008-06-01 00:54:42 +02005587 /* Workaround current PCI init glitch: wakeup bits aren't
5588 * being set from PCI PM capability.
5589 */
5590 device_init_wakeup(&pci_dev->dev, 1);
5591
Linus Torvalds1da177e2005-04-16 15:20:36 -07005592 /* disable WOL */
5593 writel(0, base + NvRegWakeUpFlags);
5594 np->wolenabled = 0;
5595
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04005596 if (id->driver_data & DEV_HAS_POWER_CNTRL) {
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04005597
5598 /* take phy and nic out of low power mode */
5599 powerstate = readl(base + NvRegPowerState2);
5600 powerstate &= ~NVREG_POWERSTATE2_POWERUP_MASK;
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005601 if ((id->driver_data & DEV_NEED_LOW_POWER_FIX) &&
Auke Kok44c10132007-06-08 15:46:36 -07005602 pci_dev->revision >= 0xA3)
Ayaz Abdulla86a0f042006-04-24 18:41:31 -04005603 powerstate |= NVREG_POWERSTATE2_POWERUP_REV_A3;
5604 writel(powerstate, base + NvRegPowerState2);
5605 }
5606
Szymon Janc78aea4f2010-11-27 08:39:43 +00005607 if (np->desc_ver == DESC_VER_1)
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04005608 np->tx_flags = NV_TX_VALID;
Szymon Janc78aea4f2010-11-27 08:39:43 +00005609 else
Ayaz Abdullaac9c1892005-10-26 00:51:24 -04005610 np->tx_flags = NV_TX2_VALID;
Ayaz Abdulla9e184762009-03-05 08:02:18 +00005611
5612 np->msi_flags = 0;
Szymon Janc78aea4f2010-11-27 08:39:43 +00005613 if ((id->driver_data & DEV_HAS_MSI) && msi)
Ayaz Abdulla9e184762009-03-05 08:02:18 +00005614 np->msi_flags |= NV_MSI_CAPABLE;
Szymon Janc78aea4f2010-11-27 08:39:43 +00005615
Ayaz Abdulla9e184762009-03-05 08:02:18 +00005616 if ((id->driver_data & DEV_HAS_MSI_X) && msix) {
5617 /* msix has had reported issues when modifying irqmask
5618 as in the case of napi, therefore, disable for now
5619 */
David S. Miller0a127612010-05-03 23:33:05 -07005620#if 0
Ayaz Abdulla9e184762009-03-05 08:02:18 +00005621 np->msi_flags |= NV_MSI_X_CAPABLE;
5622#endif
5623 }
5624
5625 if (optimization_mode == NV_OPTIMIZATION_MODE_CPU) {
Ayaz Abdullaa971c322005-11-11 08:30:38 -05005626 np->irqmask = NVREG_IRQMASK_CPU;
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05005627 if (np->msi_flags & NV_MSI_X_CAPABLE) /* set number of vectors */
5628 np->msi_flags |= 0x0001;
Ayaz Abdulla9e184762009-03-05 08:02:18 +00005629 } else if (optimization_mode == NV_OPTIMIZATION_MODE_DYNAMIC &&
5630 !(id->driver_data & DEV_NEED_TIMERIRQ)) {
5631 /* start off in throughput mode */
5632 np->irqmask = NVREG_IRQMASK_THROUGHPUT;
5633 /* remove support for msix mode */
5634 np->msi_flags &= ~NV_MSI_X_CAPABLE;
5635 } else {
5636 optimization_mode = NV_OPTIMIZATION_MODE_THROUGHPUT;
5637 np->irqmask = NVREG_IRQMASK_THROUGHPUT;
5638 if (np->msi_flags & NV_MSI_X_CAPABLE) /* set number of vectors */
5639 np->msi_flags |= 0x0003;
Ayaz Abdullad33a73c82006-02-04 13:13:31 -05005640 }
Ayaz Abdullaa971c322005-11-11 08:30:38 -05005641
Linus Torvalds1da177e2005-04-16 15:20:36 -07005642 if (id->driver_data & DEV_NEED_TIMERIRQ)
5643 np->irqmask |= NVREG_IRQ_TIMER;
5644 if (id->driver_data & DEV_NEED_LINKTIMER) {
Joe Perchesf52dafc2010-11-29 07:41:55 +00005645 netdev_dbg(dev, "%s: link timer on\n", pci_name(pci_dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005646 np->need_linktimer = 1;
5647 np->link_timeout = jiffies + LINK_TIMEOUT;
5648 } else {
Joe Perchesf52dafc2010-11-29 07:41:55 +00005649 netdev_dbg(dev, "%s: link timer off\n", pci_name(pci_dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005650 np->need_linktimer = 0;
5651 }
5652
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05005653 /* Limit the number of tx's outstanding for hw bug */
5654 if (id->driver_data & DEV_NEED_TX_LIMIT) {
5655 np->tx_limit = 1;
Ayaz Abdulla5c659322010-04-13 18:49:51 -07005656 if (((id->driver_data & DEV_NEED_TX_LIMIT2) == DEV_NEED_TX_LIMIT2) &&
Ayaz Abdulla3b446c32008-03-10 14:58:21 -05005657 pci_dev->revision >= 0xA2)
5658 np->tx_limit = 0;
5659 }
5660
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005661 /* clear phy state and temporarily halt phy interrupts */
5662 writel(0, base + NvRegMIIMask);
5663 phystate = readl(base + NvRegAdapterControl);
5664 if (phystate & NVREG_ADAPTCTL_RUNNING) {
5665 phystate_orig = 1;
5666 phystate &= ~NVREG_ADAPTCTL_RUNNING;
5667 writel(phystate, base + NvRegAdapterControl);
5668 }
Ayaz Abdullaeb798422008-02-04 15:14:04 -05005669 writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus);
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005670
5671 if (id->driver_data & DEV_HAS_MGMT_UNIT) {
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005672 /* management unit running on the mac? */
Ayaz Abdullacac1c522009-02-07 00:23:57 -08005673 if ((readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_MGMT_ST) &&
5674 (readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_SYNC_PHY_INIT) &&
5675 nv_mgmt_acquire_sema(dev) &&
5676 nv_mgmt_get_version(dev)) {
5677 np->mac_in_use = 1;
Szymon Janc78aea4f2010-11-27 08:39:43 +00005678 if (np->mgmt_version > 0)
Ayaz Abdullacac1c522009-02-07 00:23:57 -08005679 np->mac_in_use = readl(base + NvRegMgmtUnitControl) & NVREG_MGMTUNITCONTROL_INUSE;
Joe Perchesf52dafc2010-11-29 07:41:55 +00005680 netdev_dbg(dev, "%s: mgmt unit is running. mac in use %x\n",
5681 pci_name(pci_dev), np->mac_in_use);
Ayaz Abdullacac1c522009-02-07 00:23:57 -08005682 /* management unit setup the phy already? */
5683 if (np->mac_in_use &&
5684 ((readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_SYNC_MASK) ==
5685 NVREG_XMITCTL_SYNC_PHY_INIT)) {
5686 /* phy is inited by mgmt unit */
5687 phyinitialized = 1;
Joe Perchesf52dafc2010-11-29 07:41:55 +00005688 netdev_dbg(dev, "%s: Phy already initialized by mgmt unit\n",
5689 pci_name(pci_dev));
Ayaz Abdullacac1c522009-02-07 00:23:57 -08005690 } else {
5691 /* we need to init the phy */
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005692 }
5693 }
5694 }
5695
Linus Torvalds1da177e2005-04-16 15:20:36 -07005696 /* find a suitable phy */
Ayaz Abdulla7a33e452005-11-11 08:31:11 -05005697 for (i = 1; i <= 32; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005698 int id1, id2;
Ayaz Abdulla7a33e452005-11-11 08:31:11 -05005699 int phyaddr = i & 0x1F;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005700
5701 spin_lock_irq(&np->lock);
Ayaz Abdulla7a33e452005-11-11 08:31:11 -05005702 id1 = mii_rw(dev, phyaddr, MII_PHYSID1, MII_READ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005703 spin_unlock_irq(&np->lock);
5704 if (id1 < 0 || id1 == 0xffff)
5705 continue;
5706 spin_lock_irq(&np->lock);
Ayaz Abdulla7a33e452005-11-11 08:31:11 -05005707 id2 = mii_rw(dev, phyaddr, MII_PHYSID2, MII_READ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005708 spin_unlock_irq(&np->lock);
5709 if (id2 < 0 || id2 == 0xffff)
5710 continue;
5711
Ayaz Abdullaedf7e5e2006-08-24 15:43:42 -04005712 np->phy_model = id2 & PHYID2_MODEL_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005713 id1 = (id1 & PHYID1_OUI_MASK) << PHYID1_OUI_SHFT;
5714 id2 = (id2 & PHYID2_OUI_MASK) >> PHYID2_OUI_SHFT;
Joe Perches6b808582010-11-29 07:41:53 +00005715 netdev_dbg(dev, "%s: %s: Found PHY %04x:%04x at address %d\n",
5716 pci_name(pci_dev), __func__, id1, id2, phyaddr);
Ayaz Abdulla7a33e452005-11-11 08:31:11 -05005717 np->phyaddr = phyaddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005718 np->phy_oui = id1 | id2;
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04005719
5720 /* Realtek hardcoded phy id1 to all zero's on certain phys */
5721 if (np->phy_oui == PHY_OUI_REALTEK2)
5722 np->phy_oui = PHY_OUI_REALTEK;
5723 /* Setup phy revision for Realtek */
5724 if (np->phy_oui == PHY_OUI_REALTEK && np->phy_model == PHY_MODEL_REALTEK_8211)
5725 np->phy_rev = mii_rw(dev, phyaddr, MII_RESV1, MII_READ) & PHY_REV_MASK;
5726
Linus Torvalds1da177e2005-04-16 15:20:36 -07005727 break;
5728 }
Ayaz Abdulla7a33e452005-11-11 08:31:11 -05005729 if (i == 33) {
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005730 dev_printk(KERN_INFO, &pci_dev->dev,
5731 "open: Could not find a valid PHY.\n");
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005732 goto out_error;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005733 }
Jeff Garzikf3b197a2006-05-26 21:39:03 -04005734
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005735 if (!phyinitialized) {
5736 /* reset it */
5737 phy_init(dev);
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05005738 } else {
5739 /* see if it is a gigabit phy */
5740 u32 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
Szymon Janc78aea4f2010-11-27 08:39:43 +00005741 if (mii_status & PHY_GIGABIT)
Ayaz Abdullaf35723e2003-02-20 03:03:54 -05005742 np->gigabit = PHY_GIGABIT;
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005743 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005744
5745 /* set default link speed settings */
5746 np->linkspeed = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
5747 np->duplex = 0;
5748 np->autoneg = 1;
5749
5750 err = register_netdev(dev);
5751 if (err) {
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005752 dev_printk(KERN_INFO, &pci_dev->dev,
5753 "unable to register netdev: %d\n", err);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005754 goto out_error;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005755 }
Jeff Garzik3f88ce42007-10-16 04:09:09 -04005756
5757 dev_printk(KERN_INFO, &pci_dev->dev, "ifname %s, PHY OUI 0x%x @ %d, "
5758 "addr %2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x\n",
5759 dev->name,
5760 np->phy_oui,
5761 np->phyaddr,
5762 dev->dev_addr[0],
5763 dev->dev_addr[1],
5764 dev->dev_addr[2],
5765 dev->dev_addr[3],
5766 dev->dev_addr[4],
5767 dev->dev_addr[5]);
5768
5769 dev_printk(KERN_INFO, &pci_dev->dev, "%s%s%s%s%s%s%s%s%s%sdesc-v%u\n",
Szymon Janc78aea4f2010-11-27 08:39:43 +00005770 dev->features & NETIF_F_HIGHDMA ? "highdma " : "",
5771 dev->features & (NETIF_F_IP_CSUM | NETIF_F_SG) ?
5772 "csum " : "",
5773 dev->features & (NETIF_F_HW_VLAN_RX | NETIF_F_HW_VLAN_TX) ?
5774 "vlan " : "",
5775 id->driver_data & DEV_HAS_POWER_CNTRL ? "pwrctl " : "",
5776 id->driver_data & DEV_HAS_MGMT_UNIT ? "mgmt " : "",
5777 id->driver_data & DEV_NEED_TIMERIRQ ? "timirq " : "",
5778 np->gigabit == PHY_GIGABIT ? "gbit " : "",
5779 np->need_linktimer ? "lnktim " : "",
5780 np->msi_flags & NV_MSI_CAPABLE ? "msi " : "",
5781 np->msi_flags & NV_MSI_X_CAPABLE ? "msi-x " : "",
5782 np->desc_ver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005783
5784 return 0;
5785
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005786out_error:
Ayaz Abdulla7e680c22006-10-30 17:31:51 -05005787 if (phystate_orig)
5788 writel(phystate|NVREG_ADAPTCTL_RUNNING, base + NvRegAdapterControl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005789 pci_set_drvdata(pci_dev, NULL);
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005790out_freering:
5791 free_rings(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005792out_unmap:
5793 iounmap(get_hwbase(dev));
5794out_relreg:
5795 pci_release_regions(pci_dev);
5796out_disable:
5797 pci_disable_device(pci_dev);
5798out_free:
5799 free_netdev(dev);
5800out:
5801 return err;
5802}
5803
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04005804static void nv_restore_phy(struct net_device *dev)
5805{
5806 struct fe_priv *np = netdev_priv(dev);
5807 u16 phy_reserved, mii_control;
5808
5809 if (np->phy_oui == PHY_OUI_REALTEK &&
5810 np->phy_model == PHY_MODEL_REALTEK_8201 &&
5811 phy_cross == NV_CROSSOVER_DETECTION_DISABLED) {
5812 mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3);
5813 phy_reserved = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, MII_READ);
5814 phy_reserved &= ~PHY_REALTEK_INIT_MSK1;
5815 phy_reserved |= PHY_REALTEK_INIT8;
5816 mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, phy_reserved);
5817 mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1);
5818
5819 /* restart auto negotiation */
5820 mii_control = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
5821 mii_control |= (BMCR_ANRESTART | BMCR_ANENABLE);
5822 mii_rw(dev, np->phyaddr, MII_BMCR, mii_control);
5823 }
5824}
5825
Yinghai Luf55c21f2008-09-13 13:10:31 -07005826static void nv_restore_mac_addr(struct pci_dev *pci_dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005827{
5828 struct net_device *dev = pci_get_drvdata(pci_dev);
Ayaz Abdullaf1489652006-07-31 12:04:45 -04005829 struct fe_priv *np = netdev_priv(dev);
5830 u8 __iomem *base = get_hwbase(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005831
Ayaz Abdullaf1489652006-07-31 12:04:45 -04005832 /* special op: write back the misordered MAC address - otherwise
5833 * the next nv_probe would see a wrong address.
5834 */
5835 writel(np->orig_mac[0], base + NvRegMacAddrA);
5836 writel(np->orig_mac[1], base + NvRegMacAddrB);
Björn Steinbrink2e3884b2008-01-07 23:22:53 -08005837 writel(readl(base + NvRegTransmitPoll) & ~NVREG_TRANSMITPOLL_MAC_ADDR_REV,
5838 base + NvRegTransmitPoll);
Yinghai Luf55c21f2008-09-13 13:10:31 -07005839}
5840
5841static void __devexit nv_remove(struct pci_dev *pci_dev)
5842{
5843 struct net_device *dev = pci_get_drvdata(pci_dev);
5844
5845 unregister_netdev(dev);
5846
5847 nv_restore_mac_addr(pci_dev);
Ayaz Abdullaf1489652006-07-31 12:04:45 -04005848
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04005849 /* restore any phy related changes */
5850 nv_restore_phy(dev);
5851
Ayaz Abdullacac1c522009-02-07 00:23:57 -08005852 nv_mgmt_release_sema(dev);
5853
Linus Torvalds1da177e2005-04-16 15:20:36 -07005854 /* free all structures */
Ayaz Abdullaeafa59f2006-06-10 22:47:34 -04005855 free_rings(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005856 iounmap(get_hwbase(dev));
5857 pci_release_regions(pci_dev);
5858 pci_disable_device(pci_dev);
5859 free_netdev(dev);
5860 pci_set_drvdata(pci_dev, NULL);
5861}
5862
Francois Romieua1893172006-10-10 14:33:27 -07005863#ifdef CONFIG_PM
5864static int nv_suspend(struct pci_dev *pdev, pm_message_t state)
5865{
5866 struct net_device *dev = pci_get_drvdata(pdev);
5867 struct fe_priv *np = netdev_priv(dev);
Tobias Diedrich1a1ca862008-05-18 15:03:44 +02005868 u8 __iomem *base = get_hwbase(dev);
5869 int i;
Francois Romieua1893172006-10-10 14:33:27 -07005870
Tobias Diedrich25d90812008-05-18 15:04:29 +02005871 if (netif_running(dev)) {
Szymon Janc78aea4f2010-11-27 08:39:43 +00005872 /* Gross. */
Tobias Diedrich25d90812008-05-18 15:04:29 +02005873 nv_close(dev);
5874 }
Francois Romieua1893172006-10-10 14:33:27 -07005875 netif_device_detach(dev);
5876
Tobias Diedrich1a1ca862008-05-18 15:03:44 +02005877 /* save non-pci configuration space */
Szymon Janc78aea4f2010-11-27 08:39:43 +00005878 for (i = 0; i <= np->register_size/sizeof(u32); i++)
Tobias Diedrich1a1ca862008-05-18 15:03:44 +02005879 np->saved_config_space[i] = readl(base + i*sizeof(u32));
5880
Francois Romieua1893172006-10-10 14:33:27 -07005881 pci_save_state(pdev);
5882 pci_enable_wake(pdev, pci_choose_state(pdev, state), np->wolenabled);
Tobias Diedrich25d90812008-05-18 15:04:29 +02005883 pci_disable_device(pdev);
Francois Romieua1893172006-10-10 14:33:27 -07005884 pci_set_power_state(pdev, pci_choose_state(pdev, state));
Francois Romieua1893172006-10-10 14:33:27 -07005885 return 0;
5886}
5887
5888static int nv_resume(struct pci_dev *pdev)
5889{
5890 struct net_device *dev = pci_get_drvdata(pdev);
Tobias Diedrich1a1ca862008-05-18 15:03:44 +02005891 struct fe_priv *np = netdev_priv(dev);
Ayaz Abdullaa376e792008-04-10 21:30:35 -07005892 u8 __iomem *base = get_hwbase(dev);
Tobias Diedrich1a1ca862008-05-18 15:03:44 +02005893 int i, rc = 0;
Francois Romieua1893172006-10-10 14:33:27 -07005894
Francois Romieua1893172006-10-10 14:33:27 -07005895 pci_set_power_state(pdev, PCI_D0);
5896 pci_restore_state(pdev);
Tobias Diedrich25d90812008-05-18 15:04:29 +02005897 /* ack any pending wake events, disable PME */
Francois Romieua1893172006-10-10 14:33:27 -07005898 pci_enable_wake(pdev, PCI_D0, 0);
5899
Tobias Diedrich1a1ca862008-05-18 15:03:44 +02005900 /* restore non-pci configuration space */
Szymon Janc78aea4f2010-11-27 08:39:43 +00005901 for (i = 0; i <= np->register_size/sizeof(u32); i++)
Tobias Diedrich1a1ca862008-05-18 15:03:44 +02005902 writel(np->saved_config_space[i], base+i*sizeof(u32));
Ayaz Abdullaa376e792008-04-10 21:30:35 -07005903
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005904 if (np->driver_data & DEV_NEED_MSI_FIX)
5905 pci_write_config_dword(pdev, NV_MSI_PRIV_OFFSET, NV_MSI_PRIV_VALUE);
Ayaz Abdullab6e44052009-02-07 00:24:15 -08005906
Ed Swierk35a74332009-04-06 17:49:12 -07005907 /* restore phy state, including autoneg */
5908 phy_init(dev);
5909
Tobias Diedrich25d90812008-05-18 15:04:29 +02005910 netif_device_attach(dev);
5911 if (netif_running(dev)) {
5912 rc = nv_open(dev);
5913 nv_set_multicast(dev);
5914 }
Francois Romieua1893172006-10-10 14:33:27 -07005915 return rc;
5916}
Tobias Diedrichf735a2a2008-05-18 15:02:37 +02005917
5918static void nv_shutdown(struct pci_dev *pdev)
5919{
5920 struct net_device *dev = pci_get_drvdata(pdev);
5921 struct fe_priv *np = netdev_priv(dev);
5922
5923 if (netif_running(dev))
5924 nv_close(dev);
5925
Tobias Diedrich34edaa82009-02-16 00:13:20 -08005926 /*
5927 * Restore the MAC so a kernel started by kexec won't get confused.
5928 * If we really go for poweroff, we must not restore the MAC,
5929 * otherwise the MAC for WOL will be reversed at least on some boards.
5930 */
Szymon Janc78aea4f2010-11-27 08:39:43 +00005931 if (system_state != SYSTEM_POWER_OFF)
Tobias Diedrich34edaa82009-02-16 00:13:20 -08005932 nv_restore_mac_addr(pdev);
Yinghai Luf55c21f2008-09-13 13:10:31 -07005933
Tobias Diedrichf735a2a2008-05-18 15:02:37 +02005934 pci_disable_device(pdev);
Tobias Diedrich34edaa82009-02-16 00:13:20 -08005935 /*
5936 * Apparently it is not possible to reinitialise from D3 hot,
5937 * only put the device into D3 if we really go for poweroff.
5938 */
Rafael J. Wysocki3cb55992008-09-05 14:00:19 -07005939 if (system_state == SYSTEM_POWER_OFF) {
5940 if (pci_enable_wake(pdev, PCI_D3cold, np->wolenabled))
5941 pci_enable_wake(pdev, PCI_D3hot, np->wolenabled);
5942 pci_set_power_state(pdev, PCI_D3hot);
5943 }
Tobias Diedrichf735a2a2008-05-18 15:02:37 +02005944}
Francois Romieua1893172006-10-10 14:33:27 -07005945#else
5946#define nv_suspend NULL
Tobias Diedrichf735a2a2008-05-18 15:02:37 +02005947#define nv_shutdown NULL
Francois Romieua1893172006-10-10 14:33:27 -07005948#define nv_resume NULL
5949#endif /* CONFIG_PM */
5950
Alexey Dobriyana3aa1882010-01-07 11:58:11 +00005951static DEFINE_PCI_DEVICE_TABLE(pci_tbl) = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005952 { /* nForce Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005953 PCI_DEVICE(0x10DE, 0x01C3),
Manfred Spraulc2dba062005-07-31 18:29:47 +02005954 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005955 },
5956 { /* nForce2 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005957 PCI_DEVICE(0x10DE, 0x0066),
Manfred Spraulc2dba062005-07-31 18:29:47 +02005958 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005959 },
5960 { /* nForce3 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005961 PCI_DEVICE(0x10DE, 0x00D6),
Manfred Spraulc2dba062005-07-31 18:29:47 +02005962 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005963 },
5964 { /* nForce3 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005965 PCI_DEVICE(0x10DE, 0x0086),
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005966 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005967 },
5968 { /* nForce3 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005969 PCI_DEVICE(0x10DE, 0x008C),
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005970 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005971 },
5972 { /* nForce3 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005973 PCI_DEVICE(0x10DE, 0x00E6),
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005974 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005975 },
5976 { /* nForce3 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005977 PCI_DEVICE(0x10DE, 0x00DF),
Manfred Spraul8a4ae7f2005-09-21 23:22:10 -04005978 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005979 },
5980 { /* CK804 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005981 PCI_DEVICE(0x10DE, 0x0056),
Yinghai Lu033e97b2009-02-06 01:30:56 -08005982 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005983 },
5984 { /* CK804 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005985 PCI_DEVICE(0x10DE, 0x0057),
Yinghai Lu033e97b2009-02-06 01:30:56 -08005986 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005987 },
5988 { /* MCP04 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005989 PCI_DEVICE(0x10DE, 0x0037),
Ayaz Abdulla9e184762009-03-05 08:02:18 +00005990 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005991 },
5992 { /* MCP04 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005993 PCI_DEVICE(0x10DE, 0x0038),
Ayaz Abdulla9e184762009-03-05 08:02:18 +00005994 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT,
Manfred Sprauldc8216c2005-07-31 18:26:05 +02005995 },
5996 { /* MCP51 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00005997 PCI_DEVICE(0x10DE, 0x0268),
5998 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_STATISTICS_V1|DEV_NEED_LOW_POWER_FIX,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005999 },
Manfred Spraul9992d4a2005-06-05 17:36:11 +02006000 { /* MCP51 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006001 PCI_DEVICE(0x10DE, 0x0269),
6002 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_STATISTICS_V1|DEV_NEED_LOW_POWER_FIX,
Manfred Spraul9992d4a2005-06-05 17:36:11 +02006003 },
Manfred Spraulf49d16e2005-06-26 11:36:52 +02006004 { /* MCP55 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006005 PCI_DEVICE(0x10DE, 0x0372),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006006 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_VLAN|DEV_HAS_MSI|DEV_HAS_MSI_X|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_NEED_TX_LIMIT|DEV_NEED_MSI_FIX,
Manfred Spraulf49d16e2005-06-26 11:36:52 +02006007 },
6008 { /* MCP55 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006009 PCI_DEVICE(0x10DE, 0x0373),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006010 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_VLAN|DEV_HAS_MSI|DEV_HAS_MSI_X|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_NEED_TX_LIMIT|DEV_NEED_MSI_FIX,
Manfred Spraulf49d16e2005-06-26 11:36:52 +02006011 },
Ayaz Abdullac99ce7e2006-06-10 22:48:28 -04006012 { /* MCP61 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006013 PCI_DEVICE(0x10DE, 0x03E5),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006014 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_NEED_MSI_FIX,
Ayaz Abdullac99ce7e2006-06-10 22:48:28 -04006015 },
6016 { /* MCP61 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006017 PCI_DEVICE(0x10DE, 0x03E6),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006018 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_NEED_MSI_FIX,
Ayaz Abdullac99ce7e2006-06-10 22:48:28 -04006019 },
6020 { /* MCP61 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006021 PCI_DEVICE(0x10DE, 0x03EE),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006022 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_NEED_MSI_FIX,
Ayaz Abdullac99ce7e2006-06-10 22:48:28 -04006023 },
6024 { /* MCP61 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006025 PCI_DEVICE(0x10DE, 0x03EF),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006026 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_NEED_MSI_FIX,
Ayaz Abdullac99ce7e2006-06-10 22:48:28 -04006027 },
6028 { /* MCP65 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006029 PCI_DEVICE(0x10DE, 0x0450),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006030 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_NEED_TX_LIMIT|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdullac99ce7e2006-06-10 22:48:28 -04006031 },
6032 { /* MCP65 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006033 PCI_DEVICE(0x10DE, 0x0451),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006034 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_NEED_TX_LIMIT|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdullac99ce7e2006-06-10 22:48:28 -04006035 },
6036 { /* MCP65 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006037 PCI_DEVICE(0x10DE, 0x0452),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006038 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_NEED_TX_LIMIT|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdullac99ce7e2006-06-10 22:48:28 -04006039 },
6040 { /* MCP65 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006041 PCI_DEVICE(0x10DE, 0x0453),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006042 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_NEED_TX_LIMIT|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdullac99ce7e2006-06-10 22:48:28 -04006043 },
Ayaz Abdullaf4344842006-11-06 00:43:40 -08006044 { /* MCP67 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006045 PCI_DEVICE(0x10DE, 0x054C),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006046 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdullaf4344842006-11-06 00:43:40 -08006047 },
6048 { /* MCP67 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006049 PCI_DEVICE(0x10DE, 0x054D),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006050 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdullaf4344842006-11-06 00:43:40 -08006051 },
6052 { /* MCP67 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006053 PCI_DEVICE(0x10DE, 0x054E),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006054 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdullaf4344842006-11-06 00:43:40 -08006055 },
6056 { /* MCP67 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006057 PCI_DEVICE(0x10DE, 0x054F),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006058 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdullaf4344842006-11-06 00:43:40 -08006059 },
Ayaz Abdulla13986612007-07-22 20:43:26 -04006060 { /* MCP73 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006061 PCI_DEVICE(0x10DE, 0x07DC),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006062 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdulla13986612007-07-22 20:43:26 -04006063 },
6064 { /* MCP73 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006065 PCI_DEVICE(0x10DE, 0x07DD),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006066 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdulla13986612007-07-22 20:43:26 -04006067 },
6068 { /* MCP73 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006069 PCI_DEVICE(0x10DE, 0x07DE),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006070 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdulla13986612007-07-22 20:43:26 -04006071 },
6072 { /* MCP73 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006073 PCI_DEVICE(0x10DE, 0x07DF),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006074 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_MSI|DEV_HAS_PAUSEFRAME_TX_V1|DEV_HAS_STATISTICS_V12|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_HAS_GEAR_MODE|DEV_NEED_MSI_FIX,
Ayaz Abdulla13986612007-07-22 20:43:26 -04006075 },
Ayaz Abdulla96fd4cd2007-10-25 03:36:42 -04006076 { /* MCP77 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006077 PCI_DEVICE(0x10DE, 0x0760),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006078 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V2|DEV_HAS_STATISTICS_V123|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_NEED_TX_LIMIT2|DEV_HAS_GEAR_MODE|DEV_NEED_PHY_INIT_FIX|DEV_NEED_MSI_FIX,
Ayaz Abdulla96fd4cd2007-10-25 03:36:42 -04006079 },
6080 { /* MCP77 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006081 PCI_DEVICE(0x10DE, 0x0761),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006082 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V2|DEV_HAS_STATISTICS_V123|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_NEED_TX_LIMIT2|DEV_HAS_GEAR_MODE|DEV_NEED_PHY_INIT_FIX|DEV_NEED_MSI_FIX,
Ayaz Abdulla96fd4cd2007-10-25 03:36:42 -04006083 },
6084 { /* MCP77 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006085 PCI_DEVICE(0x10DE, 0x0762),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006086 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V2|DEV_HAS_STATISTICS_V123|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_NEED_TX_LIMIT2|DEV_HAS_GEAR_MODE|DEV_NEED_PHY_INIT_FIX|DEV_NEED_MSI_FIX,
Ayaz Abdulla96fd4cd2007-10-25 03:36:42 -04006087 },
6088 { /* MCP77 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006089 PCI_DEVICE(0x10DE, 0x0763),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006090 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V2|DEV_HAS_STATISTICS_V123|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_NEED_TX_LIMIT2|DEV_HAS_GEAR_MODE|DEV_NEED_PHY_INIT_FIX|DEV_NEED_MSI_FIX,
Ayaz Abdulla96fd4cd2007-10-25 03:36:42 -04006091 },
Ayaz Abdulla490dde82007-11-23 20:54:01 -05006092 { /* MCP79 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006093 PCI_DEVICE(0x10DE, 0x0AB0),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006094 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V3|DEV_HAS_STATISTICS_V123|DEV_HAS_TEST_EXTENDED|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_NEED_TX_LIMIT2|DEV_HAS_GEAR_MODE|DEV_NEED_PHY_INIT_FIX|DEV_NEED_MSI_FIX,
Ayaz Abdulla490dde82007-11-23 20:54:01 -05006095 },
6096 { /* MCP79 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006097 PCI_DEVICE(0x10DE, 0x0AB1),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006098 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V3|DEV_HAS_STATISTICS_V123|DEV_HAS_TEST_EXTENDED|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_NEED_TX_LIMIT2|DEV_HAS_GEAR_MODE|DEV_NEED_PHY_INIT_FIX|DEV_NEED_MSI_FIX,
Ayaz Abdulla490dde82007-11-23 20:54:01 -05006099 },
6100 { /* MCP79 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006101 PCI_DEVICE(0x10DE, 0x0AB2),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006102 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V3|DEV_HAS_STATISTICS_V123|DEV_HAS_TEST_EXTENDED|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_NEED_TX_LIMIT2|DEV_HAS_GEAR_MODE|DEV_NEED_PHY_INIT_FIX|DEV_NEED_MSI_FIX,
Ayaz Abdulla490dde82007-11-23 20:54:01 -05006103 },
6104 { /* MCP79 Ethernet Controller */
Ayaz Abdulla3c2e1c12009-06-03 15:05:17 +00006105 PCI_DEVICE(0x10DE, 0x0AB3),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006106 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V3|DEV_HAS_STATISTICS_V123|DEV_HAS_TEST_EXTENDED|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_NEED_TX_LIMIT2|DEV_HAS_GEAR_MODE|DEV_NEED_PHY_INIT_FIX|DEV_NEED_MSI_FIX,
Ayaz Abdulla490dde82007-11-23 20:54:01 -05006107 },
Ayaz Abdulla3df81c42009-06-03 15:05:35 +00006108 { /* MCP89 Ethernet Controller */
6109 PCI_DEVICE(0x10DE, 0x0D7D),
Mike Ditto7b5e0782010-07-25 21:54:28 -07006110 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX_V3|DEV_HAS_STATISTICS_V123|DEV_HAS_TEST_EXTENDED|DEV_HAS_CORRECT_MACADDR|DEV_HAS_COLLISION_FIX|DEV_HAS_GEAR_MODE|DEV_NEED_PHY_INIT_FIX,
Ayaz Abdulla3df81c42009-06-03 15:05:35 +00006111 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07006112 {0,},
6113};
6114
6115static struct pci_driver driver = {
Jeff Garzik3f88ce42007-10-16 04:09:09 -04006116 .name = DRV_NAME,
6117 .id_table = pci_tbl,
6118 .probe = nv_probe,
6119 .remove = __devexit_p(nv_remove),
6120 .suspend = nv_suspend,
6121 .resume = nv_resume,
Tobias Diedrichf735a2a2008-05-18 15:02:37 +02006122 .shutdown = nv_shutdown,
Linus Torvalds1da177e2005-04-16 15:20:36 -07006123};
6124
Linus Torvalds1da177e2005-04-16 15:20:36 -07006125static int __init init_nic(void)
6126{
Jeff Garzik29917622006-08-19 17:48:59 -04006127 return pci_register_driver(&driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006128}
6129
6130static void __exit exit_nic(void)
6131{
6132 pci_unregister_driver(&driver);
6133}
6134
6135module_param(max_interrupt_work, int, 0);
6136MODULE_PARM_DESC(max_interrupt_work, "forcedeth maximum events handled per interrupt");
Ayaz Abdullaa971c322005-11-11 08:30:38 -05006137module_param(optimization_mode, int, 0);
Ayaz Abdulla9e184762009-03-05 08:02:18 +00006138MODULE_PARM_DESC(optimization_mode, "In throughput mode (0), every tx & rx packet will generate an interrupt. In CPU mode (1), interrupts are controlled by a timer. In dynamic mode (2), the mode toggles between throughput and CPU mode based on network load.");
Ayaz Abdullaa971c322005-11-11 08:30:38 -05006139module_param(poll_interval, int, 0);
6140MODULE_PARM_DESC(poll_interval, "Interval determines how frequent timer interrupt is generated by [(time_in_micro_secs * 100) / (2^10)]. Min is 0 and Max is 65535.");
Ayaz Abdulla69fe3fd2006-06-10 22:48:18 -04006141module_param(msi, int, 0);
6142MODULE_PARM_DESC(msi, "MSI interrupts are enabled by setting to 1 and disabled by setting to 0.");
6143module_param(msix, int, 0);
6144MODULE_PARM_DESC(msix, "MSIX interrupts are enabled by setting to 1 and disabled by setting to 0.");
6145module_param(dma_64bit, int, 0);
6146MODULE_PARM_DESC(dma_64bit, "High DMA is enabled by setting to 1 and disabled by setting to 0.");
Ayaz Abdulla9f3f7912008-04-23 14:37:30 -04006147module_param(phy_cross, int, 0);
6148MODULE_PARM_DESC(phy_cross, "Phy crossover detection for Realtek 8201 phy is enabled by setting to 1 and disabled by setting to 0.");
Ed Swierk5a9a8e32009-06-02 00:19:52 -07006149module_param(phy_power_down, int, 0);
6150MODULE_PARM_DESC(phy_power_down, "Power down phy and disable link when interface is down (1), or leave phy powered up (0).");
Linus Torvalds1da177e2005-04-16 15:20:36 -07006151
6152MODULE_AUTHOR("Manfred Spraul <manfred@colorfullife.com>");
6153MODULE_DESCRIPTION("Reverse Engineered nForce ethernet driver");
6154MODULE_LICENSE("GPL");
6155
6156MODULE_DEVICE_TABLE(pci, pci_tbl);
6157
6158module_init(init_nic);
6159module_exit(exit_nic);