forcedeth.c 190.2 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 * forcedeth: Ethernet driver for NVIDIA nForce media access controllers.
 *
 * Note: This driver is a cleanroom reimplementation based on reverse
 *      engineered documentation written by Carl-Daniel Hailfinger
A
Ayaz Abdulla 已提交
6
 *      and Andrew de Quincey.
L
Linus Torvalds 已提交
7 8 9 10 11
 *
 * NVIDIA, nForce and other NVIDIA marks are trademarks or registered
 * trademarks of NVIDIA Corporation in the United States and other
 * countries.
 *
12
 * Copyright (C) 2003,4,5 Manfred Spraul
L
Linus Torvalds 已提交
13 14 15
 * Copyright (C) 2004 Andrew de Quincey (wol support)
 * Copyright (C) 2004 Carl-Daniel Hailfinger (invalid MAC handling, insane
 *		IRQ rate fixes, bigendian fixes, cleanups, verification)
16
 * Copyright (c) 2004,2005,2006,2007,2008,2009 NVIDIA Corporation
L
Linus Torvalds 已提交
17 18 19 20 21 22 23 24 25 26 27 28
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
29
 * along with this program; if not, see <http://www.gnu.org/licenses/>.
L
Linus Torvalds 已提交
30 31 32 33 34 35 36 37 38 39 40
 *
 * Known bugs:
 * We suspect that on some hardware no TX done interrupts are generated.
 * This means recovery from netif_stop_queue only happens if the hw timer
 * interrupt fires (100 times/second, configurable with NVREG_POLL_DEFAULT)
 * and the timer is active in the IRQMask, or if a rx packet arrives by chance.
 * If your hardware reliably generates tx done interrupts, then you can remove
 * DEV_NEED_TIMERIRQ from the driver_data flags.
 * DEV_NEED_TIMERIRQ will not harm you on sane hardware, only generating a few
 * superfluous timer interrupts from the nic.
 */
J
Joe Perches 已提交
41 42 43

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

A
Ayaz Abdulla 已提交
44
#define FORCEDETH_VERSION		"0.64"
L
Linus Torvalds 已提交
45 46 47 48 49 50 51 52 53
#define DRV_NAME			"forcedeth"

#include <linux/module.h>
#include <linux/types.h>
#include <linux/pci.h>
#include <linux/interrupt.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/delay.h>
54
#include <linux/sched.h>
L
Linus Torvalds 已提交
55 56 57 58 59 60
#include <linux/spinlock.h>
#include <linux/ethtool.h>
#include <linux/timer.h>
#include <linux/skbuff.h>
#include <linux/mii.h>
#include <linux/random.h>
61
#include <linux/if_vlan.h>
62
#include <linux/dma-mapping.h>
63
#include <linux/slab.h>
64
#include <linux/uaccess.h>
65
#include <linux/prefetch.h>
66 67
#include <linux/u64_stats_sync.h>
#include <linux/io.h>
L
Linus Torvalds 已提交
68 69 70

#include <asm/irq.h>

71 72
#define TX_WORK_PER_LOOP  64
#define RX_WORK_PER_LOOP  64
L
Linus Torvalds 已提交
73 74 75 76 77

/*
 * Hardware access:
 */

78 79 80 81 82 83 84 85 86 87
#define DEV_NEED_TIMERIRQ          0x0000001  /* set the timer irq flag in the irq mask */
#define DEV_NEED_LINKTIMER         0x0000002  /* poll link settings. Relies on the timer irq */
#define DEV_HAS_LARGEDESC          0x0000004  /* device supports jumbo frames and needs packet format 2 */
#define DEV_HAS_HIGH_DMA           0x0000008  /* device supports 64bit dma */
#define DEV_HAS_CHECKSUM           0x0000010  /* device supports tx and rx checksum offloads */
#define DEV_HAS_VLAN               0x0000020  /* device supports vlan tagging and striping */
#define DEV_HAS_MSI                0x0000040  /* device supports MSI */
#define DEV_HAS_MSI_X              0x0000080  /* device supports MSI-X */
#define DEV_HAS_POWER_CNTRL        0x0000100  /* device supports power savings */
#define DEV_HAS_STATISTICS_V1      0x0000200  /* device supports hw statistics version 1 */
88 89 90 91
#define DEV_HAS_STATISTICS_V2      0x0000400  /* device supports hw statistics version 2 */
#define DEV_HAS_STATISTICS_V3      0x0000800  /* device supports hw statistics version 3 */
#define DEV_HAS_STATISTICS_V12     0x0000600  /* device supports hw statistics version 1 and 2 */
#define DEV_HAS_STATISTICS_V123    0x0000e00  /* device supports hw statistics version 1, 2, and 3 */
92 93 94 95 96 97 98 99 100 101 102 103 104
#define DEV_HAS_TEST_EXTENDED      0x0001000  /* device supports extended diagnostic test */
#define DEV_HAS_MGMT_UNIT          0x0002000  /* device supports management unit */
#define DEV_HAS_CORRECT_MACADDR    0x0004000  /* device supports correct mac address order */
#define DEV_HAS_COLLISION_FIX      0x0008000  /* device supports tx collision fix */
#define DEV_HAS_PAUSEFRAME_TX_V1   0x0010000  /* device supports tx pause frames version 1 */
#define DEV_HAS_PAUSEFRAME_TX_V2   0x0020000  /* device supports tx pause frames version 2 */
#define DEV_HAS_PAUSEFRAME_TX_V3   0x0040000  /* device supports tx pause frames version 3 */
#define DEV_NEED_TX_LIMIT          0x0080000  /* device needs to limit tx */
#define DEV_NEED_TX_LIMIT2         0x0180000  /* device needs to limit tx, expect for some revs */
#define DEV_HAS_GEAR_MODE          0x0200000  /* device supports gear mode */
#define DEV_NEED_PHY_INIT_FIX      0x0400000  /* device needs specific phy workaround */
#define DEV_NEED_LOW_POWER_FIX     0x0800000  /* device needs special power up workaround */
#define DEV_NEED_MSI_FIX           0x1000000  /* device needs msi workaround */
L
Linus Torvalds 已提交
105 106 107 108

enum {
	NvRegIrqStatus = 0x000,
#define NVREG_IRQSTAT_MIIEVENT	0x040
A
Ayaz Abdulla 已提交
109
#define NVREG_IRQSTAT_MASK		0x83ff
L
Linus Torvalds 已提交
110 111 112 113 114
	NvRegIrqMask = 0x004,
#define NVREG_IRQ_RX_ERROR		0x0001
#define NVREG_IRQ_RX			0x0002
#define NVREG_IRQ_RX_NOBUF		0x0004
#define NVREG_IRQ_TX_ERR		0x0008
115
#define NVREG_IRQ_TX_OK			0x0010
L
Linus Torvalds 已提交
116 117
#define NVREG_IRQ_TIMER			0x0020
#define NVREG_IRQ_LINK			0x0040
118 119
#define NVREG_IRQ_RX_FORCED		0x0080
#define NVREG_IRQ_TX_FORCED		0x0100
A
Ayaz Abdulla 已提交
120
#define NVREG_IRQ_RECOVER_ERROR		0x8200
121
#define NVREG_IRQMASK_THROUGHPUT	0x00df
A
Ayaz Abdulla 已提交
122
#define NVREG_IRQMASK_CPU		0x0060
123 124
#define NVREG_IRQ_TX_ALL		(NVREG_IRQ_TX_ERR|NVREG_IRQ_TX_OK|NVREG_IRQ_TX_FORCED)
#define NVREG_IRQ_RX_ALL		(NVREG_IRQ_RX_ERROR|NVREG_IRQ_RX|NVREG_IRQ_RX_NOBUF|NVREG_IRQ_RX_FORCED)
125
#define NVREG_IRQ_OTHER			(NVREG_IRQ_TIMER|NVREG_IRQ_LINK|NVREG_IRQ_RECOVER_ERROR)
126

L
Linus Torvalds 已提交
127 128 129 130 131 132 133 134
	NvRegUnknownSetupReg6 = 0x008,
#define NVREG_UNKSETUP6_VAL		3

/*
 * NVREG_POLL_DEFAULT is the interval length of the timer source on the nic
 * NVREG_POLL_DEFAULT=97 would result in an interval length of 1 ms
 */
	NvRegPollingInterval = 0x00c,
A
Ayaz Abdulla 已提交
135
#define NVREG_POLL_DEFAULT_THROUGHPUT	65535 /* backup tx cleanup if loop max reached */
136
#define NVREG_POLL_DEFAULT_CPU	13
137 138 139 140
	NvRegMSIMap0 = 0x020,
	NvRegMSIMap1 = 0x024,
	NvRegMSIIrqMask = 0x030,
#define NVREG_MSI_VECTOR_0_ENABLED 0x01
L
Linus Torvalds 已提交
141
	NvRegMisc1 = 0x080,
142
#define NVREG_MISC1_PAUSE_TX	0x01
L
Linus Torvalds 已提交
143 144 145
#define NVREG_MISC1_HD		0x02
#define NVREG_MISC1_FORCE	0x3b0f3c

A
Ayaz Abdulla 已提交
146
	NvRegMacReset = 0x34,
147
#define NVREG_MAC_RESET_ASSERT	0x0F3
L
Linus Torvalds 已提交
148 149
	NvRegTransmitterControl = 0x084,
#define NVREG_XMITCTL_START	0x01
150 151 152 153 154 155 156 157 158
#define NVREG_XMITCTL_MGMT_ST	0x40000000
#define NVREG_XMITCTL_SYNC_MASK		0x000f0000
#define NVREG_XMITCTL_SYNC_NOT_READY	0x0
#define NVREG_XMITCTL_SYNC_PHY_INIT	0x00040000
#define NVREG_XMITCTL_MGMT_SEMA_MASK	0x00000f00
#define NVREG_XMITCTL_MGMT_SEMA_FREE	0x0
#define NVREG_XMITCTL_HOST_SEMA_MASK	0x0000f000
#define NVREG_XMITCTL_HOST_SEMA_ACQ	0x0000f000
#define NVREG_XMITCTL_HOST_LOADED	0x00004000
159
#define NVREG_XMITCTL_TX_PATH_EN	0x01000000
A
Ayaz Abdulla 已提交
160 161 162
#define NVREG_XMITCTL_DATA_START	0x00100000
#define NVREG_XMITCTL_DATA_READY	0x00010000
#define NVREG_XMITCTL_DATA_ERROR	0x00020000
L
Linus Torvalds 已提交
163 164 165 166
	NvRegTransmitterStatus = 0x088,
#define NVREG_XMITSTAT_BUSY	0x01

	NvRegPacketFilterFlags = 0x8c,
167 168
#define NVREG_PFF_PAUSE_RX	0x08
#define NVREG_PFF_ALWAYS	0x7F0000
L
Linus Torvalds 已提交
169 170
#define NVREG_PFF_PROMISC	0x80
#define NVREG_PFF_MYADDR	0x20
171
#define NVREG_PFF_LOOPBACK	0x10
L
Linus Torvalds 已提交
172 173 174 175 176 177

	NvRegOffloadConfig = 0x90,
#define NVREG_OFFLOAD_HOMEPHY	0x601
#define NVREG_OFFLOAD_NORMAL	RX_NIC_BUFSIZE
	NvRegReceiverControl = 0x094,
#define NVREG_RCVCTL_START	0x01
178
#define NVREG_RCVCTL_RX_PATH_EN	0x01000000
L
Linus Torvalds 已提交
179 180 181
	NvRegReceiverStatus = 0x98,
#define NVREG_RCVSTAT_BUSY	0x01

182 183 184
	NvRegSlotTime = 0x9c,
#define NVREG_SLOTTIME_LEGBF_ENABLED	0x80000000
#define NVREG_SLOTTIME_10_100_FULL	0x00007f00
185
#define NVREG_SLOTTIME_1000_FULL	0x0003ff00
186
#define NVREG_SLOTTIME_HALF		0x0000ff00
187
#define NVREG_SLOTTIME_DEFAULT		0x00007f00
188
#define NVREG_SLOTTIME_MASK		0x000000ff
L
Linus Torvalds 已提交
189

A
Ayaz Abdulla 已提交
190
	NvRegTxDeferral = 0xA0,
A
Ayaz Abdulla 已提交
191 192 193 194 195 196
#define NVREG_TX_DEFERRAL_DEFAULT		0x15050f
#define NVREG_TX_DEFERRAL_RGMII_10_100		0x16070f
#define NVREG_TX_DEFERRAL_RGMII_1000		0x14050f
#define NVREG_TX_DEFERRAL_RGMII_STRETCH_10	0x16190f
#define NVREG_TX_DEFERRAL_RGMII_STRETCH_100	0x16300f
#define NVREG_TX_DEFERRAL_MII_STRETCH		0x152000
A
Ayaz Abdulla 已提交
197 198
	NvRegRxDeferral = 0xA4,
#define NVREG_RX_DEFERRAL_DEFAULT	0x16
L
Linus Torvalds 已提交
199 200 201 202 203 204
	NvRegMacAddrA = 0xA8,
	NvRegMacAddrB = 0xAC,
	NvRegMulticastAddrA = 0xB0,
#define NVREG_MCASTADDRA_FORCE	0x01
	NvRegMulticastAddrB = 0xB4,
	NvRegMulticastMaskA = 0xB8,
A
Ayaz Abdulla 已提交
205
#define NVREG_MCASTMASKA_NONE		0xffffffff
L
Linus Torvalds 已提交
206
	NvRegMulticastMaskB = 0xBC,
A
Ayaz Abdulla 已提交
207
#define NVREG_MCASTMASKB_NONE		0xffff
L
Linus Torvalds 已提交
208 209 210

	NvRegPhyInterface = 0xC0,
#define PHY_RGMII		0x10000000
211 212 213 214 215
	NvRegBackOffControl = 0xC4,
#define NVREG_BKOFFCTRL_DEFAULT			0x70000000
#define NVREG_BKOFFCTRL_SEED_MASK		0x000003ff
#define NVREG_BKOFFCTRL_SELECT			24
#define NVREG_BKOFFCTRL_GEAR			12
L
Linus Torvalds 已提交
216 217 218 219 220 221

	NvRegTxRingPhysAddr = 0x100,
	NvRegRxRingPhysAddr = 0x104,
	NvRegRingSizes = 0x108,
#define NVREG_RINGSZ_TXSHIFT 0
#define NVREG_RINGSZ_RXSHIFT 16
222 223
	NvRegTransmitPoll = 0x10c,
#define NVREG_TRANSMITPOLL_MAC_ADDR_REV	0x00008000
L
Linus Torvalds 已提交
224 225 226 227 228 229 230 231
	NvRegLinkSpeed = 0x110,
#define NVREG_LINKSPEED_FORCE 0x10000
#define NVREG_LINKSPEED_10	1000
#define NVREG_LINKSPEED_100	100
#define NVREG_LINKSPEED_1000	50
#define NVREG_LINKSPEED_MASK	(0xFFF)
	NvRegUnknownSetupReg5 = 0x130,
#define NVREG_UNKSETUP5_BIT31	(1<<31)
232 233 234 235
	NvRegTxWatermark = 0x13c,
#define NVREG_TX_WM_DESC1_DEFAULT	0x0200010
#define NVREG_TX_WM_DESC2_3_DEFAULT	0x1e08000
#define NVREG_TX_WM_DESC2_3_1000	0xfe08000
L
Linus Torvalds 已提交
236 237 238 239 240 241 242
	NvRegTxRxControl = 0x144,
#define NVREG_TXRXCTL_KICK	0x0001
#define NVREG_TXRXCTL_BIT1	0x0002
#define NVREG_TXRXCTL_BIT2	0x0004
#define NVREG_TXRXCTL_IDLE	0x0008
#define NVREG_TXRXCTL_RESET	0x0010
#define NVREG_TXRXCTL_RXCHECK	0x0400
243
#define NVREG_TXRXCTL_DESC_1	0
A
Ayaz Abdulla 已提交
244 245
#define NVREG_TXRXCTL_DESC_2	0x002100
#define NVREG_TXRXCTL_DESC_3	0xc02200
246 247
#define NVREG_TXRXCTL_VLANSTRIP 0x00040
#define NVREG_TXRXCTL_VLANINS	0x00080
248 249
	NvRegTxRingPhysAddrHigh = 0x148,
	NvRegRxRingPhysAddrHigh = 0x14C,
250
	NvRegTxPauseFrame = 0x170,
A
Ayaz Abdulla 已提交
251 252 253 254
#define NVREG_TX_PAUSEFRAME_DISABLE	0x0fff0080
#define NVREG_TX_PAUSEFRAME_ENABLE_V1	0x01800010
#define NVREG_TX_PAUSEFRAME_ENABLE_V2	0x056003f0
#define NVREG_TX_PAUSEFRAME_ENABLE_V3	0x09f00880
A
Ayaz Abdulla 已提交
255 256
	NvRegTxPauseFrameLimit = 0x174,
#define NVREG_TX_PAUSEFRAMELIMIT_ENABLE	0x00010000
L
Linus Torvalds 已提交
257 258 259
	NvRegMIIStatus = 0x180,
#define NVREG_MIISTAT_ERROR		0x0001
#define NVREG_MIISTAT_LINKCHANGE	0x0008
A
Ayaz Abdulla 已提交
260 261
#define NVREG_MIISTAT_MASK_RW		0x0007
#define NVREG_MIISTAT_MASK_ALL		0x000f
262 263
	NvRegMIIMask = 0x184,
#define NVREG_MII_LINKCHANGE		0x0008
L
Linus Torvalds 已提交
264 265 266 267 268 269 270 271 272 273 274 275 276 277 278

	NvRegAdapterControl = 0x188,
#define NVREG_ADAPTCTL_START	0x02
#define NVREG_ADAPTCTL_LINKUP	0x04
#define NVREG_ADAPTCTL_PHYVALID	0x40000
#define NVREG_ADAPTCTL_RUNNING	0x100000
#define NVREG_ADAPTCTL_PHYSHIFT	24
	NvRegMIISpeed = 0x18c,
#define NVREG_MIISPEED_BIT8	(1<<8)
#define NVREG_MIIDELAY	5
	NvRegMIIControl = 0x190,
#define NVREG_MIICTL_INUSE	0x08000
#define NVREG_MIICTL_WRITE	0x00400
#define NVREG_MIICTL_ADDRSHIFT	5
	NvRegMIIData = 0x194,
279 280 281
	NvRegTxUnicast = 0x1a0,
	NvRegTxMulticast = 0x1a4,
	NvRegTxBroadcast = 0x1a8,
L
Linus Torvalds 已提交
282 283 284 285 286 287 288 289 290 291 292 293 294
	NvRegWakeUpFlags = 0x200,
#define NVREG_WAKEUPFLAGS_VAL		0x7770
#define NVREG_WAKEUPFLAGS_BUSYSHIFT	24
#define NVREG_WAKEUPFLAGS_ENABLESHIFT	16
#define NVREG_WAKEUPFLAGS_D3SHIFT	12
#define NVREG_WAKEUPFLAGS_D2SHIFT	8
#define NVREG_WAKEUPFLAGS_D1SHIFT	4
#define NVREG_WAKEUPFLAGS_D0SHIFT	0
#define NVREG_WAKEUPFLAGS_ACCEPT_MAGPAT		0x01
#define NVREG_WAKEUPFLAGS_ACCEPT_WAKEUPPAT	0x02
#define NVREG_WAKEUPFLAGS_ACCEPT_LINKCHANGE	0x04
#define NVREG_WAKEUPFLAGS_ENABLE	0x1111

A
Ayaz Abdulla 已提交
295
	NvRegMgmtUnitGetVersion = 0x204,
296
#define NVREG_MGMTUNITGETVERSION	0x01
A
Ayaz Abdulla 已提交
297 298
	NvRegMgmtUnitVersion = 0x208,
#define NVREG_MGMTUNITVERSION		0x08
L
Linus Torvalds 已提交
299 300 301 302 303 304 305 306 307 308 309 310
	NvRegPowerCap = 0x268,
#define NVREG_POWERCAP_D3SUPP	(1<<30)
#define NVREG_POWERCAP_D2SUPP	(1<<26)
#define NVREG_POWERCAP_D1SUPP	(1<<25)
	NvRegPowerState = 0x26c,
#define NVREG_POWERSTATE_POWEREDUP	0x8000
#define NVREG_POWERSTATE_VALID		0x0100
#define NVREG_POWERSTATE_MASK		0x0003
#define NVREG_POWERSTATE_D0		0x0000
#define NVREG_POWERSTATE_D1		0x0001
#define NVREG_POWERSTATE_D2		0x0002
#define NVREG_POWERSTATE_D3		0x0003
A
Ayaz Abdulla 已提交
311 312
	NvRegMgmtUnitControl = 0x278,
#define NVREG_MGMTUNITCONTROL_INUSE	0x20000
313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339
	NvRegTxCnt = 0x280,
	NvRegTxZeroReXmt = 0x284,
	NvRegTxOneReXmt = 0x288,
	NvRegTxManyReXmt = 0x28c,
	NvRegTxLateCol = 0x290,
	NvRegTxUnderflow = 0x294,
	NvRegTxLossCarrier = 0x298,
	NvRegTxExcessDef = 0x29c,
	NvRegTxRetryErr = 0x2a0,
	NvRegRxFrameErr = 0x2a4,
	NvRegRxExtraByte = 0x2a8,
	NvRegRxLateCol = 0x2ac,
	NvRegRxRunt = 0x2b0,
	NvRegRxFrameTooLong = 0x2b4,
	NvRegRxOverflow = 0x2b8,
	NvRegRxFCSErr = 0x2bc,
	NvRegRxFrameAlignErr = 0x2c0,
	NvRegRxLenErr = 0x2c4,
	NvRegRxUnicast = 0x2c8,
	NvRegRxMulticast = 0x2cc,
	NvRegRxBroadcast = 0x2d0,
	NvRegTxDef = 0x2d4,
	NvRegTxFrame = 0x2d8,
	NvRegRxCnt = 0x2dc,
	NvRegTxPause = 0x2e0,
	NvRegRxPause = 0x2e4,
	NvRegRxDropFrame = 0x2e8,
340 341
	NvRegVlanControl = 0x300,
#define NVREG_VLANCONTROL_ENABLE	0x2000
342 343 344
	NvRegMSIXMap0 = 0x3e0,
	NvRegMSIXMap1 = 0x3e4,
	NvRegMSIXIrqStatus = 0x3f0,
345 346

	NvRegPowerState2 = 0x600,
347
#define NVREG_POWERSTATE2_POWERUP_MASK		0x0F15
348
#define NVREG_POWERSTATE2_POWERUP_REV_A3	0x0001
349
#define NVREG_POWERSTATE2_PHY_RESET		0x0004
350
#define NVREG_POWERSTATE2_GATE_CLOCKS		0x0F00
L
Linus Torvalds 已提交
351 352 353 354
};

/* Big endian: should work, but is untested */
struct ring_desc {
355 356
	__le32 buf;
	__le32 flaglen;
L
Linus Torvalds 已提交
357 358
};

359
struct ring_desc_ex {
360 361 362 363
	__le32 bufhigh;
	__le32 buflow;
	__le32 txvlan;
	__le32 flaglen;
364 365
};

366
union ring_type {
367 368
	struct ring_desc *orig;
	struct ring_desc_ex *ex;
369
};
370

L
Linus Torvalds 已提交
371 372 373 374 375 376 377
#define FLAG_MASK_V1 0xffff0000
#define FLAG_MASK_V2 0xffffc000
#define LEN_MASK_V1 (0xffffffff ^ FLAG_MASK_V1)
#define LEN_MASK_V2 (0xffffffff ^ FLAG_MASK_V2)

#define NV_TX_LASTPACKET	(1<<16)
#define NV_TX_RETRYERROR	(1<<19)
378
#define NV_TX_RETRYCOUNT_MASK	(0xF<<20)
379
#define NV_TX_FORCED_INTERRUPT	(1<<24)
L
Linus Torvalds 已提交
380 381 382 383 384 385 386 387 388
#define NV_TX_DEFERRED		(1<<26)
#define NV_TX_CARRIERLOST	(1<<27)
#define NV_TX_LATECOLLISION	(1<<28)
#define NV_TX_UNDERFLOW		(1<<29)
#define NV_TX_ERROR		(1<<30)
#define NV_TX_VALID		(1<<31)

#define NV_TX2_LASTPACKET	(1<<29)
#define NV_TX2_RETRYERROR	(1<<18)
389
#define NV_TX2_RETRYCOUNT_MASK	(0xF<<19)
390
#define NV_TX2_FORCED_INTERRUPT	(1<<30)
L
Linus Torvalds 已提交
391 392 393 394 395 396 397
#define NV_TX2_DEFERRED		(1<<25)
#define NV_TX2_CARRIERLOST	(1<<26)
#define NV_TX2_LATECOLLISION	(1<<27)
#define NV_TX2_UNDERFLOW	(1<<28)
/* error and valid are the same for both */
#define NV_TX2_ERROR		(1<<30)
#define NV_TX2_VALID		(1<<31)
398 399
#define NV_TX2_TSO		(1<<28)
#define NV_TX2_TSO_SHIFT	14
400 401
#define NV_TX2_TSO_MAX_SHIFT	14
#define NV_TX2_TSO_MAX_SIZE	(1<<NV_TX2_TSO_MAX_SHIFT)
402 403
#define NV_TX2_CHECKSUM_L3	(1<<27)
#define NV_TX2_CHECKSUM_L4	(1<<26)
L
Linus Torvalds 已提交
404

405 406
#define NV_TX3_VLAN_TAG_PRESENT (1<<18)

L
Linus Torvalds 已提交
407 408
#define NV_RX_DESCRIPTORVALID	(1<<16)
#define NV_RX_MISSEDFRAME	(1<<17)
409
#define NV_RX_SUBTRACT1		(1<<18)
L
Linus Torvalds 已提交
410 411 412 413 414 415 416 417 418
#define NV_RX_ERROR1		(1<<23)
#define NV_RX_ERROR2		(1<<24)
#define NV_RX_ERROR3		(1<<25)
#define NV_RX_ERROR4		(1<<26)
#define NV_RX_CRCERR		(1<<27)
#define NV_RX_OVERFLOW		(1<<28)
#define NV_RX_FRAMINGERR	(1<<29)
#define NV_RX_ERROR		(1<<30)
#define NV_RX_AVAIL		(1<<31)
A
Ayaz Abdulla 已提交
419
#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)
L
Linus Torvalds 已提交
420 421

#define NV_RX2_CHECKSUMMASK	(0x1C000000)
A
Ayaz Abdulla 已提交
422 423 424
#define NV_RX2_CHECKSUM_IP	(0x10000000)
#define NV_RX2_CHECKSUM_IP_TCP	(0x14000000)
#define NV_RX2_CHECKSUM_IP_UDP	(0x18000000)
L
Linus Torvalds 已提交
425
#define NV_RX2_DESCRIPTORVALID	(1<<29)
426
#define NV_RX2_SUBTRACT1	(1<<25)
L
Linus Torvalds 已提交
427 428 429 430 431 432 433 434 435 436
#define NV_RX2_ERROR1		(1<<18)
#define NV_RX2_ERROR2		(1<<19)
#define NV_RX2_ERROR3		(1<<20)
#define NV_RX2_ERROR4		(1<<21)
#define NV_RX2_CRCERR		(1<<22)
#define NV_RX2_OVERFLOW		(1<<23)
#define NV_RX2_FRAMINGERR	(1<<24)
/* error and avail are the same for both */
#define NV_RX2_ERROR		(1<<30)
#define NV_RX2_AVAIL		(1<<31)
A
Ayaz Abdulla 已提交
437
#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)
L
Linus Torvalds 已提交
438

439 440 441
#define NV_RX3_VLAN_TAG_PRESENT (1<<16)
#define NV_RX3_VLAN_TAG_MASK	(0x0000FFFF)

L
Lucas De Marchi 已提交
442
/* Miscellaneous hardware related defines: */
443 444 445 446
#define NV_PCI_REGSZ_VER1	0x270
#define NV_PCI_REGSZ_VER2	0x2d4
#define NV_PCI_REGSZ_VER3	0x604
#define NV_PCI_REGSZ_MAX	0x604
L
Linus Torvalds 已提交
447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462

/* various timeout delays: all in usec */
#define NV_TXRX_RESET_DELAY	4
#define NV_TXSTOP_DELAY1	10
#define NV_TXSTOP_DELAY1MAX	500000
#define NV_TXSTOP_DELAY2	100
#define NV_RXSTOP_DELAY1	10
#define NV_RXSTOP_DELAY1MAX	500000
#define NV_RXSTOP_DELAY2	100
#define NV_SETUP5_DELAY		5
#define NV_SETUP5_DELAYMAX	50000
#define NV_POWERUP_DELAY	5
#define NV_POWERUP_DELAYMAX	5000
#define NV_MIIBUSY_DELAY	50
#define NV_MIIPHY_DELAY	10
#define NV_MIIPHY_DELAYMAX	10000
463
#define NV_MAC_RESET_DELAY	64
L
Linus Torvalds 已提交
464 465 466 467 468 469 470

#define NV_WAKEUPPATTERNS	5
#define NV_WAKEUPMASKENTRIES	4

/* General driver defaults */
#define NV_WATCHDOG_TIMEO	(5*HZ)

A
Ayaz Abdulla 已提交
471
#define RX_RING_DEFAULT		512
472 473 474 475 476
#define TX_RING_DEFAULT		256
#define RX_RING_MIN		128
#define TX_RING_MIN		64
#define RING_MAX_DESC_VER_1	1024
#define RING_MAX_DESC_VER_2_3	16384
L
Linus Torvalds 已提交
477 478

/* rx/tx mac addr + type + vlan + align + slack*/
479 480 481 482 483 484 485
#define NV_RX_HEADERS		(64)
/* even more slack. */
#define NV_RX_ALLOC_PAD		(64)

/* maximum mtu size */
#define NV_PKTLIMIT_1	ETH_DATA_LEN	/* hard limit not known */
#define NV_PKTLIMIT_2	9100	/* Actual limit according to NVidia: 9202 */
L
Linus Torvalds 已提交
486 487 488 489

#define OOM_REFILL	(1+HZ/20)
#define POLL_WAIT	(1+HZ/100)
#define LINK_TIMEOUT	(3*HZ)
490
#define STATS_INTERVAL	(10*HZ)
L
Linus Torvalds 已提交
491

492
/*
L
Linus Torvalds 已提交
493
 * desc_ver values:
494 495 496 497
 * The nic supports three different descriptor types:
 * - DESC_VER_1: Original
 * - DESC_VER_2: support for jumbo frames.
 * - DESC_VER_3: 64-bit format.
L
Linus Torvalds 已提交
498
 */
499 500 501
#define DESC_VER_1	1
#define DESC_VER_2	2
#define DESC_VER_3	3
L
Linus Torvalds 已提交
502 503

/* PHY defines */
504 505 506 507 508
#define PHY_OUI_MARVELL		0x5043
#define PHY_OUI_CICADA		0x03f1
#define PHY_OUI_VITESSE		0x01c1
#define PHY_OUI_REALTEK		0x0732
#define PHY_OUI_REALTEK2	0x0020
L
Linus Torvalds 已提交
509 510 511 512
#define PHYID1_OUI_MASK	0x03ff
#define PHYID1_OUI_SHFT	6
#define PHYID2_OUI_MASK	0xfc00
#define PHYID2_OUI_SHFT	10
513
#define PHYID2_MODEL_MASK		0x03f0
514 515 516 517 518 519
#define PHY_MODEL_REALTEK_8211		0x0110
#define PHY_REV_MASK			0x0001
#define PHY_REV_REALTEK_8211B		0x0000
#define PHY_REV_REALTEK_8211C		0x0001
#define PHY_MODEL_REALTEK_8201		0x0200
#define PHY_MODEL_MARVELL_E3016		0x0220
520
#define PHY_MARVELL_E3016_INITMASK	0x0300
A
Ayaz Abdulla 已提交
521 522 523 524 525 526
#define PHY_CICADA_INIT1	0x0f000
#define PHY_CICADA_INIT2	0x0e00
#define PHY_CICADA_INIT3	0x01000
#define PHY_CICADA_INIT4	0x0200
#define PHY_CICADA_INIT5	0x0004
#define PHY_CICADA_INIT6	0x02000
A
Ayaz Abdulla 已提交
527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542
#define PHY_VITESSE_INIT_REG1	0x1f
#define PHY_VITESSE_INIT_REG2	0x10
#define PHY_VITESSE_INIT_REG3	0x11
#define PHY_VITESSE_INIT_REG4	0x12
#define PHY_VITESSE_INIT_MSK1	0xc
#define PHY_VITESSE_INIT_MSK2	0x0180
#define PHY_VITESSE_INIT1	0x52b5
#define PHY_VITESSE_INIT2	0xaf8a
#define PHY_VITESSE_INIT3	0x8
#define PHY_VITESSE_INIT4	0x8f8a
#define PHY_VITESSE_INIT5	0xaf86
#define PHY_VITESSE_INIT6	0x8f86
#define PHY_VITESSE_INIT7	0xaf82
#define PHY_VITESSE_INIT8	0x0100
#define PHY_VITESSE_INIT9	0x8f82
#define PHY_VITESSE_INIT10	0x0
A
Ayaz Abdulla 已提交
543 544 545
#define PHY_REALTEK_INIT_REG1	0x1f
#define PHY_REALTEK_INIT_REG2	0x19
#define PHY_REALTEK_INIT_REG3	0x13
546 547 548
#define PHY_REALTEK_INIT_REG4	0x14
#define PHY_REALTEK_INIT_REG5	0x18
#define PHY_REALTEK_INIT_REG6	0x11
549
#define PHY_REALTEK_INIT_REG7	0x01
A
Ayaz Abdulla 已提交
550 551 552 553
#define PHY_REALTEK_INIT1	0x0000
#define PHY_REALTEK_INIT2	0x8e00
#define PHY_REALTEK_INIT3	0x0001
#define PHY_REALTEK_INIT4	0xad17
554 555 556 557
#define PHY_REALTEK_INIT5	0xfb54
#define PHY_REALTEK_INIT6	0xf5c7
#define PHY_REALTEK_INIT7	0x1000
#define PHY_REALTEK_INIT8	0x0003
558 559 560
#define PHY_REALTEK_INIT9	0x0008
#define PHY_REALTEK_INIT10	0x0005
#define PHY_REALTEK_INIT11	0x0200
561
#define PHY_REALTEK_INIT_MSK1	0x0003
A
Ayaz Abdulla 已提交
562

L
Linus Torvalds 已提交
563 564 565 566 567 568 569 570 571
#define PHY_GIGABIT	0x0100

#define PHY_TIMEOUT	0x1
#define PHY_ERROR	0x2

#define PHY_100	0x1
#define PHY_1000	0x2
#define PHY_HALF	0x100

572 573 574 575
#define NV_PAUSEFRAME_RX_CAPABLE 0x0001
#define NV_PAUSEFRAME_TX_CAPABLE 0x0002
#define NV_PAUSEFRAME_RX_ENABLE  0x0004
#define NV_PAUSEFRAME_TX_ENABLE  0x0008
576 577 578
#define NV_PAUSEFRAME_RX_REQ     0x0010
#define NV_PAUSEFRAME_TX_REQ     0x0020
#define NV_PAUSEFRAME_AUTONEG    0x0040
L
Linus Torvalds 已提交
579

580 581 582 583 584 585 586 587 588 589 590 591
/* MSI/MSI-X defines */
#define NV_MSI_X_MAX_VECTORS  8
#define NV_MSI_X_VECTORS_MASK 0x000f
#define NV_MSI_CAPABLE        0x0010
#define NV_MSI_X_CAPABLE      0x0020
#define NV_MSI_ENABLED        0x0040
#define NV_MSI_X_ENABLED      0x0080

#define NV_MSI_X_VECTOR_ALL   0x0
#define NV_MSI_X_VECTOR_RX    0x0
#define NV_MSI_X_VECTOR_TX    0x1
#define NV_MSI_X_VECTOR_OTHER 0x2
L
Linus Torvalds 已提交
592

A
Ayaz Abdulla 已提交
593 594 595
#define NV_MSI_PRIV_OFFSET 0x68
#define NV_MSI_PRIV_VALUE  0xffffffff

A
Ayaz Abdulla 已提交
596 597 598
#define NV_RESTART_TX         0x1
#define NV_RESTART_RX         0x2

A
Ayaz Abdulla 已提交
599 600
#define NV_TX_LIMIT_COUNT     16

601 602 603
#define NV_DYNAMIC_THRESHOLD        4
#define NV_DYNAMIC_MAX_QUIET_COUNT  2048

604 605 606 607 608 609
/* statistics */
struct nv_ethtool_str {
	char name[ETH_GSTRING_LEN];
};

static const struct nv_ethtool_str nv_estats_str[] = {
610
	{ "tx_bytes" }, /* includes Ethernet FCS CRC */
611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630
	{ "tx_zero_rexmt" },
	{ "tx_one_rexmt" },
	{ "tx_many_rexmt" },
	{ "tx_late_collision" },
	{ "tx_fifo_errors" },
	{ "tx_carrier_errors" },
	{ "tx_excess_deferral" },
	{ "tx_retry_error" },
	{ "rx_frame_error" },
	{ "rx_extra_byte" },
	{ "rx_late_collision" },
	{ "rx_runt" },
	{ "rx_frame_too_long" },
	{ "rx_over_errors" },
	{ "rx_crc_errors" },
	{ "rx_frame_align_error" },
	{ "rx_length_error" },
	{ "rx_unicast" },
	{ "rx_multicast" },
	{ "rx_broadcast" },
A
Ayaz Abdulla 已提交
631 632 633 634 635 636 637
	{ "rx_packets" },
	{ "rx_errors_total" },
	{ "tx_errors_total" },

	/* version 2 stats */
	{ "tx_deferral" },
	{ "tx_packets" },
638
	{ "rx_bytes" }, /* includes Ethernet FCS CRC */
A
Ayaz Abdulla 已提交
639
	{ "tx_pause" },
640
	{ "rx_pause" },
641 642 643 644 645 646
	{ "rx_drop_frame" },

	/* version 3 stats */
	{ "tx_unicast" },
	{ "tx_multicast" },
	{ "tx_broadcast" }
647 648 649
};

struct nv_ethtool_stats {
650
	u64 tx_bytes; /* should be ifconfig->tx_bytes + 4*tx_packets */
651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670
	u64 tx_zero_rexmt;
	u64 tx_one_rexmt;
	u64 tx_many_rexmt;
	u64 tx_late_collision;
	u64 tx_fifo_errors;
	u64 tx_carrier_errors;
	u64 tx_excess_deferral;
	u64 tx_retry_error;
	u64 rx_frame_error;
	u64 rx_extra_byte;
	u64 rx_late_collision;
	u64 rx_runt;
	u64 rx_frame_too_long;
	u64 rx_over_errors;
	u64 rx_crc_errors;
	u64 rx_frame_align_error;
	u64 rx_length_error;
	u64 rx_unicast;
	u64 rx_multicast;
	u64 rx_broadcast;
671
	u64 rx_packets; /* should be ifconfig->rx_packets */
A
Ayaz Abdulla 已提交
672 673 674 675 676
	u64 rx_errors_total;
	u64 tx_errors_total;

	/* version 2 stats */
	u64 tx_deferral;
677 678
	u64 tx_packets; /* should be ifconfig->tx_packets */
	u64 rx_bytes;   /* should be ifconfig->rx_bytes + 4*rx_packets */
A
Ayaz Abdulla 已提交
679
	u64 tx_pause;
680 681
	u64 rx_pause;
	u64 rx_drop_frame;
682 683 684 685 686

	/* version 3 stats */
	u64 tx_unicast;
	u64 tx_multicast;
	u64 tx_broadcast;
687 688
};

689 690
#define NV_DEV_STATISTICS_V3_COUNT (sizeof(struct nv_ethtool_stats)/sizeof(u64))
#define NV_DEV_STATISTICS_V2_COUNT (NV_DEV_STATISTICS_V3_COUNT - 3)
A
Ayaz Abdulla 已提交
691 692
#define NV_DEV_STATISTICS_V1_COUNT (NV_DEV_STATISTICS_V2_COUNT - 6)

693 694 695 696 697 698 699 700 701 702 703 704
/* diagnostics */
#define NV_TEST_COUNT_BASE 3
#define NV_TEST_COUNT_EXTENDED 4

static const struct nv_ethtool_str nv_etests_str[] = {
	{ "link      (online/offline)" },
	{ "register  (offline)       " },
	{ "interrupt (offline)       " },
	{ "loopback  (offline)       " }
};

struct register_test {
A
Al Viro 已提交
705 706
	__u32 reg;
	__u32 mask;
707 708 709 710 711 712 713
};

static const struct register_test nv_registers_test[] = {
	{ NvRegUnknownSetupReg6, 0x01 },
	{ NvRegMisc1, 0x03c },
	{ NvRegOffloadConfig, 0x03ff },
	{ NvRegMulticastAddrA, 0xffffffff },
714
	{ NvRegTxWatermark, 0x0ff },
715
	{ NvRegWakeUpFlags, 0x07777 },
716
	{ 0, 0 }
717 718
};

A
Ayaz Abdulla 已提交
719 720 721
struct nv_skb_map {
	struct sk_buff *skb;
	dma_addr_t dma;
E
Eric Dumazet 已提交
722 723
	unsigned int dma_len:31;
	unsigned int dma_single:1;
A
Ayaz Abdulla 已提交
724 725
	struct ring_desc_ex *first_tx_desc;
	struct nv_skb_map *next_tx_ctx;
A
Ayaz Abdulla 已提交
726 727
};

L
Linus Torvalds 已提交
728 729
/*
 * SMP locking:
W
Wang Chen 已提交
730
 * All hardware access under netdev_priv(dev)->lock, except the performance
L
Linus Torvalds 已提交
731 732 733
 * critical parts:
 * - rx is (pseudo-) lockless: it relies on the single-threading provided
 *	by the arch code for interrupts.
H
Herbert Xu 已提交
734
 * - tx setup is lockless: it relies on netif_tx_lock. Actual submission
W
Wang Chen 已提交
735
 *	needs netdev_priv(dev)->lock :-(
H
Herbert Xu 已提交
736
 * - set_multicast_list: preparation lockless, relies on netif_tx_lock.
737 738 739 740 741 742 743 744 745 746
 *
 * Hardware stats updates are protected by hwstats_lock:
 * - updated by nv_do_stats_poll (timer). This is meant to avoid
 *   integer wraparound in the NIC stats registers, at low frequency
 *   (0.1 Hz)
 * - updated by nv_get_ethtool_stats + nv_get_stats64
 *
 * Software stats are accessed only through 64b synchronization points
 * and are not subject to other synchronization techniques (single
 * update thread on the TX or RX paths).
L
Linus Torvalds 已提交
747 748 749 750 751 752
 */

/* in dev: base, irq */
struct fe_priv {
	spinlock_t lock;

753 754 755
	struct net_device *dev;
	struct napi_struct napi;

756 757
	/* hardware stats are updated in syscall and timer */
	spinlock_t hwstats_lock;
758
	struct nv_ethtool_stats estats;
759

L
Linus Torvalds 已提交
760 761 762 763 764 765 766 767
	int in_shutdown;
	u32 linkspeed;
	int duplex;
	int autoneg;
	int fixed_mode;
	int phyaddr;
	int wolenabled;
	unsigned int phy_oui;
768
	unsigned int phy_model;
769
	unsigned int phy_rev;
L
Linus Torvalds 已提交
770
	u16 gigabit;
771
	int intr_test;
772
	int recover_error;
773
	int quiet_count;
L
Linus Torvalds 已提交
774 775 776 777 778

	/* General data: RO fields */
	dma_addr_t ring_addr;
	struct pci_dev *pci_dev;
	u32 orig_mac[2];
779
	u32 events;
L
Linus Torvalds 已提交
780 781
	u32 irqmask;
	u32 desc_ver;
782
	u32 txrxctl_bits;
783
	u32 vlanctl_bits;
784
	u32 driver_data;
785
	u32 device_id;
786
	u32 register_size;
787
	u32 mac_in_use;
A
Ayaz Abdulla 已提交
788 789
	int mgmt_version;
	int mgmt_sema;
L
Linus Torvalds 已提交
790 791 792 793 794 795

	void __iomem *base;

	/* rx specific fields.
	 * Locking: Within irq hander or disable_irq+spin_lock(&np->lock);
	 */
A
Ayaz Abdulla 已提交
796 797 798 799 800
	union ring_type get_rx, put_rx, first_rx, last_rx;
	struct nv_skb_map *get_rx_ctx, *put_rx_ctx;
	struct nv_skb_map *first_rx_ctx, *last_rx_ctx;
	struct nv_skb_map *rx_skb;

801
	union ring_type rx_ring;
L
Linus Torvalds 已提交
802
	unsigned int rx_buf_sz;
803
	unsigned int pkt_limit;
L
Linus Torvalds 已提交
804 805
	struct timer_list oom_kick;
	struct timer_list nic_poll;
806
	struct timer_list stats_poll;
807
	u32 nic_poll_irq;
808
	int rx_ring_size;
L
Linus Torvalds 已提交
809

810 811 812 813 814
	/* RX software stats */
	struct u64_stats_sync swstats_rx_syncp;
	u64 stat_rx_packets;
	u64 stat_rx_bytes; /* not always available in HW */
	u64 stat_rx_missed_errors;
815
	u64 stat_rx_dropped;
816

L
Linus Torvalds 已提交
817 818 819 820 821 822 823 824
	/* media detection workaround.
	 * Locking: Within irq hander or disable_irq+spin_lock(&np->lock);
	 */
	int need_linktimer;
	unsigned long link_timeout;
	/*
	 * tx specific fields.
	 */
A
Ayaz Abdulla 已提交
825 826 827 828 829
	union ring_type get_tx, put_tx, first_tx, last_tx;
	struct nv_skb_map *get_tx_ctx, *put_tx_ctx;
	struct nv_skb_map *first_tx_ctx, *last_tx_ctx;
	struct nv_skb_map *tx_skb;

830
	union ring_type tx_ring;
L
Linus Torvalds 已提交
831
	u32 tx_flags;
832
	int tx_ring_size;
A
Ayaz Abdulla 已提交
833 834 835 836
	int tx_limit;
	u32 tx_pkts_in_progress;
	struct nv_skb_map *tx_change_owner;
	struct nv_skb_map *tx_end_flip;
A
Ayaz Abdulla 已提交
837
	int tx_stop;
838

839 840 841 842 843 844
	/* TX software stats */
	struct u64_stats_sync swstats_tx_syncp;
	u64 stat_tx_packets; /* not always available in HW */
	u64 stat_tx_bytes;
	u64 stat_tx_dropped;

845 846 847
	/* msi/msi-x fields */
	u32 msi_flags;
	struct msix_entry msi_x_entry[NV_MSI_X_MAX_VECTORS];
848 849 850

	/* flow control */
	u32 pause_flags;
851 852 853

	/* power saved state */
	u32 saved_config_space[NV_PCI_REGSZ_MAX/4];
854 855 856 857 858

	/* for different msi-x irq type */
	char name_rx[IFNAMSIZ + 3];       /* -rx    */
	char name_tx[IFNAMSIZ + 3];       /* -tx    */
	char name_other[IFNAMSIZ + 6];    /* -other */
L
Linus Torvalds 已提交
859 860 861 862 863 864
};

/*
 * Maximum number of loops until we assume that a bit in the irq mask
 * is stuck. Overridable with module param.
 */
865
static int max_interrupt_work = 4;
L
Linus Torvalds 已提交
866

867 868
/*
 * Optimization can be either throuput mode or cpu mode
869
 *
870 871 872
 * Throughput Mode: Every tx and rx packet will generate an interrupt.
 * CPU Mode: Interrupts are controlled by a timer.
 */
873 874
enum {
	NV_OPTIMIZATION_MODE_THROUGHPUT,
875 876
	NV_OPTIMIZATION_MODE_CPU,
	NV_OPTIMIZATION_MODE_DYNAMIC
877
};
878
static int optimization_mode = NV_OPTIMIZATION_MODE_DYNAMIC;
879 880 881 882 883 884 885 886 887 888

/*
 * Poll interval for timer irq
 *
 * This interval determines how frequent an interrupt is generated.
 * The is value is determined by [(time_in_micro_secs * 100) / (2^10)]
 * Min = 0, and Max = 65535
 */
static int poll_interval = -1;

889
/*
890
 * MSI interrupts
891
 */
892 893 894 895 896
enum {
	NV_MSI_INT_DISABLED,
	NV_MSI_INT_ENABLED
};
static int msi = NV_MSI_INT_ENABLED;
897 898

/*
899
 * MSIX interrupts
900
 */
901 902 903 904
enum {
	NV_MSIX_INT_DISABLED,
	NV_MSIX_INT_ENABLED
};
Y
Yinghai Lu 已提交
905
static int msix = NV_MSIX_INT_ENABLED;
906 907 908 909 910 911 912 913 914

/*
 * DMA 64bit
 */
enum {
	NV_DMA_64BIT_DISABLED,
	NV_DMA_64BIT_ENABLED
};
static int dma_64bit = NV_DMA_64BIT_ENABLED;
915

916 917 918 919 920
/*
 * Debug output control for tx_timeout
 */
static bool debug_tx_timeout = false;

921 922 923 924 925 926 927 928 929 930
/*
 * Crossover Detection
 * Realtek 8201 phy + some OEM boards do not work properly.
 */
enum {
	NV_CROSSOVER_DETECTION_DISABLED,
	NV_CROSSOVER_DETECTION_ENABLED
};
static int phy_cross = NV_CROSSOVER_DETECTION_DISABLED;

931 932 933 934
/*
 * Power down phy when interface is down (persists through reboot;
 * older Linux and other OSes may not power it up again)
 */
935
static int phy_power_down;
936

L
Linus Torvalds 已提交
937 938 939 940 941 942 943
static inline struct fe_priv *get_nvpriv(struct net_device *dev)
{
	return netdev_priv(dev);
}

static inline u8 __iomem *get_hwbase(struct net_device *dev)
{
944
	return ((struct fe_priv *)netdev_priv(dev))->base;
L
Linus Torvalds 已提交
945 946 947 948 949 950 951 952 953 954
}

static inline void pci_push(u8 __iomem *base)
{
	/* force out pending posted writes */
	readl(base);
}

static inline u32 nv_descr_getlength(struct ring_desc *prd, u32 v)
{
955
	return le32_to_cpu(prd->flaglen)
L
Linus Torvalds 已提交
956 957 958
		& ((v == DESC_VER_1) ? LEN_MASK_V1 : LEN_MASK_V2);
}

959 960
static inline u32 nv_descr_getlength_ex(struct ring_desc_ex *prd, u32 v)
{
961
	return le32_to_cpu(prd->flaglen) & LEN_MASK_V2;
962 963
}

964 965 966 967 968 969 970
static bool nv_optimized(struct fe_priv *np)
{
	if (np->desc_ver == DESC_VER_1 || np->desc_ver == DESC_VER_2)
		return false;
	return true;
}

L
Linus Torvalds 已提交
971
static int reg_delay(struct net_device *dev, int offset, u32 mask, u32 target,
972
		     int delay, int delaymax)
L
Linus Torvalds 已提交
973 974 975 976 977 978 979
{
	u8 __iomem *base = get_hwbase(dev);

	pci_push(base);
	do {
		udelay(delay);
		delaymax -= delay;
980
		if (delaymax < 0)
L
Linus Torvalds 已提交
981 982 983 984 985
			return 1;
	} while ((readl(base + offset) & mask) != target);
	return 0;
}

986 987 988
#define NV_SETUP_RX_RING 0x01
#define NV_SETUP_TX_RING 0x02

A
Al Viro 已提交
989 990 991 992 993 994 995 996 997 998
static inline u32 dma_low(dma_addr_t addr)
{
	return addr;
}

static inline u32 dma_high(dma_addr_t addr)
{
	return addr>>31>>1;	/* 0 if 32bit, shift down by 32 if 64bit */
}

999 1000 1001 1002 1003
static void setup_hw_rings(struct net_device *dev, int rxtx_flags)
{
	struct fe_priv *np = get_nvpriv(dev);
	u8 __iomem *base = get_hwbase(dev);

1004
	if (!nv_optimized(np)) {
1005
		if (rxtx_flags & NV_SETUP_RX_RING)
A
Al Viro 已提交
1006
			writel(dma_low(np->ring_addr), base + NvRegRxRingPhysAddr);
1007
		if (rxtx_flags & NV_SETUP_TX_RING)
A
Al Viro 已提交
1008
			writel(dma_low(np->ring_addr + np->rx_ring_size*sizeof(struct ring_desc)), base + NvRegTxRingPhysAddr);
1009 1010
	} else {
		if (rxtx_flags & NV_SETUP_RX_RING) {
A
Al Viro 已提交
1011 1012
			writel(dma_low(np->ring_addr), base + NvRegRxRingPhysAddr);
			writel(dma_high(np->ring_addr), base + NvRegRxRingPhysAddrHigh);
1013 1014
		}
		if (rxtx_flags & NV_SETUP_TX_RING) {
A
Al Viro 已提交
1015 1016
			writel(dma_low(np->ring_addr + np->rx_ring_size*sizeof(struct ring_desc_ex)), base + NvRegTxRingPhysAddr);
			writel(dma_high(np->ring_addr + np->rx_ring_size*sizeof(struct ring_desc_ex)), base + NvRegTxRingPhysAddrHigh);
1017 1018 1019 1020
		}
	}
}

1021 1022 1023 1024
static void free_rings(struct net_device *dev)
{
	struct fe_priv *np = get_nvpriv(dev);

1025
	if (!nv_optimized(np)) {
1026
		if (np->rx_ring.orig)
1027 1028 1029 1030 1031
			dma_free_coherent(&np->pci_dev->dev,
					  sizeof(struct ring_desc) *
					  (np->rx_ring_size +
					  np->tx_ring_size),
					  np->rx_ring.orig, np->ring_addr);
1032 1033
	} else {
		if (np->rx_ring.ex)
1034 1035 1036 1037 1038
			dma_free_coherent(&np->pci_dev->dev,
					  sizeof(struct ring_desc_ex) *
					  (np->rx_ring_size +
					  np->tx_ring_size),
					  np->rx_ring.ex, np->ring_addr);
1039
	}
1040 1041
	kfree(np->rx_skb);
	kfree(np->tx_skb);
1042 1043
}

1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055
static int using_multi_irqs(struct net_device *dev)
{
	struct fe_priv *np = get_nvpriv(dev);

	if (!(np->msi_flags & NV_MSI_X_ENABLED) ||
	    ((np->msi_flags & NV_MSI_X_ENABLED) &&
	     ((np->msi_flags & NV_MSI_X_VECTORS_MASK) == 0x1)))
		return 0;
	else
		return 1;
}

1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072
static void nv_txrx_gate(struct net_device *dev, bool gate)
{
	struct fe_priv *np = get_nvpriv(dev);
	u8 __iomem *base = get_hwbase(dev);
	u32 powerstate;

	if (!np->mac_in_use &&
	    (np->driver_data & DEV_HAS_POWER_CNTRL)) {
		powerstate = readl(base + NvRegPowerState2);
		if (gate)
			powerstate |= NVREG_POWERSTATE2_GATE_CLOCKS;
		else
			powerstate &= ~NVREG_POWERSTATE2_GATE_CLOCKS;
		writel(powerstate, base + NvRegPowerState2);
	}
}

1073 1074 1075 1076 1077 1078 1079 1080
static void nv_enable_irq(struct net_device *dev)
{
	struct fe_priv *np = get_nvpriv(dev);

	if (!using_multi_irqs(dev)) {
		if (np->msi_flags & NV_MSI_X_ENABLED)
			enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector);
		else
M
Manfred Spraul 已提交
1081
			enable_irq(np->pci_dev->irq);
1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096
	} else {
		enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector);
		enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector);
		enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector);
	}
}

static void nv_disable_irq(struct net_device *dev)
{
	struct fe_priv *np = get_nvpriv(dev);

	if (!using_multi_irqs(dev)) {
		if (np->msi_flags & NV_MSI_X_ENABLED)
			disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector);
		else
M
Manfred Spraul 已提交
1097
			disable_irq(np->pci_dev->irq);
1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126
	} else {
		disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector);
		disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector);
		disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector);
	}
}

/* In MSIX mode, a write to irqmask behaves as XOR */
static void nv_enable_hw_interrupts(struct net_device *dev, u32 mask)
{
	u8 __iomem *base = get_hwbase(dev);

	writel(mask, base + NvRegIrqMask);
}

static void nv_disable_hw_interrupts(struct net_device *dev, u32 mask)
{
	struct fe_priv *np = get_nvpriv(dev);
	u8 __iomem *base = get_hwbase(dev);

	if (np->msi_flags & NV_MSI_X_ENABLED) {
		writel(mask, base + NvRegIrqMask);
	} else {
		if (np->msi_flags & NV_MSI_ENABLED)
			writel(0, base + NvRegMSIIrqMask);
		writel(0, base + NvRegIrqMask);
	}
}

1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140
static void nv_napi_enable(struct net_device *dev)
{
	struct fe_priv *np = get_nvpriv(dev);

	napi_enable(&np->napi);
}

static void nv_napi_disable(struct net_device *dev)
{
	struct fe_priv *np = get_nvpriv(dev);

	napi_disable(&np->napi);
}

L
Linus Torvalds 已提交
1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151
#define MII_READ	(-1)
/* mii_rw: read/write a register on the PHY.
 *
 * Caller must guarantee serialization
 */
static int mii_rw(struct net_device *dev, int addr, int miireg, int value)
{
	u8 __iomem *base = get_hwbase(dev);
	u32 reg;
	int retval;

A
Ayaz Abdulla 已提交
1152
	writel(NVREG_MIISTAT_MASK_RW, base + NvRegMIIStatus);
L
Linus Torvalds 已提交
1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167

	reg = readl(base + NvRegMIIControl);
	if (reg & NVREG_MIICTL_INUSE) {
		writel(NVREG_MIICTL_INUSE, base + NvRegMIIControl);
		udelay(NV_MIIBUSY_DELAY);
	}

	reg = (addr << NVREG_MIICTL_ADDRSHIFT) | miireg;
	if (value != MII_READ) {
		writel(value, base + NvRegMIIData);
		reg |= NVREG_MIICTL_WRITE;
	}
	writel(reg, base + NvRegMIIControl);

	if (reg_delay(dev, NvRegMIIControl, NVREG_MIICTL_INUSE, 0,
1168
			NV_MIIPHY_DELAY, NV_MIIPHY_DELAYMAX)) {
L
Linus Torvalds 已提交
1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181
		retval = -1;
	} else if (value != MII_READ) {
		/* it was a write operation - fewer failures are detectable */
		retval = 0;
	} else if (readl(base + NvRegMIIStatus) & NVREG_MIISTAT_ERROR) {
		retval = -1;
	} else {
		retval = readl(base + NvRegMIIData);
	}

	return retval;
}

1182
static int phy_reset(struct net_device *dev, u32 bmcr_setup)
L
Linus Torvalds 已提交
1183
{
1184
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
1185 1186 1187
	u32 miicontrol;
	unsigned int tries = 0;

1188
	miicontrol = BMCR_RESET | bmcr_setup;
1189
	if (mii_rw(dev, np->phyaddr, MII_BMCR, miicontrol))
L
Linus Torvalds 已提交
1190 1191 1192 1193 1194 1195 1196
		return -1;

	/* wait for 500ms */
	msleep(500);

	/* must wait till reset is deasserted */
	while (miicontrol & BMCR_RESET) {
1197
		usleep_range(10000, 20000);
L
Linus Torvalds 已提交
1198 1199 1200 1201 1202 1203 1204 1205
		miicontrol = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
		/* FIXME: 100 tries seem excessive */
		if (tries++ > 100)
			return -1;
	}
	return 0;
}

1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222
static int init_realtek_8211b(struct net_device *dev, struct fe_priv *np)
{
	static const struct {
		int reg;
		int init;
	} ri[] = {
		{ PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1 },
		{ PHY_REALTEK_INIT_REG2, PHY_REALTEK_INIT2 },
		{ PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3 },
		{ PHY_REALTEK_INIT_REG3, PHY_REALTEK_INIT4 },
		{ PHY_REALTEK_INIT_REG4, PHY_REALTEK_INIT5 },
		{ PHY_REALTEK_INIT_REG5, PHY_REALTEK_INIT6 },
		{ PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1 },
	};
	int i;

	for (i = 0; i < ARRAY_SIZE(ri); i++) {
1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297
		if (mii_rw(dev, np->phyaddr, ri[i].reg, ri[i].init))
			return PHY_ERROR;
	}

	return 0;
}

static int init_realtek_8211c(struct net_device *dev, struct fe_priv *np)
{
	u32 reg;
	u8 __iomem *base = get_hwbase(dev);
	u32 powerstate = readl(base + NvRegPowerState2);

	/* need to perform hw phy reset */
	powerstate |= NVREG_POWERSTATE2_PHY_RESET;
	writel(powerstate, base + NvRegPowerState2);
	msleep(25);

	powerstate &= ~NVREG_POWERSTATE2_PHY_RESET;
	writel(powerstate, base + NvRegPowerState2);
	msleep(25);

	reg = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, MII_READ);
	reg |= PHY_REALTEK_INIT9;
	if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, reg))
		return PHY_ERROR;
	if (mii_rw(dev, np->phyaddr,
		   PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT10))
		return PHY_ERROR;
	reg = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG7, MII_READ);
	if (!(reg & PHY_REALTEK_INIT11)) {
		reg |= PHY_REALTEK_INIT11;
		if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG7, reg))
			return PHY_ERROR;
	}
	if (mii_rw(dev, np->phyaddr,
		   PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1))
		return PHY_ERROR;

	return 0;
}

static int init_realtek_8201(struct net_device *dev, struct fe_priv *np)
{
	u32 phy_reserved;

	if (np->driver_data & DEV_NEED_PHY_INIT_FIX) {
		phy_reserved = mii_rw(dev, np->phyaddr,
				      PHY_REALTEK_INIT_REG6, MII_READ);
		phy_reserved |= PHY_REALTEK_INIT7;
		if (mii_rw(dev, np->phyaddr,
			   PHY_REALTEK_INIT_REG6, phy_reserved))
			return PHY_ERROR;
	}

	return 0;
}

static int init_realtek_8201_cross(struct net_device *dev, struct fe_priv *np)
{
	u32 phy_reserved;

	if (phy_cross == NV_CROSSOVER_DETECTION_DISABLED) {
		if (mii_rw(dev, np->phyaddr,
			   PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3))
			return PHY_ERROR;
		phy_reserved = mii_rw(dev, np->phyaddr,
				      PHY_REALTEK_INIT_REG2, MII_READ);
		phy_reserved &= ~PHY_REALTEK_INIT_MSK1;
		phy_reserved |= PHY_REALTEK_INIT3;
		if (mii_rw(dev, np->phyaddr,
			   PHY_REALTEK_INIT_REG2, phy_reserved))
			return PHY_ERROR;
		if (mii_rw(dev, np->phyaddr,
			   PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1))
1298 1299 1300 1301 1302 1303
			return PHY_ERROR;
	}

	return 0;
}

1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389
static int init_cicada(struct net_device *dev, struct fe_priv *np,
		       u32 phyinterface)
{
	u32 phy_reserved;

	if (phyinterface & PHY_RGMII) {
		phy_reserved = mii_rw(dev, np->phyaddr, MII_RESV1, MII_READ);
		phy_reserved &= ~(PHY_CICADA_INIT1 | PHY_CICADA_INIT2);
		phy_reserved |= (PHY_CICADA_INIT3 | PHY_CICADA_INIT4);
		if (mii_rw(dev, np->phyaddr, MII_RESV1, phy_reserved))
			return PHY_ERROR;
		phy_reserved = mii_rw(dev, np->phyaddr, MII_NCONFIG, MII_READ);
		phy_reserved |= PHY_CICADA_INIT5;
		if (mii_rw(dev, np->phyaddr, MII_NCONFIG, phy_reserved))
			return PHY_ERROR;
	}
	phy_reserved = mii_rw(dev, np->phyaddr, MII_SREVISION, MII_READ);
	phy_reserved |= PHY_CICADA_INIT6;
	if (mii_rw(dev, np->phyaddr, MII_SREVISION, phy_reserved))
		return PHY_ERROR;

	return 0;
}

static int init_vitesse(struct net_device *dev, struct fe_priv *np)
{
	u32 phy_reserved;

	if (mii_rw(dev, np->phyaddr,
		   PHY_VITESSE_INIT_REG1, PHY_VITESSE_INIT1))
		return PHY_ERROR;
	if (mii_rw(dev, np->phyaddr,
		   PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT2))
		return PHY_ERROR;
	phy_reserved = mii_rw(dev, np->phyaddr,
			      PHY_VITESSE_INIT_REG4, MII_READ);
	if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, phy_reserved))
		return PHY_ERROR;
	phy_reserved = mii_rw(dev, np->phyaddr,
			      PHY_VITESSE_INIT_REG3, MII_READ);
	phy_reserved &= ~PHY_VITESSE_INIT_MSK1;
	phy_reserved |= PHY_VITESSE_INIT3;
	if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, phy_reserved))
		return PHY_ERROR;
	if (mii_rw(dev, np->phyaddr,
		   PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT4))
		return PHY_ERROR;
	if (mii_rw(dev, np->phyaddr,
		   PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT5))
		return PHY_ERROR;
	phy_reserved = mii_rw(dev, np->phyaddr,
			      PHY_VITESSE_INIT_REG4, MII_READ);
	phy_reserved &= ~PHY_VITESSE_INIT_MSK1;
	phy_reserved |= PHY_VITESSE_INIT3;
	if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, phy_reserved))
		return PHY_ERROR;
	phy_reserved = mii_rw(dev, np->phyaddr,
			      PHY_VITESSE_INIT_REG3, MII_READ);
	if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, phy_reserved))
		return PHY_ERROR;
	if (mii_rw(dev, np->phyaddr,
		   PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT6))
		return PHY_ERROR;
	if (mii_rw(dev, np->phyaddr,
		   PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT7))
		return PHY_ERROR;
	phy_reserved = mii_rw(dev, np->phyaddr,
			      PHY_VITESSE_INIT_REG4, MII_READ);
	if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, phy_reserved))
		return PHY_ERROR;
	phy_reserved = mii_rw(dev, np->phyaddr,
			      PHY_VITESSE_INIT_REG3, MII_READ);
	phy_reserved &= ~PHY_VITESSE_INIT_MSK2;
	phy_reserved |= PHY_VITESSE_INIT8;
	if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, phy_reserved))
		return PHY_ERROR;
	if (mii_rw(dev, np->phyaddr,
		   PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT9))
		return PHY_ERROR;
	if (mii_rw(dev, np->phyaddr,
		   PHY_VITESSE_INIT_REG1, PHY_VITESSE_INIT10))
		return PHY_ERROR;

	return 0;
}

L
Linus Torvalds 已提交
1390 1391 1392 1393
static int phy_init(struct net_device *dev)
{
	struct fe_priv *np = get_nvpriv(dev);
	u8 __iomem *base = get_hwbase(dev);
1394 1395
	u32 phyinterface;
	u32 mii_status, mii_control, mii_control_1000, reg;
L
Linus Torvalds 已提交
1396

1397 1398 1399 1400 1401
	/* phy errata for E3016 phy */
	if (np->phy_model == PHY_MODEL_MARVELL_E3016) {
		reg = mii_rw(dev, np->phyaddr, MII_NCONFIG, MII_READ);
		reg &= ~PHY_MARVELL_E3016_INITMASK;
		if (mii_rw(dev, np->phyaddr, MII_NCONFIG, reg)) {
1402 1403
			netdev_info(dev, "%s: phy write to errata reg failed\n",
				    pci_name(np->pci_dev));
1404 1405 1406
			return PHY_ERROR;
		}
	}
A
Ayaz Abdulla 已提交
1407
	if (np->phy_oui == PHY_OUI_REALTEK) {
1408 1409
		if (np->phy_model == PHY_MODEL_REALTEK_8211 &&
		    np->phy_rev == PHY_REV_REALTEK_8211B) {
1410
			if (init_realtek_8211b(dev, np)) {
1411 1412
				netdev_info(dev, "%s: phy init failed\n",
					    pci_name(np->pci_dev));
1413 1414
				return PHY_ERROR;
			}
1415 1416 1417
		} else if (np->phy_model == PHY_MODEL_REALTEK_8211 &&
			   np->phy_rev == PHY_REV_REALTEK_8211C) {
			if (init_realtek_8211c(dev, np)) {
1418 1419
				netdev_info(dev, "%s: phy init failed\n",
					    pci_name(np->pci_dev));
1420 1421
				return PHY_ERROR;
			}
1422 1423
		} else if (np->phy_model == PHY_MODEL_REALTEK_8201) {
			if (init_realtek_8201(dev, np)) {
1424 1425
				netdev_info(dev, "%s: phy init failed\n",
					    pci_name(np->pci_dev));
1426 1427 1428
				return PHY_ERROR;
			}
		}
A
Ayaz Abdulla 已提交
1429
	}
1430

L
Linus Torvalds 已提交
1431 1432
	/* set advertise register */
	reg = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
1433 1434 1435
	reg |= (ADVERTISE_10HALF | ADVERTISE_10FULL |
		ADVERTISE_100HALF | ADVERTISE_100FULL |
		ADVERTISE_PAUSE_ASYM | ADVERTISE_PAUSE_CAP);
L
Linus Torvalds 已提交
1436
	if (mii_rw(dev, np->phyaddr, MII_ADVERTISE, reg)) {
1437 1438
		netdev_info(dev, "%s: phy write to advertise failed\n",
			    pci_name(np->pci_dev));
L
Linus Torvalds 已提交
1439 1440 1441 1442 1443 1444 1445 1446 1447 1448
		return PHY_ERROR;
	}

	/* get phy interface type */
	phyinterface = readl(base + NvRegPhyInterface);

	/* see if gigabit phy */
	mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
	if (mii_status & PHY_GIGABIT) {
		np->gigabit = PHY_GIGABIT;
1449 1450
		mii_control_1000 = mii_rw(dev, np->phyaddr,
					  MII_CTRL1000, MII_READ);
L
Linus Torvalds 已提交
1451 1452 1453 1454 1455 1456
		mii_control_1000 &= ~ADVERTISE_1000HALF;
		if (phyinterface & PHY_RGMII)
			mii_control_1000 |= ADVERTISE_1000FULL;
		else
			mii_control_1000 &= ~ADVERTISE_1000FULL;

1457
		if (mii_rw(dev, np->phyaddr, MII_CTRL1000, mii_control_1000)) {
1458 1459
			netdev_info(dev, "%s: phy init failed\n",
				    pci_name(np->pci_dev));
L
Linus Torvalds 已提交
1460 1461
			return PHY_ERROR;
		}
1462
	} else
L
Linus Torvalds 已提交
1463 1464
		np->gigabit = 0;

1465 1466 1467
	mii_control = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
	mii_control |= BMCR_ANENABLE;

1468 1469 1470 1471 1472 1473
	if (np->phy_oui == PHY_OUI_REALTEK &&
	    np->phy_model == PHY_MODEL_REALTEK_8211 &&
	    np->phy_rev == PHY_REV_REALTEK_8211C) {
		/* start autoneg since we already performed hw reset above */
		mii_control |= BMCR_ANRESTART;
		if (mii_rw(dev, np->phyaddr, MII_BMCR, mii_control)) {
1474 1475
			netdev_info(dev, "%s: phy init failed\n",
				    pci_name(np->pci_dev));
1476 1477 1478 1479 1480 1481 1482
			return PHY_ERROR;
		}
	} else {
		/* reset the phy
		 * (certain phys need bmcr to be setup with reset)
		 */
		if (phy_reset(dev, mii_control)) {
1483 1484
			netdev_info(dev, "%s: phy reset failed\n",
				    pci_name(np->pci_dev));
1485 1486
			return PHY_ERROR;
		}
L
Linus Torvalds 已提交
1487 1488 1489
	}

	/* phy vendor specific configuration */
1490
	if (np->phy_oui == PHY_OUI_CICADA) {
1491
		if (init_cicada(dev, np, phyinterface)) {
1492 1493
			netdev_info(dev, "%s: phy init failed\n",
				    pci_name(np->pci_dev));
A
Ayaz Abdulla 已提交
1494 1495
			return PHY_ERROR;
		}
1496 1497
	} else if (np->phy_oui == PHY_OUI_VITESSE) {
		if (init_vitesse(dev, np)) {
1498 1499
			netdev_info(dev, "%s: phy init failed\n",
				    pci_name(np->pci_dev));
A
Ayaz Abdulla 已提交
1500 1501
			return PHY_ERROR;
		}
1502
	} else if (np->phy_oui == PHY_OUI_REALTEK) {
1503 1504 1505
		if (np->phy_model == PHY_MODEL_REALTEK_8211 &&
		    np->phy_rev == PHY_REV_REALTEK_8211B) {
			/* reset could have cleared these out, set them back */
1506 1507 1508
			if (init_realtek_8211b(dev, np)) {
				netdev_info(dev, "%s: phy init failed\n",
					    pci_name(np->pci_dev));
1509 1510
				return PHY_ERROR;
			}
1511 1512 1513 1514 1515 1516
		} else if (np->phy_model == PHY_MODEL_REALTEK_8201) {
			if (init_realtek_8201(dev, np) ||
			    init_realtek_8201_cross(dev, np)) {
				netdev_info(dev, "%s: phy init failed\n",
					    pci_name(np->pci_dev));
				return PHY_ERROR;
1517
			}
A
Ayaz Abdulla 已提交
1518 1519 1520
		}
	}

L
Lucas De Marchi 已提交
1521
	/* some phys clear out pause advertisement on reset, set it back */
1522
	mii_rw(dev, np->phyaddr, MII_ADVERTISE, reg);
L
Linus Torvalds 已提交
1523

1524
	/* restart auto negotiation, power down phy */
L
Linus Torvalds 已提交
1525
	mii_control = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
1526
	mii_control |= (BMCR_ANRESTART | BMCR_ANENABLE);
1527
	if (phy_power_down)
1528
		mii_control |= BMCR_PDOWN;
1529
	if (mii_rw(dev, np->phyaddr, MII_BMCR, mii_control))
L
Linus Torvalds 已提交
1530 1531 1532 1533 1534 1535 1536
		return PHY_ERROR;

	return 0;
}

static void nv_start_rx(struct net_device *dev)
{
1537
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
1538
	u8 __iomem *base = get_hwbase(dev);
1539
	u32 rx_ctrl = readl(base + NvRegReceiverControl);
L
Linus Torvalds 已提交
1540 1541

	/* Already running? Stop it. */
1542 1543 1544
	if ((readl(base + NvRegReceiverControl) & NVREG_RCVCTL_START) && !np->mac_in_use) {
		rx_ctrl &= ~NVREG_RCVCTL_START;
		writel(rx_ctrl, base + NvRegReceiverControl);
L
Linus Torvalds 已提交
1545 1546 1547 1548
		pci_push(base);
	}
	writel(np->linkspeed, base + NvRegLinkSpeed);
	pci_push(base);
1549 1550
	rx_ctrl |= NVREG_RCVCTL_START;
	if (np->mac_in_use)
1551 1552
		rx_ctrl &= ~NVREG_RCVCTL_RX_PATH_EN;
	writel(rx_ctrl, base + NvRegReceiverControl);
L
Linus Torvalds 已提交
1553 1554 1555 1556 1557
	pci_push(base);
}

static void nv_stop_rx(struct net_device *dev)
{
1558
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
1559
	u8 __iomem *base = get_hwbase(dev);
1560
	u32 rx_ctrl = readl(base + NvRegReceiverControl);
L
Linus Torvalds 已提交
1561

1562 1563 1564 1565 1566
	if (!np->mac_in_use)
		rx_ctrl &= ~NVREG_RCVCTL_START;
	else
		rx_ctrl |= NVREG_RCVCTL_RX_PATH_EN;
	writel(rx_ctrl, base + NvRegReceiverControl);
1567 1568
	if (reg_delay(dev, NvRegReceiverStatus, NVREG_RCVSTAT_BUSY, 0,
		      NV_RXSTOP_DELAY1, NV_RXSTOP_DELAY1MAX))
1569 1570
		netdev_info(dev, "%s: ReceiverStatus remained busy\n",
			    __func__);
L
Linus Torvalds 已提交
1571 1572

	udelay(NV_RXSTOP_DELAY2);
1573 1574
	if (!np->mac_in_use)
		writel(0, base + NvRegLinkSpeed);
L
Linus Torvalds 已提交
1575 1576 1577 1578
}

static void nv_start_tx(struct net_device *dev)
{
1579
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
1580
	u8 __iomem *base = get_hwbase(dev);
1581
	u32 tx_ctrl = readl(base + NvRegTransmitterControl);
L
Linus Torvalds 已提交
1582

1583 1584 1585 1586
	tx_ctrl |= NVREG_XMITCTL_START;
	if (np->mac_in_use)
		tx_ctrl &= ~NVREG_XMITCTL_TX_PATH_EN;
	writel(tx_ctrl, base + NvRegTransmitterControl);
L
Linus Torvalds 已提交
1587 1588 1589 1590 1591
	pci_push(base);
}

static void nv_stop_tx(struct net_device *dev)
{
1592
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
1593
	u8 __iomem *base = get_hwbase(dev);
1594
	u32 tx_ctrl = readl(base + NvRegTransmitterControl);
L
Linus Torvalds 已提交
1595

1596 1597 1598 1599 1600
	if (!np->mac_in_use)
		tx_ctrl &= ~NVREG_XMITCTL_START;
	else
		tx_ctrl |= NVREG_XMITCTL_TX_PATH_EN;
	writel(tx_ctrl, base + NvRegTransmitterControl);
1601 1602
	if (reg_delay(dev, NvRegTransmitterStatus, NVREG_XMITSTAT_BUSY, 0,
		      NV_TXSTOP_DELAY1, NV_TXSTOP_DELAY1MAX))
1603 1604
		netdev_info(dev, "%s: TransmitterStatus remained busy\n",
			    __func__);
L
Linus Torvalds 已提交
1605 1606

	udelay(NV_TXSTOP_DELAY2);
1607 1608 1609
	if (!np->mac_in_use)
		writel(readl(base + NvRegTransmitPoll) & NVREG_TRANSMITPOLL_MAC_ADDR_REV,
		       base + NvRegTransmitPoll);
L
Linus Torvalds 已提交
1610 1611
}

1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623
static void nv_start_rxtx(struct net_device *dev)
{
	nv_start_rx(dev);
	nv_start_tx(dev);
}

static void nv_stop_rxtx(struct net_device *dev)
{
	nv_stop_rx(dev);
	nv_stop_tx(dev);
}

L
Linus Torvalds 已提交
1624 1625
static void nv_txrx_reset(struct net_device *dev)
{
1626
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
1627 1628
	u8 __iomem *base = get_hwbase(dev);

1629
	writel(NVREG_TXRXCTL_BIT2 | NVREG_TXRXCTL_RESET | np->txrxctl_bits, base + NvRegTxRxControl);
L
Linus Torvalds 已提交
1630 1631
	pci_push(base);
	udelay(NV_TXRX_RESET_DELAY);
1632
	writel(NVREG_TXRXCTL_BIT2 | np->txrxctl_bits, base + NvRegTxRxControl);
L
Linus Torvalds 已提交
1633 1634 1635
	pci_push(base);
}

1636 1637 1638 1639
static void nv_mac_reset(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
A
Ayaz Abdulla 已提交
1640
	u32 temp1, temp2, temp3;
1641 1642 1643

	writel(NVREG_TXRXCTL_BIT2 | NVREG_TXRXCTL_RESET | np->txrxctl_bits, base + NvRegTxRxControl);
	pci_push(base);
A
Ayaz Abdulla 已提交
1644 1645 1646 1647 1648 1649

	/* save registers since they will be cleared on reset */
	temp1 = readl(base + NvRegMacAddrA);
	temp2 = readl(base + NvRegMacAddrB);
	temp3 = readl(base + NvRegTransmitPoll);

1650 1651 1652 1653 1654 1655
	writel(NVREG_MAC_RESET_ASSERT, base + NvRegMacReset);
	pci_push(base);
	udelay(NV_MAC_RESET_DELAY);
	writel(0, base + NvRegMacReset);
	pci_push(base);
	udelay(NV_MAC_RESET_DELAY);
A
Ayaz Abdulla 已提交
1656 1657 1658 1659 1660 1661

	/* restore saved registers */
	writel(temp1, base + NvRegMacAddrA);
	writel(temp2, base + NvRegMacAddrB);
	writel(temp3, base + NvRegTransmitPoll);

1662 1663 1664 1665
	writel(NVREG_TXRXCTL_BIT2 | np->txrxctl_bits, base + NvRegTxRxControl);
	pci_push(base);
}

1666 1667
/* Caller must appropriately lock netdev_priv(dev)->hwstats_lock */
static void nv_update_stats(struct net_device *dev)
A
Ayaz Abdulla 已提交
1668 1669 1670 1671
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);

1672 1673 1674 1675 1676 1677 1678
	/* If it happens that this is run in top-half context, then
	 * replace the spin_lock of hwstats_lock with
	 * spin_lock_irqsave() in calling functions. */
	WARN_ONCE(in_irq(), "forcedeth: estats spin_lock(_bh) from top-half");
	assert_spin_locked(&np->hwstats_lock);

	/* query hardware */
A
Ayaz Abdulla 已提交
1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725
	np->estats.tx_bytes += readl(base + NvRegTxCnt);
	np->estats.tx_zero_rexmt += readl(base + NvRegTxZeroReXmt);
	np->estats.tx_one_rexmt += readl(base + NvRegTxOneReXmt);
	np->estats.tx_many_rexmt += readl(base + NvRegTxManyReXmt);
	np->estats.tx_late_collision += readl(base + NvRegTxLateCol);
	np->estats.tx_fifo_errors += readl(base + NvRegTxUnderflow);
	np->estats.tx_carrier_errors += readl(base + NvRegTxLossCarrier);
	np->estats.tx_excess_deferral += readl(base + NvRegTxExcessDef);
	np->estats.tx_retry_error += readl(base + NvRegTxRetryErr);
	np->estats.rx_frame_error += readl(base + NvRegRxFrameErr);
	np->estats.rx_extra_byte += readl(base + NvRegRxExtraByte);
	np->estats.rx_late_collision += readl(base + NvRegRxLateCol);
	np->estats.rx_runt += readl(base + NvRegRxRunt);
	np->estats.rx_frame_too_long += readl(base + NvRegRxFrameTooLong);
	np->estats.rx_over_errors += readl(base + NvRegRxOverflow);
	np->estats.rx_crc_errors += readl(base + NvRegRxFCSErr);
	np->estats.rx_frame_align_error += readl(base + NvRegRxFrameAlignErr);
	np->estats.rx_length_error += readl(base + NvRegRxLenErr);
	np->estats.rx_unicast += readl(base + NvRegRxUnicast);
	np->estats.rx_multicast += readl(base + NvRegRxMulticast);
	np->estats.rx_broadcast += readl(base + NvRegRxBroadcast);
	np->estats.rx_packets =
		np->estats.rx_unicast +
		np->estats.rx_multicast +
		np->estats.rx_broadcast;
	np->estats.rx_errors_total =
		np->estats.rx_crc_errors +
		np->estats.rx_over_errors +
		np->estats.rx_frame_error +
		(np->estats.rx_frame_align_error - np->estats.rx_extra_byte) +
		np->estats.rx_late_collision +
		np->estats.rx_runt +
		np->estats.rx_frame_too_long;
	np->estats.tx_errors_total =
		np->estats.tx_late_collision +
		np->estats.tx_fifo_errors +
		np->estats.tx_carrier_errors +
		np->estats.tx_excess_deferral +
		np->estats.tx_retry_error;

	if (np->driver_data & DEV_HAS_STATISTICS_V2) {
		np->estats.tx_deferral += readl(base + NvRegTxDef);
		np->estats.tx_packets += readl(base + NvRegTxFrame);
		np->estats.rx_bytes += readl(base + NvRegRxCnt);
		np->estats.tx_pause += readl(base + NvRegTxPause);
		np->estats.rx_pause += readl(base + NvRegRxPause);
		np->estats.rx_drop_frame += readl(base + NvRegRxDropFrame);
M
Mandeep Baines 已提交
1726
		np->estats.rx_errors_total += np->estats.rx_drop_frame;
A
Ayaz Abdulla 已提交
1727
	}
1728 1729 1730 1731 1732 1733

	if (np->driver_data & DEV_HAS_STATISTICS_V3) {
		np->estats.tx_unicast += readl(base + NvRegTxUnicast);
		np->estats.tx_multicast += readl(base + NvRegTxMulticast);
		np->estats.tx_broadcast += readl(base + NvRegTxBroadcast);
	}
A
Ayaz Abdulla 已提交
1734 1735
}

L
Linus Torvalds 已提交
1736
/*
1737
 * nv_get_stats64: dev->ndo_get_stats64 function
L
Linus Torvalds 已提交
1738 1739 1740 1741
 * Get latest stats value from the nic.
 * Called with read_lock(&dev_base_lock) held for read -
 * only synchronized against unregister_netdevice.
 */
1742
static void
1743 1744 1745
nv_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *storage)
	__acquires(&netdev_priv(dev)->hwstats_lock)
	__releases(&netdev_priv(dev)->hwstats_lock)
L
Linus Torvalds 已提交
1746
{
1747
	struct fe_priv *np = netdev_priv(dev);
1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761
	unsigned int syncp_start;

	/*
	 * Note: because HW stats are not always available and for
	 * consistency reasons, the following ifconfig stats are
	 * managed by software: rx_bytes, tx_bytes, rx_packets and
	 * tx_packets. The related hardware stats reported by ethtool
	 * should be equivalent to these ifconfig stats, with 4
	 * additional bytes per packet (Ethernet FCS CRC), except for
	 * tx_packets when TSO kicks in.
	 */

	/* software stats */
	do {
1762
		syncp_start = u64_stats_fetch_begin_irq(&np->swstats_rx_syncp);
1763 1764
		storage->rx_packets       = np->stat_rx_packets;
		storage->rx_bytes         = np->stat_rx_bytes;
1765
		storage->rx_dropped       = np->stat_rx_dropped;
1766
		storage->rx_missed_errors = np->stat_rx_missed_errors;
1767
	} while (u64_stats_fetch_retry_irq(&np->swstats_rx_syncp, syncp_start));
1768 1769

	do {
1770
		syncp_start = u64_stats_fetch_begin_irq(&np->swstats_tx_syncp);
1771 1772 1773
		storage->tx_packets = np->stat_tx_packets;
		storage->tx_bytes   = np->stat_tx_bytes;
		storage->tx_dropped = np->stat_tx_dropped;
1774
	} while (u64_stats_fetch_retry_irq(&np->swstats_tx_syncp, syncp_start));
L
Linus Torvalds 已提交
1775

1776
	/* If the nic supports hw counters then retrieve latest values */
1777 1778
	if (np->driver_data & DEV_HAS_STATISTICS_V123) {
		spin_lock_bh(&np->hwstats_lock);
1779

1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794
		nv_update_stats(dev);

		/* generic stats */
		storage->rx_errors = np->estats.rx_errors_total;
		storage->tx_errors = np->estats.tx_errors_total;

		/* meaningful only when NIC supports stats v3 */
		storage->multicast = np->estats.rx_multicast;

		/* detailed rx_errors */
		storage->rx_length_errors = np->estats.rx_length_error;
		storage->rx_over_errors   = np->estats.rx_over_errors;
		storage->rx_crc_errors    = np->estats.rx_crc_errors;
		storage->rx_frame_errors  = np->estats.rx_frame_align_error;
		storage->rx_fifo_errors   = np->estats.rx_drop_frame;
1795

1796 1797 1798 1799 1800
		/* detailed tx_errors */
		storage->tx_carrier_errors = np->estats.tx_carrier_errors;
		storage->tx_fifo_errors    = np->estats.tx_fifo_errors;

		spin_unlock_bh(&np->hwstats_lock);
1801
	}
L
Linus Torvalds 已提交
1802 1803 1804 1805 1806 1807 1808 1809 1810
}

/*
 * nv_alloc_rx: fill rx ring entries.
 * Return 1 if the allocations for the skbs failed and the
 * rx engine is without Available descriptors
 */
static int nv_alloc_rx(struct net_device *dev)
{
1811
	struct fe_priv *np = netdev_priv(dev);
1812
	struct ring_desc *less_rx;
L
Linus Torvalds 已提交
1813

A
Ayaz Abdulla 已提交
1814 1815 1816
	less_rx = np->get_rx.orig;
	if (less_rx-- == np->first_rx.orig)
		less_rx = np->last_rx.orig;
A
Ayaz Abdulla 已提交
1817

A
Ayaz Abdulla 已提交
1818
	while (np->put_rx.orig != less_rx) {
1819
		struct sk_buff *skb = netdev_alloc_skb(dev, np->rx_buf_sz + NV_RX_ALLOC_PAD);
A
Ayaz Abdulla 已提交
1820 1821
		if (skb) {
			np->put_rx_ctx->skb = skb;
1822
			np->put_rx_ctx->dma = dma_map_single(&np->pci_dev->dev,
1823
							     skb->data,
1824
							     skb_tailroom(skb),
1825
							     DMA_FROM_DEVICE);
1826 1827
			if (unlikely(dma_mapping_error(&np->pci_dev->dev,
						       np->put_rx_ctx->dma))) {
1828 1829 1830
				kfree_skb(skb);
				goto packet_dropped;
			}
1831
			np->put_rx_ctx->dma_len = skb_tailroom(skb);
A
Ayaz Abdulla 已提交
1832 1833 1834
			np->put_rx.orig->buf = cpu_to_le32(np->put_rx_ctx->dma);
			wmb();
			np->put_rx.orig->flaglen = cpu_to_le32(np->rx_buf_sz | NV_RX_AVAIL);
1835
			if (unlikely(np->put_rx.orig++ == np->last_rx.orig))
A
Ayaz Abdulla 已提交
1836
				np->put_rx.orig = np->first_rx.orig;
1837
			if (unlikely(np->put_rx_ctx++ == np->last_rx_ctx))
A
Ayaz Abdulla 已提交
1838
				np->put_rx_ctx = np->first_rx_ctx;
1839
		} else {
1840
packet_dropped:
1841 1842 1843
			u64_stats_update_begin(&np->swstats_rx_syncp);
			np->stat_rx_dropped++;
			u64_stats_update_end(&np->swstats_rx_syncp);
A
Ayaz Abdulla 已提交
1844
			return 1;
1845
		}
A
Ayaz Abdulla 已提交
1846 1847 1848 1849 1850 1851 1852
	}
	return 0;
}

static int nv_alloc_rx_optimized(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);
1853
	struct ring_desc_ex *less_rx;
A
Ayaz Abdulla 已提交
1854 1855 1856 1857

	less_rx = np->get_rx.ex;
	if (less_rx-- == np->first_rx.ex)
		less_rx = np->last_rx.ex;
A
Ayaz Abdulla 已提交
1858

A
Ayaz Abdulla 已提交
1859
	while (np->put_rx.ex != less_rx) {
1860
		struct sk_buff *skb = netdev_alloc_skb(dev, np->rx_buf_sz + NV_RX_ALLOC_PAD);
A
Ayaz Abdulla 已提交
1861
		if (skb) {
A
Ayaz Abdulla 已提交
1862
			np->put_rx_ctx->skb = skb;
1863
			np->put_rx_ctx->dma = dma_map_single(&np->pci_dev->dev,
1864
							     skb->data,
1865
							     skb_tailroom(skb),
1866
							     DMA_FROM_DEVICE);
1867 1868
			if (unlikely(dma_mapping_error(&np->pci_dev->dev,
						       np->put_rx_ctx->dma))) {
1869 1870 1871
				kfree_skb(skb);
				goto packet_dropped;
			}
1872
			np->put_rx_ctx->dma_len = skb_tailroom(skb);
A
Al Viro 已提交
1873 1874
			np->put_rx.ex->bufhigh = cpu_to_le32(dma_high(np->put_rx_ctx->dma));
			np->put_rx.ex->buflow = cpu_to_le32(dma_low(np->put_rx_ctx->dma));
A
Ayaz Abdulla 已提交
1875 1876
			wmb();
			np->put_rx.ex->flaglen = cpu_to_le32(np->rx_buf_sz | NV_RX2_AVAIL);
1877
			if (unlikely(np->put_rx.ex++ == np->last_rx.ex))
A
Ayaz Abdulla 已提交
1878
				np->put_rx.ex = np->first_rx.ex;
1879
			if (unlikely(np->put_rx_ctx++ == np->last_rx_ctx))
A
Ayaz Abdulla 已提交
1880
				np->put_rx_ctx = np->first_rx_ctx;
1881
		} else {
1882
packet_dropped:
1883 1884 1885
			u64_stats_update_begin(&np->swstats_rx_syncp);
			np->stat_rx_dropped++;
			u64_stats_update_end(&np->swstats_rx_syncp);
A
Ayaz Abdulla 已提交
1886
			return 1;
1887
		}
L
Linus Torvalds 已提交
1888 1889 1890 1891
	}
	return 0;
}

1892
/* If rx bufs are exhausted called after 50ms to attempt to refresh */
1893
static void nv_do_rx_refill(struct timer_list *t)
1894
{
1895
	struct fe_priv *np = from_timer(np, t, oom_kick);
1896 1897

	/* Just reschedule NAPI rx processing */
1898
	napi_schedule(&np->napi);
1899
}
L
Linus Torvalds 已提交
1900

1901
static void nv_init_rx(struct net_device *dev)
L
Linus Torvalds 已提交
1902
{
1903
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
1904
	int i;
1905

A
Ayaz Abdulla 已提交
1906
	np->get_rx = np->put_rx = np->first_rx = np->rx_ring;
1907 1908

	if (!nv_optimized(np))
A
Ayaz Abdulla 已提交
1909 1910 1911 1912 1913
		np->last_rx.orig = &np->rx_ring.orig[np->rx_ring_size-1];
	else
		np->last_rx.ex = &np->rx_ring.ex[np->rx_ring_size-1];
	np->get_rx_ctx = np->put_rx_ctx = np->first_rx_ctx = np->rx_skb;
	np->last_rx_ctx = &np->rx_skb[np->rx_ring_size-1];
L
Linus Torvalds 已提交
1914

A
Ayaz Abdulla 已提交
1915
	for (i = 0; i < np->rx_ring_size; i++) {
1916
		if (!nv_optimized(np)) {
1917
			np->rx_ring.orig[i].flaglen = 0;
A
Ayaz Abdulla 已提交
1918 1919
			np->rx_ring.orig[i].buf = 0;
		} else {
1920
			np->rx_ring.ex[i].flaglen = 0;
A
Ayaz Abdulla 已提交
1921 1922 1923 1924 1925 1926 1927
			np->rx_ring.ex[i].txvlan = 0;
			np->rx_ring.ex[i].bufhigh = 0;
			np->rx_ring.ex[i].buflow = 0;
		}
		np->rx_skb[i].skb = NULL;
		np->rx_skb[i].dma = 0;
	}
1928 1929 1930 1931
}

static void nv_init_tx(struct net_device *dev)
{
1932
	struct fe_priv *np = netdev_priv(dev);
1933
	int i;
1934

A
Ayaz Abdulla 已提交
1935
	np->get_tx = np->put_tx = np->first_tx = np->tx_ring;
1936 1937

	if (!nv_optimized(np))
A
Ayaz Abdulla 已提交
1938 1939 1940 1941 1942
		np->last_tx.orig = &np->tx_ring.orig[np->tx_ring_size-1];
	else
		np->last_tx.ex = &np->tx_ring.ex[np->tx_ring_size-1];
	np->get_tx_ctx = np->put_tx_ctx = np->first_tx_ctx = np->tx_skb;
	np->last_tx_ctx = &np->tx_skb[np->tx_ring_size-1];
1943
	netdev_reset_queue(np->dev);
A
Ayaz Abdulla 已提交
1944 1945 1946
	np->tx_pkts_in_progress = 0;
	np->tx_change_owner = NULL;
	np->tx_end_flip = NULL;
A
Ayaz Abdulla 已提交
1947
	np->tx_stop = 0;
1948

1949
	for (i = 0; i < np->tx_ring_size; i++) {
1950
		if (!nv_optimized(np)) {
1951
			np->tx_ring.orig[i].flaglen = 0;
A
Ayaz Abdulla 已提交
1952 1953
			np->tx_ring.orig[i].buf = 0;
		} else {
1954
			np->tx_ring.ex[i].flaglen = 0;
A
Ayaz Abdulla 已提交
1955 1956 1957 1958 1959 1960
			np->tx_ring.ex[i].txvlan = 0;
			np->tx_ring.ex[i].bufhigh = 0;
			np->tx_ring.ex[i].buflow = 0;
		}
		np->tx_skb[i].skb = NULL;
		np->tx_skb[i].dma = 0;
A
Ayaz Abdulla 已提交
1961
		np->tx_skb[i].dma_len = 0;
E
Eric Dumazet 已提交
1962
		np->tx_skb[i].dma_single = 0;
A
Ayaz Abdulla 已提交
1963 1964
		np->tx_skb[i].first_tx_desc = NULL;
		np->tx_skb[i].next_tx_ctx = NULL;
1965
	}
1966 1967 1968 1969
}

static int nv_init_ring(struct net_device *dev)
{
A
Ayaz Abdulla 已提交
1970 1971
	struct fe_priv *np = netdev_priv(dev);

1972 1973
	nv_init_tx(dev);
	nv_init_rx(dev);
1974 1975

	if (!nv_optimized(np))
A
Ayaz Abdulla 已提交
1976 1977 1978
		return nv_alloc_rx(dev);
	else
		return nv_alloc_rx_optimized(dev);
L
Linus Torvalds 已提交
1979 1980
}

E
Eric Dumazet 已提交
1981
static void nv_unmap_txskb(struct fe_priv *np, struct nv_skb_map *tx_skb)
1982
{
A
Ayaz Abdulla 已提交
1983
	if (tx_skb->dma) {
E
Eric Dumazet 已提交
1984
		if (tx_skb->dma_single)
1985
			dma_unmap_single(&np->pci_dev->dev, tx_skb->dma,
E
Eric Dumazet 已提交
1986
					 tx_skb->dma_len,
1987
					 DMA_TO_DEVICE);
E
Eric Dumazet 已提交
1988 1989 1990 1991
		else
			pci_unmap_page(np->pci_dev, tx_skb->dma,
				       tx_skb->dma_len,
				       PCI_DMA_TODEVICE);
A
Ayaz Abdulla 已提交
1992
		tx_skb->dma = 0;
1993
	}
E
Eric Dumazet 已提交
1994 1995 1996 1997 1998
}

static int nv_release_txskb(struct fe_priv *np, struct nv_skb_map *tx_skb)
{
	nv_unmap_txskb(np, tx_skb);
A
Ayaz Abdulla 已提交
1999 2000 2001
	if (tx_skb->skb) {
		dev_kfree_skb_any(tx_skb->skb);
		tx_skb->skb = NULL;
2002
		return 1;
2003
	}
E
Eric Dumazet 已提交
2004
	return 0;
2005 2006
}

L
Linus Torvalds 已提交
2007 2008
static void nv_drain_tx(struct net_device *dev)
{
2009 2010
	struct fe_priv *np = netdev_priv(dev);
	unsigned int i;
2011

2012
	for (i = 0; i < np->tx_ring_size; i++) {
2013
		if (!nv_optimized(np)) {
2014
			np->tx_ring.orig[i].flaglen = 0;
A
Ayaz Abdulla 已提交
2015 2016
			np->tx_ring.orig[i].buf = 0;
		} else {
2017
			np->tx_ring.ex[i].flaglen = 0;
A
Ayaz Abdulla 已提交
2018 2019 2020 2021
			np->tx_ring.ex[i].txvlan = 0;
			np->tx_ring.ex[i].bufhigh = 0;
			np->tx_ring.ex[i].buflow = 0;
		}
2022 2023 2024 2025 2026
		if (nv_release_txskb(np, &np->tx_skb[i])) {
			u64_stats_update_begin(&np->swstats_tx_syncp);
			np->stat_tx_dropped++;
			u64_stats_update_end(&np->swstats_tx_syncp);
		}
A
Ayaz Abdulla 已提交
2027 2028
		np->tx_skb[i].dma = 0;
		np->tx_skb[i].dma_len = 0;
E
Eric Dumazet 已提交
2029
		np->tx_skb[i].dma_single = 0;
A
Ayaz Abdulla 已提交
2030 2031
		np->tx_skb[i].first_tx_desc = NULL;
		np->tx_skb[i].next_tx_ctx = NULL;
L
Linus Torvalds 已提交
2032
	}
A
Ayaz Abdulla 已提交
2033 2034 2035
	np->tx_pkts_in_progress = 0;
	np->tx_change_owner = NULL;
	np->tx_end_flip = NULL;
L
Linus Torvalds 已提交
2036 2037 2038 2039
}

static void nv_drain_rx(struct net_device *dev)
{
2040
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
2041
	int i;
A
Ayaz Abdulla 已提交
2042

2043
	for (i = 0; i < np->rx_ring_size; i++) {
2044
		if (!nv_optimized(np)) {
2045
			np->rx_ring.orig[i].flaglen = 0;
A
Ayaz Abdulla 已提交
2046 2047
			np->rx_ring.orig[i].buf = 0;
		} else {
2048
			np->rx_ring.ex[i].flaglen = 0;
A
Ayaz Abdulla 已提交
2049 2050 2051 2052
			np->rx_ring.ex[i].txvlan = 0;
			np->rx_ring.ex[i].bufhigh = 0;
			np->rx_ring.ex[i].buflow = 0;
		}
L
Linus Torvalds 已提交
2053
		wmb();
A
Ayaz Abdulla 已提交
2054
		if (np->rx_skb[i].skb) {
2055
			dma_unmap_single(&np->pci_dev->dev, np->rx_skb[i].dma,
2056
					 (skb_end_pointer(np->rx_skb[i].skb) -
2057 2058
					 np->rx_skb[i].skb->data),
					 DMA_FROM_DEVICE);
A
Ayaz Abdulla 已提交
2059 2060
			dev_kfree_skb(np->rx_skb[i].skb);
			np->rx_skb[i].skb = NULL;
L
Linus Torvalds 已提交
2061 2062 2063 2064
		}
	}
}

2065
static void nv_drain_rxtx(struct net_device *dev)
L
Linus Torvalds 已提交
2066 2067 2068 2069 2070
{
	nv_drain_tx(dev);
	nv_drain_rx(dev);
}

A
Ayaz Abdulla 已提交
2071 2072 2073 2074 2075
static inline u32 nv_get_empty_tx_slots(struct fe_priv *np)
{
	return (u32)(np->tx_ring_size - ((np->tx_ring_size + (np->put_tx_ctx - np->get_tx_ctx)) % np->tx_ring_size));
}

2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105
static void nv_legacybackoff_reseed(struct net_device *dev)
{
	u8 __iomem *base = get_hwbase(dev);
	u32 reg;
	u32 low;
	int tx_status = 0;

	reg = readl(base + NvRegSlotTime) & ~NVREG_SLOTTIME_MASK;
	get_random_bytes(&low, sizeof(low));
	reg |= low & NVREG_SLOTTIME_MASK;

	/* Need to stop tx before change takes effect.
	 * Caller has already gained np->lock.
	 */
	tx_status = readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_START;
	if (tx_status)
		nv_stop_tx(dev);
	nv_stop_rx(dev);
	writel(reg, base + NvRegSlotTime);
	if (tx_status)
		nv_start_tx(dev);
	nv_start_rx(dev);
}

/* Gear Backoff Seeds */
#define BACKOFF_SEEDSET_ROWS	8
#define BACKOFF_SEEDSET_LFSRS	15

/* Known Good seed sets */
static const u32 main_seedset[BACKOFF_SEEDSET_ROWS][BACKOFF_SEEDSET_LFSRS] = {
2106 2107 2108 2109 2110 2111 2112 2113
	{145, 155, 165, 175, 185, 196, 235, 245, 255, 265, 275, 285, 660, 690, 874},
	{245, 255, 265, 575, 385, 298, 335, 345, 355, 366, 375, 385, 761, 790, 974},
	{145, 155, 165, 175, 185, 196, 235, 245, 255, 265, 275, 285, 660, 690, 874},
	{245, 255, 265, 575, 385, 298, 335, 345, 355, 366, 375, 386, 761, 790, 974},
	{266, 265, 276, 585, 397, 208, 345, 355, 365, 376, 385, 396, 771, 700, 984},
	{266, 265, 276, 586, 397, 208, 346, 355, 365, 376, 285, 396, 771, 700, 984},
	{366, 365, 376, 686, 497, 308, 447, 455, 466, 476, 485, 496, 871, 800,  84},
	{466, 465, 476, 786, 597, 408, 547, 555, 566, 576, 585, 597, 971, 900, 184} };
2114 2115

static const u32 gear_seedset[BACKOFF_SEEDSET_ROWS][BACKOFF_SEEDSET_LFSRS] = {
2116 2117 2118 2119 2120 2121 2122 2123
	{251, 262, 273, 324, 319, 508, 375, 364, 341, 371, 398, 193, 375,  30, 295},
	{351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395},
	{351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 397},
	{251, 262, 273, 324, 319, 508, 375, 364, 341, 371, 398, 193, 375,  30, 295},
	{251, 262, 273, 324, 319, 508, 375, 364, 341, 371, 398, 193, 375,  30, 295},
	{351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395},
	{351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395},
	{351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395} };
2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170

static void nv_gear_backoff_reseed(struct net_device *dev)
{
	u8 __iomem *base = get_hwbase(dev);
	u32 miniseed1, miniseed2, miniseed2_reversed, miniseed3, miniseed3_reversed;
	u32 temp, seedset, combinedSeed;
	int i;

	/* Setup seed for free running LFSR */
	/* We are going to read the time stamp counter 3 times
	   and swizzle bits around to increase randomness */
	get_random_bytes(&miniseed1, sizeof(miniseed1));
	miniseed1 &= 0x0fff;
	if (miniseed1 == 0)
		miniseed1 = 0xabc;

	get_random_bytes(&miniseed2, sizeof(miniseed2));
	miniseed2 &= 0x0fff;
	if (miniseed2 == 0)
		miniseed2 = 0xabc;
	miniseed2_reversed =
		((miniseed2 & 0xF00) >> 8) |
		 (miniseed2 & 0x0F0) |
		 ((miniseed2 & 0x00F) << 8);

	get_random_bytes(&miniseed3, sizeof(miniseed3));
	miniseed3 &= 0x0fff;
	if (miniseed3 == 0)
		miniseed3 = 0xabc;
	miniseed3_reversed =
		((miniseed3 & 0xF00) >> 8) |
		 (miniseed3 & 0x0F0) |
		 ((miniseed3 & 0x00F) << 8);

	combinedSeed = ((miniseed1 ^ miniseed2_reversed) << 12) |
		       (miniseed2 ^ miniseed3_reversed);

	/* Seeds can not be zero */
	if ((combinedSeed & NVREG_BKOFFCTRL_SEED_MASK) == 0)
		combinedSeed |= 0x08;
	if ((combinedSeed & (NVREG_BKOFFCTRL_SEED_MASK << NVREG_BKOFFCTRL_GEAR)) == 0)
		combinedSeed |= 0x8000;

	/* No need to disable tx here */
	temp = NVREG_BKOFFCTRL_DEFAULT | (0 << NVREG_BKOFFCTRL_SELECT);
	temp |= combinedSeed & NVREG_BKOFFCTRL_SEED_MASK;
	temp |= combinedSeed >> NVREG_BKOFFCTRL_GEAR;
2171
	writel(temp, base + NvRegBackOffControl);
2172

2173
	/* Setup seeds for all gear LFSRs. */
2174 2175
	get_random_bytes(&seedset, sizeof(seedset));
	seedset = seedset % BACKOFF_SEEDSET_ROWS;
2176
	for (i = 1; i <= BACKOFF_SEEDSET_LFSRS; i++) {
2177 2178 2179 2180 2181 2182 2183
		temp = NVREG_BKOFFCTRL_DEFAULT | (i << NVREG_BKOFFCTRL_SELECT);
		temp |= main_seedset[seedset][i-1] & 0x3ff;
		temp |= ((gear_seedset[seedset][i-1] & 0x3ff) << NVREG_BKOFFCTRL_GEAR);
		writel(temp, base + NvRegBackOffControl);
	}
}

L
Linus Torvalds 已提交
2184 2185
/*
 * nv_start_xmit: dev->hard_start_xmit function
H
Herbert Xu 已提交
2186
 * Called with netif_tx_lock held.
L
Linus Torvalds 已提交
2187
 */
2188
static netdev_tx_t nv_start_xmit(struct sk_buff *skb, struct net_device *dev)
L
Linus Torvalds 已提交
2189
{
2190
	struct fe_priv *np = netdev_priv(dev);
2191
	u32 tx_flags = 0;
2192 2193 2194
	u32 tx_flags_extra = (np->desc_ver == DESC_VER_1 ? NV_TX_LASTPACKET : NV_TX2_LASTPACKET);
	unsigned int fragments = skb_shinfo(skb)->nr_frags;
	unsigned int i;
2195 2196
	u32 offset = 0;
	u32 bcnt;
E
Eric Dumazet 已提交
2197
	u32 size = skb_headlen(skb);
2198
	u32 entries = (size >> NV_TX2_TSO_MAX_SHIFT) + ((size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0);
A
Ayaz Abdulla 已提交
2199
	u32 empty_slots;
2200 2201 2202 2203
	struct ring_desc *put_tx;
	struct ring_desc *start_tx;
	struct ring_desc *prev_tx;
	struct nv_skb_map *prev_tx_ctx;
2204
	struct nv_skb_map *tmp_tx_ctx = NULL, *start_tx_ctx = NULL;
2205
	unsigned long flags;
2206 2207 2208

	/* add fragments to entries count */
	for (i = 0; i < fragments; i++) {
2209
		u32 frag_size = skb_frag_size(&skb_shinfo(skb)->frags[i]);
E
Eric Dumazet 已提交
2210

2211 2212
		entries += (frag_size >> NV_TX2_TSO_MAX_SHIFT) +
			   ((frag_size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0);
2213
	}
2214

A
Ayaz Abdulla 已提交
2215
	spin_lock_irqsave(&np->lock, flags);
A
Ayaz Abdulla 已提交
2216
	empty_slots = nv_get_empty_tx_slots(np);
2217
	if (unlikely(empty_slots <= entries)) {
2218
		netif_stop_queue(dev);
A
Ayaz Abdulla 已提交
2219
		np->tx_stop = 1;
2220
		spin_unlock_irqrestore(&np->lock, flags);
2221 2222
		return NETDEV_TX_BUSY;
	}
A
Ayaz Abdulla 已提交
2223
	spin_unlock_irqrestore(&np->lock, flags);
L
Linus Torvalds 已提交
2224

A
Ayaz Abdulla 已提交
2225
	start_tx = put_tx = np->put_tx.orig;
A
Ayaz Abdulla 已提交
2226

2227 2228 2229
	/* setup the header buffer */
	do {
		bcnt = (size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : size;
2230 2231 2232
		np->put_tx_ctx->dma = dma_map_single(&np->pci_dev->dev,
						     skb->data + offset, bcnt,
						     DMA_TO_DEVICE);
2233 2234
		if (unlikely(dma_mapping_error(&np->pci_dev->dev,
					       np->put_tx_ctx->dma))) {
2235
			/* on DMA mapping error - drop the packet */
2236
			dev_kfree_skb_any(skb);
2237 2238 2239 2240 2241
			u64_stats_update_begin(&np->swstats_tx_syncp);
			np->stat_tx_dropped++;
			u64_stats_update_end(&np->swstats_tx_syncp);
			return NETDEV_TX_OK;
		}
A
Ayaz Abdulla 已提交
2242
		np->put_tx_ctx->dma_len = bcnt;
E
Eric Dumazet 已提交
2243
		np->put_tx_ctx->dma_single = 1;
A
Ayaz Abdulla 已提交
2244 2245
		put_tx->buf = cpu_to_le32(np->put_tx_ctx->dma);
		put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags);
2246

2247 2248 2249
		tx_flags = np->tx_flags;
		offset += bcnt;
		size -= bcnt;
2250
		if (unlikely(put_tx++ == np->last_tx.orig))
A
Ayaz Abdulla 已提交
2251
			put_tx = np->first_tx.orig;
2252
		if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx))
A
Ayaz Abdulla 已提交
2253
			np->put_tx_ctx = np->first_tx_ctx;
2254
	} while (size);
2255 2256 2257

	/* setup the fragments */
	for (i = 0; i < fragments; i++) {
E
Eric Dumazet 已提交
2258
		const skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
2259
		u32 frag_size = skb_frag_size(frag);
2260 2261 2262
		offset = 0;

		do {
2263 2264 2265
			if (!start_tx_ctx)
				start_tx_ctx = tmp_tx_ctx = np->put_tx_ctx;

2266
			bcnt = (frag_size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : frag_size;
2267 2268 2269 2270
			np->put_tx_ctx->dma = skb_frag_dma_map(
							&np->pci_dev->dev,
							frag, offset,
							bcnt,
2271
							DMA_TO_DEVICE);
2272 2273
			if (unlikely(dma_mapping_error(&np->pci_dev->dev,
						       np->put_tx_ctx->dma))) {
2274 2275 2276 2277 2278 2279 2280

				/* Unwind the mapped fragments */
				do {
					nv_unmap_txskb(np, start_tx_ctx);
					if (unlikely(tmp_tx_ctx++ == np->last_tx_ctx))
						tmp_tx_ctx = np->first_tx_ctx;
				} while (tmp_tx_ctx != np->put_tx_ctx);
2281
				dev_kfree_skb_any(skb);
2282 2283 2284 2285 2286 2287 2288
				np->put_tx_ctx = start_tx_ctx;
				u64_stats_update_begin(&np->swstats_tx_syncp);
				np->stat_tx_dropped++;
				u64_stats_update_end(&np->swstats_tx_syncp);
				return NETDEV_TX_OK;
			}

A
Ayaz Abdulla 已提交
2289
			np->put_tx_ctx->dma_len = bcnt;
E
Eric Dumazet 已提交
2290
			np->put_tx_ctx->dma_single = 0;
A
Ayaz Abdulla 已提交
2291 2292
			put_tx->buf = cpu_to_le32(np->put_tx_ctx->dma);
			put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags);
2293

2294
			offset += bcnt;
2295
			frag_size -= bcnt;
2296
			if (unlikely(put_tx++ == np->last_tx.orig))
A
Ayaz Abdulla 已提交
2297
				put_tx = np->first_tx.orig;
2298
			if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx))
A
Ayaz Abdulla 已提交
2299
				np->put_tx_ctx = np->first_tx_ctx;
2300
		} while (frag_size);
2301
	}
2302

2303 2304 2305 2306 2307 2308 2309 2310 2311 2312
	if (unlikely(put_tx == np->first_tx.orig))
		prev_tx = np->last_tx.orig;
	else
		prev_tx = put_tx - 1;

	if (unlikely(np->put_tx_ctx == np->first_tx_ctx))
		prev_tx_ctx = np->last_tx_ctx;
	else
		prev_tx_ctx = np->put_tx_ctx - 1;

2313
	/* set last fragment flag  */
A
Ayaz Abdulla 已提交
2314
	prev_tx->flaglen |= cpu_to_le32(tx_flags_extra);
2315

A
Ayaz Abdulla 已提交
2316 2317
	/* save skb in this slot's context area */
	prev_tx_ctx->skb = skb;
2318

H
Herbert Xu 已提交
2319
	if (skb_is_gso(skb))
2320
		tx_flags_extra = NV_TX2_TSO | (skb_shinfo(skb)->gso_size << NV_TX2_TSO_SHIFT);
2321
	else
A
Arjan van de Ven 已提交
2322
		tx_flags_extra = skb->ip_summed == CHECKSUM_PARTIAL ?
2323
			 NV_TX2_CHECKSUM_L3 | NV_TX2_CHECKSUM_L4 : 0;
2324

2325
	spin_lock_irqsave(&np->lock, flags);
A
Ayaz Abdulla 已提交
2326

2327
	/* set tx flags */
A
Ayaz Abdulla 已提交
2328
	start_tx->flaglen |= cpu_to_le32(tx_flags | tx_flags_extra);
2329 2330 2331

	netdev_sent_queue(np->dev, skb->len);

2332 2333
	skb_tx_timestamp(skb);

A
Ayaz Abdulla 已提交
2334
	np->put_tx.orig = put_tx;
L
Linus Torvalds 已提交
2335

2336
	spin_unlock_irqrestore(&np->lock, flags);
A
Ayaz Abdulla 已提交
2337

2338
	writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
2339
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
2340 2341
}

2342 2343
static netdev_tx_t nv_start_xmit_optimized(struct sk_buff *skb,
					   struct net_device *dev)
A
Ayaz Abdulla 已提交
2344 2345 2346
{
	struct fe_priv *np = netdev_priv(dev);
	u32 tx_flags = 0;
2347
	u32 tx_flags_extra;
A
Ayaz Abdulla 已提交
2348 2349 2350 2351
	unsigned int fragments = skb_shinfo(skb)->nr_frags;
	unsigned int i;
	u32 offset = 0;
	u32 bcnt;
E
Eric Dumazet 已提交
2352
	u32 size = skb_headlen(skb);
A
Ayaz Abdulla 已提交
2353 2354
	u32 entries = (size >> NV_TX2_TSO_MAX_SHIFT) + ((size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0);
	u32 empty_slots;
2355 2356 2357 2358
	struct ring_desc_ex *put_tx;
	struct ring_desc_ex *start_tx;
	struct ring_desc_ex *prev_tx;
	struct nv_skb_map *prev_tx_ctx;
2359 2360
	struct nv_skb_map *start_tx_ctx = NULL;
	struct nv_skb_map *tmp_tx_ctx = NULL;
2361
	unsigned long flags;
A
Ayaz Abdulla 已提交
2362 2363 2364

	/* add fragments to entries count */
	for (i = 0; i < fragments; i++) {
2365
		u32 frag_size = skb_frag_size(&skb_shinfo(skb)->frags[i]);
E
Eric Dumazet 已提交
2366

2367 2368
		entries += (frag_size >> NV_TX2_TSO_MAX_SHIFT) +
			   ((frag_size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0);
A
Ayaz Abdulla 已提交
2369 2370
	}

A
Ayaz Abdulla 已提交
2371
	spin_lock_irqsave(&np->lock, flags);
A
Ayaz Abdulla 已提交
2372
	empty_slots = nv_get_empty_tx_slots(np);
2373
	if (unlikely(empty_slots <= entries)) {
A
Ayaz Abdulla 已提交
2374
		netif_stop_queue(dev);
A
Ayaz Abdulla 已提交
2375
		np->tx_stop = 1;
2376
		spin_unlock_irqrestore(&np->lock, flags);
A
Ayaz Abdulla 已提交
2377 2378
		return NETDEV_TX_BUSY;
	}
A
Ayaz Abdulla 已提交
2379
	spin_unlock_irqrestore(&np->lock, flags);
A
Ayaz Abdulla 已提交
2380 2381

	start_tx = put_tx = np->put_tx.ex;
A
Ayaz Abdulla 已提交
2382
	start_tx_ctx = np->put_tx_ctx;
A
Ayaz Abdulla 已提交
2383 2384 2385 2386

	/* setup the header buffer */
	do {
		bcnt = (size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : size;
2387 2388 2389
		np->put_tx_ctx->dma = dma_map_single(&np->pci_dev->dev,
						     skb->data + offset, bcnt,
						     DMA_TO_DEVICE);
2390 2391
		if (unlikely(dma_mapping_error(&np->pci_dev->dev,
					       np->put_tx_ctx->dma))) {
2392
			/* on DMA mapping error - drop the packet */
2393
			dev_kfree_skb_any(skb);
2394 2395 2396 2397 2398
			u64_stats_update_begin(&np->swstats_tx_syncp);
			np->stat_tx_dropped++;
			u64_stats_update_end(&np->swstats_tx_syncp);
			return NETDEV_TX_OK;
		}
A
Ayaz Abdulla 已提交
2399
		np->put_tx_ctx->dma_len = bcnt;
E
Eric Dumazet 已提交
2400
		np->put_tx_ctx->dma_single = 1;
A
Al Viro 已提交
2401 2402
		put_tx->bufhigh = cpu_to_le32(dma_high(np->put_tx_ctx->dma));
		put_tx->buflow = cpu_to_le32(dma_low(np->put_tx_ctx->dma));
A
Ayaz Abdulla 已提交
2403
		put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags);
2404 2405

		tx_flags = NV_TX2_VALID;
A
Ayaz Abdulla 已提交
2406 2407
		offset += bcnt;
		size -= bcnt;
2408
		if (unlikely(put_tx++ == np->last_tx.ex))
A
Ayaz Abdulla 已提交
2409
			put_tx = np->first_tx.ex;
2410
		if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx))
A
Ayaz Abdulla 已提交
2411 2412 2413 2414 2415 2416
			np->put_tx_ctx = np->first_tx_ctx;
	} while (size);

	/* setup the fragments */
	for (i = 0; i < fragments; i++) {
		skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
2417
		u32 frag_size = skb_frag_size(frag);
A
Ayaz Abdulla 已提交
2418 2419 2420
		offset = 0;

		do {
2421
			bcnt = (frag_size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : frag_size;
2422 2423
			if (!start_tx_ctx)
				start_tx_ctx = tmp_tx_ctx = np->put_tx_ctx;
2424 2425 2426 2427
			np->put_tx_ctx->dma = skb_frag_dma_map(
							&np->pci_dev->dev,
							frag, offset,
							bcnt,
2428
							DMA_TO_DEVICE);
2429

2430 2431
			if (unlikely(dma_mapping_error(&np->pci_dev->dev,
						       np->put_tx_ctx->dma))) {
2432 2433 2434 2435 2436 2437 2438

				/* Unwind the mapped fragments */
				do {
					nv_unmap_txskb(np, start_tx_ctx);
					if (unlikely(tmp_tx_ctx++ == np->last_tx_ctx))
						tmp_tx_ctx = np->first_tx_ctx;
				} while (tmp_tx_ctx != np->put_tx_ctx);
2439
				dev_kfree_skb_any(skb);
2440 2441 2442 2443 2444 2445
				np->put_tx_ctx = start_tx_ctx;
				u64_stats_update_begin(&np->swstats_tx_syncp);
				np->stat_tx_dropped++;
				u64_stats_update_end(&np->swstats_tx_syncp);
				return NETDEV_TX_OK;
			}
A
Ayaz Abdulla 已提交
2446
			np->put_tx_ctx->dma_len = bcnt;
E
Eric Dumazet 已提交
2447
			np->put_tx_ctx->dma_single = 0;
A
Al Viro 已提交
2448 2449
			put_tx->bufhigh = cpu_to_le32(dma_high(np->put_tx_ctx->dma));
			put_tx->buflow = cpu_to_le32(dma_low(np->put_tx_ctx->dma));
A
Ayaz Abdulla 已提交
2450
			put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags);
2451

A
Ayaz Abdulla 已提交
2452
			offset += bcnt;
2453
			frag_size -= bcnt;
2454
			if (unlikely(put_tx++ == np->last_tx.ex))
A
Ayaz Abdulla 已提交
2455
				put_tx = np->first_tx.ex;
2456
			if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx))
A
Ayaz Abdulla 已提交
2457
				np->put_tx_ctx = np->first_tx_ctx;
2458
		} while (frag_size);
A
Ayaz Abdulla 已提交
2459 2460
	}

2461 2462 2463 2464 2465 2466 2467 2468 2469 2470
	if (unlikely(put_tx == np->first_tx.ex))
		prev_tx = np->last_tx.ex;
	else
		prev_tx = put_tx - 1;

	if (unlikely(np->put_tx_ctx == np->first_tx_ctx))
		prev_tx_ctx = np->last_tx_ctx;
	else
		prev_tx_ctx = np->put_tx_ctx - 1;

A
Ayaz Abdulla 已提交
2471
	/* set last fragment flag  */
2472
	prev_tx->flaglen |= cpu_to_le32(NV_TX2_LASTPACKET);
A
Ayaz Abdulla 已提交
2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483

	/* save skb in this slot's context area */
	prev_tx_ctx->skb = skb;

	if (skb_is_gso(skb))
		tx_flags_extra = NV_TX2_TSO | (skb_shinfo(skb)->gso_size << NV_TX2_TSO_SHIFT);
	else
		tx_flags_extra = skb->ip_summed == CHECKSUM_PARTIAL ?
			 NV_TX2_CHECKSUM_L3 | NV_TX2_CHECKSUM_L4 : 0;

	/* vlan tag */
2484
	if (skb_vlan_tag_present(skb))
2485
		start_tx->txvlan = cpu_to_le32(NV_TX3_VLAN_TAG_PRESENT |
2486
					skb_vlan_tag_get(skb));
2487
	else
2488
		start_tx->txvlan = 0;
A
Ayaz Abdulla 已提交
2489

2490
	spin_lock_irqsave(&np->lock, flags);
A
Ayaz Abdulla 已提交
2491

A
Ayaz Abdulla 已提交
2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511
	if (np->tx_limit) {
		/* Limit the number of outstanding tx. Setup all fragments, but
		 * do not set the VALID bit on the first descriptor. Save a pointer
		 * to that descriptor and also for next skb_map element.
		 */

		if (np->tx_pkts_in_progress == NV_TX_LIMIT_COUNT) {
			if (!np->tx_change_owner)
				np->tx_change_owner = start_tx_ctx;

			/* remove VALID bit */
			tx_flags &= ~NV_TX2_VALID;
			start_tx_ctx->first_tx_desc = start_tx;
			start_tx_ctx->next_tx_ctx = np->put_tx_ctx;
			np->tx_end_flip = np->put_tx_ctx;
		} else {
			np->tx_pkts_in_progress++;
		}
	}

A
Ayaz Abdulla 已提交
2512 2513
	/* set tx flags */
	start_tx->flaglen |= cpu_to_le32(tx_flags | tx_flags_extra);
2514 2515 2516

	netdev_sent_queue(np->dev, skb->len);

2517 2518
	skb_tx_timestamp(skb);

A
Ayaz Abdulla 已提交
2519 2520
	np->put_tx.ex = put_tx;

2521
	spin_unlock_irqrestore(&np->lock, flags);
A
Ayaz Abdulla 已提交
2522 2523 2524 2525 2526

	writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
	return NETDEV_TX_OK;
}

A
Ayaz Abdulla 已提交
2527 2528 2529 2530 2531 2532
static inline void nv_tx_flip_ownership(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);

	np->tx_pkts_in_progress--;
	if (np->tx_change_owner) {
A
Al Viro 已提交
2533 2534
		np->tx_change_owner->first_tx_desc->flaglen |=
			cpu_to_le32(NV_TX2_VALID);
A
Ayaz Abdulla 已提交
2535 2536 2537 2538 2539 2540 2541 2542 2543 2544
		np->tx_pkts_in_progress++;

		np->tx_change_owner = np->tx_change_owner->next_tx_ctx;
		if (np->tx_change_owner == np->tx_end_flip)
			np->tx_change_owner = NULL;

		writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
	}
}

L
Linus Torvalds 已提交
2545 2546 2547 2548 2549
/*
 * nv_tx_done: check for completed packets, release the skbs.
 *
 * Caller must own np->lock.
 */
2550
static int nv_tx_done(struct net_device *dev, int limit)
L
Linus Torvalds 已提交
2551
{
2552
	struct fe_priv *np = netdev_priv(dev);
2553
	u32 flags;
2554
	int tx_work = 0;
2555
	struct ring_desc *orig_get_tx = np->get_tx.orig;
2556
	unsigned int bytes_compl = 0;
L
Linus Torvalds 已提交
2557

2558
	while ((np->get_tx.orig != np->put_tx.orig) &&
2559 2560
	       !((flags = le32_to_cpu(np->get_tx.orig->flaglen)) & NV_TX_VALID) &&
	       (tx_work < limit)) {
L
Linus Torvalds 已提交
2561

E
Eric Dumazet 已提交
2562
		nv_unmap_txskb(np, np->get_tx_ctx);
2563

L
Linus Torvalds 已提交
2564
		if (np->desc_ver == DESC_VER_1) {
2565
			if (flags & NV_TX_LASTPACKET) {
2566
				if (flags & NV_TX_ERROR) {
2567 2568
					if ((flags & NV_TX_RETRYERROR)
					    && !(flags & NV_TX_RETRYCOUNT_MASK))
2569
						nv_legacybackoff_reseed(dev);
2570
				} else {
2571 2572 2573 2574
					u64_stats_update_begin(&np->swstats_tx_syncp);
					np->stat_tx_packets++;
					np->stat_tx_bytes += np->get_tx_ctx->skb->len;
					u64_stats_update_end(&np->swstats_tx_syncp);
2575
				}
2576
				bytes_compl += np->get_tx_ctx->skb->len;
2577 2578
				dev_kfree_skb_any(np->get_tx_ctx->skb);
				np->get_tx_ctx->skb = NULL;
2579
				tx_work++;
L
Linus Torvalds 已提交
2580 2581
			}
		} else {
2582
			if (flags & NV_TX2_LASTPACKET) {
2583
				if (flags & NV_TX2_ERROR) {
2584 2585
					if ((flags & NV_TX2_RETRYERROR)
					    && !(flags & NV_TX2_RETRYCOUNT_MASK))
2586
						nv_legacybackoff_reseed(dev);
2587
				} else {
2588 2589 2590 2591
					u64_stats_update_begin(&np->swstats_tx_syncp);
					np->stat_tx_packets++;
					np->stat_tx_bytes += np->get_tx_ctx->skb->len;
					u64_stats_update_end(&np->swstats_tx_syncp);
2592
				}
2593
				bytes_compl += np->get_tx_ctx->skb->len;
2594 2595
				dev_kfree_skb_any(np->get_tx_ctx->skb);
				np->get_tx_ctx->skb = NULL;
2596
				tx_work++;
L
Linus Torvalds 已提交
2597 2598
			}
		}
2599
		if (unlikely(np->get_tx.orig++ == np->last_tx.orig))
A
Ayaz Abdulla 已提交
2600
			np->get_tx.orig = np->first_tx.orig;
2601
		if (unlikely(np->get_tx_ctx++ == np->last_tx_ctx))
A
Ayaz Abdulla 已提交
2602 2603
			np->get_tx_ctx = np->first_tx_ctx;
	}
2604 2605 2606

	netdev_completed_queue(np->dev, tx_work, bytes_compl);

2607
	if (unlikely((np->tx_stop == 1) && (np->get_tx.orig != orig_get_tx))) {
A
Ayaz Abdulla 已提交
2608
		np->tx_stop = 0;
A
Ayaz Abdulla 已提交
2609
		netif_wake_queue(dev);
A
Ayaz Abdulla 已提交
2610
	}
2611
	return tx_work;
A
Ayaz Abdulla 已提交
2612 2613
}

2614
static int nv_tx_done_optimized(struct net_device *dev, int limit)
A
Ayaz Abdulla 已提交
2615 2616 2617
{
	struct fe_priv *np = netdev_priv(dev);
	u32 flags;
2618
	int tx_work = 0;
2619
	struct ring_desc_ex *orig_get_tx = np->get_tx.ex;
2620
	unsigned long bytes_cleaned = 0;
A
Ayaz Abdulla 已提交
2621

2622
	while ((np->get_tx.ex != np->put_tx.ex) &&
J
Julia Lawall 已提交
2623
	       !((flags = le32_to_cpu(np->get_tx.ex->flaglen)) & NV_TX2_VALID) &&
2624
	       (tx_work < limit)) {
A
Ayaz Abdulla 已提交
2625

E
Eric Dumazet 已提交
2626
		nv_unmap_txskb(np, np->get_tx_ctx);
2627

A
Ayaz Abdulla 已提交
2628
		if (flags & NV_TX2_LASTPACKET) {
2629
			if (flags & NV_TX2_ERROR) {
2630 2631
				if ((flags & NV_TX2_RETRYERROR)
				    && !(flags & NV_TX2_RETRYCOUNT_MASK)) {
2632 2633 2634 2635 2636
					if (np->driver_data & DEV_HAS_GEAR_MODE)
						nv_gear_backoff_reseed(dev);
					else
						nv_legacybackoff_reseed(dev);
				}
2637
			} else {
2638 2639 2640 2641
				u64_stats_update_begin(&np->swstats_tx_syncp);
				np->stat_tx_packets++;
				np->stat_tx_bytes += np->get_tx_ctx->skb->len;
				u64_stats_update_end(&np->swstats_tx_syncp);
2642 2643
			}

2644
			bytes_cleaned += np->get_tx_ctx->skb->len;
2645 2646
			dev_kfree_skb_any(np->get_tx_ctx->skb);
			np->get_tx_ctx->skb = NULL;
2647
			tx_work++;
A
Ayaz Abdulla 已提交
2648

2649
			if (np->tx_limit)
A
Ayaz Abdulla 已提交
2650
				nv_tx_flip_ownership(dev);
A
Ayaz Abdulla 已提交
2651
		}
2652

2653
		if (unlikely(np->get_tx.ex++ == np->last_tx.ex))
A
Ayaz Abdulla 已提交
2654
			np->get_tx.ex = np->first_tx.ex;
2655
		if (unlikely(np->get_tx_ctx++ == np->last_tx_ctx))
A
Ayaz Abdulla 已提交
2656
			np->get_tx_ctx = np->first_tx_ctx;
L
Linus Torvalds 已提交
2657
	}
2658 2659 2660

	netdev_completed_queue(np->dev, tx_work, bytes_cleaned);

2661
	if (unlikely((np->tx_stop == 1) && (np->get_tx.ex != orig_get_tx))) {
A
Ayaz Abdulla 已提交
2662
		np->tx_stop = 0;
L
Linus Torvalds 已提交
2663
		netif_wake_queue(dev);
A
Ayaz Abdulla 已提交
2664
	}
2665
	return tx_work;
L
Linus Torvalds 已提交
2666 2667 2668 2669
}

/*
 * nv_tx_timeout: dev->tx_timeout function
H
Herbert Xu 已提交
2670
 * Called with netif_tx_lock held.
L
Linus Torvalds 已提交
2671 2672 2673
 */
static void nv_tx_timeout(struct net_device *dev)
{
2674
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
2675
	u8 __iomem *base = get_hwbase(dev);
2676
	u32 status;
A
Ayaz Abdulla 已提交
2677 2678
	union ring_type put_tx;
	int saved_tx_limit;
2679 2680 2681 2682 2683

	if (np->msi_flags & NV_MSI_X_ENABLED)
		status = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQSTAT_MASK;
	else
		status = readl(base + NvRegIrqStatus) & NVREG_IRQSTAT_MASK;
L
Linus Torvalds 已提交
2684

2685
	netdev_warn(dev, "Got tx_timeout. irq status: %08x\n", status);
L
Linus Torvalds 已提交
2686

2687 2688 2689 2690 2691 2692
	if (unlikely(debug_tx_timeout)) {
		int i;

		netdev_info(dev, "Ring at %lx\n", (unsigned long)np->ring_addr);
		netdev_info(dev, "Dumping tx registers\n");
		for (i = 0; i <= np->register_size; i += 32) {
2693
			netdev_info(dev,
2694 2695
				    "%3x: %08x %08x %08x %08x "
				    "%08x %08x %08x %08x\n",
2696
				    i,
2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736
				    readl(base + i + 0), readl(base + i + 4),
				    readl(base + i + 8), readl(base + i + 12),
				    readl(base + i + 16), readl(base + i + 20),
				    readl(base + i + 24), readl(base + i + 28));
		}
		netdev_info(dev, "Dumping tx ring\n");
		for (i = 0; i < np->tx_ring_size; i += 4) {
			if (!nv_optimized(np)) {
				netdev_info(dev,
					    "%03x: %08x %08x // %08x %08x "
					    "// %08x %08x // %08x %08x\n",
					    i,
					    le32_to_cpu(np->tx_ring.orig[i].buf),
					    le32_to_cpu(np->tx_ring.orig[i].flaglen),
					    le32_to_cpu(np->tx_ring.orig[i+1].buf),
					    le32_to_cpu(np->tx_ring.orig[i+1].flaglen),
					    le32_to_cpu(np->tx_ring.orig[i+2].buf),
					    le32_to_cpu(np->tx_ring.orig[i+2].flaglen),
					    le32_to_cpu(np->tx_ring.orig[i+3].buf),
					    le32_to_cpu(np->tx_ring.orig[i+3].flaglen));
			} else {
				netdev_info(dev,
					    "%03x: %08x %08x %08x "
					    "// %08x %08x %08x "
					    "// %08x %08x %08x "
					    "// %08x %08x %08x\n",
					    i,
					    le32_to_cpu(np->tx_ring.ex[i].bufhigh),
					    le32_to_cpu(np->tx_ring.ex[i].buflow),
					    le32_to_cpu(np->tx_ring.ex[i].flaglen),
					    le32_to_cpu(np->tx_ring.ex[i+1].bufhigh),
					    le32_to_cpu(np->tx_ring.ex[i+1].buflow),
					    le32_to_cpu(np->tx_ring.ex[i+1].flaglen),
					    le32_to_cpu(np->tx_ring.ex[i+2].bufhigh),
					    le32_to_cpu(np->tx_ring.ex[i+2].buflow),
					    le32_to_cpu(np->tx_ring.ex[i+2].flaglen),
					    le32_to_cpu(np->tx_ring.ex[i+3].bufhigh),
					    le32_to_cpu(np->tx_ring.ex[i+3].buflow),
					    le32_to_cpu(np->tx_ring.ex[i+3].flaglen));
			}
2737 2738 2739
		}
	}

L
Linus Torvalds 已提交
2740 2741 2742 2743 2744
	spin_lock_irq(&np->lock);

	/* 1) stop tx engine */
	nv_stop_tx(dev);

A
Ayaz Abdulla 已提交
2745 2746 2747 2748
	/* 2) complete any outstanding tx and do not give HW any limited tx pkts */
	saved_tx_limit = np->tx_limit;
	np->tx_limit = 0; /* prevent giving HW any limited pkts */
	np->tx_stop = 0;  /* prevent waking tx queue */
2749
	if (!nv_optimized(np))
2750
		nv_tx_done(dev, np->tx_ring_size);
A
Ayaz Abdulla 已提交
2751
	else
A
Ayaz Abdulla 已提交
2752
		nv_tx_done_optimized(dev, np->tx_ring_size);
L
Linus Torvalds 已提交
2753

L
Lucas De Marchi 已提交
2754
	/* save current HW position */
A
Ayaz Abdulla 已提交
2755 2756 2757 2758
	if (np->tx_change_owner)
		put_tx.ex = np->tx_change_owner->first_tx_desc;
	else
		put_tx = np->put_tx;
L
Linus Torvalds 已提交
2759

A
Ayaz Abdulla 已提交
2760 2761 2762 2763 2764 2765 2766
	/* 3) clear all tx state */
	nv_drain_tx(dev);
	nv_init_tx(dev);

	/* 4) restore state to current HW position */
	np->get_tx = np->put_tx = put_tx;
	np->tx_limit = saved_tx_limit;
A
Ayaz Abdulla 已提交
2767

A
Ayaz Abdulla 已提交
2768
	/* 5) restart tx engine */
L
Linus Torvalds 已提交
2769
	nv_start_tx(dev);
A
Ayaz Abdulla 已提交
2770
	netif_wake_queue(dev);
L
Linus Torvalds 已提交
2771 2772 2773
	spin_unlock_irq(&np->lock);
}

2774 2775 2776 2777 2778 2779 2780 2781 2782 2783
/*
 * Called when the nic notices a mismatch between the actual data len on the
 * wire and the len indicated in the 802 header
 */
static int nv_getlen(struct net_device *dev, void *packet, int datalen)
{
	int hdrlen;	/* length of the 802 header */
	int protolen;	/* length as stored in the proto field */

	/* 1) calculate len according to header */
2784 2785
	if (((struct vlan_ethhdr *)packet)->h_vlan_proto == htons(ETH_P_8021Q)) {
		protolen = ntohs(((struct vlan_ethhdr *)packet)->h_vlan_encapsulated_proto);
2786 2787
		hdrlen = VLAN_HLEN;
	} else {
2788
		protolen = ntohs(((struct ethhdr *)packet)->h_proto);
2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812 2813 2814 2815 2816
		hdrlen = ETH_HLEN;
	}
	if (protolen > ETH_DATA_LEN)
		return datalen; /* Value in proto field not a len, no checks possible */

	protolen += hdrlen;
	/* consistency checks: */
	if (datalen > ETH_ZLEN) {
		if (datalen >= protolen) {
			/* more data on wire than in 802 header, trim of
			 * additional data.
			 */
			return protolen;
		} else {
			/* less data on wire than mentioned in header.
			 * Discard the packet.
			 */
			return -1;
		}
	} else {
		/* short packet. Accept only if 802 values are also short */
		if (protolen > ETH_ZLEN) {
			return -1;
		}
		return datalen;
	}
}

2817
static int nv_rx_process(struct net_device *dev, int limit)
L
Linus Torvalds 已提交
2818
{
2819
	struct fe_priv *np = netdev_priv(dev);
2820
	u32 flags;
I
Ingo Molnar 已提交
2821
	int rx_work = 0;
2822 2823
	struct sk_buff *skb;
	int len;
L
Linus Torvalds 已提交
2824

2825
	while ((np->get_rx.orig != np->put_rx.orig) &&
2826
	      !((flags = le32_to_cpu(np->get_rx.orig->flaglen)) & NV_RX_AVAIL) &&
I
Ingo Molnar 已提交
2827
		(rx_work < limit)) {
L
Linus Torvalds 已提交
2828 2829 2830 2831 2832 2833

		/*
		 * the packet is for us - immediately tear down the pci mapping.
		 * TODO: check if a prefetch of the first cacheline improves
		 * the performance.
		 */
2834 2835 2836
		dma_unmap_single(&np->pci_dev->dev, np->get_rx_ctx->dma,
				 np->get_rx_ctx->dma_len,
				 DMA_FROM_DEVICE);
A
Ayaz Abdulla 已提交
2837 2838
		skb = np->get_rx_ctx->skb;
		np->get_rx_ctx->skb = NULL;
L
Linus Torvalds 已提交
2839 2840 2841

		/* look at what we actually got: */
		if (np->desc_ver == DESC_VER_1) {
2842 2843 2844
			if (likely(flags & NV_RX_DESCRIPTORVALID)) {
				len = flags & LEN_MASK_V1;
				if (unlikely(flags & NV_RX_ERROR)) {
A
Ayaz Abdulla 已提交
2845
					if ((flags & NV_RX_ERROR_MASK) == NV_RX_ERROR4) {
2846 2847 2848 2849 2850 2851 2852
						len = nv_getlen(dev, skb->data, len);
						if (len < 0) {
							dev_kfree_skb(skb);
							goto next_pkt;
						}
					}
					/* framing errors are soft errors */
A
Ayaz Abdulla 已提交
2853
					else if ((flags & NV_RX_ERROR_MASK) == NV_RX_FRAMINGERR) {
2854
						if (flags & NV_RX_SUBTRACT1)
2855 2856 2857 2858
							len--;
					}
					/* the rest are hard errors */
					else {
2859 2860 2861 2862 2863
						if (flags & NV_RX_MISSEDFRAME) {
							u64_stats_update_begin(&np->swstats_rx_syncp);
							np->stat_rx_missed_errors++;
							u64_stats_update_end(&np->swstats_rx_syncp);
						}
A
Ayaz Abdulla 已提交
2864
						dev_kfree_skb(skb);
2865 2866 2867
						goto next_pkt;
					}
				}
2868
			} else {
A
Ayaz Abdulla 已提交
2869
				dev_kfree_skb(skb);
L
Linus Torvalds 已提交
2870
				goto next_pkt;
A
Ayaz Abdulla 已提交
2871
			}
2872 2873 2874 2875
		} else {
			if (likely(flags & NV_RX2_DESCRIPTORVALID)) {
				len = flags & LEN_MASK_V2;
				if (unlikely(flags & NV_RX2_ERROR)) {
A
Ayaz Abdulla 已提交
2876
					if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_ERROR4) {
2877 2878 2879 2880 2881 2882 2883
						len = nv_getlen(dev, skb->data, len);
						if (len < 0) {
							dev_kfree_skb(skb);
							goto next_pkt;
						}
					}
					/* framing errors are soft errors */
A
Ayaz Abdulla 已提交
2884
					else if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_FRAMINGERR) {
2885
						if (flags & NV_RX2_SUBTRACT1)
2886 2887 2888 2889
							len--;
					}
					/* the rest are hard errors */
					else {
A
Ayaz Abdulla 已提交
2890
						dev_kfree_skb(skb);
2891 2892 2893
						goto next_pkt;
					}
				}
A
Ayaz Abdulla 已提交
2894 2895
				if (((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_TCP) || /*ip and tcp */
				    ((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_UDP))   /*ip and udp */
A
Ayaz Abdulla 已提交
2896
					skb->ip_summed = CHECKSUM_UNNECESSARY;
2897 2898 2899
			} else {
				dev_kfree_skb(skb);
				goto next_pkt;
L
Linus Torvalds 已提交
2900 2901 2902 2903 2904
			}
		}
		/* got a valid packet - forward it to the network core */
		skb_put(skb, len);
		skb->protocol = eth_type_trans(skb, dev);
T
Tom Herbert 已提交
2905
		napi_gro_receive(&np->napi, skb);
2906 2907 2908 2909
		u64_stats_update_begin(&np->swstats_rx_syncp);
		np->stat_rx_packets++;
		np->stat_rx_bytes += len;
		u64_stats_update_end(&np->swstats_rx_syncp);
L
Linus Torvalds 已提交
2910
next_pkt:
2911
		if (unlikely(np->get_rx.orig++ == np->last_rx.orig))
A
Ayaz Abdulla 已提交
2912
			np->get_rx.orig = np->first_rx.orig;
2913
		if (unlikely(np->get_rx_ctx++ == np->last_rx_ctx))
A
Ayaz Abdulla 已提交
2914
			np->get_rx_ctx = np->first_rx_ctx;
I
Ingo Molnar 已提交
2915 2916

		rx_work++;
A
Ayaz Abdulla 已提交
2917 2918
	}

I
Ingo Molnar 已提交
2919
	return rx_work;
A
Ayaz Abdulla 已提交
2920 2921 2922 2923 2924 2925 2926
}

static int nv_rx_process_optimized(struct net_device *dev, int limit)
{
	struct fe_priv *np = netdev_priv(dev);
	u32 flags;
	u32 vlanflags = 0;
2927
	int rx_work = 0;
2928 2929
	struct sk_buff *skb;
	int len;
A
Ayaz Abdulla 已提交
2930

2931
	while ((np->get_rx.ex != np->put_rx.ex) &&
2932
	      !((flags = le32_to_cpu(np->get_rx.ex->flaglen)) & NV_RX2_AVAIL) &&
2933
	      (rx_work < limit)) {
A
Ayaz Abdulla 已提交
2934 2935 2936 2937 2938 2939

		/*
		 * the packet is for us - immediately tear down the pci mapping.
		 * TODO: check if a prefetch of the first cacheline improves
		 * the performance.
		 */
2940 2941 2942
		dma_unmap_single(&np->pci_dev->dev, np->get_rx_ctx->dma,
				 np->get_rx_ctx->dma_len,
				 DMA_FROM_DEVICE);
A
Ayaz Abdulla 已提交
2943 2944 2945 2946
		skb = np->get_rx_ctx->skb;
		np->get_rx_ctx->skb = NULL;

		/* look at what we actually got: */
2947 2948 2949
		if (likely(flags & NV_RX2_DESCRIPTORVALID)) {
			len = flags & LEN_MASK_V2;
			if (unlikely(flags & NV_RX2_ERROR)) {
A
Ayaz Abdulla 已提交
2950
				if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_ERROR4) {
2951 2952 2953 2954 2955 2956 2957
					len = nv_getlen(dev, skb->data, len);
					if (len < 0) {
						dev_kfree_skb(skb);
						goto next_pkt;
					}
				}
				/* framing errors are soft errors */
A
Ayaz Abdulla 已提交
2958
				else if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_FRAMINGERR) {
2959
					if (flags & NV_RX2_SUBTRACT1)
2960 2961 2962 2963
						len--;
				}
				/* the rest are hard errors */
				else {
A
Ayaz Abdulla 已提交
2964 2965 2966 2967
					dev_kfree_skb(skb);
					goto next_pkt;
				}
			}
2968

A
Ayaz Abdulla 已提交
2969 2970
			if (((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_TCP) || /*ip and tcp */
			    ((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_UDP))   /*ip and udp */
A
Ayaz Abdulla 已提交
2971
				skb->ip_summed = CHECKSUM_UNNECESSARY;
2972 2973 2974 2975 2976 2977

			/* got a valid packet - forward it to the network core */
			skb_put(skb, len);
			skb->protocol = eth_type_trans(skb, dev);
			prefetch(skb->data);

J
Jiri Pirko 已提交
2978
			vlanflags = le32_to_cpu(np->get_rx.ex->buflow);
J
Jiri Pirko 已提交
2979 2980

			/*
2981 2982
			 * There's need to check for NETIF_F_HW_VLAN_CTAG_RX
			 * here. Even if vlan rx accel is disabled,
J
Jiri Pirko 已提交
2983 2984
			 * NV_RX3_VLAN_TAG_PRESENT is pseudo randomly set.
			 */
2985
			if (dev->features & NETIF_F_HW_VLAN_CTAG_RX &&
J
Jiri Pirko 已提交
2986
			    vlanflags & NV_RX3_VLAN_TAG_PRESENT) {
J
Jiri Pirko 已提交
2987 2988
				u16 vid = vlanflags & NV_RX3_VLAN_TAG_MASK;

2989
				__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vid);
2990
			}
J
Jiri Pirko 已提交
2991
			napi_gro_receive(&np->napi, skb);
2992 2993 2994 2995
			u64_stats_update_begin(&np->swstats_rx_syncp);
			np->stat_rx_packets++;
			np->stat_rx_bytes += len;
			u64_stats_update_end(&np->swstats_rx_syncp);
2996 2997 2998
		} else {
			dev_kfree_skb(skb);
		}
A
Ayaz Abdulla 已提交
2999
next_pkt:
3000
		if (unlikely(np->get_rx.ex++ == np->last_rx.ex))
A
Ayaz Abdulla 已提交
3001
			np->get_rx.ex = np->first_rx.ex;
3002
		if (unlikely(np->get_rx_ctx++ == np->last_rx_ctx))
A
Ayaz Abdulla 已提交
3003
			np->get_rx_ctx = np->first_rx_ctx;
3004 3005

		rx_work++;
L
Linus Torvalds 已提交
3006
	}
3007

3008
	return rx_work;
L
Linus Torvalds 已提交
3009 3010
}

3011 3012 3013 3014 3015 3016 3017 3018 3019 3020
static void set_bufsize(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);

	if (dev->mtu <= ETH_DATA_LEN)
		np->rx_buf_sz = ETH_DATA_LEN + NV_RX_HEADERS;
	else
		np->rx_buf_sz = dev->mtu + NV_RX_HEADERS;
}

L
Linus Torvalds 已提交
3021 3022 3023 3024 3025 3026
/*
 * nv_change_mtu: dev->change_mtu function
 * Called with dev_base_lock held for read.
 */
static int nv_change_mtu(struct net_device *dev, int new_mtu)
{
3027
	struct fe_priv *np = netdev_priv(dev);
3028 3029 3030
	int old_mtu;

	old_mtu = dev->mtu;
L
Linus Torvalds 已提交
3031
	dev->mtu = new_mtu;
3032 3033 3034 3035 3036 3037 3038

	/* return early if the buffer sizes will not change */
	if (old_mtu <= ETH_DATA_LEN && new_mtu <= ETH_DATA_LEN)
		return 0;

	/* synchronized against open : rtnl_lock() held by caller */
	if (netif_running(dev)) {
3039
		u8 __iomem *base = get_hwbase(dev);
3040 3041 3042 3043 3044 3045
		/*
		 * It seems that the nic preloads valid ring entries into an
		 * internal buffer. The procedure for flushing everything is
		 * guessed, there is probably a simpler approach.
		 * Changing the MTU is a rare event, it shouldn't matter.
		 */
3046
		nv_disable_irq(dev);
3047
		nv_napi_disable(dev);
H
Herbert Xu 已提交
3048
		netif_tx_lock_bh(dev);
3049
		netif_addr_lock(dev);
3050 3051
		spin_lock(&np->lock);
		/* stop engines */
3052
		nv_stop_rxtx(dev);
3053 3054
		nv_txrx_reset(dev);
		/* drain rx queue */
3055
		nv_drain_rxtx(dev);
3056 3057
		/* reinit driver view of the rx queue */
		set_bufsize(dev);
3058
		if (nv_init_ring(dev)) {
3059 3060 3061 3062 3063
			if (!np->in_shutdown)
				mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
		}
		/* reinit nic view of the rx queue */
		writel(np->rx_buf_sz, base + NvRegOffloadConfig);
3064
		setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
3065
		writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
3066 3067
			base + NvRegRingSizes);
		pci_push(base);
3068
		writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
3069 3070 3071
		pci_push(base);

		/* restart rx engine */
3072
		nv_start_rxtx(dev);
3073
		spin_unlock(&np->lock);
3074
		netif_addr_unlock(dev);
H
Herbert Xu 已提交
3075
		netif_tx_unlock_bh(dev);
3076
		nv_napi_enable(dev);
3077
		nv_enable_irq(dev);
3078
	}
L
Linus Torvalds 已提交
3079 3080 3081
	return 0;
}

3082 3083
static void nv_copy_mac_to_hw(struct net_device *dev)
{
3084
	u8 __iomem *base = get_hwbase(dev);
3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100
	u32 mac[2];

	mac[0] = (dev->dev_addr[0] << 0) + (dev->dev_addr[1] << 8) +
			(dev->dev_addr[2] << 16) + (dev->dev_addr[3] << 24);
	mac[1] = (dev->dev_addr[4] << 0) + (dev->dev_addr[5] << 8);

	writel(mac[0], base + NvRegMacAddrA);
	writel(mac[1], base + NvRegMacAddrB);
}

/*
 * nv_set_mac_address: dev->set_mac_address function
 * Called with rtnl_lock() held.
 */
static int nv_set_mac_address(struct net_device *dev, void *addr)
{
3101
	struct fe_priv *np = netdev_priv(dev);
3102
	struct sockaddr *macaddr = (struct sockaddr *)addr;
3103

3104
	if (!is_valid_ether_addr(macaddr->sa_data))
3105 3106 3107 3108 3109 3110
		return -EADDRNOTAVAIL;

	/* synchronized against open : rtnl_lock() held by caller */
	memcpy(dev->dev_addr, macaddr->sa_data, ETH_ALEN);

	if (netif_running(dev)) {
H
Herbert Xu 已提交
3111
		netif_tx_lock_bh(dev);
3112
		netif_addr_lock(dev);
3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123
		spin_lock_irq(&np->lock);

		/* stop rx engine */
		nv_stop_rx(dev);

		/* set mac address */
		nv_copy_mac_to_hw(dev);

		/* restart rx engine */
		nv_start_rx(dev);
		spin_unlock_irq(&np->lock);
3124
		netif_addr_unlock(dev);
H
Herbert Xu 已提交
3125
		netif_tx_unlock_bh(dev);
3126 3127 3128 3129 3130 3131
	} else {
		nv_copy_mac_to_hw(dev);
	}
	return 0;
}

L
Linus Torvalds 已提交
3132 3133
/*
 * nv_set_multicast: dev->set_multicast function
H
Herbert Xu 已提交
3134
 * Called with netif_tx_lock held.
L
Linus Torvalds 已提交
3135 3136 3137
 */
static void nv_set_multicast(struct net_device *dev)
{
3138
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
3139 3140 3141
	u8 __iomem *base = get_hwbase(dev);
	u32 addr[2];
	u32 mask[2];
3142
	u32 pff = readl(base + NvRegPacketFilterFlags) & NVREG_PFF_PAUSE_RX;
L
Linus Torvalds 已提交
3143 3144 3145 3146 3147

	memset(addr, 0, sizeof(addr));
	memset(mask, 0, sizeof(mask));

	if (dev->flags & IFF_PROMISC) {
3148
		pff |= NVREG_PFF_PROMISC;
L
Linus Torvalds 已提交
3149
	} else {
3150
		pff |= NVREG_PFF_MYADDR;
L
Linus Torvalds 已提交
3151

3152
		if (dev->flags & IFF_ALLMULTI || !netdev_mc_empty(dev)) {
L
Linus Torvalds 已提交
3153 3154 3155 3156 3157 3158 3159
			u32 alwaysOff[2];
			u32 alwaysOn[2];

			alwaysOn[0] = alwaysOn[1] = alwaysOff[0] = alwaysOff[1] = 0xffffffff;
			if (dev->flags & IFF_ALLMULTI) {
				alwaysOn[0] = alwaysOn[1] = alwaysOff[0] = alwaysOff[1] = 0;
			} else {
3160
				struct netdev_hw_addr *ha;
L
Linus Torvalds 已提交
3161

3162
				netdev_for_each_mc_addr(ha, dev) {
3163
					unsigned char *hw_addr = ha->addr;
L
Linus Torvalds 已提交
3164
					u32 a, b;
3165

3166 3167
					a = le32_to_cpu(*(__le32 *) hw_addr);
					b = le16_to_cpu(*(__le16 *) (&hw_addr[4]));
L
Linus Torvalds 已提交
3168 3169 3170 3171 3172 3173 3174 3175 3176 3177
					alwaysOn[0] &= a;
					alwaysOff[0] &= ~a;
					alwaysOn[1] &= b;
					alwaysOff[1] &= ~b;
				}
			}
			addr[0] = alwaysOn[0];
			addr[1] = alwaysOn[1];
			mask[0] = alwaysOn[0] | alwaysOff[0];
			mask[1] = alwaysOn[1] | alwaysOff[1];
A
Ayaz Abdulla 已提交
3178 3179 3180
		} else {
			mask[0] = NVREG_MCASTMASKA_NONE;
			mask[1] = NVREG_MCASTMASKB_NONE;
L
Linus Torvalds 已提交
3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193 3194 3195
		}
	}
	addr[0] |= NVREG_MCASTADDRA_FORCE;
	pff |= NVREG_PFF_ALWAYS;
	spin_lock_irq(&np->lock);
	nv_stop_rx(dev);
	writel(addr[0], base + NvRegMulticastAddrA);
	writel(addr[1], base + NvRegMulticastAddrB);
	writel(mask[0], base + NvRegMulticastMaskA);
	writel(mask[1], base + NvRegMulticastMaskB);
	writel(pff, base + NvRegPacketFilterFlags);
	nv_start_rx(dev);
	spin_unlock_irq(&np->lock);
}

3196
static void nv_update_pause(struct net_device *dev, u32 pause_flags)
3197 3198 3199 3200 3201 3202 3203 3204 3205 3206 3207 3208 3209 3210 3211 3212 3213 3214
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);

	np->pause_flags &= ~(NV_PAUSEFRAME_TX_ENABLE | NV_PAUSEFRAME_RX_ENABLE);

	if (np->pause_flags & NV_PAUSEFRAME_RX_CAPABLE) {
		u32 pff = readl(base + NvRegPacketFilterFlags) & ~NVREG_PFF_PAUSE_RX;
		if (pause_flags & NV_PAUSEFRAME_RX_ENABLE) {
			writel(pff|NVREG_PFF_PAUSE_RX, base + NvRegPacketFilterFlags);
			np->pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
		} else {
			writel(pff, base + NvRegPacketFilterFlags);
		}
	}
	if (np->pause_flags & NV_PAUSEFRAME_TX_CAPABLE) {
		u32 regmisc = readl(base + NvRegMisc1) & ~NVREG_MISC1_PAUSE_TX;
		if (pause_flags & NV_PAUSEFRAME_TX_ENABLE) {
A
Ayaz Abdulla 已提交
3215 3216 3217
			u32 pause_enable = NVREG_TX_PAUSEFRAME_ENABLE_V1;
			if (np->driver_data & DEV_HAS_PAUSEFRAME_TX_V2)
				pause_enable = NVREG_TX_PAUSEFRAME_ENABLE_V2;
A
Ayaz Abdulla 已提交
3218
			if (np->driver_data & DEV_HAS_PAUSEFRAME_TX_V3) {
A
Ayaz Abdulla 已提交
3219
				pause_enable = NVREG_TX_PAUSEFRAME_ENABLE_V3;
A
Ayaz Abdulla 已提交
3220 3221 3222
				/* limit the number of tx pause frames to a default of 8 */
				writel(readl(base + NvRegTxPauseFrameLimit)|NVREG_TX_PAUSEFRAMELIMIT_ENABLE, base + NvRegTxPauseFrameLimit);
			}
A
Ayaz Abdulla 已提交
3223
			writel(pause_enable,  base + NvRegTxPauseFrame);
3224 3225 3226 3227 3228 3229 3230 3231 3232
			writel(regmisc|NVREG_MISC1_PAUSE_TX, base + NvRegMisc1);
			np->pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
		} else {
			writel(NVREG_TX_PAUSEFRAME_DISABLE,  base + NvRegTxPauseFrame);
			writel(regmisc, base + NvRegMisc1);
		}
	}
}

3233 3234 3235 3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297
static void nv_force_linkspeed(struct net_device *dev, int speed, int duplex)
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
	u32 phyreg, txreg;
	int mii_status;

	np->linkspeed = NVREG_LINKSPEED_FORCE|speed;
	np->duplex = duplex;

	/* see if gigabit phy */
	mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
	if (mii_status & PHY_GIGABIT) {
		np->gigabit = PHY_GIGABIT;
		phyreg = readl(base + NvRegSlotTime);
		phyreg &= ~(0x3FF00);
		if ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_10)
			phyreg |= NVREG_SLOTTIME_10_100_FULL;
		else if ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_100)
			phyreg |= NVREG_SLOTTIME_10_100_FULL;
		else if ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_1000)
			phyreg |= NVREG_SLOTTIME_1000_FULL;
		writel(phyreg, base + NvRegSlotTime);
	}

	phyreg = readl(base + NvRegPhyInterface);
	phyreg &= ~(PHY_HALF|PHY_100|PHY_1000);
	if (np->duplex == 0)
		phyreg |= PHY_HALF;
	if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_100)
		phyreg |= PHY_100;
	else if ((np->linkspeed & NVREG_LINKSPEED_MASK) ==
							NVREG_LINKSPEED_1000)
		phyreg |= PHY_1000;
	writel(phyreg, base + NvRegPhyInterface);

	if (phyreg & PHY_RGMII) {
		if ((np->linkspeed & NVREG_LINKSPEED_MASK) ==
							NVREG_LINKSPEED_1000)
			txreg = NVREG_TX_DEFERRAL_RGMII_1000;
		else
			txreg = NVREG_TX_DEFERRAL_RGMII_10_100;
	} else {
		txreg = NVREG_TX_DEFERRAL_DEFAULT;
	}
	writel(txreg, base + NvRegTxDeferral);

	if (np->desc_ver == DESC_VER_1) {
		txreg = NVREG_TX_WM_DESC1_DEFAULT;
	} else {
		if ((np->linkspeed & NVREG_LINKSPEED_MASK) ==
					 NVREG_LINKSPEED_1000)
			txreg = NVREG_TX_WM_DESC2_3_1000;
		else
			txreg = NVREG_TX_WM_DESC2_3_DEFAULT;
	}
	writel(txreg, base + NvRegTxWatermark);

	writel(NVREG_MISC1_FORCE | (np->duplex ? 0 : NVREG_MISC1_HD),
			base + NvRegMisc1);
	pci_push(base);
	writel(np->linkspeed, base + NvRegLinkSpeed);
	pci_push(base);
}

3298
/**
3299
 * nv_update_linkspeed - Setup the MAC according to the link partner
3300 3301 3302 3303 3304 3305 3306 3307 3308
 * @dev: Network device to be configured
 *
 * The function queries the PHY and checks if there is a link partner.
 * If yes, then it sets up the MAC accordingly. Otherwise, the MAC is
 * set to 10 MBit HD.
 *
 * The function returns 0 if there is no link partner and 1 if there is
 * a good link partner.
 */
L
Linus Torvalds 已提交
3309 3310
static int nv_update_linkspeed(struct net_device *dev)
{
3311
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
3312
	u8 __iomem *base = get_hwbase(dev);
3313 3314 3315
	int adv = 0;
	int lpa = 0;
	int adv_lpa, adv_pause, lpa_pause;
L
Linus Torvalds 已提交
3316 3317 3318
	int newls = np->linkspeed;
	int newdup = np->duplex;
	int mii_status;
3319
	u32 bmcr;
L
Linus Torvalds 已提交
3320
	int retval = 0;
A
Ayaz Abdulla 已提交
3321
	u32 control_1000, status_1000, phyreg, pause_flags, txreg;
A
Ayaz Abdulla 已提交
3322
	u32 txrxFlags = 0;
A
Ayaz Abdulla 已提交
3323
	u32 phy_exp;
L
Linus Torvalds 已提交
3324

3325 3326 3327 3328 3329 3330 3331 3332 3333 3334 3335 3336 3337
	/* If device loopback is enabled, set carrier on and enable max link
	 * speed.
	 */
	bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
	if (bmcr & BMCR_LOOPBACK) {
		if (netif_running(dev)) {
			nv_force_linkspeed(dev, NVREG_LINKSPEED_1000, 1);
			if (!netif_carrier_ok(dev))
				netif_carrier_on(dev);
		}
		return 1;
	}

L
Linus Torvalds 已提交
3338 3339 3340 3341 3342 3343 3344 3345 3346 3347 3348 3349 3350 3351 3352 3353 3354 3355 3356 3357 3358 3359 3360 3361 3362 3363 3364 3365 3366 3367 3368 3369 3370 3371 3372 3373 3374 3375 3376
	/* BMSR_LSTATUS is latched, read it twice:
	 * we want the current value.
	 */
	mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
	mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);

	if (!(mii_status & BMSR_LSTATUS)) {
		newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
		newdup = 0;
		retval = 0;
		goto set_speed;
	}

	if (np->autoneg == 0) {
		if (np->fixed_mode & LPA_100FULL) {
			newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100;
			newdup = 1;
		} else if (np->fixed_mode & LPA_100HALF) {
			newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100;
			newdup = 0;
		} else if (np->fixed_mode & LPA_10FULL) {
			newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
			newdup = 1;
		} else {
			newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
			newdup = 0;
		}
		retval = 1;
		goto set_speed;
	}
	/* check auto negotiation is complete */
	if (!(mii_status & BMSR_ANEGCOMPLETE)) {
		/* still in autonegotiation - configure nic for 10 MBit HD and wait. */
		newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
		newdup = 0;
		retval = 0;
		goto set_speed;
	}

3377 3378 3379
	adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
	lpa = mii_rw(dev, np->phyaddr, MII_LPA, MII_READ);

L
Linus Torvalds 已提交
3380 3381
	retval = 1;
	if (np->gigabit == PHY_GIGABIT) {
3382 3383
		control_1000 = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ);
		status_1000 = mii_rw(dev, np->phyaddr, MII_STAT1000, MII_READ);
L
Linus Torvalds 已提交
3384 3385 3386 3387 3388 3389 3390 3391 3392 3393

		if ((control_1000 & ADVERTISE_1000FULL) &&
			(status_1000 & LPA_1000FULL)) {
			newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_1000;
			newdup = 1;
			goto set_speed;
		}
	}

	/* FIXME: handle parallel detection properly */
3394 3395
	adv_lpa = lpa & adv;
	if (adv_lpa & LPA_100FULL) {
L
Linus Torvalds 已提交
3396 3397
		newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100;
		newdup = 1;
3398
	} else if (adv_lpa & LPA_100HALF) {
L
Linus Torvalds 已提交
3399 3400
		newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100;
		newdup = 0;
3401
	} else if (adv_lpa & LPA_10FULL) {
L
Linus Torvalds 已提交
3402 3403
		newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
		newdup = 1;
3404
	} else if (adv_lpa & LPA_10HALF) {
L
Linus Torvalds 已提交
3405 3406 3407 3408 3409 3410 3411 3412 3413 3414 3415 3416 3417 3418
		newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
		newdup = 0;
	} else {
		newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
		newdup = 0;
	}

set_speed:
	if (np->duplex == newdup && np->linkspeed == newls)
		return retval;

	np->duplex = newdup;
	np->linkspeed = newls;

A
Ayaz Abdulla 已提交
3419 3420 3421 3422 3423 3424 3425 3426 3427 3428
	/* The transmitter and receiver must be restarted for safe update */
	if (readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_START) {
		txrxFlags |= NV_RESTART_TX;
		nv_stop_tx(dev);
	}
	if (readl(base + NvRegReceiverControl) & NVREG_RCVCTL_START) {
		txrxFlags |= NV_RESTART_RX;
		nv_stop_rx(dev);
	}

L
Linus Torvalds 已提交
3429
	if (np->gigabit == PHY_GIGABIT) {
3430
		phyreg = readl(base + NvRegSlotTime);
L
Linus Torvalds 已提交
3431
		phyreg &= ~(0x3FF00);
3432 3433 3434
		if (((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_10) ||
		    ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_100))
			phyreg |= NVREG_SLOTTIME_10_100_FULL;
L
Linus Torvalds 已提交
3435
		else if ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_1000)
3436 3437
			phyreg |= NVREG_SLOTTIME_1000_FULL;
		writel(phyreg, base + NvRegSlotTime);
L
Linus Torvalds 已提交
3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449
	}

	phyreg = readl(base + NvRegPhyInterface);
	phyreg &= ~(PHY_HALF|PHY_100|PHY_1000);
	if (np->duplex == 0)
		phyreg |= PHY_HALF;
	if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_100)
		phyreg |= PHY_100;
	else if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_1000)
		phyreg |= PHY_1000;
	writel(phyreg, base + NvRegPhyInterface);

A
Ayaz Abdulla 已提交
3450
	phy_exp = mii_rw(dev, np->phyaddr, MII_EXPANSION, MII_READ) & EXPANSION_NWAY; /* autoneg capable */
A
Ayaz Abdulla 已提交
3451
	if (phyreg & PHY_RGMII) {
A
Ayaz Abdulla 已提交
3452
		if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_1000) {
A
Ayaz Abdulla 已提交
3453
			txreg = NVREG_TX_DEFERRAL_RGMII_1000;
A
Ayaz Abdulla 已提交
3454 3455 3456 3457 3458 3459 3460 3461 3462 3463
		} else {
			if (!phy_exp && !np->duplex && (np->driver_data & DEV_HAS_COLLISION_FIX)) {
				if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_10)
					txreg = NVREG_TX_DEFERRAL_RGMII_STRETCH_10;
				else
					txreg = NVREG_TX_DEFERRAL_RGMII_STRETCH_100;
			} else {
				txreg = NVREG_TX_DEFERRAL_RGMII_10_100;
			}
		}
A
Ayaz Abdulla 已提交
3464
	} else {
A
Ayaz Abdulla 已提交
3465 3466 3467 3468
		if (!phy_exp && !np->duplex && (np->driver_data & DEV_HAS_COLLISION_FIX))
			txreg = NVREG_TX_DEFERRAL_MII_STRETCH;
		else
			txreg = NVREG_TX_DEFERRAL_DEFAULT;
A
Ayaz Abdulla 已提交
3469 3470 3471
	}
	writel(txreg, base + NvRegTxDeferral);

3472 3473 3474 3475 3476 3477 3478 3479 3480 3481
	if (np->desc_ver == DESC_VER_1) {
		txreg = NVREG_TX_WM_DESC1_DEFAULT;
	} else {
		if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_1000)
			txreg = NVREG_TX_WM_DESC2_3_1000;
		else
			txreg = NVREG_TX_WM_DESC2_3_DEFAULT;
	}
	writel(txreg, base + NvRegTxWatermark);

3482
	writel(NVREG_MISC1_FORCE | (np->duplex ? 0 : NVREG_MISC1_HD),
L
Linus Torvalds 已提交
3483 3484 3485 3486 3487
		base + NvRegMisc1);
	pci_push(base);
	writel(np->linkspeed, base + NvRegLinkSpeed);
	pci_push(base);

3488 3489
	pause_flags = 0;
	/* setup pause frame */
3490
	if (netif_running(dev) && (np->duplex != 0)) {
3491
		if (np->autoneg && np->pause_flags & NV_PAUSEFRAME_AUTONEG) {
3492 3493
			adv_pause = adv & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
			lpa_pause = lpa & (LPA_PAUSE_CAP | LPA_PAUSE_ASYM);
3494 3495

			switch (adv_pause) {
3496
			case ADVERTISE_PAUSE_CAP:
3497 3498 3499 3500 3501 3502
				if (lpa_pause & LPA_PAUSE_CAP) {
					pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
					if (np->pause_flags & NV_PAUSEFRAME_TX_REQ)
						pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
				}
				break;
3503
			case ADVERTISE_PAUSE_ASYM:
3504
				if (lpa_pause == (LPA_PAUSE_CAP | LPA_PAUSE_ASYM))
3505 3506
					pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
				break;
3507 3508
			case ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM:
				if (lpa_pause & LPA_PAUSE_CAP) {
3509 3510 3511 3512 3513 3514 3515
					pause_flags |=  NV_PAUSEFRAME_RX_ENABLE;
					if (np->pause_flags & NV_PAUSEFRAME_TX_REQ)
						pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
				}
				if (lpa_pause == LPA_PAUSE_ASYM)
					pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
				break;
3516
			}
3517
		} else {
3518
			pause_flags = np->pause_flags;
3519 3520
		}
	}
3521
	nv_update_pause(dev, pause_flags);
3522

A
Ayaz Abdulla 已提交
3523 3524 3525 3526 3527
	if (txrxFlags & NV_RESTART_TX)
		nv_start_tx(dev);
	if (txrxFlags & NV_RESTART_RX)
		nv_start_rx(dev);

L
Linus Torvalds 已提交
3528 3529 3530 3531 3532 3533
	return retval;
}

static void nv_linkchange(struct net_device *dev)
{
	if (nv_update_linkspeed(dev)) {
3534
		if (!netif_carrier_ok(dev)) {
L
Linus Torvalds 已提交
3535
			netif_carrier_on(dev);
3536
			netdev_info(dev, "link up\n");
3537
			nv_txrx_gate(dev, false);
3538
			nv_start_rx(dev);
L
Linus Torvalds 已提交
3539 3540 3541 3542
		}
	} else {
		if (netif_carrier_ok(dev)) {
			netif_carrier_off(dev);
3543
			netdev_info(dev, "link down\n");
3544
			nv_txrx_gate(dev, true);
L
Linus Torvalds 已提交
3545 3546 3547 3548 3549 3550 3551 3552 3553 3554 3555
			nv_stop_rx(dev);
		}
	}
}

static void nv_link_irq(struct net_device *dev)
{
	u8 __iomem *base = get_hwbase(dev);
	u32 miistat;

	miistat = readl(base + NvRegMIIStatus);
A
Ayaz Abdulla 已提交
3556
	writel(NVREG_MIISTAT_LINKCHANGE, base + NvRegMIIStatus);
L
Linus Torvalds 已提交
3557 3558 3559 3560 3561

	if (miistat & (NVREG_MIISTAT_LINKCHANGE))
		nv_linkchange(dev);
}

A
Ayaz Abdulla 已提交
3562 3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574 3575
static void nv_msi_workaround(struct fe_priv *np)
{

	/* Need to toggle the msi irq mask within the ethernet device,
	 * otherwise, future interrupts will not be detected.
	 */
	if (np->msi_flags & NV_MSI_ENABLED) {
		u8 __iomem *base = np->base;

		writel(0, base + NvRegMSIIrqMask);
		writel(NVREG_MSI_VECTOR_0_ENABLED, base + NvRegMSIIrqMask);
	}
}

3576 3577 3578 3579 3580 3581 3582 3583 3584 3585 3586 3587 3588 3589 3590 3591 3592 3593 3594 3595 3596 3597 3598 3599 3600 3601 3602 3603
static inline int nv_change_interrupt_mode(struct net_device *dev, int total_work)
{
	struct fe_priv *np = netdev_priv(dev);

	if (optimization_mode == NV_OPTIMIZATION_MODE_DYNAMIC) {
		if (total_work > NV_DYNAMIC_THRESHOLD) {
			/* transition to poll based interrupts */
			np->quiet_count = 0;
			if (np->irqmask != NVREG_IRQMASK_CPU) {
				np->irqmask = NVREG_IRQMASK_CPU;
				return 1;
			}
		} else {
			if (np->quiet_count < NV_DYNAMIC_MAX_QUIET_COUNT) {
				np->quiet_count++;
			} else {
				/* reached a period of low activity, switch
				   to per tx/rx packet interrupts */
				if (np->irqmask != NVREG_IRQMASK_THROUGHPUT) {
					np->irqmask = NVREG_IRQMASK_THROUGHPUT;
					return 1;
				}
			}
		}
	}
	return 0;
}

3604
static irqreturn_t nv_nic_irq(int foo, void *data)
L
Linus Torvalds 已提交
3605 3606
{
	struct net_device *dev = (struct net_device *) data;
3607
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
3608 3609
	u8 __iomem *base = get_hwbase(dev);

3610 3611
	if (!(np->msi_flags & NV_MSI_X_ENABLED)) {
		np->events = readl(base + NvRegIrqStatus);
3612
		writel(np->events, base + NvRegIrqStatus);
3613 3614
	} else {
		np->events = readl(base + NvRegMSIXIrqStatus);
3615
		writel(np->events, base + NvRegMSIXIrqStatus);
3616 3617 3618
	}
	if (!(np->events & np->irqmask))
		return IRQ_NONE;
L
Linus Torvalds 已提交
3619

3620
	nv_msi_workaround(np);
A
Ayaz Abdulla 已提交
3621

E
Eric Dumazet 已提交
3622 3623 3624 3625 3626 3627 3628
	if (napi_schedule_prep(&np->napi)) {
		/*
		 * Disable further irq's (msix not enabled with napi)
		 */
		writel(0, base + NvRegIrqMask);
		__napi_schedule(&np->napi);
	}
3629

3630
	return IRQ_HANDLED;
L
Linus Torvalds 已提交
3631 3632
}

3633
/* All _optimized functions are used to help increase performance
3634 3635 3636
 * (reduce CPU and increase throughput). They use descripter version 3,
 * compiler directives, and reduce memory accesses.
 */
A
Ayaz Abdulla 已提交
3637 3638 3639 3640 3641 3642
static irqreturn_t nv_nic_irq_optimized(int foo, void *data)
{
	struct net_device *dev = (struct net_device *) data;
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);

3643 3644
	if (!(np->msi_flags & NV_MSI_X_ENABLED)) {
		np->events = readl(base + NvRegIrqStatus);
3645
		writel(np->events, base + NvRegIrqStatus);
3646 3647
	} else {
		np->events = readl(base + NvRegMSIXIrqStatus);
3648
		writel(np->events, base + NvRegMSIXIrqStatus);
3649 3650 3651
	}
	if (!(np->events & np->irqmask))
		return IRQ_NONE;
A
Ayaz Abdulla 已提交
3652

3653
	nv_msi_workaround(np);
A
Ayaz Abdulla 已提交
3654

E
Eric Dumazet 已提交
3655 3656 3657 3658 3659 3660 3661
	if (napi_schedule_prep(&np->napi)) {
		/*
		 * Disable further irq's (msix not enabled with napi)
		 */
		writel(0, base + NvRegIrqMask);
		__napi_schedule(&np->napi);
	}
A
Ayaz Abdulla 已提交
3662

3663
	return IRQ_HANDLED;
A
Ayaz Abdulla 已提交
3664 3665
}

3666
static irqreturn_t nv_nic_irq_tx(int foo, void *data)
3667 3668 3669 3670 3671 3672
{
	struct net_device *dev = (struct net_device *) data;
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
	u32 events;
	int i;
3673
	unsigned long flags;
3674

3675
	for (i = 0;; i++) {
3676
		events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQ_TX_ALL;
3677 3678
		writel(events, base + NvRegMSIXIrqStatus);
		netdev_dbg(dev, "tx irq events: %08x\n", events);
3679 3680 3681
		if (!(events & np->irqmask))
			break;

3682
		spin_lock_irqsave(&np->lock, flags);
A
Ayaz Abdulla 已提交
3683
		nv_tx_done_optimized(dev, TX_WORK_PER_LOOP);
3684
		spin_unlock_irqrestore(&np->lock, flags);
3685

3686
		if (unlikely(i > max_interrupt_work)) {
3687
			spin_lock_irqsave(&np->lock, flags);
3688 3689 3690 3691 3692 3693 3694 3695
			/* disable interrupts on the nic */
			writel(NVREG_IRQ_TX_ALL, base + NvRegIrqMask);
			pci_push(base);

			if (!np->in_shutdown) {
				np->nic_poll_irq |= NVREG_IRQ_TX_ALL;
				mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
			}
3696
			spin_unlock_irqrestore(&np->lock, flags);
3697 3698
			netdev_dbg(dev, "%s: too many iterations (%d)\n",
				   __func__, i);
3699 3700 3701 3702 3703 3704 3705 3706
			break;
		}

	}

	return IRQ_RETVAL(i);
}

3707
static int nv_napi_poll(struct napi_struct *napi, int budget)
3708
{
3709 3710
	struct fe_priv *np = container_of(napi, struct fe_priv, napi);
	struct net_device *dev = np->dev;
3711
	u8 __iomem *base = get_hwbase(dev);
3712
	unsigned long flags;
3713
	int retcode;
3714
	int rx_count, tx_work = 0, rx_work = 0;
3715

3716 3717 3718 3719 3720
	do {
		if (!nv_optimized(np)) {
			spin_lock_irqsave(&np->lock, flags);
			tx_work += nv_tx_done(dev, np->tx_ring_size);
			spin_unlock_irqrestore(&np->lock, flags);
3721

3722
			rx_count = nv_rx_process(dev, budget - rx_work);
3723 3724 3725 3726 3727
			retcode = nv_alloc_rx(dev);
		} else {
			spin_lock_irqsave(&np->lock, flags);
			tx_work += nv_tx_done_optimized(dev, np->tx_ring_size);
			spin_unlock_irqrestore(&np->lock, flags);
3728

3729 3730
			rx_count = nv_rx_process_optimized(dev,
			    budget - rx_work);
3731 3732 3733 3734
			retcode = nv_alloc_rx_optimized(dev);
		}
	} while (retcode == 0 &&
		 rx_count > 0 && (rx_work += rx_count) < budget);
3735

3736
	if (retcode) {
3737
		spin_lock_irqsave(&np->lock, flags);
3738 3739
		if (!np->in_shutdown)
			mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
3740
		spin_unlock_irqrestore(&np->lock, flags);
3741 3742
	}

3743 3744
	nv_change_interrupt_mode(dev, tx_work + rx_work);

3745 3746 3747 3748 3749 3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760 3761 3762 3763
	if (unlikely(np->events & NVREG_IRQ_LINK)) {
		spin_lock_irqsave(&np->lock, flags);
		nv_link_irq(dev);
		spin_unlock_irqrestore(&np->lock, flags);
	}
	if (unlikely(np->need_linktimer && time_after(jiffies, np->link_timeout))) {
		spin_lock_irqsave(&np->lock, flags);
		nv_linkchange(dev);
		spin_unlock_irqrestore(&np->lock, flags);
		np->link_timeout = jiffies + LINK_TIMEOUT;
	}
	if (unlikely(np->events & NVREG_IRQ_RECOVER_ERROR)) {
		spin_lock_irqsave(&np->lock, flags);
		if (!np->in_shutdown) {
			np->nic_poll_irq = np->irqmask;
			np->recover_error = 1;
			mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
		}
		spin_unlock_irqrestore(&np->lock, flags);
3764
		napi_complete(napi);
3765
		return rx_work;
3766 3767
	}

3768
	if (rx_work < budget) {
3769 3770
		/* re-enable interrupts
		   (msix not enabled in napi) */
3771
		napi_complete_done(napi, rx_work);
3772

3773
		writel(np->irqmask, base + NvRegIrqMask);
3774
	}
3775
	return rx_work;
3776 3777
}

3778
static irqreturn_t nv_nic_irq_rx(int foo, void *data)
3779 3780 3781 3782 3783 3784
{
	struct net_device *dev = (struct net_device *) data;
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
	u32 events;
	int i;
3785
	unsigned long flags;
3786

3787
	for (i = 0;; i++) {
3788
		events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQ_RX_ALL;
3789 3790
		writel(events, base + NvRegMSIXIrqStatus);
		netdev_dbg(dev, "rx irq events: %08x\n", events);
3791 3792
		if (!(events & np->irqmask))
			break;
3793

3794
		if (nv_rx_process_optimized(dev, RX_WORK_PER_LOOP)) {
3795 3796 3797 3798 3799 3800
			if (unlikely(nv_alloc_rx_optimized(dev))) {
				spin_lock_irqsave(&np->lock, flags);
				if (!np->in_shutdown)
					mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
				spin_unlock_irqrestore(&np->lock, flags);
			}
3801
		}
3802

3803
		if (unlikely(i > max_interrupt_work)) {
3804
			spin_lock_irqsave(&np->lock, flags);
3805 3806 3807 3808 3809 3810 3811 3812
			/* disable interrupts on the nic */
			writel(NVREG_IRQ_RX_ALL, base + NvRegIrqMask);
			pci_push(base);

			if (!np->in_shutdown) {
				np->nic_poll_irq |= NVREG_IRQ_RX_ALL;
				mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
			}
3813
			spin_unlock_irqrestore(&np->lock, flags);
3814 3815
			netdev_dbg(dev, "%s: too many iterations (%d)\n",
				   __func__, i);
3816 3817 3818 3819 3820 3821 3822
			break;
		}
	}

	return IRQ_RETVAL(i);
}

3823
static irqreturn_t nv_nic_irq_other(int foo, void *data)
3824 3825 3826 3827 3828 3829
{
	struct net_device *dev = (struct net_device *) data;
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
	u32 events;
	int i;
3830
	unsigned long flags;
3831

3832
	for (i = 0;; i++) {
3833
		events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQ_OTHER;
3834 3835
		writel(events, base + NvRegMSIXIrqStatus);
		netdev_dbg(dev, "irq events: %08x\n", events);
3836 3837
		if (!(events & np->irqmask))
			break;
3838

A
Ayaz Abdulla 已提交
3839 3840 3841 3842 3843
		/* check tx in case we reached max loop limit in tx isr */
		spin_lock_irqsave(&np->lock, flags);
		nv_tx_done_optimized(dev, TX_WORK_PER_LOOP);
		spin_unlock_irqrestore(&np->lock, flags);

3844
		if (events & NVREG_IRQ_LINK) {
3845
			spin_lock_irqsave(&np->lock, flags);
3846
			nv_link_irq(dev);
3847
			spin_unlock_irqrestore(&np->lock, flags);
3848 3849
		}
		if (np->need_linktimer && time_after(jiffies, np->link_timeout)) {
3850
			spin_lock_irqsave(&np->lock, flags);
3851
			nv_linkchange(dev);
3852
			spin_unlock_irqrestore(&np->lock, flags);
3853 3854
			np->link_timeout = jiffies + LINK_TIMEOUT;
		}
3855
		if (events & NVREG_IRQ_RECOVER_ERROR) {
3856
			spin_lock_irqsave(&np->lock, flags);
3857 3858 3859 3860 3861 3862 3863 3864 3865
			/* disable interrupts on the nic */
			writel(NVREG_IRQ_OTHER, base + NvRegIrqMask);
			pci_push(base);

			if (!np->in_shutdown) {
				np->nic_poll_irq |= NVREG_IRQ_OTHER;
				np->recover_error = 1;
				mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
			}
3866
			spin_unlock_irqrestore(&np->lock, flags);
3867 3868
			break;
		}
3869
		if (unlikely(i > max_interrupt_work)) {
3870
			spin_lock_irqsave(&np->lock, flags);
3871 3872 3873 3874 3875 3876 3877 3878
			/* disable interrupts on the nic */
			writel(NVREG_IRQ_OTHER, base + NvRegIrqMask);
			pci_push(base);

			if (!np->in_shutdown) {
				np->nic_poll_irq |= NVREG_IRQ_OTHER;
				mod_timer(&np->nic_poll, jiffies + POLL_WAIT);
			}
3879
			spin_unlock_irqrestore(&np->lock, flags);
3880 3881
			netdev_dbg(dev, "%s: too many iterations (%d)\n",
				   __func__, i);
3882 3883 3884 3885 3886 3887 3888 3889
			break;
		}

	}

	return IRQ_RETVAL(i);
}

3890
static irqreturn_t nv_nic_irq_test(int foo, void *data)
3891 3892 3893 3894 3895 3896 3897 3898
{
	struct net_device *dev = (struct net_device *) data;
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
	u32 events;

	if (!(np->msi_flags & NV_MSI_X_ENABLED)) {
		events = readl(base + NvRegIrqStatus) & NVREG_IRQSTAT_MASK;
3899
		writel(events & NVREG_IRQ_TIMER, base + NvRegIrqStatus);
3900 3901
	} else {
		events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQSTAT_MASK;
3902
		writel(events & NVREG_IRQ_TIMER, base + NvRegMSIXIrqStatus);
3903 3904 3905 3906 3907
	}
	pci_push(base);
	if (!(events & NVREG_IRQ_TIMER))
		return IRQ_RETVAL(0);

A
Ayaz Abdulla 已提交
3908 3909
	nv_msi_workaround(np);

3910 3911 3912 3913 3914 3915 3916
	spin_lock(&np->lock);
	np->intr_test = 1;
	spin_unlock(&np->lock);

	return IRQ_RETVAL(1);
}

3917 3918 3919 3920 3921 3922 3923 3924 3925 3926 3927
static void set_msix_vector_map(struct net_device *dev, u32 vector, u32 irqmask)
{
	u8 __iomem *base = get_hwbase(dev);
	int i;
	u32 msixmap = 0;

	/* Each interrupt bit can be mapped to a MSIX vector (4 bits).
	 * MSIXMap0 represents the first 8 interrupts and MSIXMap1 represents
	 * the remaining 8 interrupts.
	 */
	for (i = 0; i < 8; i++) {
3928
		if ((irqmask >> i) & 0x1)
3929 3930 3931 3932 3933 3934
			msixmap |= vector << (i << 2);
	}
	writel(readl(base + NvRegMSIXMap0) | msixmap, base + NvRegMSIXMap0);

	msixmap = 0;
	for (i = 0; i < 8; i++) {
3935
		if ((irqmask >> (i + 8)) & 0x1)
3936 3937 3938 3939 3940
			msixmap |= vector << (i << 2);
	}
	writel(readl(base + NvRegMSIXMap1) | msixmap, base + NvRegMSIXMap1);
}

3941
static int nv_request_irq(struct net_device *dev, int intr_test)
3942 3943 3944
{
	struct fe_priv *np = get_nvpriv(dev);
	u8 __iomem *base = get_hwbase(dev);
3945
	int ret;
3946
	int i;
A
Ayaz Abdulla 已提交
3947 3948 3949 3950 3951
	irqreturn_t (*handler)(int foo, void *data);

	if (intr_test) {
		handler = nv_nic_irq_test;
	} else {
3952
		if (nv_optimized(np))
A
Ayaz Abdulla 已提交
3953 3954 3955 3956
			handler = nv_nic_irq_optimized;
		else
			handler = nv_nic_irq;
	}
3957 3958

	if (np->msi_flags & NV_MSI_X_CAPABLE) {
3959
		for (i = 0; i < (np->msi_flags & NV_MSI_X_VECTORS_MASK); i++)
3960
			np->msi_x_entry[i].entry = i;
3961 3962 3963 3964 3965
		ret = pci_enable_msix_range(np->pci_dev,
					    np->msi_x_entry,
					    np->msi_flags & NV_MSI_X_VECTORS_MASK,
					    np->msi_flags & NV_MSI_X_VECTORS_MASK);
		if (ret > 0) {
3966
			np->msi_flags |= NV_MSI_X_ENABLED;
3967
			if (optimization_mode == NV_OPTIMIZATION_MODE_THROUGHPUT && !intr_test) {
3968
				/* Request irq for rx handling */
3969
				sprintf(np->name_rx, "%s-rx", dev->name);
3970 3971 3972
				ret = request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector,
						  nv_nic_irq_rx, IRQF_SHARED, np->name_rx, dev);
				if (ret) {
3973 3974 3975
					netdev_info(dev,
						    "request_irq failed for rx %d\n",
						    ret);
3976 3977 3978 3979 3980
					pci_disable_msix(np->pci_dev);
					np->msi_flags &= ~NV_MSI_X_ENABLED;
					goto out_err;
				}
				/* Request irq for tx handling */
3981
				sprintf(np->name_tx, "%s-tx", dev->name);
3982 3983 3984
				ret = request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector,
						  nv_nic_irq_tx, IRQF_SHARED, np->name_tx, dev);
				if (ret) {
3985 3986 3987
					netdev_info(dev,
						    "request_irq failed for tx %d\n",
						    ret);
3988 3989 3990 3991 3992
					pci_disable_msix(np->pci_dev);
					np->msi_flags &= ~NV_MSI_X_ENABLED;
					goto out_free_rx;
				}
				/* Request irq for link and timer handling */
3993
				sprintf(np->name_other, "%s-other", dev->name);
3994 3995 3996
				ret = request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector,
						  nv_nic_irq_other, IRQF_SHARED, np->name_other, dev);
				if (ret) {
3997 3998 3999
					netdev_info(dev,
						    "request_irq failed for link %d\n",
						    ret);
4000 4001 4002 4003 4004 4005 4006 4007 4008 4009 4010 4011
					pci_disable_msix(np->pci_dev);
					np->msi_flags &= ~NV_MSI_X_ENABLED;
					goto out_free_tx;
				}
				/* map interrupts to their respective vector */
				writel(0, base + NvRegMSIXMap0);
				writel(0, base + NvRegMSIXMap1);
				set_msix_vector_map(dev, NV_MSI_X_VECTOR_RX, NVREG_IRQ_RX_ALL);
				set_msix_vector_map(dev, NV_MSI_X_VECTOR_TX, NVREG_IRQ_TX_ALL);
				set_msix_vector_map(dev, NV_MSI_X_VECTOR_OTHER, NVREG_IRQ_OTHER);
			} else {
				/* Request irq for all interrupts */
4012 4013 4014
				ret = request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector,
						  handler, IRQF_SHARED, dev->name, dev);
				if (ret) {
4015 4016 4017
					netdev_info(dev,
						    "request_irq failed %d\n",
						    ret);
4018 4019 4020 4021 4022 4023 4024 4025 4026
					pci_disable_msix(np->pci_dev);
					np->msi_flags &= ~NV_MSI_X_ENABLED;
					goto out_err;
				}

				/* map interrupts to vector 0 */
				writel(0, base + NvRegMSIXMap0);
				writel(0, base + NvRegMSIXMap1);
			}
4027
			netdev_info(dev, "MSI-X enabled\n");
4028
			return 0;
4029 4030
		}
	}
4031
	if (np->msi_flags & NV_MSI_CAPABLE) {
4032 4033
		ret = pci_enable_msi(np->pci_dev);
		if (ret == 0) {
4034
			np->msi_flags |= NV_MSI_ENABLED;
4035 4036
			ret = request_irq(np->pci_dev->irq, handler, IRQF_SHARED, dev->name, dev);
			if (ret) {
4037 4038
				netdev_info(dev, "request_irq failed %d\n",
					    ret);
4039 4040 4041 4042 4043 4044 4045 4046 4047 4048
				pci_disable_msi(np->pci_dev);
				np->msi_flags &= ~NV_MSI_ENABLED;
				goto out_err;
			}

			/* map interrupts to vector 0 */
			writel(0, base + NvRegMSIMap0);
			writel(0, base + NvRegMSIMap1);
			/* enable msi vector 0 */
			writel(NVREG_MSI_VECTOR_0_ENABLED, base + NvRegMSIIrqMask);
4049
			netdev_info(dev, "MSI enabled\n");
4050
			return 0;
4051 4052
		}
	}
4053

4054 4055
	if (request_irq(np->pci_dev->irq, handler, IRQF_SHARED, dev->name, dev) != 0)
		goto out_err;
4056 4057 4058 4059 4060 4061 4062 4063 4064 4065 4066 4067 4068 4069 4070 4071

	return 0;
out_free_tx:
	free_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector, dev);
out_free_rx:
	free_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector, dev);
out_err:
	return 1;
}

static void nv_free_irq(struct net_device *dev)
{
	struct fe_priv *np = get_nvpriv(dev);
	int i;

	if (np->msi_flags & NV_MSI_X_ENABLED) {
4072
		for (i = 0; i < (np->msi_flags & NV_MSI_X_VECTORS_MASK); i++)
4073 4074 4075 4076 4077 4078 4079 4080 4081 4082 4083 4084
			free_irq(np->msi_x_entry[i].vector, dev);
		pci_disable_msix(np->pci_dev);
		np->msi_flags &= ~NV_MSI_X_ENABLED;
	} else {
		free_irq(np->pci_dev->irq, dev);
		if (np->msi_flags & NV_MSI_ENABLED) {
			pci_disable_msi(np->pci_dev);
			np->msi_flags &= ~NV_MSI_ENABLED;
		}
	}
}

4085
static void nv_do_nic_poll(struct timer_list *t)
L
Linus Torvalds 已提交
4086
{
4087 4088
	struct fe_priv *np = from_timer(np, t, nic_poll);
	struct net_device *dev = np->dev;
L
Linus Torvalds 已提交
4089
	u8 __iomem *base = get_hwbase(dev);
4090
	u32 mask = 0;
4091 4092
	unsigned long flags;
	unsigned int irq = 0;
L
Linus Torvalds 已提交
4093 4094

	/*
4095
	 * First disable irq(s) and then
L
Linus Torvalds 已提交
4096 4097 4098
	 * reenable interrupts on the nic, we have to do this before calling
	 * nv_nic_irq because that may decide to do otherwise
	 */
4099

4100 4101
	if (!using_multi_irqs(dev)) {
		if (np->msi_flags & NV_MSI_X_ENABLED)
4102
			irq = np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector;
4103
		else
4104
			irq = np->pci_dev->irq;
4105 4106 4107
		mask = np->irqmask;
	} else {
		if (np->nic_poll_irq & NVREG_IRQ_RX_ALL) {
4108
			irq = np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector;
4109 4110 4111
			mask |= NVREG_IRQ_RX_ALL;
		}
		if (np->nic_poll_irq & NVREG_IRQ_TX_ALL) {
4112
			irq = np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector;
4113 4114 4115
			mask |= NVREG_IRQ_TX_ALL;
		}
		if (np->nic_poll_irq & NVREG_IRQ_OTHER) {
4116
			irq = np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector;
4117 4118 4119
			mask |= NVREG_IRQ_OTHER;
		}
	}
4120 4121 4122

	disable_irq_nosync_lockdep_irqsave(irq, &flags);
	synchronize_irq(irq);
M
Manfred Spraul 已提交
4123

4124 4125
	if (np->recover_error) {
		np->recover_error = 0;
4126
		netdev_info(dev, "MAC in recoverable error state\n");
4127 4128
		if (netif_running(dev)) {
			netif_tx_lock_bh(dev);
4129
			netif_addr_lock(dev);
4130 4131
			spin_lock(&np->lock);
			/* stop engines */
4132
			nv_stop_rxtx(dev);
A
Ayaz Abdulla 已提交
4133 4134
			if (np->driver_data & DEV_HAS_POWER_CNTRL)
				nv_mac_reset(dev);
4135 4136
			nv_txrx_reset(dev);
			/* drain rx queue */
4137
			nv_drain_rxtx(dev);
4138 4139 4140 4141 4142 4143 4144 4145 4146
			/* reinit driver view of the rx queue */
			set_bufsize(dev);
			if (nv_init_ring(dev)) {
				if (!np->in_shutdown)
					mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
			}
			/* reinit nic view of the rx queue */
			writel(np->rx_buf_sz, base + NvRegOffloadConfig);
			setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
4147
			writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
4148 4149 4150 4151
				base + NvRegRingSizes);
			pci_push(base);
			writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
			pci_push(base);
A
Ayaz Abdulla 已提交
4152 4153 4154 4155 4156
			/* clear interrupts */
			if (!(np->msi_flags & NV_MSI_X_ENABLED))
				writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
			else
				writel(NVREG_IRQSTAT_MASK, base + NvRegMSIXIrqStatus);
4157 4158

			/* restart rx engine */
4159
			nv_start_rxtx(dev);
4160
			spin_unlock(&np->lock);
4161
			netif_addr_unlock(dev);
4162 4163 4164 4165
			netif_tx_unlock_bh(dev);
		}
	}

4166
	writel(mask, base + NvRegIrqMask);
L
Linus Torvalds 已提交
4167
	pci_push(base);
4168

4169
	if (!using_multi_irqs(dev)) {
4170
		np->nic_poll_irq = 0;
4171
		if (nv_optimized(np))
A
Ayaz Abdulla 已提交
4172 4173 4174
			nv_nic_irq_optimized(0, dev);
		else
			nv_nic_irq(0, dev);
4175 4176
	} else {
		if (np->nic_poll_irq & NVREG_IRQ_RX_ALL) {
4177
			np->nic_poll_irq &= ~NVREG_IRQ_RX_ALL;
4178
			nv_nic_irq_rx(0, dev);
4179 4180
		}
		if (np->nic_poll_irq & NVREG_IRQ_TX_ALL) {
4181
			np->nic_poll_irq &= ~NVREG_IRQ_TX_ALL;
4182
			nv_nic_irq_tx(0, dev);
4183 4184
		}
		if (np->nic_poll_irq & NVREG_IRQ_OTHER) {
4185
			np->nic_poll_irq &= ~NVREG_IRQ_OTHER;
4186
			nv_nic_irq_other(0, dev);
4187 4188
		}
	}
4189

4190
	enable_irq_lockdep_irqrestore(irq, &flags);
L
Linus Torvalds 已提交
4191 4192
}

4193 4194 4195
#ifdef CONFIG_NET_POLL_CONTROLLER
static void nv_poll_controller(struct net_device *dev)
{
4196 4197 4198
	struct fe_priv *np = netdev_priv(dev);

	nv_do_nic_poll(&np->nic_poll);
4199 4200 4201
}
#endif

4202
static void nv_do_stats_poll(struct timer_list *t)
4203 4204
	__acquires(&netdev_priv(dev)->hwstats_lock)
	__releases(&netdev_priv(dev)->hwstats_lock)
4205
{
4206 4207
	struct fe_priv *np = from_timer(np, t, stats_poll);
	struct net_device *dev = np->dev;
4208

4209 4210 4211 4212 4213 4214
	/* If lock is currently taken, the stats are being refreshed
	 * and hence fresh enough */
	if (spin_trylock(&np->hwstats_lock)) {
		nv_update_stats(dev);
		spin_unlock(&np->hwstats_lock);
	}
4215 4216

	if (!np->in_shutdown)
4217 4218
		mod_timer(&np->stats_poll,
			round_jiffies(jiffies + STATS_INTERVAL));
4219 4220
}

L
Linus Torvalds 已提交
4221 4222
static void nv_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
{
4223
	struct fe_priv *np = netdev_priv(dev);
4224 4225 4226
	strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
	strlcpy(info->version, FORCEDETH_VERSION, sizeof(info->version));
	strlcpy(info->bus_info, pci_name(np->pci_dev), sizeof(info->bus_info));
L
Linus Torvalds 已提交
4227 4228 4229 4230
}

static void nv_get_wol(struct net_device *dev, struct ethtool_wolinfo *wolinfo)
{
4231
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
4232 4233 4234 4235 4236 4237 4238 4239 4240 4241
	wolinfo->supported = WAKE_MAGIC;

	spin_lock_irq(&np->lock);
	if (np->wolenabled)
		wolinfo->wolopts = WAKE_MAGIC;
	spin_unlock_irq(&np->lock);
}

static int nv_set_wol(struct net_device *dev, struct ethtool_wolinfo *wolinfo)
{
4242
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
4243
	u8 __iomem *base = get_hwbase(dev);
A
Ayaz Abdulla 已提交
4244
	u32 flags = 0;
L
Linus Torvalds 已提交
4245 4246 4247

	if (wolinfo->wolopts == 0) {
		np->wolenabled = 0;
A
Ayaz Abdulla 已提交
4248
	} else if (wolinfo->wolopts & WAKE_MAGIC) {
L
Linus Torvalds 已提交
4249
		np->wolenabled = 1;
A
Ayaz Abdulla 已提交
4250 4251 4252 4253 4254 4255
		flags = NVREG_WAKEUPFLAGS_ENABLE;
	}
	if (netif_running(dev)) {
		spin_lock_irq(&np->lock);
		writel(flags, base + NvRegWakeUpFlags);
		spin_unlock_irq(&np->lock);
L
Linus Torvalds 已提交
4256
	}
4257
	device_set_wakeup_enable(&np->pci_dev->dev, np->wolenabled);
L
Linus Torvalds 已提交
4258 4259 4260
	return 0;
}

4261 4262
static int nv_get_link_ksettings(struct net_device *dev,
				 struct ethtool_link_ksettings *cmd)
L
Linus Torvalds 已提交
4263 4264
{
	struct fe_priv *np = netdev_priv(dev);
4265
	u32 speed, supported, advertising;
L
Linus Torvalds 已提交
4266 4267 4268
	int adv;

	spin_lock_irq(&np->lock);
4269
	cmd->base.port = PORT_MII;
L
Linus Torvalds 已提交
4270 4271 4272
	if (!netif_running(dev)) {
		/* We do not track link speed / duplex setting if the
		 * interface is disabled. Force a link check */
A
Ayaz Abdulla 已提交
4273
		if (nv_update_linkspeed(dev)) {
4274
			netif_carrier_on(dev);
A
Ayaz Abdulla 已提交
4275
		} else {
4276
			netif_carrier_off(dev);
A
Ayaz Abdulla 已提交
4277
		}
L
Linus Torvalds 已提交
4278
	}
A
Ayaz Abdulla 已提交
4279 4280

	if (netif_carrier_ok(dev)) {
4281
		switch (np->linkspeed & (NVREG_LINKSPEED_MASK)) {
L
Linus Torvalds 已提交
4282
		case NVREG_LINKSPEED_10:
4283
			speed = SPEED_10;
L
Linus Torvalds 已提交
4284 4285
			break;
		case NVREG_LINKSPEED_100:
4286
			speed = SPEED_100;
L
Linus Torvalds 已提交
4287 4288
			break;
		case NVREG_LINKSPEED_1000:
4289 4290 4291 4292
			speed = SPEED_1000;
			break;
		default:
			speed = -1;
L
Linus Torvalds 已提交
4293
			break;
A
Ayaz Abdulla 已提交
4294
		}
4295
		cmd->base.duplex = DUPLEX_HALF;
A
Ayaz Abdulla 已提交
4296
		if (np->duplex)
4297
			cmd->base.duplex = DUPLEX_FULL;
A
Ayaz Abdulla 已提交
4298
	} else {
4299
		speed = SPEED_UNKNOWN;
4300
		cmd->base.duplex = DUPLEX_UNKNOWN;
L
Linus Torvalds 已提交
4301
	}
4302 4303
	cmd->base.speed = speed;
	cmd->base.autoneg = np->autoneg;
L
Linus Torvalds 已提交
4304

4305
	advertising = ADVERTISED_MII;
L
Linus Torvalds 已提交
4306
	if (np->autoneg) {
4307
		advertising |= ADVERTISED_Autoneg;
L
Linus Torvalds 已提交
4308
		adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
A
Ayaz Abdulla 已提交
4309
		if (adv & ADVERTISE_10HALF)
4310
			advertising |= ADVERTISED_10baseT_Half;
A
Ayaz Abdulla 已提交
4311
		if (adv & ADVERTISE_10FULL)
4312
			advertising |= ADVERTISED_10baseT_Full;
A
Ayaz Abdulla 已提交
4313
		if (adv & ADVERTISE_100HALF)
4314
			advertising |= ADVERTISED_100baseT_Half;
A
Ayaz Abdulla 已提交
4315
		if (adv & ADVERTISE_100FULL)
4316
			advertising |= ADVERTISED_100baseT_Full;
A
Ayaz Abdulla 已提交
4317 4318 4319
		if (np->gigabit == PHY_GIGABIT) {
			adv = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ);
			if (adv & ADVERTISE_1000FULL)
4320
				advertising |= ADVERTISED_1000baseT_Full;
A
Ayaz Abdulla 已提交
4321
		}
L
Linus Torvalds 已提交
4322
	}
4323
	supported = (SUPPORTED_Autoneg |
L
Linus Torvalds 已提交
4324 4325 4326 4327
		SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full |
		SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full |
		SUPPORTED_MII);
	if (np->gigabit == PHY_GIGABIT)
4328
		supported |= SUPPORTED_1000baseT_Full;
L
Linus Torvalds 已提交
4329

4330 4331 4332 4333 4334 4335
	cmd->base.phy_address = np->phyaddr;

	ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
						supported);
	ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.advertising,
						advertising);
L
Linus Torvalds 已提交
4336 4337 4338 4339 4340 4341

	/* ignore maxtxpkt, maxrxpkt for now */
	spin_unlock_irq(&np->lock);
	return 0;
}

4342 4343
static int nv_set_link_ksettings(struct net_device *dev,
				 const struct ethtool_link_ksettings *cmd)
L
Linus Torvalds 已提交
4344 4345
{
	struct fe_priv *np = netdev_priv(dev);
4346 4347
	u32 speed = cmd->base.speed;
	u32 advertising;
L
Linus Torvalds 已提交
4348

4349 4350 4351 4352
	ethtool_convert_link_mode_to_legacy_u32(&advertising,
						cmd->link_modes.advertising);

	if (cmd->base.port != PORT_MII)
L
Linus Torvalds 已提交
4353
		return -EINVAL;
4354
	if (cmd->base.phy_address != np->phyaddr) {
L
Linus Torvalds 已提交
4355 4356 4357 4358
		/* TODO: support switching between multiple phys. Should be
		 * trivial, but not enabled due to lack of test hardware. */
		return -EINVAL;
	}
4359
	if (cmd->base.autoneg == AUTONEG_ENABLE) {
L
Linus Torvalds 已提交
4360 4361 4362 4363 4364 4365 4366
		u32 mask;

		mask = ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full |
			  ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full;
		if (np->gigabit == PHY_GIGABIT)
			mask |= ADVERTISED_1000baseT_Full;

4367
		if ((advertising & mask) == 0)
L
Linus Torvalds 已提交
4368 4369
			return -EINVAL;

4370
	} else if (cmd->base.autoneg == AUTONEG_DISABLE) {
L
Linus Torvalds 已提交
4371
		/* Note: autonegotiation disable, speed 1000 intentionally
L
Lucas De Marchi 已提交
4372
		 * forbidden - no one should need that. */
L
Linus Torvalds 已提交
4373

4374
		if (speed != SPEED_10 && speed != SPEED_100)
L
Linus Torvalds 已提交
4375
			return -EINVAL;
4376 4377
		if (cmd->base.duplex != DUPLEX_HALF &&
		    cmd->base.duplex != DUPLEX_FULL)
L
Linus Torvalds 已提交
4378 4379 4380 4381 4382
			return -EINVAL;
	} else {
		return -EINVAL;
	}

A
Ayaz Abdulla 已提交
4383 4384
	netif_carrier_off(dev);
	if (netif_running(dev)) {
4385 4386
		unsigned long flags;

A
Ayaz Abdulla 已提交
4387
		nv_disable_irq(dev);
4388
		netif_tx_lock_bh(dev);
4389
		netif_addr_lock(dev);
4390 4391
		/* with plain spinlock lockdep complains */
		spin_lock_irqsave(&np->lock, flags);
A
Ayaz Abdulla 已提交
4392
		/* stop engines */
4393 4394 4395 4396 4397 4398 4399 4400
		/* FIXME:
		 * this can take some time, and interrupts are disabled
		 * due to spin_lock_irqsave, but let's hope no daemon
		 * is going to change the settings very often...
		 * Worst case:
		 * NV_RXSTOP_DELAY1MAX + NV_TXSTOP_DELAY1MAX
		 * + some minor delays, which is up to a second approximately
		 */
4401
		nv_stop_rxtx(dev);
4402
		spin_unlock_irqrestore(&np->lock, flags);
4403
		netif_addr_unlock(dev);
4404
		netif_tx_unlock_bh(dev);
A
Ayaz Abdulla 已提交
4405 4406
	}

4407
	if (cmd->base.autoneg == AUTONEG_ENABLE) {
L
Linus Torvalds 已提交
4408 4409 4410 4411 4412 4413
		int adv, bmcr;

		np->autoneg = 1;

		/* advertise only what has been requested */
		adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
4414
		adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
4415
		if (advertising & ADVERTISED_10baseT_Half)
L
Linus Torvalds 已提交
4416
			adv |= ADVERTISE_10HALF;
4417
		if (advertising & ADVERTISED_10baseT_Full)
4418
			adv |= ADVERTISE_10FULL;
4419
		if (advertising & ADVERTISED_100baseT_Half)
L
Linus Torvalds 已提交
4420
			adv |= ADVERTISE_100HALF;
4421
		if (advertising & ADVERTISED_100baseT_Full)
4422
			adv |= ADVERTISE_100FULL;
L
Lucas De Marchi 已提交
4423
		if (np->pause_flags & NV_PAUSEFRAME_RX_REQ)  /* for rx we set both advertisements but disable tx pause */
4424 4425 4426
			adv |=  ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
		if (np->pause_flags & NV_PAUSEFRAME_TX_REQ)
			adv |=  ADVERTISE_PAUSE_ASYM;
L
Linus Torvalds 已提交
4427 4428 4429
		mii_rw(dev, np->phyaddr, MII_ADVERTISE, adv);

		if (np->gigabit == PHY_GIGABIT) {
4430
			adv = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ);
L
Linus Torvalds 已提交
4431
			adv &= ~ADVERTISE_1000FULL;
4432
			if (advertising & ADVERTISED_1000baseT_Full)
L
Linus Torvalds 已提交
4433
				adv |= ADVERTISE_1000FULL;
4434
			mii_rw(dev, np->phyaddr, MII_CTRL1000, adv);
L
Linus Torvalds 已提交
4435 4436
		}

A
Ayaz Abdulla 已提交
4437
		if (netif_running(dev))
4438
			netdev_info(dev, "link down\n");
L
Linus Torvalds 已提交
4439
		bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
4440 4441 4442 4443 4444
		if (np->phy_model == PHY_MODEL_MARVELL_E3016) {
			bmcr |= BMCR_ANENABLE;
			/* reset the phy in order for settings to stick,
			 * and cause autoneg to start */
			if (phy_reset(dev, bmcr)) {
4445
				netdev_info(dev, "phy reset failed\n");
4446 4447 4448 4449 4450 4451
				return -EINVAL;
			}
		} else {
			bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
			mii_rw(dev, np->phyaddr, MII_BMCR, bmcr);
		}
L
Linus Torvalds 已提交
4452 4453 4454 4455 4456 4457
	} else {
		int adv, bmcr;

		np->autoneg = 0;

		adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
4458
		adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
4459
		if (speed == SPEED_10 && cmd->base.duplex == DUPLEX_HALF)
L
Linus Torvalds 已提交
4460
			adv |= ADVERTISE_10HALF;
4461
		if (speed == SPEED_10 && cmd->base.duplex == DUPLEX_FULL)
4462
			adv |= ADVERTISE_10FULL;
4463
		if (speed == SPEED_100 && cmd->base.duplex == DUPLEX_HALF)
L
Linus Torvalds 已提交
4464
			adv |= ADVERTISE_100HALF;
4465
		if (speed == SPEED_100 && cmd->base.duplex == DUPLEX_FULL)
4466 4467
			adv |= ADVERTISE_100FULL;
		np->pause_flags &= ~(NV_PAUSEFRAME_AUTONEG|NV_PAUSEFRAME_RX_ENABLE|NV_PAUSEFRAME_TX_ENABLE);
L
Lucas De Marchi 已提交
4468
		if (np->pause_flags & NV_PAUSEFRAME_RX_REQ) {/* for rx we set both advertisements but disable tx pause */
4469 4470 4471 4472 4473 4474 4475
			adv |=  ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
			np->pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
		}
		if (np->pause_flags & NV_PAUSEFRAME_TX_REQ) {
			adv |=  ADVERTISE_PAUSE_ASYM;
			np->pause_flags |= NV_PAUSEFRAME_TX_ENABLE;
		}
L
Linus Torvalds 已提交
4476 4477 4478 4479
		mii_rw(dev, np->phyaddr, MII_ADVERTISE, adv);
		np->fixed_mode = adv;

		if (np->gigabit == PHY_GIGABIT) {
4480
			adv = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ);
L
Linus Torvalds 已提交
4481
			adv &= ~ADVERTISE_1000FULL;
4482
			mii_rw(dev, np->phyaddr, MII_CTRL1000, adv);
L
Linus Torvalds 已提交
4483 4484 4485
		}

		bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
A
Ayaz Abdulla 已提交
4486 4487
		bmcr &= ~(BMCR_ANENABLE|BMCR_SPEED100|BMCR_SPEED1000|BMCR_FULLDPLX);
		if (np->fixed_mode & (ADVERTISE_10FULL|ADVERTISE_100FULL))
L
Linus Torvalds 已提交
4488
			bmcr |= BMCR_FULLDPLX;
A
Ayaz Abdulla 已提交
4489
		if (np->fixed_mode & (ADVERTISE_100HALF|ADVERTISE_100FULL))
L
Linus Torvalds 已提交
4490
			bmcr |= BMCR_SPEED100;
A
Ayaz Abdulla 已提交
4491
		if (np->phy_oui == PHY_OUI_MARVELL) {
4492 4493
			/* reset the phy in order for forced mode settings to stick */
			if (phy_reset(dev, bmcr)) {
4494
				netdev_info(dev, "phy reset failed\n");
A
Ayaz Abdulla 已提交
4495 4496
				return -EINVAL;
			}
4497 4498 4499 4500 4501 4502 4503
		} else {
			mii_rw(dev, np->phyaddr, MII_BMCR, bmcr);
			if (netif_running(dev)) {
				/* Wait a bit and then reconfigure the nic. */
				udelay(10);
				nv_linkchange(dev);
			}
L
Linus Torvalds 已提交
4504 4505
		}
	}
A
Ayaz Abdulla 已提交
4506 4507

	if (netif_running(dev)) {
4508
		nv_start_rxtx(dev);
A
Ayaz Abdulla 已提交
4509 4510
		nv_enable_irq(dev);
	}
L
Linus Torvalds 已提交
4511 4512 4513 4514

	return 0;
}

4515 4516 4517 4518
#define FORCEDETH_REGS_VER	1

static int nv_get_regs_len(struct net_device *dev)
{
4519 4520
	struct fe_priv *np = netdev_priv(dev);
	return np->register_size;
4521 4522 4523 4524
}

static void nv_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *buf)
{
4525
	struct fe_priv *np = netdev_priv(dev);
4526 4527 4528 4529 4530 4531
	u8 __iomem *base = get_hwbase(dev);
	u32 *rbuf = buf;
	int i;

	regs->version = FORCEDETH_REGS_VER;
	spin_lock_irq(&np->lock);
D
david decotigny 已提交
4532
	for (i = 0; i < np->register_size/sizeof(u32); i++)
4533 4534 4535 4536 4537 4538
		rbuf[i] = readl(base + i*sizeof(u32));
	spin_unlock_irq(&np->lock);
}

static int nv_nway_reset(struct net_device *dev)
{
4539
	struct fe_priv *np = netdev_priv(dev);
4540 4541 4542 4543 4544
	int ret;

	if (np->autoneg) {
		int bmcr;

A
Ayaz Abdulla 已提交
4545 4546 4547
		netif_carrier_off(dev);
		if (netif_running(dev)) {
			nv_disable_irq(dev);
4548
			netif_tx_lock_bh(dev);
4549
			netif_addr_lock(dev);
A
Ayaz Abdulla 已提交
4550 4551
			spin_lock(&np->lock);
			/* stop engines */
4552
			nv_stop_rxtx(dev);
A
Ayaz Abdulla 已提交
4553
			spin_unlock(&np->lock);
4554
			netif_addr_unlock(dev);
4555
			netif_tx_unlock_bh(dev);
4556
			netdev_info(dev, "link down\n");
A
Ayaz Abdulla 已提交
4557 4558
		}

4559
		bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
4560 4561 4562 4563
		if (np->phy_model == PHY_MODEL_MARVELL_E3016) {
			bmcr |= BMCR_ANENABLE;
			/* reset the phy in order for settings to stick*/
			if (phy_reset(dev, bmcr)) {
4564
				netdev_info(dev, "phy reset failed\n");
4565 4566 4567 4568 4569 4570
				return -EINVAL;
			}
		} else {
			bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
			mii_rw(dev, np->phyaddr, MII_BMCR, bmcr);
		}
4571

A
Ayaz Abdulla 已提交
4572
		if (netif_running(dev)) {
4573
			nv_start_rxtx(dev);
A
Ayaz Abdulla 已提交
4574 4575
			nv_enable_irq(dev);
		}
4576 4577 4578 4579 4580 4581 4582 4583
		ret = 0;
	} else {
		ret = -EINVAL;
	}

	return ret;
}

4584 4585 4586 4587 4588 4589 4590 4591 4592 4593 4594 4595 4596 4597 4598
static void nv_get_ringparam(struct net_device *dev, struct ethtool_ringparam* ring)
{
	struct fe_priv *np = netdev_priv(dev);

	ring->rx_max_pending = (np->desc_ver == DESC_VER_1) ? RING_MAX_DESC_VER_1 : RING_MAX_DESC_VER_2_3;
	ring->tx_max_pending = (np->desc_ver == DESC_VER_1) ? RING_MAX_DESC_VER_1 : RING_MAX_DESC_VER_2_3;

	ring->rx_pending = np->rx_ring_size;
	ring->tx_pending = np->tx_ring_size;
}

static int nv_set_ringparam(struct net_device *dev, struct ethtool_ringparam* ring)
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
A
Ayaz Abdulla 已提交
4599
	u8 *rxtx_ring, *rx_skbuff, *tx_skbuff;
4600 4601 4602 4603 4604 4605 4606 4607 4608 4609 4610 4611 4612 4613 4614 4615
	dma_addr_t ring_addr;

	if (ring->rx_pending < RX_RING_MIN ||
	    ring->tx_pending < TX_RING_MIN ||
	    ring->rx_mini_pending != 0 ||
	    ring->rx_jumbo_pending != 0 ||
	    (np->desc_ver == DESC_VER_1 &&
	     (ring->rx_pending > RING_MAX_DESC_VER_1 ||
	      ring->tx_pending > RING_MAX_DESC_VER_1)) ||
	    (np->desc_ver != DESC_VER_1 &&
	     (ring->rx_pending > RING_MAX_DESC_VER_2_3 ||
	      ring->tx_pending > RING_MAX_DESC_VER_2_3))) {
		return -EINVAL;
	}

	/* allocate new rings */
4616
	if (!nv_optimized(np)) {
4617 4618 4619 4620 4621
		rxtx_ring = dma_alloc_coherent(&np->pci_dev->dev,
					       sizeof(struct ring_desc) *
					       (ring->rx_pending +
					       ring->tx_pending),
					       &ring_addr, GFP_ATOMIC);
4622
	} else {
4623 4624 4625 4626 4627
		rxtx_ring = dma_alloc_coherent(&np->pci_dev->dev,
					       sizeof(struct ring_desc_ex) *
					       (ring->rx_pending +
					       ring->tx_pending),
					       &ring_addr, GFP_ATOMIC);
4628
	}
A
Ayaz Abdulla 已提交
4629 4630 4631
	rx_skbuff = kmalloc(sizeof(struct nv_skb_map) * ring->rx_pending, GFP_KERNEL);
	tx_skbuff = kmalloc(sizeof(struct nv_skb_map) * ring->tx_pending, GFP_KERNEL);
	if (!rxtx_ring || !rx_skbuff || !tx_skbuff) {
4632
		/* fall back to old rings */
4633
		if (!nv_optimized(np)) {
4634
			if (rxtx_ring)
4635 4636 4637 4638 4639
				dma_free_coherent(&np->pci_dev->dev,
						  sizeof(struct ring_desc) *
						  (ring->rx_pending +
						  ring->tx_pending),
						  rxtx_ring, ring_addr);
4640 4641
		} else {
			if (rxtx_ring)
4642 4643 4644 4645 4646
				dma_free_coherent(&np->pci_dev->dev,
						  sizeof(struct ring_desc_ex) *
						  (ring->rx_pending +
						  ring->tx_pending),
						  rxtx_ring, ring_addr);
4647
		}
4648 4649 4650

		kfree(rx_skbuff);
		kfree(tx_skbuff);
4651 4652 4653 4654 4655
		goto exit;
	}

	if (netif_running(dev)) {
		nv_disable_irq(dev);
4656
		nv_napi_disable(dev);
4657
		netif_tx_lock_bh(dev);
4658
		netif_addr_lock(dev);
4659 4660
		spin_lock(&np->lock);
		/* stop engines */
4661
		nv_stop_rxtx(dev);
4662 4663
		nv_txrx_reset(dev);
		/* drain queues */
4664
		nv_drain_rxtx(dev);
4665 4666 4667 4668 4669 4670 4671
		/* delete queues */
		free_rings(dev);
	}

	/* set new values */
	np->rx_ring_size = ring->rx_pending;
	np->tx_ring_size = ring->tx_pending;
4672 4673

	if (!nv_optimized(np)) {
4674
		np->rx_ring.orig = (struct ring_desc *)rxtx_ring;
4675 4676
		np->tx_ring.orig = &np->rx_ring.orig[np->rx_ring_size];
	} else {
4677
		np->rx_ring.ex = (struct ring_desc_ex *)rxtx_ring;
4678 4679
		np->tx_ring.ex = &np->rx_ring.ex[np->rx_ring_size];
	}
4680 4681
	np->rx_skb = (struct nv_skb_map *)rx_skbuff;
	np->tx_skb = (struct nv_skb_map *)tx_skbuff;
4682 4683
	np->ring_addr = ring_addr;

A
Ayaz Abdulla 已提交
4684 4685
	memset(np->rx_skb, 0, sizeof(struct nv_skb_map) * np->rx_ring_size);
	memset(np->tx_skb, 0, sizeof(struct nv_skb_map) * np->tx_ring_size);
4686 4687 4688 4689 4690 4691 4692 4693 4694 4695 4696 4697

	if (netif_running(dev)) {
		/* reinit driver view of the queues */
		set_bufsize(dev);
		if (nv_init_ring(dev)) {
			if (!np->in_shutdown)
				mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
		}

		/* reinit nic view of the queues */
		writel(np->rx_buf_sz, base + NvRegOffloadConfig);
		setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
4698
		writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
4699 4700 4701 4702 4703 4704
			base + NvRegRingSizes);
		pci_push(base);
		writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
		pci_push(base);

		/* restart engines */
4705
		nv_start_rxtx(dev);
4706
		spin_unlock(&np->lock);
4707
		netif_addr_unlock(dev);
4708
		netif_tx_unlock_bh(dev);
4709
		nv_napi_enable(dev);
4710 4711 4712 4713 4714 4715 4716
		nv_enable_irq(dev);
	}
	return 0;
exit:
	return -ENOMEM;
}

4717 4718 4719 4720 4721 4722 4723 4724 4725 4726 4727 4728 4729 4730 4731 4732
static void nv_get_pauseparam(struct net_device *dev, struct ethtool_pauseparam* pause)
{
	struct fe_priv *np = netdev_priv(dev);

	pause->autoneg = (np->pause_flags & NV_PAUSEFRAME_AUTONEG) != 0;
	pause->rx_pause = (np->pause_flags & NV_PAUSEFRAME_RX_ENABLE) != 0;
	pause->tx_pause = (np->pause_flags & NV_PAUSEFRAME_TX_ENABLE) != 0;
}

static int nv_set_pauseparam(struct net_device *dev, struct ethtool_pauseparam* pause)
{
	struct fe_priv *np = netdev_priv(dev);
	int adv, bmcr;

	if ((!np->autoneg && np->duplex == 0) ||
	    (np->autoneg && !pause->autoneg && np->duplex == 0)) {
4733
		netdev_info(dev, "can not set pause settings when forced link is in half duplex\n");
4734 4735 4736
		return -EINVAL;
	}
	if (pause->tx_pause && !(np->pause_flags & NV_PAUSEFRAME_TX_CAPABLE)) {
4737
		netdev_info(dev, "hardware does not support tx pause frames\n");
4738 4739 4740 4741 4742 4743
		return -EINVAL;
	}

	netif_carrier_off(dev);
	if (netif_running(dev)) {
		nv_disable_irq(dev);
4744
		netif_tx_lock_bh(dev);
4745
		netif_addr_lock(dev);
4746 4747
		spin_lock(&np->lock);
		/* stop engines */
4748
		nv_stop_rxtx(dev);
4749
		spin_unlock(&np->lock);
4750
		netif_addr_unlock(dev);
4751
		netif_tx_unlock_bh(dev);
4752 4753 4754 4755 4756 4757 4758 4759 4760 4761 4762 4763 4764
	}

	np->pause_flags &= ~(NV_PAUSEFRAME_RX_REQ|NV_PAUSEFRAME_TX_REQ);
	if (pause->rx_pause)
		np->pause_flags |= NV_PAUSEFRAME_RX_REQ;
	if (pause->tx_pause)
		np->pause_flags |= NV_PAUSEFRAME_TX_REQ;

	if (np->autoneg && pause->autoneg) {
		np->pause_flags |= NV_PAUSEFRAME_AUTONEG;

		adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ);
		adv &= ~(ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
L
Lucas De Marchi 已提交
4765
		if (np->pause_flags & NV_PAUSEFRAME_RX_REQ) /* for rx we set both advertisements but disable tx pause */
4766 4767 4768 4769 4770 4771
			adv |=  ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
		if (np->pause_flags & NV_PAUSEFRAME_TX_REQ)
			adv |=  ADVERTISE_PAUSE_ASYM;
		mii_rw(dev, np->phyaddr, MII_ADVERTISE, adv);

		if (netif_running(dev))
4772
			netdev_info(dev, "link down\n");
4773 4774 4775 4776 4777 4778 4779 4780 4781 4782 4783 4784 4785 4786 4787 4788 4789
		bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
		bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
		mii_rw(dev, np->phyaddr, MII_BMCR, bmcr);
	} else {
		np->pause_flags &= ~(NV_PAUSEFRAME_AUTONEG|NV_PAUSEFRAME_RX_ENABLE|NV_PAUSEFRAME_TX_ENABLE);
		if (pause->rx_pause)
			np->pause_flags |= NV_PAUSEFRAME_RX_ENABLE;
		if (pause->tx_pause)
			np->pause_flags |= NV_PAUSEFRAME_TX_ENABLE;

		if (!netif_running(dev))
			nv_update_linkspeed(dev);
		else
			nv_update_pause(dev, np->pause_flags);
	}

	if (netif_running(dev)) {
4790
		nv_start_rxtx(dev);
4791 4792 4793 4794 4795
		nv_enable_irq(dev);
	}
	return 0;
}

4796
static int nv_set_loopback(struct net_device *dev, netdev_features_t features)
4797 4798 4799 4800 4801 4802 4803 4804 4805 4806 4807 4808 4809 4810 4811 4812 4813 4814 4815 4816 4817 4818 4819 4820 4821 4822 4823 4824 4825 4826 4827 4828 4829 4830 4831 4832 4833 4834 4835 4836 4837 4838 4839 4840 4841 4842 4843 4844 4845 4846 4847 4848 4849 4850
{
	struct fe_priv *np = netdev_priv(dev);
	unsigned long flags;
	u32 miicontrol;
	int err, retval = 0;

	spin_lock_irqsave(&np->lock, flags);
	miicontrol = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
	if (features & NETIF_F_LOOPBACK) {
		if (miicontrol & BMCR_LOOPBACK) {
			spin_unlock_irqrestore(&np->lock, flags);
			netdev_info(dev, "Loopback already enabled\n");
			return 0;
		}
		nv_disable_irq(dev);
		/* Turn on loopback mode */
		miicontrol |= BMCR_LOOPBACK | BMCR_FULLDPLX | BMCR_SPEED1000;
		err = mii_rw(dev, np->phyaddr, MII_BMCR, miicontrol);
		if (err) {
			retval = PHY_ERROR;
			spin_unlock_irqrestore(&np->lock, flags);
			phy_init(dev);
		} else {
			if (netif_running(dev)) {
				/* Force 1000 Mbps full-duplex */
				nv_force_linkspeed(dev, NVREG_LINKSPEED_1000,
									 1);
				/* Force link up */
				netif_carrier_on(dev);
			}
			spin_unlock_irqrestore(&np->lock, flags);
			netdev_info(dev,
				"Internal PHY loopback mode enabled.\n");
		}
	} else {
		if (!(miicontrol & BMCR_LOOPBACK)) {
			spin_unlock_irqrestore(&np->lock, flags);
			netdev_info(dev, "Loopback already disabled\n");
			return 0;
		}
		nv_disable_irq(dev);
		/* Turn off loopback */
		spin_unlock_irqrestore(&np->lock, flags);
		netdev_info(dev, "Internal PHY loopback mode disabled.\n");
		phy_init(dev);
	}
	msleep(500);
	spin_lock_irqsave(&np->lock, flags);
	nv_enable_irq(dev);
	spin_unlock_irqrestore(&np->lock, flags);

	return retval;
}

4851 4852
static netdev_features_t nv_fix_features(struct net_device *dev,
	netdev_features_t features)
A
Ayaz Abdulla 已提交
4853
{
4854
	/* vlan is dependent on rx checksum offload */
4855
	if (features & (NETIF_F_HW_VLAN_CTAG_TX|NETIF_F_HW_VLAN_CTAG_RX))
4856 4857 4858
		features |= NETIF_F_RXCSUM;

	return features;
A
Ayaz Abdulla 已提交
4859 4860
}

4861
static void nv_vlan_mode(struct net_device *dev, netdev_features_t features)
J
Jiri Pirko 已提交
4862 4863 4864 4865 4866
{
	struct fe_priv *np = get_nvpriv(dev);

	spin_lock_irq(&np->lock);

4867
	if (features & NETIF_F_HW_VLAN_CTAG_RX)
J
Jiri Pirko 已提交
4868 4869 4870 4871
		np->txrxctl_bits |= NVREG_TXRXCTL_VLANSTRIP;
	else
		np->txrxctl_bits &= ~NVREG_TXRXCTL_VLANSTRIP;

4872
	if (features & NETIF_F_HW_VLAN_CTAG_TX)
J
Jiri Pirko 已提交
4873 4874 4875 4876 4877 4878 4879 4880 4881
		np->txrxctl_bits |= NVREG_TXRXCTL_VLANINS;
	else
		np->txrxctl_bits &= ~NVREG_TXRXCTL_VLANINS;

	writel(np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);

	spin_unlock_irq(&np->lock);
}

4882
static int nv_set_features(struct net_device *dev, netdev_features_t features)
A
Ayaz Abdulla 已提交
4883 4884 4885
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
4886
	netdev_features_t changed = dev->features ^ features;
4887 4888 4889 4890 4891 4892 4893
	int retval;

	if ((changed & NETIF_F_LOOPBACK) && netif_running(dev)) {
		retval = nv_set_loopback(dev, features);
		if (retval != 0)
			return retval;
	}
A
Ayaz Abdulla 已提交
4894

4895 4896
	if (changed & NETIF_F_RXCSUM) {
		spin_lock_irq(&np->lock);
A
Ayaz Abdulla 已提交
4897

4898 4899 4900 4901
		if (features & NETIF_F_RXCSUM)
			np->txrxctl_bits |= NVREG_TXRXCTL_RXCHECK;
		else
			np->txrxctl_bits &= ~NVREG_TXRXCTL_RXCHECK;
A
Ayaz Abdulla 已提交
4902

4903 4904
		if (netif_running(dev))
			writel(np->txrxctl_bits, base + NvRegTxRxControl);
A
Ayaz Abdulla 已提交
4905

4906 4907
		spin_unlock_irq(&np->lock);
	}
A
Ayaz Abdulla 已提交
4908

4909
	if (changed & (NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX))
J
Jiri Pirko 已提交
4910 4911
		nv_vlan_mode(dev, features);

4912
	return 0;
A
Ayaz Abdulla 已提交
4913 4914
}

4915
static int nv_get_sset_count(struct net_device *dev, int sset)
4916 4917 4918
{
	struct fe_priv *np = netdev_priv(dev);

4919 4920 4921 4922 4923 4924 4925
	switch (sset) {
	case ETH_SS_TEST:
		if (np->driver_data & DEV_HAS_TEST_EXTENDED)
			return NV_TEST_COUNT_EXTENDED;
		else
			return NV_TEST_COUNT_BASE;
	case ETH_SS_STATS:
4926 4927
		if (np->driver_data & DEV_HAS_STATISTICS_V3)
			return NV_DEV_STATISTICS_V3_COUNT;
4928 4929
		else if (np->driver_data & DEV_HAS_STATISTICS_V2)
			return NV_DEV_STATISTICS_V2_COUNT;
4930 4931
		else if (np->driver_data & DEV_HAS_STATISTICS_V1)
			return NV_DEV_STATISTICS_V1_COUNT;
4932 4933 4934 4935 4936
		else
			return 0;
	default:
		return -EOPNOTSUPP;
	}
4937 4938
}

4939 4940 4941 4942
static void nv_get_ethtool_stats(struct net_device *dev,
				 struct ethtool_stats *estats, u64 *buffer)
	__acquires(&netdev_priv(dev)->hwstats_lock)
	__releases(&netdev_priv(dev)->hwstats_lock)
4943 4944 4945
{
	struct fe_priv *np = netdev_priv(dev);

4946 4947 4948 4949 4950
	spin_lock_bh(&np->hwstats_lock);
	nv_update_stats(dev);
	memcpy(buffer, &np->estats,
	       nv_get_sset_count(dev, ETH_SS_STATS)*sizeof(u64));
	spin_unlock_bh(&np->hwstats_lock);
4951 4952 4953 4954 4955 4956 4957 4958 4959 4960 4961 4962 4963 4964 4965 4966 4967 4968 4969 4970 4971 4972 4973 4974 4975 4976 4977 4978 4979 4980 4981 4982 4983 4984 4985 4986 4987 4988 4989 4990 4991 4992 4993 4994 4995 4996 4997 4998 4999 5000 5001 5002 5003 5004 5005 5006 5007 5008 5009 5010 5011 5012 5013 5014 5015 5016 5017 5018 5019 5020 5021 5022 5023 5024 5025 5026 5027 5028 5029 5030 5031 5032 5033 5034 5035 5036 5037 5038 5039 5040 5041 5042 5043 5044 5045 5046 5047 5048 5049 5050 5051 5052 5053 5054 5055 5056 5057 5058 5059 5060 5061 5062 5063 5064 5065
}

static int nv_link_test(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);
	int mii_status;

	mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
	mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);

	/* check phy link status */
	if (!(mii_status & BMSR_LSTATUS))
		return 0;
	else
		return 1;
}

static int nv_register_test(struct net_device *dev)
{
	u8 __iomem *base = get_hwbase(dev);
	int i = 0;
	u32 orig_read, new_read;

	do {
		orig_read = readl(base + nv_registers_test[i].reg);

		/* xor with mask to toggle bits */
		orig_read ^= nv_registers_test[i].mask;

		writel(orig_read, base + nv_registers_test[i].reg);

		new_read = readl(base + nv_registers_test[i].reg);

		if ((new_read & nv_registers_test[i].mask) != (orig_read & nv_registers_test[i].mask))
			return 0;

		/* restore original value */
		orig_read ^= nv_registers_test[i].mask;
		writel(orig_read, base + nv_registers_test[i].reg);

	} while (nv_registers_test[++i].reg != 0);

	return 1;
}

static int nv_interrupt_test(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
	int ret = 1;
	int testcnt;
	u32 save_msi_flags, save_poll_interval = 0;

	if (netif_running(dev)) {
		/* free current irq */
		nv_free_irq(dev);
		save_poll_interval = readl(base+NvRegPollingInterval);
	}

	/* flag to test interrupt handler */
	np->intr_test = 0;

	/* setup test irq */
	save_msi_flags = np->msi_flags;
	np->msi_flags &= ~NV_MSI_X_VECTORS_MASK;
	np->msi_flags |= 0x001; /* setup 1 vector */
	if (nv_request_irq(dev, 1))
		return 0;

	/* setup timer interrupt */
	writel(NVREG_POLL_DEFAULT_CPU, base + NvRegPollingInterval);
	writel(NVREG_UNKSETUP6_VAL, base + NvRegUnknownSetupReg6);

	nv_enable_hw_interrupts(dev, NVREG_IRQ_TIMER);

	/* wait for at least one interrupt */
	msleep(100);

	spin_lock_irq(&np->lock);

	/* flag should be set within ISR */
	testcnt = np->intr_test;
	if (!testcnt)
		ret = 2;

	nv_disable_hw_interrupts(dev, NVREG_IRQ_TIMER);
	if (!(np->msi_flags & NV_MSI_X_ENABLED))
		writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
	else
		writel(NVREG_IRQSTAT_MASK, base + NvRegMSIXIrqStatus);

	spin_unlock_irq(&np->lock);

	nv_free_irq(dev);

	np->msi_flags = save_msi_flags;

	if (netif_running(dev)) {
		writel(save_poll_interval, base + NvRegPollingInterval);
		writel(NVREG_UNKSETUP6_VAL, base + NvRegUnknownSetupReg6);
		/* restore original irq */
		if (nv_request_irq(dev, 0))
			return 0;
	}

	return ret;
}

static int nv_loopback_test(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
	struct sk_buff *tx_skb, *rx_skb;
	dma_addr_t test_dma_addr;
	u32 tx_flags_extra = (np->desc_ver == DESC_VER_1 ? NV_TX_LASTPACKET : NV_TX2_LASTPACKET);
5066
	u32 flags;
5067 5068 5069 5070 5071 5072 5073 5074 5075 5076 5077 5078 5079 5080 5081 5082 5083 5084 5085 5086 5087 5088 5089 5090 5091
	int len, i, pkt_len;
	u8 *pkt_data;
	u32 filter_flags = 0;
	u32 misc1_flags = 0;
	int ret = 1;

	if (netif_running(dev)) {
		nv_disable_irq(dev);
		filter_flags = readl(base + NvRegPacketFilterFlags);
		misc1_flags = readl(base + NvRegMisc1);
	} else {
		nv_txrx_reset(dev);
	}

	/* reinit driver view of the rx queue */
	set_bufsize(dev);
	nv_init_ring(dev);

	/* setup hardware for loopback */
	writel(NVREG_MISC1_FORCE, base + NvRegMisc1);
	writel(NVREG_PFF_ALWAYS | NVREG_PFF_LOOPBACK, base + NvRegPacketFilterFlags);

	/* reinit nic view of the rx queue */
	writel(np->rx_buf_sz, base + NvRegOffloadConfig);
	setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
5092
	writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
5093 5094 5095 5096
		base + NvRegRingSizes);
	pci_push(base);

	/* restart rx engine */
5097
	nv_start_rxtx(dev);
5098 5099 5100

	/* setup packet for tx */
	pkt_len = ETH_DATA_LEN;
5101
	tx_skb = netdev_alloc_skb(dev, pkt_len);
5102 5103 5104 5105
	if (!tx_skb) {
		ret = 0;
		goto out;
	}
5106
	test_dma_addr = dma_map_single(&np->pci_dev->dev, tx_skb->data,
5107
				       skb_tailroom(tx_skb),
5108
				       DMA_FROM_DEVICE);
5109 5110
	if (unlikely(dma_mapping_error(&np->pci_dev->dev,
				       test_dma_addr))) {
5111 5112 5113
		dev_kfree_skb_any(tx_skb);
		goto out;
	}
5114 5115 5116 5117
	pkt_data = skb_put(tx_skb, pkt_len);
	for (i = 0; i < pkt_len; i++)
		pkt_data[i] = (u8)(i & 0xff);

5118
	if (!nv_optimized(np)) {
5119 5120
		np->tx_ring.orig[0].buf = cpu_to_le32(test_dma_addr);
		np->tx_ring.orig[0].flaglen = cpu_to_le32((pkt_len-1) | np->tx_flags | tx_flags_extra);
5121
	} else {
A
Al Viro 已提交
5122 5123
		np->tx_ring.ex[0].bufhigh = cpu_to_le32(dma_high(test_dma_addr));
		np->tx_ring.ex[0].buflow = cpu_to_le32(dma_low(test_dma_addr));
5124
		np->tx_ring.ex[0].flaglen = cpu_to_le32((pkt_len-1) | np->tx_flags | tx_flags_extra);
5125 5126 5127 5128 5129 5130 5131
	}
	writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
	pci_push(get_hwbase(dev));

	msleep(500);

	/* check for rx of the packet */
5132
	if (!nv_optimized(np)) {
5133
		flags = le32_to_cpu(np->rx_ring.orig[0].flaglen);
5134 5135 5136
		len = nv_descr_getlength(&np->rx_ring.orig[0], np->desc_ver);

	} else {
5137
		flags = le32_to_cpu(np->rx_ring.ex[0].flaglen);
5138 5139 5140
		len = nv_descr_getlength_ex(&np->rx_ring.ex[0], np->desc_ver);
	}

5141
	if (flags & NV_RX_AVAIL) {
5142 5143
		ret = 0;
	} else if (np->desc_ver == DESC_VER_1) {
5144
		if (flags & NV_RX_ERROR)
5145 5146
			ret = 0;
	} else {
5147
		if (flags & NV_RX2_ERROR)
5148 5149 5150 5151 5152 5153 5154
			ret = 0;
	}

	if (ret) {
		if (len != pkt_len) {
			ret = 0;
		} else {
A
Ayaz Abdulla 已提交
5155
			rx_skb = np->rx_skb[0].skb;
5156 5157 5158 5159 5160 5161 5162 5163 5164
			for (i = 0; i < pkt_len; i++) {
				if (rx_skb->data[i] != (u8)(i & 0xff)) {
					ret = 0;
					break;
				}
			}
		}
	}

5165 5166 5167
	dma_unmap_single(&np->pci_dev->dev, test_dma_addr,
			 (skb_end_pointer(tx_skb) - tx_skb->data),
			 DMA_TO_DEVICE);
5168
	dev_kfree_skb_any(tx_skb);
5169
 out:
5170
	/* stop engines */
5171
	nv_stop_rxtx(dev);
5172 5173
	nv_txrx_reset(dev);
	/* drain rx queue */
5174
	nv_drain_rxtx(dev);
5175 5176 5177 5178 5179 5180 5181 5182 5183 5184 5185 5186 5187 5188

	if (netif_running(dev)) {
		writel(misc1_flags, base + NvRegMisc1);
		writel(filter_flags, base + NvRegPacketFilterFlags);
		nv_enable_irq(dev);
	}

	return ret;
}

static void nv_self_test(struct net_device *dev, struct ethtool_test *test, u64 *buffer)
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
5189 5190 5191 5192
	int result, count;

	count = nv_get_sset_count(dev, ETH_SS_TEST);
	memset(buffer, 0, count * sizeof(u64));
5193 5194 5195 5196 5197 5198 5199 5200 5201

	if (!nv_link_test(dev)) {
		test->flags |= ETH_TEST_FL_FAILED;
		buffer[0] = 1;
	}

	if (test->flags & ETH_TEST_FL_OFFLINE) {
		if (netif_running(dev)) {
			netif_stop_queue(dev);
5202
			nv_napi_disable(dev);
5203
			netif_tx_lock_bh(dev);
5204
			netif_addr_lock(dev);
5205 5206
			spin_lock_irq(&np->lock);
			nv_disable_hw_interrupts(dev, np->irqmask);
5207
			if (!(np->msi_flags & NV_MSI_X_ENABLED))
5208
				writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
5209
			else
5210 5211
				writel(NVREG_IRQSTAT_MASK, base + NvRegMSIXIrqStatus);
			/* stop engines */
5212
			nv_stop_rxtx(dev);
5213 5214
			nv_txrx_reset(dev);
			/* drain rx queue */
5215
			nv_drain_rxtx(dev);
5216
			spin_unlock_irq(&np->lock);
5217
			netif_addr_unlock(dev);
5218
			netif_tx_unlock_bh(dev);
5219 5220 5221 5222 5223 5224 5225 5226 5227 5228 5229 5230 5231 5232 5233 5234 5235
		}

		if (!nv_register_test(dev)) {
			test->flags |= ETH_TEST_FL_FAILED;
			buffer[1] = 1;
		}

		result = nv_interrupt_test(dev);
		if (result != 1) {
			test->flags |= ETH_TEST_FL_FAILED;
			buffer[2] = 1;
		}
		if (result == 0) {
			/* bail out */
			return;
		}

5236
		if (count > NV_TEST_COUNT_BASE && !nv_loopback_test(dev)) {
5237 5238 5239 5240 5241 5242 5243 5244 5245 5246 5247 5248 5249 5250
			test->flags |= ETH_TEST_FL_FAILED;
			buffer[3] = 1;
		}

		if (netif_running(dev)) {
			/* reinit driver view of the rx queue */
			set_bufsize(dev);
			if (nv_init_ring(dev)) {
				if (!np->in_shutdown)
					mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
			}
			/* reinit nic view of the rx queue */
			writel(np->rx_buf_sz, base + NvRegOffloadConfig);
			setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
5251
			writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
5252 5253 5254 5255 5256
				base + NvRegRingSizes);
			pci_push(base);
			writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl);
			pci_push(base);
			/* restart rx engine */
5257
			nv_start_rxtx(dev);
5258
			netif_start_queue(dev);
5259
			nv_napi_enable(dev);
5260 5261 5262 5263 5264
			nv_enable_hw_interrupts(dev, np->irqmask);
		}
	}
}

5265 5266 5267 5268
static void nv_get_strings(struct net_device *dev, u32 stringset, u8 *buffer)
{
	switch (stringset) {
	case ETH_SS_STATS:
5269
		memcpy(buffer, &nv_estats_str, nv_get_sset_count(dev, ETH_SS_STATS)*sizeof(struct nv_ethtool_str));
5270
		break;
5271
	case ETH_SS_TEST:
5272
		memcpy(buffer, &nv_etests_str, nv_get_sset_count(dev, ETH_SS_TEST)*sizeof(struct nv_ethtool_str));
5273
		break;
5274 5275 5276
	}
}

5277
static const struct ethtool_ops ops = {
L
Linus Torvalds 已提交
5278 5279 5280 5281
	.get_drvinfo = nv_get_drvinfo,
	.get_link = ethtool_op_get_link,
	.get_wol = nv_get_wol,
	.set_wol = nv_set_wol,
5282 5283 5284
	.get_regs_len = nv_get_regs_len,
	.get_regs = nv_get_regs,
	.nway_reset = nv_nway_reset,
5285 5286
	.get_ringparam = nv_get_ringparam,
	.set_ringparam = nv_set_ringparam,
5287 5288
	.get_pauseparam = nv_get_pauseparam,
	.set_pauseparam = nv_set_pauseparam,
5289 5290
	.get_strings = nv_get_strings,
	.get_ethtool_stats = nv_get_ethtool_stats,
5291
	.get_sset_count = nv_get_sset_count,
5292
	.self_test = nv_self_test,
5293
	.get_ts_info = ethtool_op_get_ts_info,
5294 5295
	.get_link_ksettings = nv_get_link_ksettings,
	.set_link_ksettings = nv_set_link_ksettings,
L
Linus Torvalds 已提交
5296 5297
};

5298 5299 5300
/* The mgmt unit and driver use a semaphore to access the phy during init */
static int nv_mgmt_acquire_sema(struct net_device *dev)
{
A
Ayaz Abdulla 已提交
5301
	struct fe_priv *np = netdev_priv(dev);
5302 5303 5304 5305 5306 5307 5308 5309 5310 5311 5312 5313 5314 5315 5316 5317 5318 5319 5320 5321 5322 5323
	u8 __iomem *base = get_hwbase(dev);
	int i;
	u32 tx_ctrl, mgmt_sema;

	for (i = 0; i < 10; i++) {
		mgmt_sema = readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_MGMT_SEMA_MASK;
		if (mgmt_sema == NVREG_XMITCTL_MGMT_SEMA_FREE)
			break;
		msleep(500);
	}

	if (mgmt_sema != NVREG_XMITCTL_MGMT_SEMA_FREE)
		return 0;

	for (i = 0; i < 2; i++) {
		tx_ctrl = readl(base + NvRegTransmitterControl);
		tx_ctrl |= NVREG_XMITCTL_HOST_SEMA_ACQ;
		writel(tx_ctrl, base + NvRegTransmitterControl);

		/* verify that semaphore was acquired */
		tx_ctrl = readl(base + NvRegTransmitterControl);
		if (((tx_ctrl & NVREG_XMITCTL_HOST_SEMA_MASK) == NVREG_XMITCTL_HOST_SEMA_ACQ) &&
A
Ayaz Abdulla 已提交
5324 5325
		    ((tx_ctrl & NVREG_XMITCTL_MGMT_SEMA_MASK) == NVREG_XMITCTL_MGMT_SEMA_FREE)) {
			np->mgmt_sema = 1;
5326
			return 1;
5327
		} else
5328 5329 5330 5331 5332 5333
			udelay(50);
	}

	return 0;
}

A
Ayaz Abdulla 已提交
5334 5335 5336 5337 5338 5339 5340 5341 5342 5343 5344 5345 5346 5347 5348 5349 5350 5351 5352 5353 5354 5355 5356 5357 5358 5359 5360 5361 5362 5363 5364 5365 5366 5367 5368 5369 5370 5371 5372 5373 5374 5375 5376 5377 5378
static void nv_mgmt_release_sema(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
	u32 tx_ctrl;

	if (np->driver_data & DEV_HAS_MGMT_UNIT) {
		if (np->mgmt_sema) {
			tx_ctrl = readl(base + NvRegTransmitterControl);
			tx_ctrl &= ~NVREG_XMITCTL_HOST_SEMA_ACQ;
			writel(tx_ctrl, base + NvRegTransmitterControl);
		}
	}
}


static int nv_mgmt_get_version(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
	u32 data_ready = readl(base + NvRegTransmitterControl);
	u32 data_ready2 = 0;
	unsigned long start;
	int ready = 0;

	writel(NVREG_MGMTUNITGETVERSION, base + NvRegMgmtUnitGetVersion);
	writel(data_ready ^ NVREG_XMITCTL_DATA_START, base + NvRegTransmitterControl);
	start = jiffies;
	while (time_before(jiffies, start + 5*HZ)) {
		data_ready2 = readl(base + NvRegTransmitterControl);
		if ((data_ready & NVREG_XMITCTL_DATA_READY) != (data_ready2 & NVREG_XMITCTL_DATA_READY)) {
			ready = 1;
			break;
		}
		schedule_timeout_uninterruptible(1);
	}

	if (!ready || (data_ready2 & NVREG_XMITCTL_DATA_ERROR))
		return 0;

	np->mgmt_version = readl(base + NvRegMgmtUnitVersion) & NVREG_MGMTUNITVERSION;

	return 1;
}

L
Linus Torvalds 已提交
5379 5380
static int nv_open(struct net_device *dev)
{
5381
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
5382
	u8 __iomem *base = get_hwbase(dev);
5383 5384
	int ret = 1;
	int oom, i;
5385
	u32 low;
L
Linus Torvalds 已提交
5386

5387 5388 5389 5390
	/* power up phy */
	mii_rw(dev, np->phyaddr, MII_BMCR,
	       mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ) & ~BMCR_PDOWN);

5391
	nv_txrx_gate(dev, false);
5392
	/* erase previous misconfiguration */
5393 5394
	if (np->driver_data & DEV_HAS_POWER_CNTRL)
		nv_mac_reset(dev);
L
Linus Torvalds 已提交
5395 5396
	writel(NVREG_MCASTADDRA_FORCE, base + NvRegMulticastAddrA);
	writel(0, base + NvRegMulticastAddrB);
A
Ayaz Abdulla 已提交
5397 5398
	writel(NVREG_MCASTMASKA_NONE, base + NvRegMulticastMaskA);
	writel(NVREG_MCASTMASKB_NONE, base + NvRegMulticastMaskB);
L
Linus Torvalds 已提交
5399 5400 5401 5402 5403 5404 5405
	writel(0, base + NvRegPacketFilterFlags);

	writel(0, base + NvRegTransmitterControl);
	writel(0, base + NvRegReceiverControl);

	writel(0, base + NvRegAdapterControl);

5406 5407 5408
	if (np->pause_flags & NV_PAUSEFRAME_TX_CAPABLE)
		writel(NVREG_TX_PAUSEFRAME_DISABLE,  base + NvRegTxPauseFrame);

5409
	/* initialize descriptor rings */
5410
	set_bufsize(dev);
L
Linus Torvalds 已提交
5411 5412 5413
	oom = nv_init_ring(dev);

	writel(0, base + NvRegLinkSpeed);
5414
	writel(readl(base + NvRegTransmitPoll) & NVREG_TRANSMITPOLL_MAC_ADDR_REV, base + NvRegTransmitPoll);
L
Linus Torvalds 已提交
5415 5416 5417 5418 5419
	nv_txrx_reset(dev);
	writel(0, base + NvRegUnknownSetupReg6);

	np->in_shutdown = 0;

5420
	/* give hw rings */
5421
	setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING);
5422
	writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT),
L
Linus Torvalds 已提交
5423 5424 5425
		base + NvRegRingSizes);

	writel(np->linkspeed, base + NvRegLinkSpeed);
5426 5427 5428 5429
	if (np->desc_ver == DESC_VER_1)
		writel(NVREG_TX_WM_DESC1_DEFAULT, base + NvRegTxWatermark);
	else
		writel(NVREG_TX_WM_DESC2_3_DEFAULT, base + NvRegTxWatermark);
5430
	writel(np->txrxctl_bits, base + NvRegTxRxControl);
5431
	writel(np->vlanctl_bits, base + NvRegVlanControl);
L
Linus Torvalds 已提交
5432
	pci_push(base);
5433
	writel(NVREG_TXRXCTL_BIT1|np->txrxctl_bits, base + NvRegTxRxControl);
5434 5435 5436
	if (reg_delay(dev, NvRegUnknownSetupReg5,
		      NVREG_UNKSETUP5_BIT31, NVREG_UNKSETUP5_BIT31,
		      NV_SETUP5_DELAY, NV_SETUP5_DELAYMAX))
5437 5438
		netdev_info(dev,
			    "%s: SetupReg5, Bit 31 remained off\n", __func__);
L
Linus Torvalds 已提交
5439

5440
	writel(0, base + NvRegMIIMask);
L
Linus Torvalds 已提交
5441
	writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
A
Ayaz Abdulla 已提交
5442
	writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus);
L
Linus Torvalds 已提交
5443 5444 5445 5446

	writel(NVREG_MISC1_FORCE | NVREG_MISC1_HD, base + NvRegMisc1);
	writel(readl(base + NvRegTransmitterStatus), base + NvRegTransmitterStatus);
	writel(NVREG_PFF_ALWAYS, base + NvRegPacketFilterFlags);
5447
	writel(np->rx_buf_sz, base + NvRegOffloadConfig);
L
Linus Torvalds 已提交
5448 5449

	writel(readl(base + NvRegReceiverStatus), base + NvRegReceiverStatus);
5450 5451 5452 5453 5454 5455 5456 5457 5458 5459 5460 5461 5462 5463

	get_random_bytes(&low, sizeof(low));
	low &= NVREG_SLOTTIME_MASK;
	if (np->desc_ver == DESC_VER_1) {
		writel(low|NVREG_SLOTTIME_DEFAULT, base + NvRegSlotTime);
	} else {
		if (!(np->driver_data & DEV_HAS_GEAR_MODE)) {
			/* setup legacy backoff */
			writel(NVREG_SLOTTIME_LEGBF_ENABLED|NVREG_SLOTTIME_10_100_FULL|low, base + NvRegSlotTime);
		} else {
			writel(NVREG_SLOTTIME_10_100_FULL, base + NvRegSlotTime);
			nv_gear_backoff_reseed(dev);
		}
	}
A
Ayaz Abdulla 已提交
5464 5465
	writel(NVREG_TX_DEFERRAL_DEFAULT, base + NvRegTxDeferral);
	writel(NVREG_RX_DEFERRAL_DEFAULT, base + NvRegRxDeferral);
5466 5467 5468 5469 5470
	if (poll_interval == -1) {
		if (optimization_mode == NV_OPTIMIZATION_MODE_THROUGHPUT)
			writel(NVREG_POLL_DEFAULT_THROUGHPUT, base + NvRegPollingInterval);
		else
			writel(NVREG_POLL_DEFAULT_CPU, base + NvRegPollingInterval);
5471
	} else
5472
		writel(poll_interval & 0xFFFF, base + NvRegPollingInterval);
L
Linus Torvalds 已提交
5473 5474 5475 5476
	writel(NVREG_UNKSETUP6_VAL, base + NvRegUnknownSetupReg6);
	writel((np->phyaddr << NVREG_ADAPTCTL_PHYSHIFT)|NVREG_ADAPTCTL_PHYVALID|NVREG_ADAPTCTL_RUNNING,
			base + NvRegAdapterControl);
	writel(NVREG_MIISPEED_BIT8|NVREG_MIIDELAY, base + NvRegMIISpeed);
5477
	writel(NVREG_MII_LINKCHANGE, base + NvRegMIIMask);
A
Ayaz Abdulla 已提交
5478 5479
	if (np->wolenabled)
		writel(NVREG_WAKEUPFLAGS_ENABLE , base + NvRegWakeUpFlags);
L
Linus Torvalds 已提交
5480 5481

	i = readl(base + NvRegPowerState);
5482
	if ((i & NVREG_POWERSTATE_POWEREDUP) == 0)
L
Linus Torvalds 已提交
5483 5484 5485 5486 5487 5488
		writel(NVREG_POWERSTATE_POWEREDUP|i, base + NvRegPowerState);

	pci_push(base);
	udelay(10);
	writel(readl(base + NvRegPowerState) | NVREG_POWERSTATE_VALID, base + NvRegPowerState);

5489
	nv_disable_hw_interrupts(dev, np->irqmask);
L
Linus Torvalds 已提交
5490
	pci_push(base);
A
Ayaz Abdulla 已提交
5491
	writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus);
L
Linus Torvalds 已提交
5492 5493 5494
	writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus);
	pci_push(base);

5495
	if (nv_request_irq(dev, 0))
5496
		goto out_drain;
L
Linus Torvalds 已提交
5497 5498

	/* ask for interrupts */
5499
	nv_enable_hw_interrupts(dev, np->irqmask);
L
Linus Torvalds 已提交
5500 5501 5502 5503

	spin_lock_irq(&np->lock);
	writel(NVREG_MCASTADDRA_FORCE, base + NvRegMulticastAddrA);
	writel(0, base + NvRegMulticastAddrB);
A
Ayaz Abdulla 已提交
5504 5505
	writel(NVREG_MCASTMASKA_NONE, base + NvRegMulticastMaskA);
	writel(NVREG_MCASTMASKB_NONE, base + NvRegMulticastMaskB);
L
Linus Torvalds 已提交
5506 5507 5508 5509 5510 5511 5512
	writel(NVREG_PFF_ALWAYS|NVREG_PFF_MYADDR, base + NvRegPacketFilterFlags);
	/* One manual link speed update: Interrupts are enabled, future link
	 * speed changes cause interrupts and are handled by nv_link_irq().
	 */
	{
		u32 miistat;
		miistat = readl(base + NvRegMIIStatus);
A
Ayaz Abdulla 已提交
5513
		writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus);
L
Linus Torvalds 已提交
5514
	}
5515 5516 5517
	/* set linkspeed to invalid value, thus force nv_update_linkspeed
	 * to init hw */
	np->linkspeed = 0;
L
Linus Torvalds 已提交
5518
	ret = nv_update_linkspeed(dev);
5519
	nv_start_rxtx(dev);
L
Linus Torvalds 已提交
5520
	netif_start_queue(dev);
5521
	nv_napi_enable(dev);
5522

L
Linus Torvalds 已提交
5523 5524 5525
	if (ret) {
		netif_carrier_on(dev);
	} else {
5526
		netdev_info(dev, "no link during initialization\n");
L
Linus Torvalds 已提交
5527 5528 5529 5530
		netif_carrier_off(dev);
	}
	if (oom)
		mod_timer(&np->oom_kick, jiffies + OOM_REFILL);
5531 5532

	/* start statistics timer */
5533
	if (np->driver_data & (DEV_HAS_STATISTICS_V1|DEV_HAS_STATISTICS_V2|DEV_HAS_STATISTICS_V3))
5534 5535
		mod_timer(&np->stats_poll,
			round_jiffies(jiffies + STATS_INTERVAL));
5536

L
Linus Torvalds 已提交
5537 5538
	spin_unlock_irq(&np->lock);

5539 5540 5541 5542 5543 5544
	/* If the loopback feature was set while the device was down, make sure
	 * that it's set correctly now.
	 */
	if (dev->features & NETIF_F_LOOPBACK)
		nv_set_loopback(dev, dev->features);

L
Linus Torvalds 已提交
5545 5546
	return 0;
out_drain:
5547
	nv_drain_rxtx(dev);
L
Linus Torvalds 已提交
5548 5549 5550 5551 5552
	return ret;
}

static int nv_close(struct net_device *dev)
{
5553
	struct fe_priv *np = netdev_priv(dev);
L
Linus Torvalds 已提交
5554 5555 5556 5557 5558
	u8 __iomem *base;

	spin_lock_irq(&np->lock);
	np->in_shutdown = 1;
	spin_unlock_irq(&np->lock);
5559
	nv_napi_disable(dev);
M
Manfred Spraul 已提交
5560
	synchronize_irq(np->pci_dev->irq);
L
Linus Torvalds 已提交
5561 5562 5563

	del_timer_sync(&np->oom_kick);
	del_timer_sync(&np->nic_poll);
5564
	del_timer_sync(&np->stats_poll);
L
Linus Torvalds 已提交
5565 5566 5567

	netif_stop_queue(dev);
	spin_lock_irq(&np->lock);
5568
	nv_update_pause(dev, 0); /* otherwise stop_tx bricks NIC */
5569
	nv_stop_rxtx(dev);
L
Linus Torvalds 已提交
5570 5571 5572 5573
	nv_txrx_reset(dev);

	/* disable interrupts on the nic or we will lock up */
	base = get_hwbase(dev);
5574
	nv_disable_hw_interrupts(dev, np->irqmask);
L
Linus Torvalds 已提交
5575 5576 5577 5578
	pci_push(base);

	spin_unlock_irq(&np->lock);

5579
	nv_free_irq(dev);
L
Linus Torvalds 已提交
5580

5581
	nv_drain_rxtx(dev);
L
Linus Torvalds 已提交
5582

5583
	if (np->wolenabled || !phy_power_down) {
5584
		nv_txrx_gate(dev, false);
5585
		writel(NVREG_PFF_ALWAYS|NVREG_PFF_MYADDR, base + NvRegPacketFilterFlags);
L
Linus Torvalds 已提交
5586
		nv_start_rx(dev);
5587 5588 5589 5590
	} else {
		/* power down phy */
		mii_rw(dev, np->phyaddr, MII_BMCR,
		       mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ)|BMCR_PDOWN);
5591
		nv_txrx_gate(dev, true);
5592
	}
L
Linus Torvalds 已提交
5593 5594 5595 5596 5597 5598

	/* FIXME: power down nic */

	return 0;
}

5599 5600 5601
static const struct net_device_ops nv_netdev_ops = {
	.ndo_open		= nv_open,
	.ndo_stop		= nv_close,
5602
	.ndo_get_stats64	= nv_get_stats64,
5603 5604 5605
	.ndo_start_xmit		= nv_start_xmit,
	.ndo_tx_timeout		= nv_tx_timeout,
	.ndo_change_mtu		= nv_change_mtu,
5606 5607
	.ndo_fix_features	= nv_fix_features,
	.ndo_set_features	= nv_set_features,
5608 5609
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_set_mac_address	= nv_set_mac_address,
5610
	.ndo_set_rx_mode	= nv_set_multicast,
5611 5612 5613 5614 5615 5616 5617 5618
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= nv_poll_controller,
#endif
};

static const struct net_device_ops nv_netdev_ops_optimized = {
	.ndo_open		= nv_open,
	.ndo_stop		= nv_close,
5619
	.ndo_get_stats64	= nv_get_stats64,
5620
	.ndo_start_xmit		= nv_start_xmit_optimized,
5621 5622
	.ndo_tx_timeout		= nv_tx_timeout,
	.ndo_change_mtu		= nv_change_mtu,
5623 5624
	.ndo_fix_features	= nv_fix_features,
	.ndo_set_features	= nv_set_features,
5625 5626
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_set_mac_address	= nv_set_mac_address,
5627
	.ndo_set_rx_mode	= nv_set_multicast,
5628 5629 5630 5631 5632
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= nv_poll_controller,
#endif
};

5633
static int nv_probe(struct pci_dev *pci_dev, const struct pci_device_id *id)
L
Linus Torvalds 已提交
5634 5635 5636 5637 5638 5639
{
	struct net_device *dev;
	struct fe_priv *np;
	unsigned long addr;
	u8 __iomem *base;
	int err, i;
5640
	u32 powerstate, txreg;
5641 5642
	u32 phystate_orig = 0, phystate;
	int phyinitialized = 0;
5643 5644 5645
	static int printed_version;

	if (!printed_version++)
J
Joe Perches 已提交
5646 5647
		pr_info("Reverse Engineered nForce ethernet driver. Version %s.\n",
			FORCEDETH_VERSION);
L
Linus Torvalds 已提交
5648 5649 5650 5651 5652 5653

	dev = alloc_etherdev(sizeof(struct fe_priv));
	err = -ENOMEM;
	if (!dev)
		goto out;

5654
	np = netdev_priv(dev);
5655
	np->dev = dev;
L
Linus Torvalds 已提交
5656 5657
	np->pci_dev = pci_dev;
	spin_lock_init(&np->lock);
5658
	spin_lock_init(&np->hwstats_lock);
L
Linus Torvalds 已提交
5659
	SET_NETDEV_DEV(dev, &pci_dev->dev);
5660 5661
	u64_stats_init(&np->swstats_rx_syncp);
	u64_stats_init(&np->swstats_tx_syncp);
L
Linus Torvalds 已提交
5662

5663 5664 5665
	timer_setup(&np->oom_kick, nv_do_rx_refill, 0);
	timer_setup(&np->nic_poll, nv_do_nic_poll, 0);
	timer_setup(&np->stats_poll, nv_do_stats_poll, TIMER_DEFERRABLE);
L
Linus Torvalds 已提交
5666 5667

	err = pci_enable_device(pci_dev);
5668
	if (err)
L
Linus Torvalds 已提交
5669 5670 5671 5672 5673 5674 5675 5676
		goto out_free;

	pci_set_master(pci_dev);

	err = pci_request_regions(pci_dev, DRV_NAME);
	if (err < 0)
		goto out_disable;

5677
	if (id->driver_data & (DEV_HAS_VLAN|DEV_HAS_MSI_X|DEV_HAS_POWER_CNTRL|DEV_HAS_STATISTICS_V2|DEV_HAS_STATISTICS_V3))
A
Ayaz Abdulla 已提交
5678 5679
		np->register_size = NV_PCI_REGSZ_VER3;
	else if (id->driver_data & DEV_HAS_STATISTICS_V1)
5680 5681 5682 5683
		np->register_size = NV_PCI_REGSZ_VER2;
	else
		np->register_size = NV_PCI_REGSZ_VER1;

L
Linus Torvalds 已提交
5684 5685 5686 5687
	err = -EINVAL;
	addr = 0;
	for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
		if (pci_resource_flags(pci_dev, i) & IORESOURCE_MEM &&
5688
				pci_resource_len(pci_dev, i) >= np->register_size) {
L
Linus Torvalds 已提交
5689 5690 5691 5692 5693
			addr = pci_resource_start(pci_dev, i);
			break;
		}
	}
	if (i == DEVICE_COUNT_RESOURCE) {
5694
		dev_info(&pci_dev->dev, "Couldn't find register window\n");
L
Linus Torvalds 已提交
5695 5696 5697
		goto out_relreg;
	}

5698 5699
	/* copy of driver data */
	np->driver_data = id->driver_data;
5700 5701
	/* copy of device id */
	np->device_id = id->device;
5702

L
Linus Torvalds 已提交
5703
	/* handle different descriptor versions */
5704 5705 5706
	if (id->driver_data & DEV_HAS_HIGH_DMA) {
		/* packet format 3: supports 40-bit addressing */
		np->desc_ver = DESC_VER_3;
5707
		np->txrxctl_bits = NVREG_TXRXCTL_DESC_3;
5708
		if (dma_64bit) {
5709
			if (pci_set_dma_mask(pci_dev, DMA_BIT_MASK(39)))
5710 5711
				dev_info(&pci_dev->dev,
					 "64-bit DMA failed, using 32-bit addressing\n");
5712
			else
5713
				dev->features |= NETIF_F_HIGHDMA;
5714
			if (pci_set_consistent_dma_mask(pci_dev, DMA_BIT_MASK(39))) {
5715 5716
				dev_info(&pci_dev->dev,
					 "64-bit DMA (consistent) failed, using 32-bit ring buffers\n");
5717
			}
5718 5719 5720
		}
	} else if (id->driver_data & DEV_HAS_LARGEDESC) {
		/* packet format 2: supports jumbo frames */
L
Linus Torvalds 已提交
5721
		np->desc_ver = DESC_VER_2;
5722
		np->txrxctl_bits = NVREG_TXRXCTL_DESC_2;
5723 5724 5725
	} else {
		/* original packet format */
		np->desc_ver = DESC_VER_1;
5726
		np->txrxctl_bits = NVREG_TXRXCTL_DESC_1;
5727
	}
5728 5729 5730 5731 5732

	np->pkt_limit = NV_PKTLIMIT_1;
	if (id->driver_data & DEV_HAS_LARGEDESC)
		np->pkt_limit = NV_PKTLIMIT_2;

5733 5734
	if (id->driver_data & DEV_HAS_CHECKSUM) {
		np->txrxctl_bits |= NVREG_TXRXCTL_RXCHECK;
5735 5736
		dev->hw_features |= NETIF_F_IP_CSUM | NETIF_F_SG |
			NETIF_F_TSO | NETIF_F_RXCSUM;
5737
	}
5738

5739 5740 5741
	np->vlanctl_bits = 0;
	if (id->driver_data & DEV_HAS_VLAN) {
		np->vlanctl_bits = NVREG_VLANCONTROL_ENABLE;
5742 5743
		dev->hw_features |= NETIF_F_HW_VLAN_CTAG_RX |
				    NETIF_F_HW_VLAN_CTAG_TX;
5744 5745
	}

J
Jiri Pirko 已提交
5746 5747
	dev->features |= dev->hw_features;

5748 5749 5750
	/* Add loopback capability to the device. */
	dev->hw_features |= NETIF_F_LOOPBACK;

5751 5752 5753 5754
	/* MTU range: 64 - 1500 or 9100 */
	dev->min_mtu = ETH_ZLEN + ETH_FCS_LEN;
	dev->max_mtu = np->pkt_limit;

5755
	np->pause_flags = NV_PAUSEFRAME_RX_CAPABLE | NV_PAUSEFRAME_RX_REQ | NV_PAUSEFRAME_AUTONEG;
A
Ayaz Abdulla 已提交
5756 5757 5758
	if ((id->driver_data & DEV_HAS_PAUSEFRAME_TX_V1) ||
	    (id->driver_data & DEV_HAS_PAUSEFRAME_TX_V2) ||
	    (id->driver_data & DEV_HAS_PAUSEFRAME_TX_V3)) {
5759
		np->pause_flags |= NV_PAUSEFRAME_TX_CAPABLE | NV_PAUSEFRAME_TX_REQ;
5760
	}
5761

L
Linus Torvalds 已提交
5762
	err = -ENOMEM;
5763
	np->base = ioremap(addr, np->register_size);
L
Linus Torvalds 已提交
5764 5765
	if (!np->base)
		goto out_relreg;
5766

5767 5768 5769
	np->rx_ring_size = RX_RING_DEFAULT;
	np->tx_ring_size = TX_RING_DEFAULT;

5770
	if (!nv_optimized(np)) {
5771 5772 5773 5774 5775 5776
		np->rx_ring.orig = dma_alloc_coherent(&pci_dev->dev,
						      sizeof(struct ring_desc) *
						      (np->rx_ring_size +
						      np->tx_ring_size),
						      &np->ring_addr,
						      GFP_ATOMIC);
5777 5778
		if (!np->rx_ring.orig)
			goto out_unmap;
5779
		np->tx_ring.orig = &np->rx_ring.orig[np->rx_ring_size];
5780
	} else {
5781 5782 5783 5784 5785
		np->rx_ring.ex = dma_alloc_coherent(&pci_dev->dev,
						    sizeof(struct ring_desc_ex) *
						    (np->rx_ring_size +
						    np->tx_ring_size),
						    &np->ring_addr, GFP_ATOMIC);
5786 5787
		if (!np->rx_ring.ex)
			goto out_unmap;
5788 5789
		np->tx_ring.ex = &np->rx_ring.ex[np->rx_ring_size];
	}
5790 5791
	np->rx_skb = kcalloc(np->rx_ring_size, sizeof(struct nv_skb_map), GFP_KERNEL);
	np->tx_skb = kcalloc(np->tx_ring_size, sizeof(struct nv_skb_map), GFP_KERNEL);
A
Ayaz Abdulla 已提交
5792
	if (!np->rx_skb || !np->tx_skb)
5793
		goto out_freering;
L
Linus Torvalds 已提交
5794

5795
	if (!nv_optimized(np))
5796
		dev->netdev_ops = &nv_netdev_ops;
A
Ayaz Abdulla 已提交
5797
	else
5798
		dev->netdev_ops = &nv_netdev_ops_optimized;
5799

5800
	netif_napi_add(dev, &np->napi, nv_napi_poll, RX_WORK_PER_LOOP);
5801
	dev->ethtool_ops = &ops;
L
Linus Torvalds 已提交
5802 5803 5804 5805 5806 5807 5808 5809 5810
	dev->watchdog_timeo = NV_WATCHDOG_TIMEO;

	pci_set_drvdata(pci_dev, dev);

	/* read the mac address */
	base = get_hwbase(dev);
	np->orig_mac[0] = readl(base + NvRegMacAddrA);
	np->orig_mac[1] = readl(base + NvRegMacAddrB);

5811 5812
	/* check the workaround bit for correct mac address order */
	txreg = readl(base + NvRegTransmitPoll);
A
Ayaz Abdulla 已提交
5813
	if (id->driver_data & DEV_HAS_CORRECT_MACADDR) {
5814 5815 5816 5817 5818 5819 5820
		/* mac address is already in correct order */
		dev->dev_addr[0] = (np->orig_mac[0] >>  0) & 0xff;
		dev->dev_addr[1] = (np->orig_mac[0] >>  8) & 0xff;
		dev->dev_addr[2] = (np->orig_mac[0] >> 16) & 0xff;
		dev->dev_addr[3] = (np->orig_mac[0] >> 24) & 0xff;
		dev->dev_addr[4] = (np->orig_mac[1] >>  0) & 0xff;
		dev->dev_addr[5] = (np->orig_mac[1] >>  8) & 0xff;
A
Ayaz Abdulla 已提交
5821 5822 5823 5824 5825 5826 5827 5828 5829 5830 5831 5832 5833 5834 5835 5836
	} else if (txreg & NVREG_TRANSMITPOLL_MAC_ADDR_REV) {
		/* mac address is already in correct order */
		dev->dev_addr[0] = (np->orig_mac[0] >>  0) & 0xff;
		dev->dev_addr[1] = (np->orig_mac[0] >>  8) & 0xff;
		dev->dev_addr[2] = (np->orig_mac[0] >> 16) & 0xff;
		dev->dev_addr[3] = (np->orig_mac[0] >> 24) & 0xff;
		dev->dev_addr[4] = (np->orig_mac[1] >>  0) & 0xff;
		dev->dev_addr[5] = (np->orig_mac[1] >>  8) & 0xff;
		/*
		 * Set orig mac address back to the reversed version.
		 * This flag will be cleared during low power transition.
		 * Therefore, we should always put back the reversed address.
		 */
		np->orig_mac[0] = (dev->dev_addr[5] << 0) + (dev->dev_addr[4] << 8) +
			(dev->dev_addr[3] << 16) + (dev->dev_addr[2] << 24);
		np->orig_mac[1] = (dev->dev_addr[1] << 0) + (dev->dev_addr[0] << 8);
5837 5838 5839 5840 5841 5842 5843 5844 5845
	} else {
		/* need to reverse mac address to correct order */
		dev->dev_addr[0] = (np->orig_mac[1] >>  8) & 0xff;
		dev->dev_addr[1] = (np->orig_mac[1] >>  0) & 0xff;
		dev->dev_addr[2] = (np->orig_mac[0] >> 24) & 0xff;
		dev->dev_addr[3] = (np->orig_mac[0] >> 16) & 0xff;
		dev->dev_addr[4] = (np->orig_mac[0] >>  8) & 0xff;
		dev->dev_addr[5] = (np->orig_mac[0] >>  0) & 0xff;
		writel(txreg|NVREG_TRANSMITPOLL_MAC_ADDR_REV, base + NvRegTransmitPoll);
5846 5847 5848
		dev_dbg(&pci_dev->dev,
			"%s: set workaround bit for reversed mac addr\n",
			__func__);
5849
	}
L
Linus Torvalds 已提交
5850

5851
	if (!is_valid_ether_addr(dev->dev_addr)) {
L
Linus Torvalds 已提交
5852 5853 5854 5855
		/*
		 * Bad mac address. At least one bios sets the mac address
		 * to 01:23:45:67:89:ab
		 */
5856
		dev_err(&pci_dev->dev,
5857
			"Invalid MAC address detected: %pM - Please complain to your hardware vendor.\n",
5858
			dev->dev_addr);
5859
		eth_hw_addr_random(dev);
5860 5861
		dev_err(&pci_dev->dev,
			"Using random MAC address: %pM\n", dev->dev_addr);
L
Linus Torvalds 已提交
5862 5863
	}

5864 5865 5866
	/* set mac address */
	nv_copy_mac_to_hw(dev);

L
Linus Torvalds 已提交
5867 5868 5869
	/* disable WOL */
	writel(0, base + NvRegWakeUpFlags);
	np->wolenabled = 0;
5870
	device_set_wakeup_enable(&pci_dev->dev, false);
L
Linus Torvalds 已提交
5871

5872 5873 5874 5875 5876
	if (id->driver_data & DEV_HAS_POWER_CNTRL) {

		/* take phy and nic out of low power mode */
		powerstate = readl(base + NvRegPowerState2);
		powerstate &= ~NVREG_POWERSTATE2_POWERUP_MASK;
5877
		if ((id->driver_data & DEV_NEED_LOW_POWER_FIX) &&
5878
		    pci_dev->revision >= 0xA3)
5879 5880 5881 5882
			powerstate |= NVREG_POWERSTATE2_POWERUP_REV_A3;
		writel(powerstate, base + NvRegPowerState2);
	}

5883
	if (np->desc_ver == DESC_VER_1)
5884
		np->tx_flags = NV_TX_VALID;
5885
	else
5886
		np->tx_flags = NV_TX2_VALID;
5887 5888

	np->msi_flags = 0;
5889
	if ((id->driver_data & DEV_HAS_MSI) && msi)
5890
		np->msi_flags |= NV_MSI_CAPABLE;
5891

5892 5893 5894 5895
	if ((id->driver_data & DEV_HAS_MSI_X) && msix) {
		/* msix has had reported issues when modifying irqmask
		   as in the case of napi, therefore, disable for now
		*/
5896
#if 0
5897 5898 5899 5900 5901
		np->msi_flags |= NV_MSI_X_CAPABLE;
#endif
	}

	if (optimization_mode == NV_OPTIMIZATION_MODE_CPU) {
5902
		np->irqmask = NVREG_IRQMASK_CPU;
5903 5904
		if (np->msi_flags & NV_MSI_X_CAPABLE) /* set number of vectors */
			np->msi_flags |= 0x0001;
5905 5906 5907 5908 5909 5910 5911 5912 5913 5914 5915
	} else if (optimization_mode == NV_OPTIMIZATION_MODE_DYNAMIC &&
		   !(id->driver_data & DEV_NEED_TIMERIRQ)) {
		/* start off in throughput mode */
		np->irqmask = NVREG_IRQMASK_THROUGHPUT;
		/* remove support for msix mode */
		np->msi_flags &= ~NV_MSI_X_CAPABLE;
	} else {
		optimization_mode = NV_OPTIMIZATION_MODE_THROUGHPUT;
		np->irqmask = NVREG_IRQMASK_THROUGHPUT;
		if (np->msi_flags & NV_MSI_X_CAPABLE) /* set number of vectors */
			np->msi_flags |= 0x0003;
5916
	}
5917

L
Linus Torvalds 已提交
5918 5919 5920 5921 5922 5923 5924 5925 5926
	if (id->driver_data & DEV_NEED_TIMERIRQ)
		np->irqmask |= NVREG_IRQ_TIMER;
	if (id->driver_data & DEV_NEED_LINKTIMER) {
		np->need_linktimer = 1;
		np->link_timeout = jiffies + LINK_TIMEOUT;
	} else {
		np->need_linktimer = 0;
	}

A
Ayaz Abdulla 已提交
5927 5928 5929
	/* Limit the number of tx's outstanding for hw bug */
	if (id->driver_data & DEV_NEED_TX_LIMIT) {
		np->tx_limit = 1;
5930
		if (((id->driver_data & DEV_NEED_TX_LIMIT2) == DEV_NEED_TX_LIMIT2) &&
A
Ayaz Abdulla 已提交
5931 5932 5933 5934
		    pci_dev->revision >= 0xA2)
			np->tx_limit = 0;
	}

5935 5936 5937 5938 5939 5940 5941 5942
	/* clear phy state and temporarily halt phy interrupts */
	writel(0, base + NvRegMIIMask);
	phystate = readl(base + NvRegAdapterControl);
	if (phystate & NVREG_ADAPTCTL_RUNNING) {
		phystate_orig = 1;
		phystate &= ~NVREG_ADAPTCTL_RUNNING;
		writel(phystate, base + NvRegAdapterControl);
	}
A
Ayaz Abdulla 已提交
5943
	writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus);
5944 5945 5946

	if (id->driver_data & DEV_HAS_MGMT_UNIT) {
		/* management unit running on the mac? */
A
Ayaz Abdulla 已提交
5947 5948 5949 5950 5951
		if ((readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_MGMT_ST) &&
		    (readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_SYNC_PHY_INIT) &&
		    nv_mgmt_acquire_sema(dev) &&
		    nv_mgmt_get_version(dev)) {
			np->mac_in_use = 1;
5952
			if (np->mgmt_version > 0)
A
Ayaz Abdulla 已提交
5953 5954 5955 5956 5957 5958 5959 5960 5961
				np->mac_in_use = readl(base + NvRegMgmtUnitControl) & NVREG_MGMTUNITCONTROL_INUSE;
			/* management unit setup the phy already? */
			if (np->mac_in_use &&
			    ((readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_SYNC_MASK) ==
			     NVREG_XMITCTL_SYNC_PHY_INIT)) {
				/* phy is inited by mgmt unit */
				phyinitialized = 1;
			} else {
				/* we need to init the phy */
5962 5963 5964 5965
			}
		}
	}

L
Linus Torvalds 已提交
5966
	/* find a suitable phy */
5967
	for (i = 1; i <= 32; i++) {
L
Linus Torvalds 已提交
5968
		int id1, id2;
5969
		int phyaddr = i & 0x1F;
L
Linus Torvalds 已提交
5970 5971

		spin_lock_irq(&np->lock);
5972
		id1 = mii_rw(dev, phyaddr, MII_PHYSID1, MII_READ);
L
Linus Torvalds 已提交
5973 5974 5975 5976
		spin_unlock_irq(&np->lock);
		if (id1 < 0 || id1 == 0xffff)
			continue;
		spin_lock_irq(&np->lock);
5977
		id2 = mii_rw(dev, phyaddr, MII_PHYSID2, MII_READ);
L
Linus Torvalds 已提交
5978 5979 5980 5981
		spin_unlock_irq(&np->lock);
		if (id2 < 0 || id2 == 0xffff)
			continue;

5982
		np->phy_model = id2 & PHYID2_MODEL_MASK;
L
Linus Torvalds 已提交
5983 5984
		id1 = (id1 & PHYID1_OUI_MASK) << PHYID1_OUI_SHFT;
		id2 = (id2 & PHYID2_OUI_MASK) >> PHYID2_OUI_SHFT;
5985
		np->phyaddr = phyaddr;
L
Linus Torvalds 已提交
5986
		np->phy_oui = id1 | id2;
5987 5988 5989 5990 5991 5992 5993 5994

		/* Realtek hardcoded phy id1 to all zero's on certain phys */
		if (np->phy_oui == PHY_OUI_REALTEK2)
			np->phy_oui = PHY_OUI_REALTEK;
		/* Setup phy revision for Realtek */
		if (np->phy_oui == PHY_OUI_REALTEK && np->phy_model == PHY_MODEL_REALTEK_8211)
			np->phy_rev = mii_rw(dev, phyaddr, MII_RESV1, MII_READ) & PHY_REV_MASK;

L
Linus Torvalds 已提交
5995 5996
		break;
	}
5997
	if (i == 33) {
5998
		dev_info(&pci_dev->dev, "open: Could not find a valid PHY\n");
5999
		goto out_error;
L
Linus Torvalds 已提交
6000
	}
6001

6002 6003 6004
	if (!phyinitialized) {
		/* reset it */
		phy_init(dev);
6005 6006 6007
	} else {
		/* see if it is a gigabit phy */
		u32 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ);
6008
		if (mii_status & PHY_GIGABIT)
6009
			np->gigabit = PHY_GIGABIT;
6010
	}
L
Linus Torvalds 已提交
6011 6012 6013 6014 6015 6016 6017 6018

	/* set default link speed settings */
	np->linkspeed = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10;
	np->duplex = 0;
	np->autoneg = 1;

	err = register_netdev(dev);
	if (err) {
6019
		dev_info(&pci_dev->dev, "unable to register netdev: %d\n", err);
6020
		goto out_error;
L
Linus Torvalds 已提交
6021
	}
6022

6023 6024 6025 6026 6027 6028 6029 6030 6031 6032
	netif_carrier_off(dev);

	/* Some NICs freeze when TX pause is enabled while NIC is
	 * down, and this stays across warm reboots. The sequence
	 * below should be enough to recover from that state.
	 */
	nv_update_pause(dev, 0);
	nv_start_tx(dev);
	nv_stop_tx(dev);

6033 6034
	if (id->driver_data & DEV_HAS_VLAN)
		nv_vlan_mode(dev, dev->features);
J
Jiri Pirko 已提交
6035

6036 6037 6038
	dev_info(&pci_dev->dev, "ifname %s, PHY OUI 0x%x @ %d, addr %pM\n",
		 dev->name, np->phy_oui, np->phyaddr, dev->dev_addr);

6039
	dev_info(&pci_dev->dev, "%s%s%s%s%s%s%s%s%s%s%sdesc-v%u\n",
6040 6041
		 dev->features & NETIF_F_HIGHDMA ? "highdma " : "",
		 dev->features & (NETIF_F_IP_CSUM | NETIF_F_SG) ?
6042
			"csum " : "",
6043 6044
		 dev->features & (NETIF_F_HW_VLAN_CTAG_RX |
				  NETIF_F_HW_VLAN_CTAG_TX) ?
6045
			"vlan " : "",
6046 6047
		 dev->features & (NETIF_F_LOOPBACK) ?
			"loopback " : "",
6048 6049 6050 6051 6052 6053 6054 6055
		 id->driver_data & DEV_HAS_POWER_CNTRL ? "pwrctl " : "",
		 id->driver_data & DEV_HAS_MGMT_UNIT ? "mgmt " : "",
		 id->driver_data & DEV_NEED_TIMERIRQ ? "timirq " : "",
		 np->gigabit == PHY_GIGABIT ? "gbit " : "",
		 np->need_linktimer ? "lnktim " : "",
		 np->msi_flags & NV_MSI_CAPABLE ? "msi " : "",
		 np->msi_flags & NV_MSI_X_CAPABLE ? "msi-x " : "",
		 np->desc_ver);
L
Linus Torvalds 已提交
6056 6057 6058

	return 0;

6059
out_error:
6060 6061
	if (phystate_orig)
		writel(phystate|NVREG_ADAPTCTL_RUNNING, base + NvRegAdapterControl);
6062 6063
out_freering:
	free_rings(dev);
L
Linus Torvalds 已提交
6064 6065 6066 6067 6068 6069 6070 6071 6072 6073 6074 6075
out_unmap:
	iounmap(get_hwbase(dev));
out_relreg:
	pci_release_regions(pci_dev);
out_disable:
	pci_disable_device(pci_dev);
out_free:
	free_netdev(dev);
out:
	return err;
}

6076 6077 6078 6079 6080 6081 6082 6083 6084 6085 6086 6087 6088 6089 6090 6091 6092 6093 6094 6095 6096 6097
static void nv_restore_phy(struct net_device *dev)
{
	struct fe_priv *np = netdev_priv(dev);
	u16 phy_reserved, mii_control;

	if (np->phy_oui == PHY_OUI_REALTEK &&
	    np->phy_model == PHY_MODEL_REALTEK_8201 &&
	    phy_cross == NV_CROSSOVER_DETECTION_DISABLED) {
		mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3);
		phy_reserved = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, MII_READ);
		phy_reserved &= ~PHY_REALTEK_INIT_MSK1;
		phy_reserved |= PHY_REALTEK_INIT8;
		mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, phy_reserved);
		mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1);

		/* restart auto negotiation */
		mii_control = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ);
		mii_control |= (BMCR_ANRESTART | BMCR_ANENABLE);
		mii_rw(dev, np->phyaddr, MII_BMCR, mii_control);
	}
}

6098
static void nv_restore_mac_addr(struct pci_dev *pci_dev)
L
Linus Torvalds 已提交
6099 6100
{
	struct net_device *dev = pci_get_drvdata(pci_dev);
6101 6102
	struct fe_priv *np = netdev_priv(dev);
	u8 __iomem *base = get_hwbase(dev);
L
Linus Torvalds 已提交
6103

6104 6105 6106 6107 6108
	/* special op: write back the misordered MAC address - otherwise
	 * the next nv_probe would see a wrong address.
	 */
	writel(np->orig_mac[0], base + NvRegMacAddrA);
	writel(np->orig_mac[1], base + NvRegMacAddrB);
6109 6110
	writel(readl(base + NvRegTransmitPoll) & ~NVREG_TRANSMITPOLL_MAC_ADDR_REV,
	       base + NvRegTransmitPoll);
6111 6112
}

6113
static void nv_remove(struct pci_dev *pci_dev)
6114 6115 6116 6117 6118 6119
{
	struct net_device *dev = pci_get_drvdata(pci_dev);

	unregister_netdev(dev);

	nv_restore_mac_addr(pci_dev);
6120

6121 6122 6123
	/* restore any phy related changes */
	nv_restore_phy(dev);

A
Ayaz Abdulla 已提交
6124 6125
	nv_mgmt_release_sema(dev);

L
Linus Torvalds 已提交
6126
	/* free all structures */
6127
	free_rings(dev);
L
Linus Torvalds 已提交
6128 6129 6130 6131 6132 6133
	iounmap(get_hwbase(dev));
	pci_release_regions(pci_dev);
	pci_disable_device(pci_dev);
	free_netdev(dev);
}

6134
#ifdef CONFIG_PM_SLEEP
6135
static int nv_suspend(struct device *device)
6136
{
6137
	struct pci_dev *pdev = to_pci_dev(device);
6138 6139
	struct net_device *dev = pci_get_drvdata(pdev);
	struct fe_priv *np = netdev_priv(dev);
6140 6141
	u8 __iomem *base = get_hwbase(dev);
	int i;
6142

6143
	if (netif_running(dev)) {
6144
		/* Gross. */
6145 6146
		nv_close(dev);
	}
6147 6148
	netif_device_detach(dev);

6149
	/* save non-pci configuration space */
6150
	for (i = 0; i <= np->register_size/sizeof(u32); i++)
6151 6152
		np->saved_config_space[i] = readl(base + i*sizeof(u32));

6153 6154 6155
	return 0;
}

6156
static int nv_resume(struct device *device)
6157
{
6158
	struct pci_dev *pdev = to_pci_dev(device);
6159
	struct net_device *dev = pci_get_drvdata(pdev);
6160
	struct fe_priv *np = netdev_priv(dev);
A
Ayaz Abdulla 已提交
6161
	u8 __iomem *base = get_hwbase(dev);
6162
	int i, rc = 0;
6163

6164
	/* restore non-pci configuration space */
6165
	for (i = 0; i <= np->register_size/sizeof(u32); i++)
6166
		writel(np->saved_config_space[i], base+i*sizeof(u32));
A
Ayaz Abdulla 已提交
6167

6168 6169
	if (np->driver_data & DEV_NEED_MSI_FIX)
		pci_write_config_dword(pdev, NV_MSI_PRIV_OFFSET, NV_MSI_PRIV_VALUE);
A
Ayaz Abdulla 已提交
6170

6171 6172 6173
	/* restore phy state, including autoneg */
	phy_init(dev);

6174 6175 6176 6177 6178
	netif_device_attach(dev);
	if (netif_running(dev)) {
		rc = nv_open(dev);
		nv_set_multicast(dev);
	}
6179 6180
	return rc;
}
6181

6182 6183 6184
static SIMPLE_DEV_PM_OPS(nv_pm_ops, nv_suspend, nv_resume);
#define NV_PM_OPS (&nv_pm_ops)

6185 6186 6187 6188 6189
#else
#define NV_PM_OPS NULL
#endif /* CONFIG_PM_SLEEP */

#ifdef CONFIG_PM
6190 6191 6192 6193 6194 6195 6196 6197
static void nv_shutdown(struct pci_dev *pdev)
{
	struct net_device *dev = pci_get_drvdata(pdev);
	struct fe_priv *np = netdev_priv(dev);

	if (netif_running(dev))
		nv_close(dev);

6198 6199 6200 6201 6202
	/*
	 * Restore the MAC so a kernel started by kexec won't get confused.
	 * If we really go for poweroff, we must not restore the MAC,
	 * otherwise the MAC for WOL will be reversed at least on some boards.
	 */
6203
	if (system_state != SYSTEM_POWER_OFF)
6204
		nv_restore_mac_addr(pdev);
6205

6206
	pci_disable_device(pdev);
6207 6208 6209 6210
	/*
	 * Apparently it is not possible to reinitialise from D3 hot,
	 * only put the device into D3 if we really go for poweroff.
	 */
6211
	if (system_state == SYSTEM_POWER_OFF) {
6212
		pci_wake_from_d3(pdev, np->wolenabled);
6213 6214
		pci_set_power_state(pdev, PCI_D3hot);
	}
6215
}
6216
#else
6217
#define nv_shutdown NULL
6218 6219
#endif /* CONFIG_PM */

6220
static const struct pci_device_id pci_tbl[] = {
L
Linus Torvalds 已提交
6221
	{	/* nForce Ethernet Controller */
6222
		PCI_DEVICE(0x10DE, 0x01C3),
6223
		.driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER,
L
Linus Torvalds 已提交
6224 6225
	},
	{	/* nForce2 Ethernet Controller */
6226
		PCI_DEVICE(0x10DE, 0x0066),
6227
		.driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER,
L
Linus Torvalds 已提交
6228 6229
	},
	{	/* nForce3 Ethernet Controller */
6230
		PCI_DEVICE(0x10DE, 0x00D6),
6231
		.driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER,
L
Linus Torvalds 已提交
6232 6233
	},
	{	/* nForce3 Ethernet Controller */
6234
		PCI_DEVICE(0x10DE, 0x0086),
6235
		.driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM,
L
Linus Torvalds 已提交
6236 6237
	},
	{	/* nForce3 Ethernet Controller */
6238
		PCI_DEVICE(0x10DE, 0x008C),
6239
		.driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM,
L
Linus Torvalds 已提交
6240 6241
	},
	{	/* nForce3 Ethernet Controller */
6242
		PCI_DEVICE(0x10DE, 0x00E6),
6243
		.driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM,
L
Linus Torvalds 已提交
6244 6245
	},
	{	/* nForce3 Ethernet Controller */
6246
		PCI_DEVICE(0x10DE, 0x00DF),
6247
		.driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM,
L
Linus Torvalds 已提交
6248 6249
	},
	{	/* CK804 Ethernet Controller */
6250
		PCI_DEVICE(0x10DE, 0x0056),
6251
		.driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT,
L
Linus Torvalds 已提交
6252 6253
	},
	{	/* CK804 Ethernet Controller */
6254
		PCI_DEVICE(0x10DE, 0x0057),
6255
		.driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT,
L
Linus Torvalds 已提交
6256 6257
	},
	{	/* MCP04 Ethernet Controller */
6258
		PCI_DEVICE(0x10DE, 0x0037),
6259
		.driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT,
L
Linus Torvalds 已提交
6260 6261
	},
	{	/* MCP04 Ethernet Controller */
6262
		PCI_DEVICE(0x10DE, 0x0038),
6263
		.driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT,
L
Linus Torvalds 已提交
6264
	},
6265
	{	/* MCP51 Ethernet Controller */
6266 6267
		PCI_DEVICE(0x10DE, 0x0268),
		.driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_STATISTICS_V1|DEV_NEED_LOW_POWER_FIX,
6268 6269
	},
	{	/* MCP51 Ethernet Controller */
6270 6271
		PCI_DEVICE(0x10DE, 0x0269),
		.driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_STATISTICS_V1|DEV_NEED_LOW_POWER_FIX,
6272
	},
6273
	{	/* MCP55 Ethernet Controller */
6274
		PCI_DEVICE(0x10DE, 0x0372),
6275
		.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,
6276 6277
	},
	{	/* MCP55 Ethernet Controller */
6278
		PCI_DEVICE(0x10DE, 0x0373),
6279
		.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,
6280
	},
A
Ayaz Abdulla 已提交
6281
	{	/* MCP61 Ethernet Controller */
6282
		PCI_DEVICE(0x10DE, 0x03E5),
6283
		.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,
A
Ayaz Abdulla 已提交
6284 6285
	},
	{	/* MCP61 Ethernet Controller */
6286
		PCI_DEVICE(0x10DE, 0x03E6),
6287
		.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,
A
Ayaz Abdulla 已提交
6288 6289
	},
	{	/* MCP61 Ethernet Controller */
6290
		PCI_DEVICE(0x10DE, 0x03EE),
6291
		.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,
A
Ayaz Abdulla 已提交
6292 6293
	},
	{	/* MCP61 Ethernet Controller */
6294
		PCI_DEVICE(0x10DE, 0x03EF),
6295
		.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,
A
Ayaz Abdulla 已提交
6296 6297
	},
	{	/* MCP65 Ethernet Controller */
6298
		PCI_DEVICE(0x10DE, 0x0450),
6299
		.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,
A
Ayaz Abdulla 已提交
6300 6301
	},
	{	/* MCP65 Ethernet Controller */
6302
		PCI_DEVICE(0x10DE, 0x0451),
6303
		.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,
A
Ayaz Abdulla 已提交
6304 6305
	},
	{	/* MCP65 Ethernet Controller */
6306
		PCI_DEVICE(0x10DE, 0x0452),
6307
		.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,
A
Ayaz Abdulla 已提交
6308 6309
	},
	{	/* MCP65 Ethernet Controller */
6310
		PCI_DEVICE(0x10DE, 0x0453),
6311
		.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,
A
Ayaz Abdulla 已提交
6312
	},
6313
	{	/* MCP67 Ethernet Controller */
6314
		PCI_DEVICE(0x10DE, 0x054C),
6315
		.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,
6316 6317
	},
	{	/* MCP67 Ethernet Controller */
6318
		PCI_DEVICE(0x10DE, 0x054D),
6319
		.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,
6320 6321
	},
	{	/* MCP67 Ethernet Controller */
6322
		PCI_DEVICE(0x10DE, 0x054E),
6323
		.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,
6324 6325
	},
	{	/* MCP67 Ethernet Controller */
6326
		PCI_DEVICE(0x10DE, 0x054F),
6327
		.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,
6328
	},
A
Ayaz Abdulla 已提交
6329
	{	/* MCP73 Ethernet Controller */
6330
		PCI_DEVICE(0x10DE, 0x07DC),
6331
		.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,
A
Ayaz Abdulla 已提交
6332 6333
	},
	{	/* MCP73 Ethernet Controller */
6334
		PCI_DEVICE(0x10DE, 0x07DD),
6335
		.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,
A
Ayaz Abdulla 已提交
6336 6337
	},
	{	/* MCP73 Ethernet Controller */
6338
		PCI_DEVICE(0x10DE, 0x07DE),
6339
		.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,
A
Ayaz Abdulla 已提交
6340 6341
	},
	{	/* MCP73 Ethernet Controller */
6342
		PCI_DEVICE(0x10DE, 0x07DF),
6343
		.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,
A
Ayaz Abdulla 已提交
6344
	},
6345
	{	/* MCP77 Ethernet Controller */
6346
		PCI_DEVICE(0x10DE, 0x0760),
6347
		.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,
6348 6349
	},
	{	/* MCP77 Ethernet Controller */
6350
		PCI_DEVICE(0x10DE, 0x0761),
6351
		.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,
6352 6353
	},
	{	/* MCP77 Ethernet Controller */
6354
		PCI_DEVICE(0x10DE, 0x0762),
6355
		.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,
6356 6357
	},
	{	/* MCP77 Ethernet Controller */
6358
		PCI_DEVICE(0x10DE, 0x0763),
6359
		.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,
6360
	},
A
Ayaz Abdulla 已提交
6361
	{	/* MCP79 Ethernet Controller */
6362
		PCI_DEVICE(0x10DE, 0x0AB0),
6363
		.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,
A
Ayaz Abdulla 已提交
6364 6365
	},
	{	/* MCP79 Ethernet Controller */
6366
		PCI_DEVICE(0x10DE, 0x0AB1),
6367
		.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,
A
Ayaz Abdulla 已提交
6368 6369
	},
	{	/* MCP79 Ethernet Controller */
6370
		PCI_DEVICE(0x10DE, 0x0AB2),
6371
		.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,
A
Ayaz Abdulla 已提交
6372 6373
	},
	{	/* MCP79 Ethernet Controller */
6374
		PCI_DEVICE(0x10DE, 0x0AB3),
6375
		.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,
A
Ayaz Abdulla 已提交
6376
	},
6377 6378
	{	/* MCP89 Ethernet Controller */
		PCI_DEVICE(0x10DE, 0x0D7D),
6379
		.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,
6380
	},
L
Linus Torvalds 已提交
6381 6382 6383
	{0,},
};

6384
static struct pci_driver forcedeth_pci_driver = {
6385 6386 6387
	.name		= DRV_NAME,
	.id_table	= pci_tbl,
	.probe		= nv_probe,
6388
	.remove		= nv_remove,
6389
	.shutdown	= nv_shutdown,
6390
	.driver.pm	= NV_PM_OPS,
L
Linus Torvalds 已提交
6391 6392 6393 6394
};

module_param(max_interrupt_work, int, 0);
MODULE_PARM_DESC(max_interrupt_work, "forcedeth maximum events handled per interrupt");
6395
module_param(optimization_mode, int, 0);
6396
MODULE_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.");
6397 6398
module_param(poll_interval, int, 0);
MODULE_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.");
6399 6400 6401 6402 6403 6404
module_param(msi, int, 0);
MODULE_PARM_DESC(msi, "MSI interrupts are enabled by setting to 1 and disabled by setting to 0.");
module_param(msix, int, 0);
MODULE_PARM_DESC(msix, "MSIX interrupts are enabled by setting to 1 and disabled by setting to 0.");
module_param(dma_64bit, int, 0);
MODULE_PARM_DESC(dma_64bit, "High DMA is enabled by setting to 1 and disabled by setting to 0.");
6405 6406
module_param(phy_cross, int, 0);
MODULE_PARM_DESC(phy_cross, "Phy crossover detection for Realtek 8201 phy is enabled by setting to 1 and disabled by setting to 0.");
6407 6408
module_param(phy_power_down, int, 0);
MODULE_PARM_DESC(phy_power_down, "Power down phy and disable link when interface is down (1), or leave phy powered up (0).");
6409 6410 6411
module_param(debug_tx_timeout, bool, 0);
MODULE_PARM_DESC(debug_tx_timeout,
		 "Dump tx related registers and ring when tx_timeout happens");
L
Linus Torvalds 已提交
6412

6413
module_pci_driver(forcedeth_pci_driver);
L
Linus Torvalds 已提交
6414 6415 6416 6417
MODULE_AUTHOR("Manfred Spraul <manfred@colorfullife.com>");
MODULE_DESCRIPTION("Reverse Engineered nForce ethernet driver");
MODULE_LICENSE("GPL");
MODULE_DEVICE_TABLE(pci, pci_tbl);